Improve odometry
Updated constants
Shorter waiting time
Many new things for localisation - cancelled mapping!