From e48b6689527f51cc589ccd0ee88e2c7bc05747e0 Mon Sep 17 00:00:00 2001 From: Keith Packard Date: Sun, 23 Aug 2020 18:32:41 -0600 Subject: [PATCH] altos/easymotor-v2: Beep out 'pad mode' repeatedly Easymotor doesn't have igniters, so it would have been silent on the pad, which seems bad. Add HAS_PAD_REPORT code which beeps out 'pad' once every five seconds. Signed-off-by: Keith Packard --- src/easymotor-v2/ao_pins.h | 1 + src/kernel/ao_report.c | 9 +++++++++ 2 files changed, 10 insertions(+) diff --git a/src/easymotor-v2/ao_pins.h b/src/easymotor-v2/ao_pins.h index 8930a46e..8d55c387 100644 --- a/src/easymotor-v2/ao_pins.h +++ b/src/easymotor-v2/ao_pins.h @@ -67,6 +67,7 @@ #define AO_PA11_PA12_RMP 1 #define HAS_BEEP 1 #define HAS_BATTERY_REPORT 1 +#define HAS_PAD_REPORT 1 #define BEEPER_CHANNEL 3 #define BEEPER_TIMER 2 #define BEEPER_PORT (&stm_gpioa) diff --git a/src/kernel/ao_report.c b/src/kernel/ao_report.c index 26604d1a..831ba874 100644 --- a/src/kernel/ao_report.c +++ b/src/kernel/ao_report.c @@ -285,6 +285,15 @@ ao_report(void) while (c-- && ao_flight_state == ao_flight_pad) pause(AO_MS_TO_TICKS(100)); } +#endif +#if HAS_PAD_REPORT + while (ao_flight_state == ao_flight_pad) { + uint8_t c; + ao_report_flight_state(); + c = 50; + while (c-- && ao_flight_state == ao_flight_pad) + pause(AO_MS_TO_TICKS(100)); + } #endif while (ao_report_state == ao_flight_state) ao_sleep(&ao_flight_state); -- 2.30.2