#include "stm32c0xx_hal.h"

// --- DEFINISI PIN ---
#define BUTTON_REVERSE_Pin       GPIO_PIN_0 // Dihubungkan ke PA0
#define BUTTON_REVERSE_GPIO_Port GPIOA

#define IR_SENSOR_Pin            GPIO_PIN_1 // Dihubungkan ke PA1
#define IR_SENSOR_GPIO_Port      GPIOA

#define LED_GREEN_Pin            GPIO_PIN_0 // Dihubungkan ke PB0
#define LED_GREEN_GPIO_Port      GPIOB

#define LED_RED_Pin              GPIO_PIN_1 // Dihubungkan ke PB1
#define LED_RED_GPIO_Port        GPIOB

#define BUZZER_Pin               GPIO_PIN_2 // Dihubungkan ke PB2
#define BUZZER_GPIO_Port         GPIOB

// --- PROTOTIPE FUNGSI ---
void SystemClock_Config(void);
static void MX_GPIO_Init(void);
// void Error_Handler(void); -> Dihapus karena sudah ada bawaan dari sistem Wokwi/Arduino

// --- PROGRAM UTAMA ---
int main(void)
{
  HAL_Init();
  SystemClock_Config();
  MX_GPIO_Init();

  while (1)
  {
    // 1. Cek Switch/Tombol di PA0 (Sebagai saklar utama)
    if (HAL_GPIO_ReadPin(GPIOA, BUTTON_REVERSE_Pin) == GPIO_PIN_SET)
    {
      // 2. Cek Sensor IR di PA1
      // KONDISI: TIDAK MENDETEKSI BENDA (HIGH / SET)
      if (HAL_GPIO_ReadPin(GPIOA, IR_SENSOR_Pin) == GPIO_PIN_SET)
      {
        HAL_GPIO_WritePin(GPIOB, LED_RED_Pin, GPIO_PIN_RESET);   // LED Merah MATI
        HAL_GPIO_WritePin(GPIOB, LED_GREEN_Pin, GPIO_PIN_SET);   // LED Hijau NYALA
        HAL_GPIO_WritePin(GPIOB, BUZZER_Pin, GPIO_PIN_RESET);    // Buzzer BERHENTI
      }
      // KONDISI: MENDETEKSI BENDA (LOW / RESET)
      else
      {
        HAL_GPIO_WritePin(GPIOB, LED_RED_Pin, GPIO_PIN_SET);     // LED Merah NYALA
        HAL_GPIO_WritePin(GPIOB, LED_GREEN_Pin, GPIO_PIN_RESET); // LED Hijau MATI
        HAL_GPIO_WritePin(GPIOB, BUZZER_Pin, GPIO_PIN_SET);      // Buzzer BERBUNYI
      }
    }
    // Jika Switch/Tombol di PA0 posisi OFF
    else
    {
      // Matikan semua output
      HAL_GPIO_WritePin(GPIOB, LED_GREEN_Pin | LED_RED_Pin | BUZZER_Pin, GPIO_PIN_RESET);
    }

    HAL_Delay(50); // Delay untuk kestabilan simulasi
  }
}

// --- KONFIGURASI SISTEM ---
void SystemClock_Config(void)
{
  RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
  RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
  
  // Jika konfigurasi gagal, akan otomatis memanggil fungsi bawaan sistem
  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  {
    Error_Handler(); 
  }

  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_PCLK1;
  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_HSI;
  RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;

  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_0) != HAL_OK)
  {
    Error_Handler();
  }
}

// --- INISIALISASI PIN GPIO ---
static void MX_GPIO_Init(void)
{
  GPIO_InitTypeDef GPIO_InitStruct = {0};

  // Mengaktifkan Clock untuk Port A dan Port B
  __HAL_RCC_GPIOA_CLK_ENABLE();
  __HAL_RCC_GPIOB_CLK_ENABLE();

  // Konfigurasi Pin Input: PA0 (Switch) dan PA1 (IR Sensor)
  GPIO_InitStruct.Pin = BUTTON_REVERSE_Pin | IR_SENSOR_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  GPIO_InitStruct.Pull = GPIO_PULLDOWN; 
  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

  // Konfigurasi Pin Output: PB0 (LED Hijau), PB1 (LED Merah), PB2 (Buzzer)
  GPIO_InitStruct.Pin = LED_GREEN_Pin | LED_RED_Pin | BUZZER_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);

  // Set default awal: Semua Output Mati
  HAL_GPIO_WritePin(GPIOB, LED_GREEN_Pin | LED_RED_Pin | BUZZER_Pin, GPIO_PIN_RESET);
}