Magnetometer reset code added to fix radio interference issue which caused magnetometer code to lock up.