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

#define sm_Amenos 14
#define sm_Amais 13
#define sm_Bmais 12
#define sm_Bmenos 11

uint8_t sm_pin [4] = {sm_Amenos, sm_Amais, sm_Bmenos, sm_Bmais};

bool sm_monofasico[4][4] = {{1,0,0,0}, {0,0,1,0}, {0,1,0,0}, {0,0,0,1}};
bool sm_bifasico[4][4] = {{1,0,0,1}, {1,0,1,0}, {0,1,1,0}, {0,1,0,1}};

int main() {
stdio_init_all();

for (uint8_t i=0; i<4; i++) {
  gpio_init(sm_pin[i]);
  gpio_set_dir(sm_pin[i], GPIO_OUT);
}

  while (true){
    for (int8_t step = 0; step<4; step++){
      for (uint8_t i=0; i<4; i++){
        gpio_put (sm_pin[i], sm_monofasico[step][i]);
      }
    sleep_ms(20);
    }
  }
}