I2C temperatuer sensor reading now working, but needs to be tidied up a lot.