diff --git a/libraries/AP_GPS/AP_GPS.cpp b/libraries/AP_GPS/AP_GPS.cpp index 28c0c4aa56..28a223122a 100644 --- a/libraries/AP_GPS/AP_GPS.cpp +++ b/libraries/AP_GPS/AP_GPS.cpp @@ -207,6 +207,11 @@ AP_GPS::update_instance(uint8_t instance) state[instance].status = NO_GPS; return; } + if (locked_ports & (1U<= GPS_MAX_INSTANCES) { + return; + } + if (lock) { + locked_ports |= (1U<