#include "stm32c0xx_hal.h"

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

#define IR_SENSOR_Pin            GPIO_PIN_1 // PA1
#define IR_SENSOR_GPIO_Port      GPIOA

// RGB LED
#define LED_R_Pin                GPIO_PIN_0 // PB0
#define LED_G_Pin                GPIO_PIN_1 // PB1
#define LED_B_Pin                GPIO_PIN_2 // PB2
#define LED_GPIO_Port            GPIOB

#define BUZZER_Pin               GPIO_PIN_3 // PB3
#define BUZZER_GPIO_Port         GPIOB

// --- PROTOTIPE ---
void SystemClock_Config(void);
static void MX_GPIO_Init(void);

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

  while (1)
  {
    // Cek tombol utama
    if (HAL_GPIO_ReadPin(GPIOA, BUTTON_REVERSE_Pin) == GPIO_PIN_SET)
    {
      // Tidak ada objek (sensor HIGH)
      if (HAL_GPIO_ReadPin(GPIOA, IR_SENSOR_Pin) == GPIO_PIN_SET)
      {
        // >>> SEKARANG JADI MERAH <<<
        HAL_GPIO_WritePin(GPIOB, LED_R_Pin, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, LED_G_Pin, GPIO_PIN_RESET);
        HAL_GPIO_WritePin(GPIOB, LED_B_Pin, GPIO_PIN_RESET);

        HAL_GPIO_WritePin(GPIOB, BUZZER_Pin, GPIO_PIN_RESET); // buzzer mati
      }
      // Ada objek (sensor LOW)
      else
      {
        // >>> SEKARANG JADI KUNING (MERAH + HIJAU) <<<
        HAL_GPIO_WritePin(GPIOB, LED_R_Pin, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, LED_G_Pin, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, LED_B_Pin, GPIO_PIN_RESET);

        HAL_GPIO_WritePin(GPIOB, BUZZER_Pin, GPIO_PIN_SET); // buzzer bunyi
      }
    }
    else
    {
      // Semua mati
      HAL_GPIO_WritePin(GPIOB, LED_R_Pin | LED_G_Pin | LED_B_Pin | BUZZER_Pin, GPIO_PIN_RESET);
    }

    HAL_Delay(50);
  }
}

// --- CLOCK ---
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;

  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();
  }
}

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

  __HAL_RCC_GPIOA_CLK_ENABLE();
  __HAL_RCC_GPIOB_CLK_ENABLE();

  // INPUT (PA0 & PA1)
  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);

  // OUTPUT (RGB + BUZZER)
  GPIO_InitStruct.Pin = LED_R_Pin | LED_G_Pin | LED_B_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);

  // Default mati
  HAL_GPIO_WritePin(GPIOB, LED_R_Pin | LED_G_Pin | LED_B_Pin | BUZZER_Pin, GPIO_PIN_RESET);
}