Initial attempt at queueing messages to send over I2C.
Fixed message size calculation in i2c_queue_lthread().