mirror of
https://gitee.com/dlmu-cone/bf_original_balance_chassis
synced 2026-07-23 19:25:09 +08:00
根据裁判系统底盘输出电压设定底盘状态
This commit is contained in:
@@ -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())
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user