LD-83 Add write to i2c function