Fixes to i2c, and adding new sensor types