I2C lib works

Pretty sure the I2C lib is working now I saw data on the scope. However
still working on the actual reading this stupid 9 axis bitch