Still trying to get the new MPU6050 Lib working

The problem is the C code needs an i2c function defined and I need to
use a C++ i2c library. Complete mess.