Testing code. Magnetometer does not produce anything meaningful yet, and Y/Z must be swapped