#define LED_VANG_1 PA12
#define LED_VANG_2 PA1
#define LED_DO_1 PB0
#define LED_DO_2 PA3
#define LED_XANH_1 PB7
#define LED_XANH_2 PA4

void stage1()
{
  digitalWrite(LED_XANH_1, HIGH);
  digitalWrite(LED_DO_1, LOW);
  digitalWrite(LED_VANG_1, LOW);
    
  digitalWrite(LED_DO_2, HIGH);
  digitalWrite(LED_XANH_2, LOW);
  digitalWrite(LED_VANG_2, LOW);
  delay(5000);
}

void stage2()
{
  digitalWrite(LED_XANH_1, LOW);
  digitalWrite(LED_DO_1, HIGH);
  digitalWrite(LED_VANG_1, LOW);
    
  digitalWrite(LED_DO_2, LOW);
  digitalWrite(LED_XANH_2, HIGH);
  digitalWrite(LED_VANG_2, LOW);
  delay(5000);
}

void Vang_1()
{
  digitalWrite(LED_XANH_1, LOW);
  digitalWrite(LED_DO_1, LOW);
  digitalWrite(LED_VANG_1, HIGH);
    
  digitalWrite(LED_DO_2, LOW);
  digitalWrite(LED_XANH_2, LOW);
  digitalWrite(LED_VANG_2, LOW);  
  delay(1000);
}

void Vang_2()
{
  digitalWrite(LED_XANH_1, LOW);
  digitalWrite(LED_DO_1, LOW);
  digitalWrite(LED_VANG_1, LOW);
    
  digitalWrite(LED_DO_2, LOW);
  digitalWrite(LED_XANH_2, LOW);
  digitalWrite(LED_VANG_2, HIGH);  
  delay(1000);
}


void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, STM32!");
  pinMode(LED_DO_1, OUTPUT);
  pinMode(LED_VANG_1, OUTPUT);
  pinMode(LED_XANH_1, OUTPUT);

  pinMode(LED_DO_2, OUTPUT);
  pinMode(LED_VANG_2, OUTPUT);
  pinMode(LED_XANH_2, OUTPUT);

  // Thiết lập trạng thái ban đầu: Làn 1 Xanh, Làn 2 Đỏ
  digitalWrite(LED_XANH_1, HIGH);
  digitalWrite(LED_DO_2, HIGH);
}

void loop() {
  stage1();
  Vang_1();
  stage2();
  Vang_2();
  // put your main code here, to run repeatedly:
  delay(10); // this speeds up the simulation
}