diff --git a/User/module/balance_chassis.c b/User/module/balance_chassis.c index 1993efd..e149b3b 100644 --- a/User/module/balance_chassis.c +++ b/User/module/balance_chassis.c @@ -33,11 +33,10 @@ static int8_t Chassis_MotorEnable(Chassis_t *c) { static int8_t Chassis_MotorRelax(Chassis_t *c) { if (c == NULL) return CHASSIS_ERR_NULL; + float relax_torque[4] = {0.0f, 0.0f, 0.0f, 0.0f}; + Virtual_Chassis_SendJointTorque(&virtual_chassis, relax_torque); // for (int i = 0; i < 2; i++) { - // // MOTOR_LK_Relax(&c->param->wheel_motors[i]); - // } - // for (int i = 0; i < 4; i++) { - // MOTOR_LZ_Relax(&c->param->joint_motors[i]); + // MOTOR_LK_Relax(&c->param->wheel_motors[i]); // } return CHASSIS_OK; }