made some changes to step_odometry