mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-06 07:53:43 +08:00
[rotorcraft] guidance_h: normalize psi sp from nav_heading
This commit is contained in:
@@ -267,6 +267,7 @@ void guidance_h_run(bool_t in_flight) {
|
|||||||
|
|
||||||
/* set psi command */
|
/* set psi command */
|
||||||
guidance_h_command_body.psi = nav_heading;
|
guidance_h_command_body.psi = nav_heading;
|
||||||
|
INT32_ANGLE_NORMALIZE(guidance_h_command_body.psi);
|
||||||
/* compute roll and pitch commands and set final attitude setpoint */
|
/* compute roll and pitch commands and set final attitude setpoint */
|
||||||
guidance_h_traj_run(in_flight);
|
guidance_h_traj_run(in_flight);
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user