Fixed motor stop in code (maybe)