Working simple test of i2c comms
Added hub
Added basic message sending functions