Changeset 9786 in ntrip


Ignore:
Timestamp:
Jun 30, 2022, 5:23:55 PM (7 weeks ago)
Author:
stuerze
Message:

some more changes to consider RINEX Version 4 in nav files: added CNAF, CNV2 for GPS, QZSS

Location:
trunk/BNC/src
Files:
2 edited

Legend:

Unmodified
Added
Removed
  • trunk/BNC/src/ephemeris.cpp

    r9785 r9786  
    244244t_ephGPS::t_ephGPS(double rnxVersion, const QStringList& lines) {
    245245
    246   const int nLines = 8;
     246  int nLines = 8;
     247
     248  if (navType() == t_eph::CNAV) {
     249    nLines += 1;
     250  }
     251  else if (navType() == t_eph::CNV2) {
     252    nLines += 2;
     253  }
    247254
    248255  if (lines.size() != nLines) {
     
    305312      _TOC.set(year, month, day, hour, min, sec);
    306313
    307       if ( readDbl(line, pos[1], fieldLen, _clock_bias     ) ||
     314    if  ( readDbl(line, pos[1], fieldLen, _clock_bias     ) ||
    308315           readDbl(line, pos[2], fieldLen, _clock_drift    ) ||
    309316           readDbl(line, pos[3], fieldLen, _clock_driftrate) ) {
     
    312319      }
    313320    }
    314 
    315     else if      ( iLine == 1 ) {
    316       if ( readDbl(line, pos[0], fieldLen, _IODE   ) ||
    317            readDbl(line, pos[1], fieldLen, _Crs    ) ||
    318            readDbl(line, pos[2], fieldLen, _Delta_n) ||
    319            readDbl(line, pos[3], fieldLen, _M0     ) ) {
    320         _checkState = bad;
    321         return;
    322       }
    323     }
    324 
     321    // =====================
     322    // BROADCAST ORBIT - 1
     323    // =====================
     324    else if      ( iLine == 1) {
     325
     326      if (navType() == t_eph::CNAV ||
     327          navType() == t_eph::CNV2) {
     328        if ( readDbl(line, pos[0], fieldLen, _ADOT   ) ||
     329             readDbl(line, pos[1], fieldLen, _Crs    ) ||
     330             readDbl(line, pos[2], fieldLen, _Delta_n) ||
     331             readDbl(line, pos[3], fieldLen, _M0     ) ) {
     332              _checkState = bad;
     333                return;
     334                }
     335      }
     336      else { // LNAV, undefined
     337        if ( readDbl(line, pos[0], fieldLen, _IODE   ) ||
     338             readDbl(line, pos[1], fieldLen, _Crs    ) ||
     339             readDbl(line, pos[2], fieldLen, _Delta_n) ||
     340             readDbl(line, pos[3], fieldLen, _M0     ) ) {
     341          _checkState = bad;
     342          return;
     343        }
     344      }
     345    }
     346    // =====================
     347    // BROADCAST ORBIT - 2
     348    // =====================
    325349    else if ( iLine == 2 ) {
    326350      if ( readDbl(line, pos[0], fieldLen, _Cuc   ) ||
     
    332356      }
    333357    }
    334 
     358    // =====================
     359    // BROADCAST ORBIT - 3
     360    // =====================
    335361    else if ( iLine == 3 ) {
    336       if ( readDbl(line, pos[0], fieldLen, _TOEsec)  ||
    337            readDbl(line, pos[1], fieldLen, _Cic   )  ||
    338            readDbl(line, pos[2], fieldLen, _OMEGA0)  ||
    339            readDbl(line, pos[3], fieldLen, _Cis   ) ) {
    340         _checkState = bad;
    341         return;
    342       }
    343     }
    344 
     362
     363      if (navType() == t_eph::CNAV ||
     364          navType() == t_eph::CNV2) {
     365        if ( readDbl(line, pos[0], fieldLen, _top)  ||
     366             readDbl(line, pos[1], fieldLen, _Cic   )  ||
     367             readDbl(line, pos[2], fieldLen, _OMEGA0)  ||
     368             readDbl(line, pos[3], fieldLen, _Cis   ) ) {
     369          _checkState = bad;
     370          return;
     371        }
     372      }
     373      else { // LNAV, undefined
     374        if ( readDbl(line, pos[0], fieldLen, _TOEsec)  ||
     375             readDbl(line, pos[1], fieldLen, _Cic   )  ||
     376             readDbl(line, pos[2], fieldLen, _OMEGA0)  ||
     377             readDbl(line, pos[3], fieldLen, _Cis   ) ) {
     378          _checkState = bad;
     379          return;
     380        }
     381      }
     382    }
     383    // =====================
     384    // BROADCAST ORBIT - 4
     385    // =====================
    345386    else if ( iLine == 4 ) {
    346387      if ( readDbl(line, pos[0], fieldLen, _i0      ) ||
     
    352393      }
    353394    }
    354 
     395    // =====================
     396    // BROADCAST ORBIT - 5
     397    // =====================
    355398    else if ( iLine == 5 && type() != t_eph::IRNSS) {
    356       if ( readDbl(line, pos[0], fieldLen, _IDOT   ) ||
    357            readDbl(line, pos[1], fieldLen, _L2Codes) ||
    358            readDbl(line, pos[2], fieldLen, _TOEweek  ) ||
    359            readDbl(line, pos[3], fieldLen, _L2PFlag) ) {
    360         _checkState = bad;
    361         return;
     399
     400      if (navType() == t_eph::CNAV ||
     401          navType() == t_eph::CNV2) {
     402        if ( readDbl(line, pos[0], fieldLen, _IDOT   ) ||
     403             readDbl(line, pos[1], fieldLen, _DN0DOT ) ||
     404             readDbl(line, pos[2], fieldLen, _URAI_NED0 ) ||
     405             readDbl(line, pos[3], fieldLen, _URAI_NED1) ) {
     406          _checkState = bad;
     407          return;
     408        }
     409      }
     410      else { // LNAV, undefined
     411        if ( readDbl(line, pos[0], fieldLen, _IDOT   ) ||
     412             readDbl(line, pos[1], fieldLen, _L2Codes) ||
     413             readDbl(line, pos[2], fieldLen, _TOEweek  ) ||
     414             readDbl(line, pos[3], fieldLen, _L2PFlag) ) {
     415          _checkState = bad;
     416          return;
     417        }
    362418      }
    363419    }
     
    369425      }
    370426    }
    371 
     427    // =====================
     428    // BROADCAST ORBIT - 6
     429    // =====================
    372430    else if ( iLine == 6 && type() != t_eph::IRNSS) {
    373       if ( readDbl(line, pos[0], fieldLen, _ura   ) ||
    374            readDbl(line, pos[1], fieldLen, _health) ||
    375            readDbl(line, pos[2], fieldLen, _TGD   ) ||
    376            readDbl(line, pos[3], fieldLen, _IODC  ) ) {
    377         _checkState = bad;
    378         return;
     431
     432      if (navType() == t_eph::CNAV ||
     433          navType() == t_eph::CNV2  ) {
     434        if ( readDbl(line, pos[0], fieldLen, _URAI_ED) ||
     435             readDbl(line, pos[1], fieldLen, _health ) ||
     436             readDbl(line, pos[2], fieldLen, _TGD    ) ||
     437             readDbl(line, pos[3], fieldLen, _URAI_NED2) ) {
     438          _checkState = bad;
     439          return;
     440        }
     441      }
     442      else { // LNAV, undefined
     443        if ( readDbl(line, pos[0], fieldLen, _ura   ) ||
     444             readDbl(line, pos[1], fieldLen, _health) ||
     445             readDbl(line, pos[2], fieldLen, _TGD   ) ||
     446             readDbl(line, pos[3], fieldLen, _IODC  ) ) {
     447          _checkState = bad;
     448          return;
     449        }
    379450      }
    380451    }
     
    387458      }
    388459    }
     460    // =====================
     461    // BROADCAST ORBIT - 7
     462    // =====================
    389463    else if ( iLine == 7 ) {
    390       if ( readDbl(line, pos[0], fieldLen, _TOT) ) {
    391         _checkState = bad;
    392         return;
    393       }
    394       // fitInterval is not valid for IRNSS
    395       if (type() != t_eph::IRNSS) {
    396         double fitIntervalRnx;
    397         readDbl(line, pos[1], fieldLen, fitIntervalRnx);
    398         if        (type() == t_eph::GPS) {  // in RINEX specified allways as time period for GPS
    399             _fitInterval = fitIntervalRnx;
    400         } else if (type() == t_eph::QZSS) { // specified as flag for QZSS
    401           if (rnxVersion == 3.02) {
    402             _fitInterval = fitIntervalRnx; // specified as time period
     464      if (navType() == t_eph::LNAV ||
     465          navType() == t_eph::undefined) {
     466
     467        if ( readDbl(line, pos[0], fieldLen, _TOT) ) {
     468          _checkState = bad;
     469          return;
     470        }
     471
     472        if (type() != t_eph::IRNSS) {
     473          double fitIntervalRnx;
     474          if ( readDbl(line, pos[1], fieldLen, fitIntervalRnx) ) {
     475            _checkState = bad;
     476            return;
    403477          }
    404           else {
    405             _fitInterval = fitIntervalFromFlag(fitIntervalRnx, _IODC, t_eph::QZSS);
     478          if        (type() == t_eph::GPS) {  // in RINEX specified always as time period for GPS
     479              _fitInterval = fitIntervalRnx;
     480          } else if (type() == t_eph::QZSS) { // specified as flag for QZSS
     481            if (rnxVersion == 3.02) {
     482              _fitInterval = fitIntervalRnx; // specified as time period
     483            }
     484            else {
     485              _fitInterval = fitIntervalFromFlag(fitIntervalRnx, _IODC, t_eph::QZSS);
     486            }
    406487          }
     488        }
     489      }
     490
     491      else if (navType() == t_eph::CNAV ||
     492               navType() == t_eph::CNV2) {
     493        if ( readDbl(line, pos[0], fieldLen, _ISC_L1CA) ||
     494             readDbl(line, pos[1], fieldLen, _ISC_L2C ) ||
     495             readDbl(line, pos[2], fieldLen, _ISC_L5I5) ||
     496             readDbl(line, pos[3], fieldLen, _ISC_L5Q5) ) {
     497          _checkState = bad;
     498          return;
     499        }
     500
     501      }
     502
     503    }
     504    // =====================
     505    // BROADCAST ORBIT - 8
     506    // =====================
     507    else if ( iLine == 8 ) {
     508      if (navType() == t_eph::CNAV) {
     509        if ( readDbl(line, pos[0], fieldLen, _TOT) ||
     510             readDbl(line, pos[1], fieldLen, _wnop) ) {
     511          _checkState = bad;
     512          return;
     513        }
     514      }
     515      else if (navType() == t_eph::CNV2) {
     516        if ( readDbl(line, pos[0], fieldLen, _ISC_L1Cd) ||
     517             readDbl(line, pos[1], fieldLen, _ISC_L1Cp)) {
     518          _checkState = bad;
     519          return;
     520        }
     521      }
     522    }
     523    // =====================
     524    // BROADCAST ORBIT - 9
     525    // =====================
     526    else if ( iLine == 9 ) {
     527      if (navType() == t_eph::CNV2) {
     528        if ( readDbl(line, pos[0], fieldLen, _TOT) ||
     529             readDbl(line, pos[1], fieldLen, _wnop) ) {
     530          _checkState = bad;
     531          return;
    407532        }
    408533      }
     
    517642  QString fmt = version < 3.0 ? "   %1%2%3%4\n" : "    %1%2%3%4\n";
    518643
    519   out << QString(fmt)
    520     .arg(_IODE,    19, 'e', 12)
    521     .arg(_Crs,     19, 'e', 12)
    522     .arg(_Delta_n, 19, 'e', 12)
    523     .arg(_M0,      19, 'e', 12);
    524 
     644
     645  // =====================
     646  // BROADCAST ORBIT - 1
     647  // =====================
     648  if (navType() == t_eph::CNAV ||
     649      navType() == t_eph::CNV2) {
     650    out << QString(fmt)
     651      .arg(_ADOT,    19, 'e', 12)
     652      .arg(_Crs,     19, 'e', 12)
     653      .arg(_Delta_n, 19, 'e', 12)
     654      .arg(_M0,      19, 'e', 12);
     655  }
     656  else { // LNAV, undefinded
     657    out << QString(fmt)
     658      .arg(_IODE,    19, 'e', 12)
     659      .arg(_Crs,     19, 'e', 12)
     660      .arg(_Delta_n, 19, 'e', 12)
     661      .arg(_M0,      19, 'e', 12);
     662  }
     663  // =====================
     664  // BROADCAST ORBIT - 2
     665  // =====================
    525666  out << QString(fmt)
    526667    .arg(_Cuc,    19, 'e', 12)
     
    528669    .arg(_Cus,    19, 'e', 12)
    529670    .arg(_sqrt_A, 19, 'e', 12);
    530 
    531   out << QString(fmt)
    532     .arg(_TOEsec, 19, 'e', 12)
    533     .arg(_Cic,    19, 'e', 12)
    534     .arg(_OMEGA0, 19, 'e', 12)
    535     .arg(_Cis,    19, 'e', 12);
    536 
     671  // =====================
     672  // BROADCAST ORBIT - 3
     673  // =====================
     674  if (navType() == t_eph::CNAV ||
     675      navType() == t_eph::CNV2) {
     676    out << QString(fmt)
     677        .arg(_top,    19, 'e', 12)
     678        .arg(_Cic,    19, 'e', 12)
     679        .arg(_OMEGA0, 19, 'e', 12)
     680        .arg(_Cis,    19, 'e', 12);
     681  }
     682  else {
     683    out << QString(fmt)
     684        .arg(_TOEsec, 19, 'e', 12)
     685        .arg(_Cic,    19, 'e', 12)
     686        .arg(_OMEGA0, 19, 'e', 12)
     687        .arg(_Cis,    19, 'e', 12);
     688  }
     689  // =====================
     690  // BROADCAST ORBIT - 4
     691  // =====================
    537692  out << QString(fmt)
    538693    .arg(_i0,       19, 'e', 12)
     
    540695    .arg(_omega,    19, 'e', 12)
    541696    .arg(_OMEGADOT, 19, 'e', 12);
    542 
     697  // =====================
     698  // BROADCAST ORBIT - 5
     699  // =====================
    543700  if (type() == t_eph::IRNSS) {
    544701    out << QString(fmt)
     
    549706  }
    550707  else {
    551     out << QString(fmt)
    552       .arg(_IDOT,    19, 'e', 12)
    553       .arg(_L2Codes, 19, 'e', 12)
    554       .arg(_TOEweek, 19, 'e', 12)
    555       .arg(_L2PFlag, 19, 'e', 12);
    556   }
    557 
     708    if (navType() == t_eph::CNAV ||
     709        navType() == t_eph::CNV2) {
     710      out << QString(fmt)
     711        .arg(_IDOT,      19, 'e', 12)
     712        .arg(_DN0DOT,    19, 'e', 12)
     713        .arg(_URAI_NED0, 19, 'e', 12)
     714        .arg(_URAI_NED1, 19, 'e', 12);
     715
     716    }
     717    else { // LNAV, undefined
     718      out << QString(fmt)
     719        .arg(_IDOT,    19, 'e', 12)
     720        .arg(_L2Codes, 19, 'e', 12)
     721        .arg(_TOEweek, 19, 'e', 12)
     722        .arg(_L2PFlag, 19, 'e', 12);
     723
     724    }
     725  }
     726  // =====================
     727  // BROADCAST ORBIT - 6
     728  // =====================
    558729  if (type() == t_eph::IRNSS) {
    559730    out << QString(fmt)
     
    564735  }
    565736  else {
     737    if (navType() == t_eph::CNAV ||
     738        navType() == t_eph::CNV2) {
     739      out << QString(fmt)
     740        .arg(_URAI_ED,  19, 'e', 12)
     741        .arg(_health,   19, 'e', 12)
     742        .arg(_TGD,      19, 'e', 12)
     743        .arg(_URAI_NED2,19, 'e', 12);
     744
     745    }
     746    else { // LNAV, undefined
     747      out << QString(fmt)
     748        .arg(_ura,    19, 'e', 12)
     749        .arg(_health, 19, 'e', 12)
     750        .arg(_TGD,    19, 'e', 12)
     751        .arg(_IODC,   19, 'e', 12);
     752    }
     753  }
     754  // =====================
     755  // BROADCAST ORBIT - 7
     756  // =====================
     757  if (navType() == t_eph::LNAV ||
     758      navType() == t_eph::undefined) {
     759
     760    double tot = _TOT;
     761    if (tot == 0.9999e9 && version < 3.0) {
     762      tot = 0.0;
     763    }
     764    // fitInterval
     765    if (type() == t_eph::IRNSS) {// not valid for IRNSS
     766      out << QString(fmt)
     767        .arg(tot,          19, 'e', 12)
     768        .arg(0.0,          19, 'e', 12)
     769        .arg("",           19, QChar(' '))
     770        .arg("",           19, QChar(' '));
     771    }
     772    else {
     773      // for GPS and QZSS in version 3.02 specified in hours
     774      double fitIntervalRnx = _fitInterval;
     775      // otherwise specified as flag
     776      if (type() == t_eph::QZSS && version != 3.02) {
     777        (_fitInterval == 2.0) ? fitIntervalRnx = 0.0 : fitIntervalRnx = 1.0;
     778      }
     779      out << QString(fmt)
     780        .arg(tot,            19, 'e', 12)
     781        .arg(fitIntervalRnx, 19, 'e', 12)
     782        .arg("",             19, QChar(' '))
     783        .arg("",             19, QChar(' '));
     784    }
     785  }
     786  else if (navType() == t_eph::CNAV ||
     787           navType() == t_eph::CNV2) {
    566788    out << QString(fmt)
    567       .arg(_ura,    19, 'e', 12)
    568       .arg(_health, 19, 'e', 12)
    569       .arg(_TGD,    19, 'e', 12)
    570       .arg(_IODC,   19, 'e', 12);
    571   }
    572 
    573   double tot = _TOT;
    574   if (tot == 0.9999e9 && version < 3.0) {
    575     tot = 0.0;
    576   }
    577   // fitInterval
    578   if (type() == t_eph::IRNSS) {// not valid for IRNSS
     789      .arg(_ISC_L1CA, 19, 'e', 12)
     790      .arg(_ISC_L2C,  19, 'e', 12)
     791      .arg(_ISC_L5I5, 19, 'e', 12)
     792      .arg(_ISC_L5Q5, 19, 'e', 12);
     793  }
     794  // =====================
     795  // BROADCAST ORBIT - 8
     796  // =====================
     797  if (navType() == t_eph::CNAV) {
    579798    out << QString(fmt)
    580       .arg(tot,          19, 'e', 12)
    581       .arg(0.0,          19, 'e', 12)
    582       .arg("",           19, QChar(' '))
    583       .arg("",           19, QChar(' '));
    584   }
    585   else {
    586     // for GPS and QZSS in version 3.02 specified in hours
    587     double fitIntervalRnx = _fitInterval;
    588     // otherwise specified as flag
    589     if (type() == t_eph::QZSS && version != 3.02) {
    590       (_fitInterval == 2.0) ? fitIntervalRnx = 0.0 : fitIntervalRnx = 1.0;
    591     }
     799      .arg(_TOT,  19, 'e', 12)
     800      .arg(_wnop, 19, 'e', 12)
     801      .arg("",    19, QChar(' '))
     802      .arg("",    19, QChar(' '));
     803  }
     804  else if (navType() == t_eph::CNV2) {
    592805    out << QString(fmt)
    593       .arg(tot,            19, 'e', 12)
    594       .arg(fitIntervalRnx, 19, 'e', 12)
    595       .arg("",             19, QChar(' '))
    596       .arg("",             19, QChar(' '));
    597   }
     806      .arg(_ISC_L1Cd, 19, 'e', 12)
     807      .arg(_ISC_L1Cp, 19, 'e', 12)
     808      .arg("",        19, QChar(' '))
     809      .arg("",        19, QChar(' '));
     810  }
     811
     812  // =====================
     813  // BROADCAST ORBIT - 9
     814  // =====================
     815  if (navType() == t_eph::CNV2) {
     816    out << QString(fmt)
     817      .arg(_TOT,  19, 'e', 12)
     818      .arg(_wnop, 19, 'e', 12)
     819      .arg("",    19, QChar(' '))
     820      .arg("",    19, QChar(' '));
     821  }
     822
    598823  return rnxStr;
    599824}
  • trunk/BNC/src/ephemeris.h

    r9785 r9786  
    104104    _TOT              = 0.0;
    105105    _fitInterval      = 0.0;
     106    _ADOT             = 0.0;
     107    _top              = 0.0;
     108    _DN0DOT           = 0.0;
     109    _URAI_NED0        = 0.0;
     110    _URAI_NED1        = 0.0;
     111    _URAI_NED2        = 0.0;
     112    _URAI_ED          = 0.0;
     113    _ISC_L1CA         = 0.0;
     114    _ISC_L2C          = 0.0;
     115    _ISC_L5I5         = 0.0;
     116    _ISC_L5Q5         = 0.0;
     117    _ISC_L1Cd         = 0.0;
     118    _ISC_L1Cp         = 0.0;
    106119    _receptStaID      = "";
    107120  }
     
    136149
    137150  double  _Cuc;             // [rad]
    138   double  _e;               //
     151  double  _e;               // []
    139152  double  _Cus;             // [rad]
    140153  double  _sqrt_A;          // [m^0.5]
    141154
    142   double  _TOEsec;          // [s]
     155  double  _TOEsec;          // [s of GPS week]
    143156  double  _Cic;             // [rad]
    144157  double  _OMEGA0;          // [rad]
     
    152165  double  _IDOT;            // [rad/s]
    153166  double  _L2Codes;         // Codes on L2 channel  (not valid for IRNSS)
    154   double  _TOEweek;
     167  double  _TOEweek;         // GPS week # to go with TOE, cont. number, not mode 1024
    155168  double  _L2PFlag;         // L2 P data flag (not valid for IRNSS and QZSS)
    156169
     
    162175  double  _TOT;             // Transmission time
    163176  double  _fitInterval;     // Fit interval in hours (not valid for IRNSS)
     177
     178  double  _ADOT;            // [m/s]
     179  double  _top;             // [s]
     180  double  _DN0DOT;          // [rad/s^2]
     181
     182  double _URAI_NED0;        // []
     183  double _URAI_NED1;        // []
     184  double _URAI_NED2;        // []
     185  double _URAI_ED;          // []
     186
     187  double _ISC_L1CA;         // [s]
     188  double _ISC_L2C;          // [s]
     189  double _ISC_L5I5;         // [s]
     190  double _ISC_L5Q5;         // [s]
     191  double _ISC_L1Cd;         // [s]
     192  double _ISC_L1Cp;         // [s]
     193
     194  double _wnop;             // GPS continuous week number with the ambiguity resolved
    164195};
    165196
Note: See TracChangeset for help on using the changeset viewer.