AP_Notify: NCP5623 Re enabling the LED OV3-968

CarbonixUAV · Sep 6, 2023 · af19399 · af19399
1 parent 721062a
commit af19399
Show file tree

Hide file tree

Showing 2 changed files with 8 additions and 1 deletion.
diff --git a/libraries/AP_Notify/NCP5623.cpp b/libraries/AP_Notify/NCP5623.cpp
@@ -113,10 +113,16 @@ bool NCP5623::hw_set_rgb(uint8_t red, uint8_t green, uint8_t blue)
 
 void NCP5623::_timer(void)
 {
+    // enable the led if ack not fetch in last write
+    if (!_status){
+        _status = write(NCP5623_LED_ENABLE, 0x1f);
+        return;
+    }
+
     if (!_need_update) {
         return;
     }
     _need_update = false;
 
-    write_pwm(rgb);
+    _status = write_pwm(rgb);
 }
diff --git a/libraries/AP_Notify/NCP5623.h b/libraries/AP_Notify/NCP5623.h
@@ -34,4 +34,5 @@ class NCP5623 : public RGBLed {
     uint8_t rgb[3];
     bool _need_update;
     uint8_t _bus;
+    bool _status;
 };