AP_Periph: support FSOPowerStack

lthall · Feb 10, 2024 · dae2570 · dae2570
1 parent dfec4b1
commit dae2570
Show file tree

Hide file tree

Showing 7 changed files with 709 additions and 1 deletion.
diff --git a/Tools/AP_Periph/AP_Periph.cpp b/Tools/AP_Periph/AP_Periph.cpp
@@ -289,6 +289,10 @@ void AP_Periph_FW::init()
     relay.init();
 #endif
 
+#ifdef HAL_PERIPH_ENABLE_FSO_POWER_STACK
+    FSO_power_stack.init();
+#endif
+
 #if AP_SCRIPTING_ENABLED
     scripting.init();
 #endif
@@ -474,6 +478,10 @@ void AP_Periph_FW::update()
 #ifdef HAL_PERIPH_ENABLE_BATTERY_BALANCE
     batt_balance_update();
 #endif
+
+#ifdef HAL_PERIPH_ENABLE_FSO_POWER_STACK
+    FSO_power_stack.update();
+#endif
 
     static uint32_t fiftyhz_last_update_ms;
     if (now - fiftyhz_last_update_ms >= 20) {

diff --git a/Tools/AP_Periph/AP_Periph.h b/Tools/AP_Periph/AP_Periph.h
@@ -45,6 +45,10 @@
 #endif
 #include <AP_AHRS/AP_AHRS.h>
 
+#ifdef HAL_PERIPH_ENABLE_FSO_POWER_STACK
+#include "FSOPowerStack.h"
+#endif
+
 #ifdef HAL_PERIPH_ENABLE_RELAY
 #ifdef HAL_PERIPH_ENABLE_PWM_HARDPOINT
     #error "Relay and PWM_HARDPOINT both use hardpoint message"
@@ -354,6 +358,10 @@ class AP_Periph_FW {
     BattBalance battery_balance;
 #endif
 
+#ifdef HAL_PERIPH_ENABLE_FSO_POWER_STACK
+    FSOPowerStack FSO_power_stack;
+#endif
+
 #ifdef HAL_PERIPH_ENABLE_SERIAL_OPTIONS
     SerialOptions serial_options;
 #endif