diff --git a/application/chassis/chassis.c b/application/chassis/chassis.c index 338218a..17d2726 100644 --- a/application/chassis/chassis.c +++ b/application/chassis/chassis.c @@ -477,7 +477,7 @@ void ChassisTask() { last_chassis_mode = chassis_cmd_recv.chassis_mode; chassis_vx = (chassis_cmd_recv.vx * cos_theta + chassis_cmd_recv.vy * sin_theta)/4;//实验版 - chassis_vy = (-chassis_cmd_recv.vx * sin_theta + chassis_cmd_recv.vy * cos_theta)/4;//实验版 + chassis_vy = (-chassis_cmd_recv.vx * sin_theta + chassis_cmd_recv.vy * cos_theta)/4;//实验版/ // 根据控制模式进行正运动学解算,计算底盘输出 SteeringWheelCalculate();