X-Git-Url: https://git.gag.com/?a=blobdiff_plain;ds=sidebyside;f=src%2Fstm32f4-disco%2Fao_disco.c;h=c6cdbd234d9c61cf2382e1f494e8c89216c8580b;hb=2cdb1f30c49ba460b0850d23ba9c85e0336af290;hp=efbed947a1d4c54267fcbfad8282a5807ddb4435;hpb=cdaa0d7b272505c49017f409b7c0b8e3240608f0;p=fw%2Faltos

diff --git a/src/stm32f4-disco/ao_disco.c b/src/stm32f4-disco/ao_disco.c
index efbed947..c6cdbd23 100644
--- a/src/stm32f4-disco/ao_disco.c
+++ b/src/stm32f4-disco/ao_disco.c
@@ -14,24 +14,35 @@
 
 #include <ao.h>
 
-void main(void)
+static struct ao_task red_task;
+static struct ao_task green_task;
+
+static void
+red(void)
 {
-	float		x;
-	int		r = 1;
-	int		g = 0;
+	for (;;) {
+		ao_led_toggle(LED_RED);
+		ao_delay(AO_MS_TO_TICKS(500));
+	}
+}
 
-	ao_clock_init();
+static void
+green(void)
+{
+	for (;;) {
+		ao_led_toggle(LED_GREEN);
+		ao_delay(AO_MS_TO_TICKS(450));
+	}
+}
 
+void main(void)
+{
+	ao_clock_init();
 	ao_timer_init();
+	ao_led_init();
+	ao_task_init();
 
-	ao_enable_output(LED_GREEN_PORT, LED_GREEN_PIN, 0);
-	ao_enable_output(LED_RED_PORT, LED_RED_PIN, 1);
-	for (;;) {
-		ao_gpio_set(LED_GREEN_PORT, LED_GREEN_PIN, g);
-		ao_gpio_set(LED_RED_PORT, LED_RED_PIN, r);
-		g ^= 1;
-		r ^= 1;
-		for (x = 0.0f; x < 100000.0f; x = x + 0.1f)
-			ao_arch_nop();
-	}
+	ao_add_task(&red_task, red, "red");
+	ao_add_task(&green_task, green, "green");
+	ao_start_scheduler();
 }