Update src/modules/mc_pos_control/MulticopterPositionControl.cpp

Co-authored-by: Mathieu Bresciani <brescianimathieu@gmail.com>
This commit is contained in:
Daniel Agar 2022-04-25 22:37:25 -04:00 committed by Matthias Grob
parent 3fb4889ab9
commit 7f1bb556e9
1 changed files with 1 additions and 1 deletions

View File

@ -371,7 +371,7 @@ void MulticopterPositionControl::Run()
}
if (vehicle_local_position.heading_reset_counter != _heading_reset_counter) {
_setpoint.yaw += vehicle_local_position.delta_heading;
_setpoint.yaw = wrap_pi(_setpoint.yaw + vehicle_local_position.delta_heading);
}
}