AP_NavEKF2: writeExtNavData reset handles system time wrap

This commit is contained in:
Randy Mackay 2020-04-10 11:24:02 +09:00 committed by Andrew Tridgell
parent 74f33d57c5
commit fb7e68c53a

View File

@ -903,7 +903,7 @@ void NavEKF2_core::writeExtNavData(const Vector3f &sensOffset, const Vector3f &p
extNavMeasTime_ms = timeStamp_ms;
}
if (resetTime_ms > extNavLastPosResetTime_ms) {
if (resetTime_ms != extNavLastPosResetTime_ms) {
extNavDataNew.posReset = true;
extNavLastPosResetTime_ms = resetTime_ms;
} else {