mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 05:03:34 +08:00
navigator: convert to radians in configuration getter
This commit is contained in:
committed by
Daniel Agar
parent
334a599b2d
commit
9f545ae3cf
@@ -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;
|
||||
|
||||
Reference in New Issue
Block a user