Fixed some things with encoder odometry