final code (doesnt work)

Dependencies:   mbed Servo C12832_lcd