X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fcore%2Fao_panic.c;h=524330447b248b550c5ba068d2c3d74316a63ac9;hb=ced6a020d6d94b1c63837a7ab5b0091b7b8ea3c9;hp=fdada201572c38e19e8adac2b6d9c7ad23414109;hpb=9513be7f9d3d0b0ec29f6487fa9dc8f1ac24d0de;p=fw%2Faltos

diff --git a/src/core/ao_panic.c b/src/core/ao_panic.c
index fdada201..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)
@@ -33,7 +37,7 @@ ao_panic_delay(uint8_t n)
 	while (n--)
 		while (--j)
 			while (--i)
-				_asm nop _endasm;
+				ao_arch_nop();
 }
 
 void
@@ -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);