navigator: convert to radians in configuration getter

This commit is contained in:
Matthias Grob
2019-11-22 13:36:05 -05:00
committed by Daniel Agar
parent 334a599b2d
commit 9f545ae3cf
2 changed files with 2 additions and 2 deletions
+1 -1
View File
@@ -345,7 +345,7 @@ MissionBlock::is_mission_item_reached()
float yaw_err = wrap_pi(_mission_item.yaw - cog);
/* accept yaw if reached or if timeout is set in which case we ignore not forced headings */
if (fabsf(yaw_err) < math::radians(_navigator->get_yaw_threshold())
if (fabsf(yaw_err) < _navigator->get_yaw_threshold()
|| (_navigator->get_yaw_timeout() >= FLT_EPSILON && !_mission_item.force_heading)) {
_waypoint_yaw_reached = true;