Initial attempt at the final chalenge

Dependencies:   ContinuousServo TCS3472_I2C Tach mbed