1st Revision of clean control code for project biorobotics

Dependencies:   Encoder MODSERIAL Servo mbed

no such method: docs