Browse Source

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

mission-4.1.18
Randy Mackay 12 years ago
parent
commit
facd8fc89f
  1. 2
      ArduCopter/navigation.pde

2
ArduCopter/navigation.pde

@ -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
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_bearing = pv_get_bearing_cd(curr,Vector3f(0,0,0));

Loading…
Cancel
Save