altos: Check for full log and complain

[fw/altos] / src / ao_report.c

diff --git a/src/ao_report.c b/src/ao_report.c
index 511b4f16643cda099dbf94679c0c5dc5eda4e48c..cc8b512b095ca0af903620e9d7802fd32e3905ca 100644 (file)
--- a/src/ao_report.c
+++ b/src/ao_report.c
@@ -128,6 +128,16 @@ ao_report_continuity(void) __reentrant
                        ao_beep_for(AO_BEEP_LOW, AO_MS_TO_TICKS(20));
                }
        }
+       if (ao_log_full()) {
+               pause(AO_MS_TO_TICKS(100));
+               c = 2;
+               while (c--) {
+                       ao_beep_for(AO_BEEP_LOW, AO_MS_TO_TICKS(100));
+                       ao_beep_for(AO_BEEP_MID, AO_MS_TO_TICKS(100));
+                       ao_beep_for(AO_BEEP_HIGH, AO_MS_TO_TICKS(100));
+                       ao_beep_for(AO_BEEP_MID, AO_MS_TO_TICKS(100));
+               }
+       }
        c = 50;
        while (c-- && ao_flight_state == ao_flight_pad)
                pause(AO_MS_TO_TICKS(100));