Adaptions to new ChibiOS (PSTR and i2c). Optical sensor added.