/* ================================================
   DEMO RTOS CONCEPT - STM32 Bluepill
   Tanpa library tambahan - pakai millis()
   Konsep: Cooperative Multitasking
   Mirip FreeRTOS tapi tanpa overhead kernel
   ================================================ */
 
#define R1 PA0
#define J1 PA1
#define V1 PA2

#define R2 PA3
#define J2 PA4
#define V2 PA5

void setup() {
  pinMode(R1, OUTPUT);
  pinMode(J1, OUTPUT);
  pinMode(V1, OUTPUT);

  pinMode(R2, OUTPUT);
  pinMode(J2, OUTPUT);
  pinMode(V2, OUTPUT);
}

void loop() {

  // Route 1 verte
  digitalWrite(V1, HIGH);
  digitalWrite(R2, HIGH);

  digitalWrite(R1, LOW);
  digitalWrite(J1, LOW);
  digitalWrite(J2, LOW);
  digitalWrite(V2, LOW);

  delay(5000);

  // Route 1 jaune
  digitalWrite(V1, LOW);
  digitalWrite(J1, HIGH);

  delay(2000);

  // Passage à la route 2
  digitalWrite(J1, LOW);
  digitalWrite(R2, LOW);

  digitalWrite(R1, HIGH);
  digitalWrite(V2, HIGH);

  delay(5000);

  // Route 2 jaune
  digitalWrite(V2, LOW);
  digitalWrite(J2, HIGH);

  delay(2000);

  digitalWrite(J2, LOW);
  digitalWrite(R1, LOW);
}