コード例 #1
0
ファイル: Rinex3NavData.cpp プロジェクト: JC5005/GPSTk
   // Private helper routine for casts from this to OrbitEph-based Ephemerides
   void Rinex3NavData::castTo(OrbitEph *oeptr) const
   {
      try {
         // Glonass and Geosync do not have a orbit-based ephemeris
         if(satSys == "R" || satSys == "S") {
            oeptr->dataLoadedFlag = false;
            return;
         }

         // Overhead
         RinexSatID sat;
         sat.fromString(satSys + StringUtils::asString(PRNID));
         oeptr->satID = SatID(sat);
         //obsID = ?? ObsID obsID; // Defines carrier and tracking code
         oeptr->ctToe = time;

         // clock model
         oeptr->af0 = af0;
         oeptr->af1 = af1;
         oeptr->af2 = af2;
   
         // Major orbit parameters
         oeptr->M0 = M0;
         oeptr->dn = dn;
         oeptr->ecc = ecc;
         oeptr->A = Ahalf * Ahalf;
         oeptr->OMEGA0 = OMEGA0;
         oeptr->i0 = i0;
         oeptr->w = w;
         oeptr->OMEGAdot = OMEGAdot;
         oeptr->idot = idot;
         // modern nav msg
         oeptr->dndot = 0.;
         oeptr->Adot = 0.;
   
         // Harmonic perturbations
         oeptr->Cuc = Cuc;
         oeptr->Cus = Cus;
         oeptr->Crc = Crc;
         oeptr->Crs = Crs;
         oeptr->Cic = Cic;
         oeptr->Cis = Cis;
   
         oeptr->dataLoadedFlag = true;
      }
      catch(Exception& e) { GPSTK_RETHROW(e); }
   }
コード例 #2
0
ファイル: Rinex3ObsData.cpp プロジェクト: rumkex/GPSTk
RinexDatum Rinex3ObsData::getObs(const RinexSatID& svID,
                                 const RinexObsID& obsID,
                                 const Rinex3ObsHeader& hdr ) const
throw(InvalidRequest)
{
    string sys(1,svID.systemChar());
    return getObs(svID, hdr.getObsIndex(sys, obsID));
}
コード例 #3
0
ファイル: Rinex3ObsData.cpp プロジェクト: rumkex/GPSTk
void Rinex3ObsData::setObs(const RinexDatum& data,
                           const RinexSatID& svID,
                           const RinexObsID& obsID,
                           const Rinex3ObsHeader& hdr )
throw(InvalidRequest)
{
    size_t index = hdr.getObsIndex(string(1,svID.systemChar()), obsID);
    if (obs[svID].size() <= index)
        obs[svID].resize(index+1);
    obs[svID][index] = data;
}
コード例 #4
0
ファイル: Rinex3ObsData.cpp プロジェクト: rumkex/GPSTk
RinexDatum Rinex3ObsData::getObs(const RinexSatID& svID,
                                 const std::string& type,
                                 const Rinex3ObsHeader& hdr ) const
