X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fnucleao-32%2Fao_nucleo.c;h=5854fe58860d8fa76525ce119967805d0d4a0117;hb=HEAD;hp=113e2399aaebc7fe962186a8a19469835960c76c;hpb=d2408e72d1e0d3459918601712b09860ab17e200;p=fw%2Faltos diff --git a/src/nucleao-32/ao_nucleo.c b/src/nucleao-32/ao_nucleo.c index 113e2399..5854fe58 100644 --- a/src/nucleao-32/ao_nucleo.c +++ b/src/nucleao-32/ao_nucleo.c @@ -13,57 +13,21 @@ */ #include -#include +#include -static uint16_t blink_delay, blink_running; +uint8_t ao_sensor_errors; -static void blink(void) { - blink_running = 1; - while (blink_delay) { - ao_led_on(AO_LED_GREEN); - ao_delay(blink_delay); - ao_led_off(AO_LED_GREEN); - ao_delay(blink_delay); - } - blink_running = 0; - ao_wakeup(&blink_running); - ao_exit(); -} - -struct ao_task blink_task; - -static void blink_cmd() { - ao_cmd_decimal(); - blink_delay = ao_cmd_lex_i; - if (blink_delay && !blink_running) - ao_add_task(&blink_task, blink, "blink"); - if (!blink_delay) - while (blink_running) - ao_sleep(&blink_running); -} - -static void lisp_cmd() { - ao_lisp_read_eval_print(); -} - -static const struct ao_cmds blink_cmds[] = { - { blink_cmd, "b \0Blink the green LED" }, - { lisp_cmd, "l\0Run lisp interpreter" }, - { 0, 0 } -}; - - -void main(void) +int main(void) { - ao_led_init(LEDS_AVAILABLE); + ao_led_init(); ao_clock_init(); ao_task_init(); ao_timer_init(); ao_dma_init(); ao_usb_init(); - ao_serial_init(); + ao_spi_init(); + ao_bmi088_init(); ao_cmd_init(); - ao_cmd_register(blink_cmds); ao_start_scheduler(); }