Some cleanup
Odometry step withou noise and resampling. Drawing the uncertainty ellipse of the samples.