Add i2c_reg_uchar_write()
Add initial handling of mpu6050

MIssing:
 - setup of interruption
 - test