Organization and Added Motor Code

I added a .c/.h combo of a rewritten motor code. Not all commands have
been tested, but all motors behave as intended.
Command Interpreter only moves forward, back, right, and left. no duty
cycle changes yet