got odometry almost working