diff --git a/src/drivers/gps/gps.cpp b/src/drivers/gps/gps.cpp index 4c02646633..cd7fb5ab76 100644 --- a/src/drivers/gps/gps.cpp +++ b/src/drivers/gps/gps.cpp @@ -540,6 +540,9 @@ void GPS::handleInjectDataTopic() } } + // Reset instance in case we didn't actually want to switch + _orb_inject_data_sub.ChangeInstance(_selected_rtcm_instance); + bool updated = false; // Limit maximum number of GPS injections to 8 since usually