diff --git a/application/chassis/balance.c b/application/chassis/balance.c index d7a4c81..98b6a63 100644 --- a/application/chassis/balance.c +++ b/application/chassis/balance.c @@ -188,6 +188,16 @@ static void EnableAllMotor() /* 打开所有电机 */ /* 切换底盘遥控器控制和云台双板控制 */ static void ControlSwitch() { + // 根据裁判系统底盘输出电压设定底盘状态 + float chassis_vol = referee_data->PowerHeatData.chassis_voltage * 0.001; + if (chassis_vol < 15.0f || + l_driven->daemon->temp_count == 0 || + r_driven->daemon->temp_count == 0) + { + chassis_cmd_recv.chassis_mode = CHASSIS_ZERO_FORCE; // 皆离线,急停 + return; + } + // 右侧拨杆向下,进入遥控器底盘控制,此时不响应云台控制指令 if (switch_is_down(rc_data->rc.switch_right) && RemoteControlIsOnline()) {