Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-02 05:58:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AR_WPNav: fix wp_bearing_cd calc

Browse Source
This commit is contained in:
Peter Hall 2019-08-22 21:14:11 +01:00 committed by Randy Mackay
parent 847f85a081
commit c445362fae
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AR_WPNav/AR_WPNav.cpp
View File

@ -327,7 +327,7 @@ void AR_WPNav::update_distance_and_bearing_to_destination()
// update OA adjusted values // update OA adjusted values
if (_oa_active) { if (_oa_active) {
_oa_distance_to_destination = current_loc.get_distance(_oa_destination); _oa_distance_to_destination = current_loc.get_distance(_oa_destination);
_oa_wp_bearing_cd = _oa_origin.get_bearing_to(_oa_destination); _oa_wp_bearing_cd = current_loc.get_bearing_to(_oa_destination);
} else { } else {
_oa_distance_to_destination = _distance_to_destination; _oa_distance_to_destination = _distance_to_destination;
_oa_wp_bearing_cd = _wp_bearing_cd; _oa_wp_bearing_cd = _wp_bearing_cd;