Our final project code

Dependencies:   Motor Servo TCS3472_I2C mbed