mirror of
https://gitee.com/dlmu-cone/bf_original_balance_chassis
synced 2026-07-24 19:47:44 +08:00
根据裁判系统底盘输出电压设定底盘状态
This commit is contained in:
@@ -188,6 +188,16 @@ static void EnableAllMotor() /* 打开所有电机 */
|
|||||||
/* 切换底盘遥控器控制和云台双板控制 */
|
/* 切换底盘遥控器控制和云台双板控制 */
|
||||||
static void ControlSwitch()
|
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())
|
if (switch_is_down(rc_data->rc.switch_right) && RemoteControlIsOnline())
|
||||||
{
|
{
|
||||||
|
|||||||
Reference in New Issue
Block a user