Fix STM LED driver and blink LEDs on discovery board

[fw/altos] / src / stm-demo / ao_demo.c

diff --git a/src/stm-demo/ao_demo.c b/src/stm-demo/ao_demo.c
index 902165357a754da6be3fbfef53b63935b8e7e159..94527089b407225a4b3c92993c9c1899e23e777d 100644 (file)
--- a/src/stm-demo/ao_demo.c
+++ b/src/stm-demo/ao_demo.c
@@ -22,9 +22,13 @@ struct ao_task demo_task;
 void
 ao_demo(void)
 {
-       int     i = 0;
        for (;;) {
-               printf ("hello %d\n", i++);
+               ao_led_on(AO_LED_BLUE);
+               ao_delay(AO_MS_TO_TICKS(500));
+               ao_led_off(AO_LED_BLUE);
+               ao_led_on(AO_LED_GREEN);
+               ao_delay(AO_MS_TO_TICKS(500));
+               ao_led_off(AO_LED_GREEN);
        }
 }
 
@@ -43,7 +47,9 @@ main(void)
        ao_serial_init();
        ao_timer_init();
        ao_cmd_init();
+       ao_led_init(LEDS_AVAILABLE);
+       ao_add_task(&demo_task, ao_demo, "demo");
        
-       ao_demo();
+       ao_start_scheduler();
        return 0;
 }