Add stop function
Fix bug which was causing steppers not to release