optimal estimate Gauss-Newton estimation sequence quaternion estimator magnetometer sun sensor