Open cagrikilic opened 4 years ago
Thought about this, since we are only using body-frame velocity estimates from kimera in our filter and not position, we just need to restart and no need to worry about special init. We can just let us use the "deadreckoning odometry" from the wheels as the initialization, which it already does.
https://github.com/wvu-navLab/SRC2-Sensor-Fusion/blob/502cc13ce3884382e4517f0f1e2574a4ac96ba6b/sensor_fusion/src/sensor_fusion.cpp#L206