basic odometry working