#include <stdio.h>
#include "pico/stdlib.h"
#define DEBOUNCE 50
int main() {
unsigned int gpio , ogpio , ngpio ;
unsigned int led_pins = 0xfc;
unsigned int sw_pin = 15;
// inialise switch y
gpio_init(sw_pin);
gpio_set_dir(sw_pin, GPIO_IN);
gpio_pull_up(sw_pin);
// Initialize LED pins
for (gpio = 2; gpio < 8; gpio ++) {
gpio_init(gpio);
gpio_set_dir(gpio , GPIO_OUT);
}
// Initialise switches A, B, X, Y
for (gpio = 12; gpio < 15; gpio ++) {
gpio_init(gpio);
gpio_set_dir(gpio , GPIO_IN);
gpio_pull_up(gpio);
}
// Loop forever
while (1) {
for (gpio = 12; gpio <15; gpio ++)
{
ogpio = gpio - 10;
ngpio = ogpio + 3;
gpio_put(ogpio , !gpio_get(gpio));
gpio_put(ngpio , !gpio_get(gpio));
if (!gpio_get(sw_pin))
{
gpio_put_masked(led_pins, led_pins);
}
sleep_ms(DEBOUNCE);
}
}
}