TuxMonkey/bf_original_balance_chassis
1
0
Fork 0
mirror of https://gitee.com/dlmu-cone/bf_original_balance_chassis synced 2026-07-24 03:27:45 +08:00
Code Issues Packages Projects Releases Wiki Activity

能动了！（小板凳）但是还是很抖

Browse Source
This commit is contained in:
TuxMonkey
2026-07-15 13:40:54 +08:00
parent 8a13444e48
commit b3da53745d
5 changed files with 74 additions and 65 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
application/cmd/robot_cmd.c
View File

@@ -330,8 +330,8 @@ static void EmergencyHandler()
if (switch_is_down(rc_data[TEMP].rc.switch_left) || switch_is_mid(rc_data[TEMP].rc.switch_left)) // 遥控器左侧开关状态为[下]或[中]
{
// 急停触发条件：遥控器离线 或者 右侧开关打到[下] 或者 robot_state 已经是 STOP
if (!rc_online || switch_is_down(rc_data[TEMP].rc.switch_right) || robot_state == ROBOT_STOP)
// 急停触发条件：遥控器离线或者右侧开关打到[下]
if (!rc_online || switch_is_down(rc_data[TEMP].rc.switch_right))
{
robot_state = ROBOT_STOP;
gimbal_cmd_send.gimbal_mode = GIMBAL_ZERO_FORCE;
@@ -343,7 +343,7 @@ static void EmergencyHandler()
gimbal_cmd_send.yaw = gimbal_fetch_data.gimbal_imu_data.YawTotalAngle; // 急停时设定值保持与实际值同步
gimbal_cmd_send.pitch = gimbal_fetch_data.gimbal_imu_data.Pitch;
}
// 恢复正常运行条件：遥控器在线 且 右侧开关状态为[上]
// 恢复正常运行条件：遥控器在线且右侧开关状态为[上]或[中]
else if (switch_is_up(rc_data[TEMP].rc.switch_right) || switch_is_mid(rc_data[TEMP].rc.switch_right))
{
robot_state = ROBOT_READY;