chaning command_velocity to cmd_vel