feat: force gimbal detection on serial passthrough init (#6089)

This commit is contained in:
3djc
2025-04-14 19:15:06 +10:00
committed by GitHub
parent dfae0b09dd
commit 81eb287c0f
3 changed files with 4 additions and 4 deletions
+1 -1
View File
@@ -1115,7 +1115,7 @@ static void spGimbalDeInit(int port_n)
{ {
(void)port_n; (void)port_n;
_sp_drv->deinit(_sp_ctx); _sp_drv->deinit(_sp_ctx);
flysky_gimbal_init(); flysky_gimbal_init(true);
} }
#endif #endif
@@ -165,7 +165,7 @@ void flysky_gimbal_deinit()
STM32SerialDriver.deinit(_fs_usart_ctx); STM32SerialDriver.deinit(_fs_usart_ctx);
} }
bool flysky_gimbal_init() bool flysky_gimbal_init(bool force)
{ {
etx_serial_init cfg = { etx_serial_init cfg = {
.baudrate = FLYSKY_HALL_BAUDRATE, .baudrate = FLYSKY_HALL_BAUDRATE,
@@ -174,7 +174,7 @@ bool flysky_gimbal_init()
.polarity = ETX_Pol_Normal, .polarity = ETX_Pol_Normal,
}; };
_fs_gimbal_detected = false; _fs_gimbal_detected = force;
_fs_usart_ctx = STM32SerialDriver.init(REF_STM32_SERIAL_PORT(FSGimbal), &cfg); _fs_usart_ctx = STM32SerialDriver.init(REF_STM32_SERIAL_PORT(FSGimbal), &cfg);
STM32SerialDriver.setIdleCb(_fs_usart_ctx, flysky_gimbal_loop, 0); STM32SerialDriver.setIdleCb(_fs_usart_ctx, flysky_gimbal_loop, 0);
@@ -128,7 +128,7 @@ extern signed short hall_raw_values[FLYSKY_HALL_CHANNEL_COUNT];
extern unsigned short hall_adc_values[FLYSKY_HALL_CHANNEL_COUNT]; extern unsigned short hall_adc_values[FLYSKY_HALL_CHANNEL_COUNT];
// returns true if the gimbals were detected properly // returns true if the gimbals were detected properly
bool flysky_gimbal_init(); bool flysky_gimbal_init(bool force = false);
void flysky_gimbal_deinit(); void flysky_gimbal_deinit();
const etx_serial_port_t* flysky_gimbal_get_port(); const etx_serial_port_t* flysky_gimbal_get_port();