Fixed Odom/ResetCountdown not resetting anymore if next frame is also bad.

This commit is contained in:
matlabbe
2024-03-17 17:19:08 -07:00
parent 264c560a2c
commit 79dc180bf4

View File

@@ -915,6 +915,7 @@ Transform Odometry::process(SensorData & data, const Transform & guessIn, Odomet
{
UWARN("Odometry automatically reset to latest pose!");
this->reset(_pose);
_resetCurrentCount = _resetCountdown;
if(info)
{
*info = OdometryInfo();