根据裁判系统底盘输出电压设定底盘状态

This commit is contained in:
kai
2024-04-29 13:30:03 +08:00
parent d4d0d0ac54
commit c6f4a99712

View File

@@ -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())
{