mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-04-14 10:07:39 +08:00
rover steering example: fixed compile error
Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
parent
7cb06c01eb
commit
d086a348aa
@ -179,7 +179,7 @@ void control_attitude(const struct vehicle_attitude_setpoint_s *att_sp, const st
|
||||
/*
|
||||
* Calculate yaw error and apply P gain
|
||||
*/
|
||||
float yaw_err = Eulerf(Quaternion(att->q)).psi() - Eulerf(Quaternion(att->q_d)).psi();
|
||||
float yaw_err = matrix::Eulerf(matrix::Quatf(att->q)).psi() - matrix::Eulerf(matrix::Quatf(att_sp->q_d)).psi();
|
||||
actuators->control[2] = yaw_err * pp.yaw_p;
|
||||
|
||||
/* copy throttle */
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user