Changeset 4681 in ntrip for trunk/BNC/src/rinex/reqcanalyze.cpp

Timestamp:

Sep 9, 2012, 11:43:49 AM (12 years ago)

Author:

mervart

Message:

 

File:

• trunk/BNC/src/rinex/reqcanalyze.cpp (modified) (1 diff)

trunk/BNC/src/rinex/reqcanalyze.cpp

@@ -663 +663 @@
                     xSat(1), xSat(2), xSat(3), clkSat);
       ColumnVector dx = xSat - xyzSta;
-    }
-
-  }
-
-  return 0.0;
-}
+      double rho = dx.norm_Frobenius();
+      AA(nSatUsed,1) = dx(1) / rho;
+      AA(nSatUsed,2) = dx(2) / rho;
+      AA(nSatUsed,3) = dx(3) / rho;
+      AA(nSatUsed,4) = 1.0;
+    }
+  }
+
+  if (nSatUsed < 4) {
+    return 0.0;
+  }
+
+  AA = AA.Rows(1, nSatUsed);
+
+  SymmetricMatrix QQ; 
+  QQ << AA.t() * AA;
+  QQ = QQ.i();
+
+  return sqrt(QQ.trace());
+}