Added a basic Servo.h and Servo.c

also some lint in Motor.c