Magnetometer and gyro fusion