Update AP_GPS.cpp