Hopefully done, but i2c comms not tested at all.