-Added support for pioneer odometry.
-Made Kalman filter more robust for cases when not all data is available