Support for Continuous and Stepper motors
Various fixes
Interface cleanup