TuxMonkey/half-steering-basic-framework
1
0
Fork 0
mirror of https://gitee.com/dlmu-cone/half-steering-basic-framework synced 2026-10-24 01:52:20 +08:00
Code Issues Packages Projects Releases Wiki Activity

Compare commits

base: TuxMonkey:devSJTUheadPWRC
Branches Tags
TuxMonkey:master TuxMonkey:codex/chassis-power-control TuxMonkey:devSJTUhead TuxMonkey:devSJTUheadPWRC TuxMonkey:dev TuxMonkey:dev-visionandreferee
TuxMonkey:v1.0
...
compare: TuxMonkey:devSJTUhead
Branches Tags
TuxMonkey:codex/chassis-power-control TuxMonkey:master TuxMonkey:devSJTUhead TuxMonkey:devSJTUheadPWRC TuxMonkey:dev TuxMonkey:dev-visionandreferee
TuxMonkey:v1.0

2 Commits
devSJTUhea ... devSJTUhea

Author SHA1 Message Date
guoxy06
76d0844209 底盘正常移动，小陀螺降速方便调 2026-04-17 16:52:02 +08:00
guoxy06
ca8c991a0a 底盘正常移动，小陀螺降速方便调 2026-04-16 20:31:48 +08:00
2 changed files with 7 additions and 8 deletions
Expand all files Collapse all files

7
application/chassis/chassis.c
View File

@@ -411,8 +411,7 @@ void ChassisTask() {
chassis_cmd_recv.wz = -PIDCalculate(&chassis_follow_pid, single_round_offset, 0)/70.0f; chassis_cmd_recv.wz = -PIDCalculate(&chassis_follow_pid, single_round_offset, 0)/70.0f;
break; break;
case CHASSIS_ROTATE: // 自旋,同时保持全向机动;当前wz维持定值,后续增加不规则的变速策略 case CHASSIS_ROTATE: // 自旋,同时保持全向机动;当前wz维持定值,后续增加不规则的变速策略
// chassis_cmd_recv.wz = 0.75; chassis_cmd_recv.wz = -0.35;//实验版
chassis_cmd_recv.wz = -0.75;//实验版
break; break;
default: default:
break; break;
@@ -425,8 +424,8 @@ void ChassisTask() {
sin_theta = arm_sin_f32(chassis_cmd_recv.offset_angle * DEGREE_2_RAD); sin_theta = arm_sin_f32(chassis_cmd_recv.offset_angle * DEGREE_2_RAD);
// chassis_vx = chassis_cmd_recv.vx * cos_theta - chassis_cmd_recv.vy * sin_theta; // chassis_vx = chassis_cmd_recv.vx * cos_theta - chassis_cmd_recv.vy * sin_theta;
// chassis_vy = chassis_cmd_recv.vx * sin_theta + chassis_cmd_recv.vy * cos_theta; // chassis_vy = chassis_cmd_recv.vx * sin_theta + chassis_cmd_recv.vy * cos_theta;
chassis_vy = chassis_cmd_recv.vx * cos_theta - chassis_cmd_recv.vy * sin_theta;//实验版 chassis_vx = chassis_cmd_recv.vx * cos_theta - chassis_cmd_recv.vy * sin_theta;//实验版
chassis_vx = chassis_cmd_recv.vx * sin_theta + chassis_cmd_recv.vy * cos_theta; chassis_vy = chassis_cmd_recv.vx * sin_theta + chassis_cmd_recv.vy * cos_theta;
// 根据控制模式进行正运动学解算,计算底盘输出 // 根据控制模式进行正运动学解算,计算底盘输出
SteeringWheelCalculate(); SteeringWheelCalculate();

8
application/cmd/robot_cmd.c
View File

@@ -200,7 +200,7 @@ static void RemoteControlSet()
// 云台参数,确定云台控制数据 // 云台参数,确定云台控制数据
if (switch_is_mid(rc_data[TEMP].rc.switch_left)) // 左侧开关状态为[中],视觉模式 if (switch_is_mid(rc_data[TEMP].rc.switch_left)) // 左侧开关状态为[中],视觉模式
{ {
// 待添加,视觉会发来和目标的误差,同样将其转化为total angle的增量进行控制 // 待添加,视觉会发来和目标的误差,同样将其转化为total angle的增量进行控制/
// ... // ...
} }
// 左侧开关状态为[下],或视觉未识别到目标,纯遥控器拨杆控制 // 左侧开关状态为[下],或视觉未识别到目标,纯遥控器拨杆控制
@@ -216,9 +216,9 @@ static void RemoteControlSet()
gimbal_cmd_send.pitch = PITCH_MIN_ANGLE; gimbal_cmd_send.pitch = PITCH_MIN_ANGLE;
// 底盘参数,目前没有加入小陀螺(调试似乎暂时没有必要),系数需要调整 // 底盘参数,目前没有加入小陀螺(调试似乎暂时没有必要),系数需要调整
chassis_cmd_send.vx = (0.25f * (float)rc_data[TEMP].rc.rocker_r_); // _水平方向 chassis_cmd_send.vx = (0.25f * (float)rc_data[TEMP].rc.rocker_r1); // 竖直方向
chassis_cmd_send.vy = (0.25f * (float)rc_data[TEMP].rc.rocker_r1); // 1数值方向 . chassis_cmd_send.vy = (0.25f * (float)rc_data[TEMP].rc.rocker_r_); // 水平方向
//此处如果是右手系，那么x应该是前进方向即竖直方向
// // 发射参数 // // 发射参数
// if (switch_is_up(rc_data[TEMP].rc.switch_right)) // 右侧开关状态[上],弹舱打开 // if (switch_is_up(rc_data[TEMP].rc.switch_right)) // 右侧开关状态[上],弹舱打开
// ; // 弹舱舵机控制,待添加servo_motor模块,开启 // ; // 弹舱舵机控制,待添加servo_motor模块,开启