AP_GPS: SBF report correct satellite count on NrSV DNU value

When the NrSV field of the SBF PVTGeodetic message contains the
Do-Not-Use value of 255, set the satellite count to 0 instead of
ignoring the change.
This commit is contained in:
Thomas Frans 2024-03-26 14:11:31 +01:00 committed by Peter Barker
parent a9d0bf856e
commit d52f49ec36

View File

@ -455,8 +455,10 @@ AP_GPS_SBF::process_message(void)
set_alt_amsl_cm(state, ((float)temp.Height - temp.Undulation) * 1e2f);
}
if (temp.NrSV != 255) {
state.num_sats = temp.NrSV;
state.num_sats = temp.NrSV;
if (temp.NrSV == 255) {
// Do-Not-Use value for NrSV field in PVTGeodetic message
state.num_sats = 0;
}
Debug("temp.Mode=0x%02x\n", (unsigned)temp.Mode);