From fb63262699d3a6fbf347d24efda8b01f75b7d0d3 Mon Sep 17 00:00:00 2001 From: Keith Packard Date: Tue, 14 Apr 2009 10:02:19 -0700 Subject: Add comments, clean up white space, etc. Various clean ups now that the basic code appears to work. Signed-off-by: Keith Packard --- ao_panic.c | 30 +++++++++++++++++++++++++++++- 1 file changed, 29 insertions(+), 1 deletion(-) (limited to 'ao_panic.c') diff --git a/ao_panic.c b/ao_panic.c index 0f8433dc..30ccce60 100644 --- a/ao_panic.c +++ b/ao_panic.c @@ -17,8 +17,36 @@ #include "ao.h" +static void +ao_panic_delay(uint8_t n) +{ + uint8_t i = 0; + + while (n--) + while (--i) + _asm nop _endasm; +} + void ao_panic(uint8_t reason) { - (void) reason; + uint8_t n; + + for (;;) { + ao_led_on(AO_LED_RED); + ao_beep(AO_BEEP_MID); + ao_panic_delay(2); + ao_led_off(AO_LED_RED); + ao_beep(AO_BEEP_OFF); + ao_panic_delay(2); + for (n = 0; n < reason; n++) { + ao_led_on(AO_LED_RED); + ao_beep(AO_BEEP_MID); + ao_panic_delay(1); + ao_led_off(AO_LED_RED); + ao_beep(AO_BEEP_OFF); + ao_panic_delay(1); + } + ao_panic_delay(2); + } } -- cgit v1.2.3