http://mbed.org/users/meriac/code/rgb_sensor/#7bd80f4a965e