Added some magnetometer functions, create I2cBusTester