Separate color task

Now there are two tasks for color, one which runs every 50ms and maintaince the connection with the sensor, and the other which runs every 100ms and reads the color
Merge remote-tracking branch 'origin/developer' into localization-calibration