X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fcore%2Fao_monitor.c;h=382af8a2a2b101426aaea54d3af82eb0a74fc3f7;hp=aaa6bb8b8fae980e4d01ab6f396bd6a5ac2beff7;hb=7c6a3195dec6ac68f5d7b3f883ccc2c316384e76;hpb=cff737c290347b61ba16584880c2f4c436b95042

diff --git a/src/core/ao_monitor.c b/src/core/ao_monitor.c
index aaa6bb8b..382af8a2 100644
--- a/src/core/ao_monitor.c
+++ b/src/core/ao_monitor.c
@@ -55,7 +55,15 @@ ao_monitor_get(void)
 			continue;
 		ao_monitor_head = ao_monitor_ring_next(ao_monitor_head);
 		ao_wakeup(DATA_TO_XDATA(&ao_monitor_head));
-		ao_led_toggle(ao_monitor_led);
+	}
+}
+
+void
+ao_monitor_blink(void)
+{
+	for (;;) {
+		ao_sleep(DATA_TO_XDATA(&ao_monitor_head));
+		ao_led_for(ao_monitor_led, AO_MS_TO_TICKS(100));
 	}
 }
 
@@ -246,6 +254,7 @@ ao_monitor_put(void)
 
 __xdata struct ao_task ao_monitor_get_task;
 __xdata struct ao_task ao_monitor_put_task;
+__xdata struct ao_task ao_monitor_blink_task;
 
 void
 ao_set_monitor(uint8_t monitoring)
@@ -276,4 +285,6 @@ ao_monitor_init(uint8_t monitor_led, uint8_t monitoring) __reentrant
 	ao_cmd_register(&ao_monitor_cmds[0]);
 	ao_add_task(&ao_monitor_get_task, ao_monitor_get, "monitor_get");
 	ao_add_task(&ao_monitor_put_task, ao_monitor_put, "monitor_put");
+	if (ao_monitor_led)
+		ao_add_task(&ao_monitor_blink_task, ao_monitor_blink, "monitor_blink");
 }