Implementing libcsp i2c driver