Merge pull request #695 from ourairquality/getstapos-sinex

getstapos: add sinex suport, and export

Author: rtklibexplorer

src/postpos.c

@@ -847,47 +847,14 @@ static int avepos(double *ra, int rcv, const obs_t *obs, const nav_t *nav,
     for (i=0;i<3;i++) ra[i]/=n;
     return 1;
 }
-/* station position from file ------------------------------------------------*/
-static int getstapos(const char *file, const char *name, double *r)
-{
-    FILE *fp;
-    char buff[256],sname[256],*p;
-    const char *q;
-    double pos[3];
-
-    trace(3,"getstapos: file=%s name=%s\n",file,name);
 
-    if (!(fp=fopen(file,"r"))) {
-        trace(1,"station position file open error: %s\n",file);
-        return 0;
-    }
-    while (fgets(buff,sizeof(buff),fp)) {
-        if ((p=strchr(buff,'%'))) *p='\0';
-        
-        if (sscanf(buff,"%lf %lf %lf %255s",pos,pos+1,pos+2,sname)<4) continue;
-        
-        for (p=sname,q=name;*p&&*q;p++,q++) {
-            if (toupper((int)*p)!=toupper((int)*q)) break;
-        }
-        if (!*p) {
-            pos[0]*=D2R;
-            pos[1]*=D2R;
-            pos2ecef(pos,r);
-            fclose(fp);
-            return 1;
-        }
-    }
-    fclose(fp);
-    trace(1,"no station position: %s %s\n",name,file);
-    return 0;
-}
 /* antenna phase center position ---------------------------------------------*/
 static int antpos(prcopt_t *opt, int rcvno, const obs_t *obs, const nav_t *nav,
-                  const sta_t *sta, const char *posfile)
+                  const sta_t *stas, const char *posfile)
 {
     double *rr=rcvno==1?opt->ru:opt->rb,del[3],pos[3],dr[3]={0};
     int i,postype=rcvno==1?opt->rovpos:opt->refpos;
-    char *name;
+    const char *name;
 
     trace(3,"antpos  : rcvno=%d\n",rcvno);
 

src/rtkcmn.c

@@ -4147,6 +4147,117 @@ extern int rtk_uncompress(const char *file, char *uncfile)
     trace(3,"rtk_uncompress: stat=%d\n",stat);
     return stat;
 }
+/* station position from file ------------------------------------------------*/
+extern int getstapos(const char *file, const char *name, double *r)
+{
+    trace(3, "getstapos: file=%s name=%s\n", file, name);
+
+    FILE *fp = fopen(file, "r");
+    if (!fp) {
+        trace(1,"station position file open error: %s\n",file);
+        return 0;
+    }
+
+    char buff[256];
+    int state = 0; // 0 pos file, 1 sinex misc, 2 sinex pos estimates.
+    int n = 0, posp = 0;
+    double poss[3];
+    while (fgets(buff, sizeof(buff), fp)) {
+      size_t len = strlen(buff);
+      if (state == 0) {
+        if (len >= 4 && strncmp(buff, "%=SNX", 4) == 0) {
+          state = 1;
+          continue;
+        }
+        // RTKLIB Position file
+        char *p = strchr(buff,'%');
+        if (p) *p='\0';
+
+        // Match either the full extended name or the 4 character
+        // prefix, giving priority to a full match.
+        char sname[256];
+        double pos[3];
+        if (sscanf(buff, "%lf %lf %lf %255s", pos, pos+1, pos+2, sname) < 4) continue;
+
+        int i = 0;
+        for (; sname[i] && name[i]; i++) {
+          if (toupper(sname[i]) != toupper(name[i])) break;
+        }
+
+        if (sname[i] == '\0' && name[i] == '\0') {
+          // Exact match.
+          pos[0] *= D2R;
+          pos[1] *= D2R;
+          pos2ecef(pos, r);
+          fclose(fp);
+          return 1;
+        }
+
+        if (i > 3 && (sname[i] == '\0' || name[i] == '\0') && i > posp) {
+          // Prefix match, save position.
+          posp = i;
+          for (int i = 0; i < 3; i++) poss[i] = pos[i];
+        }
+      }
+
+      // Sinex position file.
+      if (buff[0] == '*') continue; // Comment
+      if (strncmp(buff, "+SOLUTION/ESTIMATE", 18) == 0) {
+        state = 2;
+        continue;
+      }
+      if (state != 2) continue;
+
+      if (strncmp(buff, "-SOLUTION/ESTIMATE", 18) == 0) {
+        state = 1;
+        continue;
+      }
+      if (len < 68) {
+        trace(2, "getstapos: unexpected sinex line '%s'\n", buff);
+        continue;
+      }
+
+      // The solution sinex site codes are limited to 4 characters
+      // and only the 4 character prefix of the 'name' is matched.
+      char sname[5];
+      setstr(sname, buff + 14, 4);
+      int i = 0;
+      for (; i < 4 && sname[i] && name[i]; i++) {
+        if (toupper(sname[i]) != toupper(name[i])) break;
+      }
+      if (sname[i]) continue;
+      if (i < 4 && name[i]) continue;
+
+      if (strncmp(buff + 7, "STAX", 4) == 0) {
+        r[0] = str2num(buff, 47, 21);
+        n |= 1;
+      }
+      if (strncmp(buff + 7, "STAY", 4) == 0) {
+        r[1] = str2num(buff, 47, 21);
+        n |= 2;
+      }
+      if (strncmp(buff + 7, "STAZ", 4) == 0) {
+        r[2] = str2num(buff, 47, 21);
+        n |= 4;
+      }
+      if (n == 7) {
+        fclose(fp);
+        return 1;
+      }
+    }
+    fclose(fp);
+
+    if (state == 0 && posp > 0) {
+      // Return the longest prefix match.
+      poss[0] *= D2R;
+      poss[1] *= D2R;
+      pos2ecef(poss, r);
+      return 1;
+    }
+
+    trace(1, "no station position: %s %s\n", name, file);
+    return 0;
+}
 /* dummy application functions for shared library ----------------------------*/
 #if defined(WIN_DLL) || defined(DLL)
 extern int showmsg(const char *format,...) {return 0;}

src/rtklib.h

@@ -1862,6 +1862,7 @@ EXPORT int postpos(gtime_t ts, gtime_t te, double ti, double tu,
                    const prcopt_t *popt, const solopt_t *sopt,
                    const filopt_t *fopt, const char **infile, int n, const char *outfile,
                    const char *rov, const char *base);
+EXPORT int getstapos(const char *file, const char *name, double *r);
 
 /* stream server functions ---------------------------------------------------*/
 EXPORT void strsvrinit (strsvr_t *svr, int nout);