Update readme to add credit to sources
Format code (we need to develop some code standards..)
Document Servo.h
Refactor Motor.h to use a struct; failsafe if not initialized
Refactor Servo.h to use consistent servo struct, and check type