Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-01 21:48:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_GPS: fragments_received is a bitmask not a count

Browse Source
This commit is contained in:
Andrew Piper 2024-02-24 18:32:12 +00:00 committed by Andrew Tridgell
parent 59135b6ea0
commit d919478bdd
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_GPS/AP_GPS.cpp
View File

@ -1632,7 +1632,7 @@ void AP_GPS::handle_gps_rtcm_fragment(uint8_t flags, const uint8_t *data, uint8_
// we have one or more partial fragments already received // we have one or more partial fragments already received
// which conflict with the new fragment, discard previous fragments // which conflict with the new fragment, discard previous fragments
rtcm_buffer->fragment_count = 0; rtcm_buffer->fragment_count = 0;
rtcm_stats.fragments_discarded += rtcm_buffer->fragments_received; rtcm_stats.fragments_discarded += __builtin_popcount(rtcm_buffer->fragments_received);
rtcm_buffer->fragments_received = 0; rtcm_buffer->fragments_received = 0;
} }
@ -1661,7 +1661,7 @@ void AP_GPS::handle_gps_rtcm_fragment(uint8_t flags, const uint8_t *data, uint8_
if (rtcm_buffer->fragment_count != 0 && if (rtcm_buffer->fragment_count != 0 &&
rtcm_buffer->fragments_received == (1U << rtcm_buffer->fragment_count) - 1) { rtcm_buffer->fragments_received == (1U << rtcm_buffer->fragment_count) - 1) {
// we have them all, inject // we have them all, inject
rtcm_stats.fragments_used += rtcm_buffer->fragments_received; rtcm_stats.fragments_used += __builtin_popcount(rtcm_buffer->fragments_received);
inject_data(rtcm_buffer->buffer, rtcm_buffer->total_length); inject_data(rtcm_buffer->buffer, rtcm_buffer->total_length);
rtcm_buffer->fragment_count = 0; rtcm_buffer->fragment_count = 0;
rtcm_buffer->fragments_received = 0; rtcm_buffer->fragments_received = 0;