refactor: remove remote control, zero-force mode and emergency stop
- Remove RC_ctrl_t and RemoteControlInit from robot_cmd.c - Delete GIMBAL_ZERO_FORCE, gimbal_mode_e, Robot_Status_e from robot_def.h - Remove EmergencyHandler and robot_state from robot_cmd.c - Remove emergency commands from master_machine.h - Remove remote_control and can_comm from CMakeLists.txt
This commit is contained in:
@@ -84,17 +84,8 @@ void GimbalTask()
|
||||
{
|
||||
SubGetMessage(gimbal_sub, &gimbal_cmd_recv);
|
||||
|
||||
if (gimbal_cmd_recv.gimbal_mode == GIMBAL_ZERO_FORCE)
|
||||
{
|
||||
/* 零力模式: 保持当前IMU角度, 电机不主动出力 */
|
||||
DMMotorSetRef(yaw_motor, gimbal_IMU_data->YawTotalAngle);
|
||||
DMMotorSetRef(pitch_motor, gimbal_IMU_data->Pitch);
|
||||
}
|
||||
else
|
||||
{
|
||||
DMMotorSetRef(yaw_motor, gimbal_cmd_recv.yaw);
|
||||
DMMotorSetRef(pitch_motor, gimbal_cmd_recv.pitch);
|
||||
}
|
||||
DMMotorSetRef(yaw_motor, gimbal_cmd_recv.yaw);
|
||||
DMMotorSetRef(pitch_motor, gimbal_cmd_recv.pitch);
|
||||
|
||||
gimbal_feedback_data.gimbal_imu_data = gimbal_IMU_data;
|
||||
PubPushMessage(gimbal_pub, (void *)&gimbal_feedback_data);
|
||||
|
||||
Reference in New Issue
Block a user