X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fcore%2Fao_panic.c;h=524330447b248b550c5ba068d2c3d74316a63ac9;hb=e45c47c52f9cc9c43b81148e0e58fdedb3af1eb8;hp=cbfdf3999e01f17d3343c31dbb45b8a42066e372;hpb=e9fab7dc99a0e7c22b511c5919adf7df85213252;p=fw%2Faltos diff --git a/src/core/ao_panic.c b/src/core/ao_panic.c index cbfdf399..52433044 100644 --- a/src/core/ao_panic.c +++ b/src/core/ao_panic.c @@ -24,6 +24,10 @@ #if !HAS_BEEP #define ao_beep(x) #endif +#if !LEDS_AVAILABLE +#define ao_led_on(x) +#define ao_led_off(x) +#endif static void ao_panic_delay(uint8_t n) @@ -41,6 +45,10 @@ ao_panic(uint8_t reason) { uint8_t n; +#if LOW_LEVEL_DEBUG + ao_cur_task = NULL; + printf ("panic %d\n", reason); +#endif __critical for (;;) { ao_panic_delay(20); for (n = 0; n < 5; n++) { @@ -53,8 +61,19 @@ ao_panic(uint8_t reason) } ao_beep(AO_BEEP_OFF); ao_panic_delay(2); + +#ifdef SDCC #pragma disable_warning 126 - for (n = 0; n < reason; n++) { +#endif + if (reason & 0x40) { + ao_led_on(AO_LED_RED); + ao_beep(AO_BEEP_HIGH); + ao_panic_delay(40); + ao_led_off(AO_LED_RED); + ao_beep(AO_BEEP_OFF); + ao_panic_delay(10); + } + for (n = 0; n < (reason & 0x3f); n++) { ao_led_on(AO_LED_RED); ao_beep(AO_BEEP_MID); ao_panic_delay(10);