Changeset 7244 in ntrip for trunk/BNC/src/bncutils.cpp

Timestamp:

Aug 20, 2015, 1:37:05 PM (9 years ago)

Author:

stuerze

Message:

method for transformation of rectangular coordinates into geocentric coordinates is added

File:

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

trunk/BNC/src/bncutils.cpp

@@ -409 +409 @@
 }
 
+// Rectangular Coordinates -> Geocentric Coordinates
+////////////////////////////////////////////////////////////////////////////
+void xyz2geoc(const double* XYZ, double* Geoc) {
+
+  const double bell = t_CST::aell*(1.0-1.0/t_CST::fInv) ;
+  const double e2   = (t_CST::aell*t_CST::aell-bell*bell)/(t_CST::aell*t_CST::aell) ;
+
+  double Ell[3];
+  xyz2ell(XYZ, Ell);
+
+  double rho = sqrt(XYZ[0]*XYZ[0]+XYZ[1]*XYZ[1]+XYZ[2]*XYZ[2]);
+  double Rn = t_CST::aell/sqrt(1-(e2)*pow(sin(Ell[0]),2));
+
+  Geoc[0] = atan((1-e2 * Rn/(Rn + Ell[2])) * tan(Ell[0]));
+  Geoc[1] = Ell[1];
+  Geoc[2] = rho-t_CST::rgeoc;
+}
+
 // 
 ////////////////////////////////////////////////////////////////////////////