throw(InvalidRequest)
{
    string obsID;
    // Add GNSS code if needed
    if( type.size() == 3 )
        obsID = svID.systemChar() + type;
    else
        obsID = type;

    return getObs(svID, hdr.getObsIndex(obsID));
}
コード例 #5
0
ファイル: Rinex3ObsData.cpp プロジェクト: JC5005/GPSTk
   void reallyGetRecordVer2(Rinex3ObsStream& strm, Rinex3ObsData& rod)
      throw(Exception)
   {
      static CommonTime previousTime(CommonTime::BEGINNING_OF_TIME);

      // get the epoch line and check
      string line;
      while(line.empty())        // ignore blank lines in place of epoch lines
         strm.formattedGetLine(line, true);

      if(line.size()>80 || line[0] != ' ' || line[3] != ' ' || line[6] != ' ') {
         FFStreamError e("Bad epoch line: >" + line + "<");
         GPSTK_THROW(e);
      }

      // process the epoch line, including SV list and clock bias
      rod.epochFlag = asInt(line.substr(28,1));
      if((rod.epochFlag < 0) || (rod.epochFlag > 6)) {
         FFStreamError e("Invalid epoch flag: " + asString(rod.epochFlag));
         GPSTK_THROW(e);
      }

      // Not all epoch flags are required to have a time.
      // Specifically, 0,1,5,6 must have an epoch time; it is optional for 2,3,4.
      // If there is and epoch time, parse it and load it in the member "time".
      // If epoch flag=0, 1, 5, or 6 and there is NO epoch time, then throw.
      // If epoch flag=2, 3, or 4 and there is no epoch time,
      // use the time of the previous record.
      bool noEpochTime = (line.substr(0,26) == string(26, ' '));
      if(noEpochTime && (rod.epochFlag==0 || rod.epochFlag==1 ||
                         rod.epochFlag==5 || rod.epochFlag==6 )) {
         FFStreamError e("Required epoch time missing: " + line);
         GPSTK_THROW(e);
      }
      else if(noEpochTime)
         rod.time = previousTime;
      else {
         try {
            // check if the spaces are in the right place - an easy
            // way to check if there's corruption in the file
            if((line[0] != ' ') || (line[3] != ' ') || (line[6] != ' ') ||
                 (line[9] != ' ') || (line[12] != ' ') || (line[15] != ' '))
            {
               FFStreamError e("Invalid time format");
               GPSTK_THROW(e);
            }

            // if there's no time, just use a bad time
            if(line.substr(0,26) == string(26, ' '))
               rod.time = CommonTime::BEGINNING_OF_TIME;
               //rod.time = previousTime; ??
            else {
               int year, month, day, hour, min;
               double sec;
               int yy = (static_cast<CivilTime>(strm.header.firstObs)).year/100;
               yy *= 100;

               year  = asInt(   line.substr(1,  2 ));
               month = asInt(   line.substr(4,  2 ));
               day   = asInt(   line.substr(7,  2 ));
               hour  = asInt(   line.substr(10, 2 ));
               min   = asInt(   line.substr(13, 2 ));
               sec   = asDouble(line.substr(15, 11));

               // Real Rinex has epochs 'yy mm dd hr 59 60.0' surprisingly often....
               double ds(0);
               if(sec >= 60.) { ds=sec; sec=0.0; }
               CivilTime rv(yy+year, month, day, hour, min, sec, TimeSystem::GPS);
               if(ds != 0) rv.second += ds;

               rod.time = rv.convertToCommonTime();
            }
         }
         // string exceptions for substr are caught here
         catch(exception &e)
         {
            FFStreamError err("std::exception: " + string(e.what()));
            GPSTK_THROW(err);
         }
         catch(Exception& e)
         {
            string text;
            for(size_t i=0; i<e.getTextCount(); i++) text += e.getText(i);
            FFStreamError err("gpstk::Exception in parseTime(): " + text);
            GPSTK_THROW(err);
         }
         // end rod.time = parseTime(line, strm.header);

         // save for next call
         previousTime = rod.time;
      }

      // number of satellites
      rod.numSVs = asInt(line.substr(29,3));

      // clock offset
      if(line.size() > 68 )
         rod.clockOffset = asDouble(line.substr(68, 12));
      else
         rod.clockOffset = 0.0;

      // Read the observations ...
      if(rod.epochFlag==0 || rod.epochFlag==1 || rod.epochFlag==6) {
         // first read the SatIDs off the epoch line
         int isv, ndx, line_ndx;
         string satsys;
         RinexSatID sat;
         vector<RinexSatID> satIndex(rod.numSVs);
         for(isv=1, ndx=0; ndx<rod.numSVs; isv++, ndx++) {
            if(!(isv % 13)) {                   // get a new continuation line
               strm.formattedGetLine(line);
               isv = 1;
               if(line.size() > 80) {
                  FFStreamError err("Invalid line size:" + asString(line.size()));
                  GPSTK_THROW(err);
               }
            }

            // read the sat id
            try {
               sat = RinexSatID(line.substr(30+isv*3-1, 3));
               satIndex[ndx] = sat;
               //// if this system does not have obs types assigned, do so
               //string satsys = asString(sat.systemChar());
               //if(strm.header.mapObsTypes[satsys].size() == 0) {
               //   strm.header.mapObsTypes[satsys] = strm.header.mapObsTypes["G"];
               //}
            }
            catch (Exception& e) {
               FFStreamError ffse(e);
               GPSTK_THROW(ffse);
            }
         }  // end loop over numSVs

         // loop over all sats, reading obs data
         int numObs(strm.header.R2ObsTypes.size());// number of R2 OTs in header
         rod.obs.clear();
         for(isv=0; isv < rod.numSVs; isv++) {
            //strm.formattedGetLine(line);           // get a line
            //line.resize(80, ' ');                  // pad just in case
            sat = satIndex[isv];                   // sat for this data
            satsys = asString(sat.systemChar());   // system for this sat
            vector<RinexDatum> data;
            // loop over data in the line
            for(ndx=0, line_ndx=0; ndx < numObs; ndx++, line_ndx++) {
               if(! (line_ndx % 5)) {              // get a new line
                  strm.formattedGetLine(line);
                  line.resize(80, ' ');            // pad just in case
                  line_ndx = 0;
                  if(line.size() > 80) {
                     FFStreamError err("Invalid line size:" + asString(line.size()));
                     GPSTK_THROW(err);
                  }
               }

               // does this R2 OT map into a valid R3 ObsID?
               string R2ot(strm.header.R2ObsTypes[ndx]);
               string R3ot(strm.header.mapSysR2toR3ObsID[satsys][R2ot].asString());
               if(R3ot != string("   ")) {
                  RinexDatum tempData;
                  tempData.data = asDouble(line.substr(line_ndx*16,   14));
                  tempData.lli =     asInt(line.substr(line_ndx*16+14, 1));
                  tempData.ssi =     asInt(line.substr(line_ndx*16+15, 1));
                  data.push_back(tempData);
               }
            }
            rod.obs[sat] = data;

         }  // end loop over sats to read obs data
      }

      // ... or the auxiliary header information
      else if(rod.numSVs > 0) {
         rod.auxHeader.clear();
         for(int i=0; i<rod.numSVs; i++)
         {
            strm.formattedGetLine(line);
            StringUtils::stripTrailing(line);
            try {
               rod.auxHeader.ParseHeaderRecord(line);
            }
            catch(FFStreamError& e) { GPSTK_RETHROW(e); }
            catch(StringException& e) { GPSTK_RETHROW(e); }
         }
      }
   }  // end void reallyGetRecordVer2(Rinex3ObsStream& strm, Rinex3ObsData& rod)
