first working GPS + Mag fusion