AR_WPNav: fix wp_bearing_cd calc

6 years ago · c445362fae
1 changed files with 1 additions and 1 deletions
--- a/libraries/AR_WPNav/AR_WPNav.cpp
+++ b/libraries/AR_WPNav/AR_WPNav.cpp
@ -327,7 +327,7 @@ void AR_WPNav::update_distance_and_bearing_to_destination()
				@@ -327,7 +327,7 @@ void AR_WPNav::update_distance_and_bearing_to_destination()
    // update OA adjusted values
    if (_oa_active) {
        _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 {
        _oa_distance_to_destination = _distance_to_destination;
        _oa_wp_bearing_cd = _wp_bearing_cd;