heres the code

Dependencies:   Motor Servo mbed

Revision:
7:8881672744fd
Parent:
1:69c1ba9abd94