コード例 #6
0
ファイル: RinexConvert.cpp プロジェクト: Milfhunter/gpstk
bool convertRinex2ObsFile(std::string& fileName, std::string& outFile)
{
   bool retBool = true;

   try
   {
      // Open the input & output files.

      if (debug) cout << "Trying to open input file:" << fileName << endl;
      RinexObsStream obsIn(fileName.c_str(), ios::in);
      if (!obsIn) return false;
      else if (debug) cout << "...opened" << endl;

      if (outFile.length() == 0)
      {
         if (outputPath.length() > 0)
            outFile = outputPath;
         
         int lastIndexOf = fileName.find_last_of("\\/");
         if (lastIndexOf == -1)
            lastIndexOf = 0;
         outFile = fileName.substr(lastIndexOf);
      }
      
      if (debug) cout << "Trying to open output file: " << outFile << endl;
      Rinex3ObsStream obsOut(outFile.c_str(), ios::out);
      if (!obsOut) return false;
      else if (debug) cout << "...opened" << endl;

      // Declare the header and its converted version.

      RinexObsHeader robsHead;
      Rinex3ObsHeader convHead;

      // Read in the header data.

      if (debug) cout << "Reading in header..." << endl;
      obsIn >> robsHead;
      if (debug) cout << "...finished" << endl;

      // Convert the obs header and test, all in one step.
      // If the header couldn't be converted return false.

      if (debug) cout << "Converting header..." << endl;
      if (!RinexConverter::convertToRinex3(convHead, robsHead)) return false;
      if (debug) cout << "...finished" << endl;

      // Write out the converted header data.

      obsOut << convHead;

      if (debug)
      {
         convHead.dump(cout);
/*
         cout << "        Version: " << convHead.version << endl;
         cout << "      File Type: " << convHead.fileType << endl;
         cout << "         System: " << convHead.system << endl;
         cout << "   File Program: " << convHead.fileProgram << endl;
         cout << "    File Agency: " << convHead.fileAgency << endl;
         cout << "           Date: " << convHead.date << endl;
         cout << "    Marker Name: " << convHead.markerName << endl;
         cout << "  Marker Number: " << convHead.markerNumber << endl;
         cout << "    Marker Type: " << convHead.markerType << endl;
         cout << "       Observer: " << convHead.observer << endl;
         cout << "         Agency: " << convHead.agency << endl;
         cout << "        Rec. No: " << convHead.recNo << endl;
         cout << "      Rec. Type: " << convHead.recType << endl;
         cout << "   Rec. Version: " << convHead.recVers << endl;
         cout << "        Ant. No: " << convHead.antNo << endl;
         cout << "      Ant. Type: " << convHead.antType << endl;
         cout << "  Ant. Position: " << convHead.antennaPosition << endl;
         cout << " Ant. Delta HEN: " << convHead.antennaDeltaHEN << endl;
         cout << "       Interval: " << convHead.interval << endl;
         cout << "Receiver Offset: " << convHead.receiverOffset << endl;
         cout << "   Leap Seconds: " << convHead.leapSeconds << endl;
         cout << "        Num SVs: " << convHead.numSVs << endl;
         cout << "          Valid: " << convHead.valid << endl;
*/
      }

      // All of the data contained in the file.
      vector<RinexObsData> robsData;
      // A temporary data object for reading in from the stream.
      RinexObsData temp;
      // Converted data object.
      Rinex3ObsData convData;
      // Last observed epoch
      CommonTime lastEpoch = CommonTime::BEGINNING_OF_TIME;

      // Flags for the presence of the different systems
      bool hasGPS, hasGLO, hasGAL, hasGEO;
      hasGPS = hasGLO = hasGAL = hasGEO = false;

      if (debug) cout << "Start reading in data..." << endl;

      while(1)
      {
         try
         {
            obsIn >> temp;
         }
         catch (Exception gpstkEx)
         {
            if (printExceptions)
               cout << "Exception Reading Data:" << endl
                    << gpstkEx << endl;
            continue;
         }
         catch (exception stdEx)
         {
            if (printExceptions)
               cout << "Exception Reading Data:" << endl
                    << stdEx.what() << endl;
            continue;
         }
         catch (...)
         {
            if (printExceptions)
               cout << "Exception Reading Data" << endl;
            continue;
         }

         // Break for bad data or end of file.
         if (!obsIn.good() || obsIn.eof()) break;

         // Otherwise, save the data.
         robsData.push_back(temp);

         if (temp.time > lastEpoch)
            lastEpoch = temp.time;

         // Set the system flags.

         RinexSatID id;
         RinexObsData::RinexSatMap::const_iterator iter = temp.obs.begin();
         while(iter != temp.obs.end())
         {
            id = RinexSatID(iter->first);

            if      (id.systemChar() == 'G')
               hasGPS = true;
            else if (id.systemChar() == 'R')
               hasGLO = true;
            else if (id.systemChar() == 'E')
               hasGAL = true;
            else if (id.systemChar() == 'S')
               hasGEO = true;

            ++iter;
         }
      }

/// For now, comment out the following.  While logical, we will abide by the
/// philosophy that this converter sould simply read in and write out, not
/// alter the data in any way.
/*
      // Erase any systems that were not present.
      map<string, vector<ObsID> >::const_iterator mapIter;
      mapIter = convHead.mapObsTypes.find("G");
      if (!hasGPS && mapIter != convHead.mapObsTypes.end())
         convHead.mapObsTypes.erase("G");

      mapIter = convHead.mapObsTypes.find("R");
      if (!hasGPS && mapIter != convHead.mapObsTypes.end())
         convHead.mapObsTypes.erase("R");

      mapIter = convHead.mapObsTypes.find("E");
      if (!hasGPS && mapIter != convHead.mapObsTypes.end())
         convHead.mapObsTypes.erase("E");

      mapIter = convHead.mapObsTypes.find("S");
      if (!hasGPS && mapIter != convHead.mapObsTypes.end())
         convHead.mapObsTypes.erase("S");

      // close the input stream
      obsIn.clear();
      obsIn.close();
*/

      for (int i = 0; i < robsData.size(); ++i)
      {
         RinexConverter::convertToRinex3(convData, robsData[i], robsHead);
         obsOut << convData;
      }

//      obsOut.flush();
      obsOut.close();
   }
   catch(Exception gpstkException)
   {
      if (printExceptions)
         cout << "GPSTk Exception:" << gpstkException << endl;
      return false;
   }
   catch(exception stdException)
   {
      if (printExceptions)
         cout << "Exception:" << stdException.what() << endl;
      return false;
   }
   catch(...)
   {
      if (printExceptions) cout << "Exception!" << endl;
      return false;
   }
}