@@ -6660,7 +6660,7 @@ bool SFE_UBLOX_GNSS::getSurveyMode(uint16_t maxWait)
6660
6660
}
6661
6661
6662
6662
// Control Survey-In for NEO-M8P
6663
- bool SFE_UBLOX_GNSS::setSurveyMode(uint8_t mode, uint32_t observationTime, float requiredAccuracy, uint16_t maxWait)
6663
+ bool SFE_UBLOX_GNSS::setSurveyMode(uint8_t mode, uint16_t observationTime, float requiredAccuracy, uint16_t maxWait)
6664
6664
{
6665
6665
if (getSurveyMode(maxWait) == false) // Ask module for the current TimeMode3 settings. Loads into payloadCfg.
6666
6666
return (false);
@@ -6673,11 +6673,11 @@ bool SFE_UBLOX_GNSS::setSurveyMode(uint8_t mode, uint32_t observationTime, float
6673
6673
// payloadCfg should be loaded with poll response. Now modify only the bits we care about
6674
6674
payloadCfg[2] = mode; // Set mode. Survey-In and Disabled are most common. Use ECEF (not LAT/LON/ALT).
6675
6675
6676
- // svinMinDur is U4 (uint32_t) in seconds
6676
+ // svinMinDur is U4 (uint32_t) but we'll only use a uint16_t (waiting more than 65535 seconds seems excessive!)
6677
6677
payloadCfg[24] = observationTime & 0xFF; // svinMinDur in seconds
6678
6678
payloadCfg[25] = observationTime >> 8; // svinMinDur in seconds
6679
- payloadCfg[26] = observationTime >> 16;
6680
- payloadCfg[27] = observationTime >> 24;
6679
+ payloadCfg[26] = 0; // Truncate to 16 bits
6680
+ payloadCfg[27] = 0; // Truncate to 16 bits
6681
6681
6682
6682
// svinAccLimit is U4 (uint32_t) in 0.1mm.
6683
6683
uint32_t svinAccLimit = (uint32_t)(requiredAccuracy * 10000.0); // Convert m to 0.1mm
@@ -6690,7 +6690,7 @@ bool SFE_UBLOX_GNSS::setSurveyMode(uint8_t mode, uint32_t observationTime, float
6690
6690
}
6691
6691
6692
6692
// Begin Survey-In for NEO-M8P
6693
- bool SFE_UBLOX_GNSS::enableSurveyMode(uint32_t observationTime, float requiredAccuracy, uint16_t maxWait)
6693
+ bool SFE_UBLOX_GNSS::enableSurveyMode(uint16_t observationTime, float requiredAccuracy, uint16_t maxWait)
6694
6694
{
6695
6695
return (setSurveyMode(SVIN_MODE_ENABLE, observationTime, requiredAccuracy, maxWait));
6696
6696
}
0 commit comments