fixed robot odometry calculations