Added function o I2C library to handle writing to target register.
Beats having to reallocate a buffer very time. Still not tested.

Also, implemented some funny stuff with i2c_writeWords.