fix x补偿
This commit is contained in:
parent
bef9394790
commit
2ba7d879b0
@ -817,7 +817,7 @@ int8_t Chassis_LQRControl(Chassis_t *c, const Chassis_CMD_t *c_cmd) {
|
|||||||
.d_theta = 0.0f,
|
.d_theta = 0.0f,
|
||||||
.phi = 0.0f+c->param->lqr_offset.phi,
|
.phi = 0.0f+c->param->lqr_offset.phi,
|
||||||
.d_phi = 0.0f,
|
.d_phi = 0.0f,
|
||||||
.x = c->chassis_state.target_x+c->param->lqr_offset.x + leg_x_comp,
|
.x = c->chassis_state.target_x-c->param->lqr_offset.x + leg_x_comp,
|
||||||
.d_x = c->chassis_state.target_velocity_x,
|
.d_x = c->chassis_state.target_velocity_x,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user