Motor Control

More motor control stuff
Commit Error

I don't know what's up with GitHub