Version totally functional
Added the odometry