Magnetometer code complete :)