Skip to content
Snippets Groups Projects
Commit a2c3bc05 authored by Randy Mackay's avatar Randy Mackay
Browse files

Copter: calculate home position and bearing when we have 2D Fix

parent 40b7000c
No related branches found
No related tags found
No related merge requests found
...@@ -68,7 +68,7 @@ static void calc_distance_and_bearing() ...@@ -68,7 +68,7 @@ static void calc_distance_and_bearing()
} }
// calculate home distance and bearing // calculate home distance and bearing
if( ap.home_is_set && g_gps->status() == GPS::GPS_OK_FIX_3D ) { if( ap.home_is_set && (g_gps->status() == GPS::GPS_OK_FIX_3D || g_gps->status() == GPS::GPS_OK_FIX_2D)) {
home_distance = pythagorous2(curr.x, curr.y); home_distance = pythagorous2(curr.x, curr.y);
home_bearing = pv_get_bearing_cd(curr,Vector3f(0,0,0)); home_bearing = pv_get_bearing_cd(curr,Vector3f(0,0,0));
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment