Revert "Fixed Motor Debugging"

This reverts commit 39987b96ffa6d43f1cd5996913efdeaf18dc03c3.
I don't know what changed

But I'll commit these changes before I break something
Merge branch 'master' of https://github.com/Obsidianarch/AOIP_1314
Autonomous improved