This fixes the bug where an error occured if disconnect is called while
motor is running. Motors are now explicitly stopped if they are busily
moving when resetting the devices