Fixed Test Motor

The interface does not work unfortunately, however we have a working
test class regardless. Just enter anything in HyperTerminal to make it
progress through all of the tests