Fix i2c driver and package it