Add state check for motor velocities