MPU9150 MAG driver

Redo the driver. Init is good. Read data is good. Need to add 3D init