- fixed error in odometry kalman filter update
- localization working except for calibration of covariance matrices