#include <stdio.h>
#include "pico/stdlib.h"
#include "hardware/gpio.h"

#define LED1R 13
#define LED2R 11
#define LED2G 12
#define LED3G 10

#define BTN 5



int main() {
  stdio_init_all();

  gpio_init(BTN);
  gpio_set_dir(BTN,GPIO_IN);
  gpio_pull_up(4);


  gpio_init(LED1R);
  gpio_init(LED2R);
  gpio_init(LED2G);
  gpio_init(LED3G);

  gpio_set_dir(LED1R, true);
  gpio_set_dir(LED2R, true);
  gpio_set_dir(LED2G, true);
  gpio_set_dir(LED3G, true);

  while (true) {

    if (gpio_get(BTN)== 0){
      printf("oii");
      semaforoN();
    }
  }

}

void semaforoN(){
  gpio_put(LED1R, true);
  sleep_ms(4000);
  gpio_put(LED1R, false);
  gpio_put(LED2G, true);
  gpio_put(LED2R, true);
  sleep_ms(2000);
  gpio_put(LED2G, false);
  gpio_put(LED2R, false);
  gpio_put(LED3G, true);
  sleep_ms(2000);
  gpio_put(LED3G, false);
}

/*void semaforoP(){
  gpio_put(LED2R,true);
  gpio_put(LED2G,true);
  sleep_ms(4000);
  gpio_put(LED2R,false);
  gpio_put(LED2G,false);
  gpio_put(LED1R,true);
  sleep_ms(4000);
  sleep_ms(LED1R,false); 
} */