Magnetometer control registers

I had to change some of the control registers to get the magnetometer working right.