#include <stdio.h>
#include "pico/stdlib.h"
#include "pico/cyw43_arch.h"

#define LED_VD 13
#define LED_VM 12
#define LED_AZ 11
#define ButtonA 5
#define ButtonB 6

void init();

int main() {
  stdio_init_all();
  init();
  while (true) {
    if (gpio_get(ButtonA)){
      gpio_put(LED_AZ, 1);
      gpio_put(LED_VM, 0);
      gpio_put(LED_VD, 0);
      sleep_ms(100);
    } else if (gpio_get(ButtonB)){
      gpio_put(LED_AZ, 0);
      gpio_put(LED_VM, 1);
      gpio_put(LED_VD, 0);
      sleep_ms(100);
    } else{
      gpio_put(LED_AZ, 0);
      gpio_put(LED_VM, 0);
      gpio_put(LED_VD, 0);
    }
  }
}

void init(){
  gpio_init(LED_VD);
  gpio_init(LED_VM);
  gpio_init(LED_AZ);

  gpio_set_dir(LED_VD, GPIO_OUT);
  gpio_set_dir(LED_VM, GPIO_OUT);
  gpio_set_dir(LED_AZ, GPIO_OUT);

  gpio_init(ButtonA);
  gpio_init(ButtonB);
  gpio_set_dir(ButtonA, GPIO_IN);
  gpio_set_dir(ButtonB, GPIO_IN);

  gpio_pull_down(ButtonA);
  gpio_pull_down(ButtonB);
}