Motor Contorler v1.1.0 Motor Helper functions

created the servo motor class as well as moved the helper functions out
to their own header. To clean up code