diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2012-12-09 19:19:59 +0100 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2012-12-09 19:19:59 +0100 |
commit | 26faab64e5e1679d15afe88ef0edebd598f47dc7 (patch) | |
tree | 9e1a63c80321ccaa4604e6e279bd337cae6e0bc2 /apps/px4io/safety.c | |
parent | 1ebb3b4ada6bdf2109f3e6bb45800f0459b35ccc (diff) | |
parent | 154035279fbfbe14be208d5ec957089f11f6447d (diff) | |
download | px4-firmware-26faab64e5e1679d15afe88ef0edebd598f47dc7.tar.gz px4-firmware-26faab64e5e1679d15afe88ef0edebd598f47dc7.tar.bz2 px4-firmware-26faab64e5e1679d15afe88ef0edebd598f47dc7.zip |
Merge branch 'master' of github.com:PX4/Firmware into fixedwing_outdoor
Diffstat (limited to 'apps/px4io/safety.c')
-rw-r--r-- | apps/px4io/safety.c | 33 |
1 files changed, 26 insertions, 7 deletions
diff --git a/apps/px4io/safety.c b/apps/px4io/safety.c index 916988af1..88e7aeac6 100644 --- a/apps/px4io/safety.c +++ b/apps/px4io/safety.c @@ -60,10 +60,19 @@ static struct hrt_call failsafe_call; */ static unsigned counter = 0; +/* + * Define the various LED flash sequences for each system state. + */ +#define LED_PATTERN_SAFE 0xffff // always on +#define LED_PATTERN_FMU_ARMED 0x4444 // slow blinking +#define LED_PATTERN_IO_ARMED 0x5555 // fast blinking +#define LED_PATTERN_IO_FMU_ARMED 0x5050 // long off then double blink + +static unsigned blink_counter = 0; + #define ARM_COUNTER_THRESHOLD 10 #define DISARM_COUNTER_THRESHOLD 2 -static bool safety_led_state; static bool safety_button_pressed; static void safety_check_button(void *arg); @@ -120,15 +129,25 @@ safety_check_button(void *arg) counter = 0; } - /* when armed, toggle the LED; when safe, leave it on */ + /* Select the appropriate LED flash pattern depending on the current IO/FMU arm state */ + uint16_t pattern = LED_PATTERN_SAFE; if (system_state.armed) { - safety_led_state = !safety_led_state; - } else { - safety_led_state = true; + if (system_state.arm_ok) { + pattern = LED_PATTERN_IO_FMU_ARMED; + } else { + pattern = LED_PATTERN_IO_ARMED; + } + } else if (system_state.arm_ok) { + pattern = LED_PATTERN_FMU_ARMED; } - LED_SAFETY(safety_led_state); -} + /* Turn the LED on if we have a 1 at the current bit position */ + LED_SAFETY(pattern & (1 << blink_counter++)); + + if (blink_counter > 15) { + blink_counter = 0; + } +} static void heartbeat_blink(void *arg) |