Setup configuration module, re-designed all the motor stuff and added a velocity controller.  Sorry this isn't split into more commits.