Fixed bug with motor not stopping