fixed problem with cmd_vel