Work on #7, add more sensors to i2c.h