From e6351b6a4109c9fb3eacdb01b3e20c1c58437f9e Mon Sep 17 00:00:00 2001 From: Henry Wurzburg Date: Mon, 26 Aug 2024 11:21:41 +0200 Subject: [PATCH] AP_Notify:correct and expand 1 led flash sequences --- libraries/AP_Notify/GPIO_LED_1.cpp | 2 ++ libraries/AP_Notify/GPIO_LED_1.h | 3 ++- 2 files changed, 4 insertions(+), 1 deletion(-) diff --git a/libraries/AP_Notify/GPIO_LED_1.cpp b/libraries/AP_Notify/GPIO_LED_1.cpp index 6ea0bd16c9..4f11affe02 100644 --- a/libraries/AP_Notify/GPIO_LED_1.cpp +++ b/libraries/AP_Notify/GPIO_LED_1.cpp @@ -47,6 +47,8 @@ void GPIO_LED_1::update(void) uint32_t new_pattern; if (AP_Notify::flags.initialising) { new_pattern = INITIALIZING; + } else if (AP_Notify::flags.failsafe_radio || AP_Notify::flags.failsafe_gcs || AP_Notify::flags.failsafe_battery) { + new pattern = FAILSAFE; } else if (AP_Notify::flags.armed) { new_pattern = ARMED; } else if (AP_Notify::flags.pre_arm_check) { diff --git a/libraries/AP_Notify/GPIO_LED_1.h b/libraries/AP_Notify/GPIO_LED_1.h index 129e6cac52..b9f2a0302e 100644 --- a/libraries/AP_Notify/GPIO_LED_1.h +++ b/libraries/AP_Notify/GPIO_LED_1.h @@ -36,9 +36,10 @@ private: // left-to-right, each bit represents 100ms static const uint32_t INITIALIZING = 0b10101010101010101010101010101010UL; - static const uint32_t NOT_READY_TO_ARM = 0b11111111000000001111111100000000UL; + static const uint32_t NOT_READY_TO_ARM = 0b11110000000000001111111110000000UL; static const uint32_t READY_TO_ARM = 0b11111111111111100000000000000000UL; static const uint32_t ARMED = 0b11111111111111111111111111111111UL; + static const uint32_t FAILSAFE = 0b11110000111100001111000011110000UL; uint32_t current_pattern = INITIALIZING; uint32_t last_timestep_ms;