Added sensors firmware using new I2C lib