#include <stdio.h>
#include "pico/stdlib.h"
#include "hardware/pio.h"
#include "pio_program.h"
#include "constants.h"

const PIO pio_num = 0;
const uint sm_num = 0;

int main() {
  stdio_init_all();
  
  printf("LED Begin!\n");
  sleep_ms(1000);
  uint offset_test = pio_add_program(pio_num, &test_program);
  test_program_init(pio_num, sm_num, offset_test);
  pio_sm_set_enabled(pio_num, sm_num, true);

  sleep_ms(2000);

  //pio_payload payload = {};
  while (1) {
      printf("Sending 0b111111111\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b111111111);
      sleep_ms(2000);

      printf("Sending 0b000000000\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b000000000);
      sleep_ms(2000);

      printf("Sending 0b011111111\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b011111111);
      sleep_ms(2000);

      printf("Sending 0b100000000\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b100000000);
      sleep_ms(2000);

      printf("Sending 0b111111111\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b111111111);
      sleep_ms(2000);

      printf("Sending 0b000000000\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b000000000);
      sleep_ms(2000);

      printf("Sending 0b111111110\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b111111110);
      sleep_ms(2000);

      printf("Sending 0b000000001\n");
      pio_sm_put_blocking(pio_num, sm_num, 0b000000001);
      sleep_ms(2000);
  }
}