Changeset 2065 in ntrip for trunk/BNC/bncutils.cpp

Timestamp:

Dec 1, 2009, 2:13:03 PM (14 years ago)

Author:

mervart

Message:

* empty log message *

File:

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

trunk/BNC/bncutils.cpp

@@ -222 +222 @@
   return failure;
 }
+
+// Rectangular Coordinates -> North, East, Up Components
+////////////////////////////////////////////////////////////////////////////
+void xyz2neu(const double* Ell, const double* xyz, double* neu) {
+
+  double sinPhi = sin(Ell[0]);
+  double cosPhi = cos(Ell[0]);
+  double sinLam = sin(Ell[1]);
+  double cosLam = cos(Ell[1]);
+
+  neu[0] = - sinPhi*cosLam * xyz[0]
+           - sinPhi*sinLam * xyz[1]
+           + cosPhi        * xyz[2];
+
+  neu[1] = - sinLam * xyz[0]
+           + cosLam * xyz[1];
+
+  neu[2] = + cosPhi*cosLam * xyz[0]
+           + cosPhi*sinLam * xyz[1]
+           + sinPhi        * xyz[2];
+}