Modified SensorFilter Odometry for new localisation