Addition of new motor, cleanup of old debug
Merge pull request #5 from Lukanite/master

Addition of new motor, cleanup of old debug