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

Timestamp:

Jun 24, 2012, 12:11:32 PM (12 years ago)

Author:

mervart

Message:

 

File:

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

trunk/BNC/src/bncutils.cpp

@@ -408 +408 @@
   return ok ? 0 : 1;
 }
+
+// Topocentrical Distance and Elevation
+////////////////////////////////////////////////////////////////////////////
+void topos(double xRec, double yRec, double zRec, 
+           double xSat, double ySat, double zSat, 
+           double& rho, double& eleSat, double& azSat) {
+
+  double dx[3];
+  dx[0] = xSat-xRec;
+  dx[1] = ySat-yRec;
+  dx[2] = zSat-zRec;
+
+  rho =  sqrt( dx[0]*dx[0] + dx[1]*dx[1] + dx[2]*dx[2] ); 
+
+  double xyzRec[3];
+  xyzRec[0] = xRec;
+  xyzRec[1] = yRec;
+  xyzRec[2] = zRec;
+
+  double Ell[3];
+  double neu[3];
+  xyz2ell(xyzRec, Ell);
+  xyz2neu(Ell, dx, neu);
+
+  eleSat = acos( sqrt(neu[0]*neu[0] + neu[1]*neu[1]) / rho );
+  if (neu[2] < 0) {
+    eleSat *= -1.0;
+  }
+
+  azSat  = atan2(neu[1], neu[0]);
+}