Esempio n. 1
0
   void CNavUTC::loadData(const PackedNavBits& message33)
      throw(InvalidParameter)
   {
         // First, verify the correct message type is being passed in. 
      long msgType = message33.asUnsignedLong(14,6,1);
      if(msgType!=33)
      {
         char errStr[80];
         sprintf(errStr,"Expected CNAV MsgType 33.  Found MsgType %ld",msgType);
         std::string tstr(errStr);
         InvalidParameter exc(tstr);
         GPSTK_THROW(exc);    
      } 
      obsID     = message33.getobsID();
      satID     = message33.getsatSys();
      ctXmit    = message33.getTransmitTime();
 
      A0 = message33.asSignedDouble(127,16,-35);
      A1 = message33.asSignedDouble(143,13,-51);
      A2 = message33.asSignedDouble(156, 7,-68);

      deltaTls  = message33.asLong(163, 8, 1);
      Tot       = message33.asUnsignedLong(171,16,16);
      WNot      = message33.asUnsignedLong(187,13, 1);
      WNlsf     = message33.asUnsignedLong(200,13, 1);
      DN        = message33.asUnsignedLong(213, 4, 1);
      deltaTlsf = message33.asLong(217, 8, 1);

      ctEpoch   = GPSWeekSecond(WNot, Tot, TimeSystem::GPS);

      dataLoadedFlag = true;   
   } // end of loadData()
Esempio n. 2
0
   void CNavGGTO::loadData(const PackedNavBits& message35)
      throw(InvalidParameter)
   {
         // First, verify the correct message type is being passed in. 
      long msgType = message35.asUnsignedLong(14,6,1);
      if(msgType!=35)
      {
         char errStr[80];
         sprintf(errStr,"Expected CNAV MsgType 35.  Found MsgType %ld",msgType);
         std::string tstr(errStr);
         InvalidParameter exc(tstr);
         GPSTK_THROW(exc);    
      } 
      obsID     = message35.getobsID();
      satID     = message35.getsatSys();
      ctXmit    = message35.getTransmitTime();

      TGGTO     = message35.asLong(127,16,16);
      WNGGTO    = message35.asLong(143,13, 1);
      GNSS_ID   = message35.asLong(156, 3, 1); 
      A0GGTO    = message35.asSignedDouble(158,16,-35);
      A1GGTO    = message35.asSignedDouble(175,13,-51);
      A2GGTO    = message35.asSignedDouble(188, 7,-68);

      if (GNSS_ID>0)
         ctEpoch   = GPSWeekSecond(WNGGTO, TGGTO, TimeSystem::GPS);

      dataLoadedFlag = true;   
   } // end of loadData()
Esempio n. 3
0
   void CNavEOP::loadData(const PackedNavBits& message32)
      throw(InvalidParameter)
   {
         // First, verify the correct message type is being passed in. 
      long msgType = message32.asUnsignedLong(14,6,1);
      if(msgType!=32)
      {
         char errStr[80];
         sprintf(errStr,"Expected CNAV MsgType 32.  Found MsgType %ld",msgType);
         std::string tstr(errStr);
         InvalidParameter exc(tstr);
         GPSTK_THROW(exc);    
      } 
      obsID     = message32.getobsID();
      satID     = message32.getsatSys();
      ctXmit    = message32.getTransmitTime();

      Teop         = message32.asUnsignedLong(127,16, 16);
      PM_X         = message32.asSignedDouble(143,21,-20);
      PM_X_dot     = message32.asSignedDouble(164,15,-21);
      PM_Y         = message32.asSignedDouble(179,21,-20);
      PM_Y_dot     = message32.asSignedDouble(200,15,-21);
      deltaUT1     = message32.asSignedDouble(215,31,-24);
      deltaUT1_dot = message32.asSignedDouble(246,19,-25);

         // The message does not contain a week counter.
         // We'll assume the Teop is to be within 1/2 week 
         // of the transmit time. 
      long xmitSOW = (static_cast<GPSWeekSecond>(ctXmit)).sow;
      short xmitWeek = (static_cast<GPSWeekSecond>(ctXmit)).week;
      double timeDiff = Teop - xmitSOW;
      short epochWeek = xmitWeek;
      if (timeDiff < -HALFWEEK) epochWeek++;
      else if (timeDiff > HALFWEEK) epochWeek--;

      ctEpoch   = GPSWeekSecond(epochWeek, Teop, TimeSystem::GPS);

      dataLoadedFlag = true;   
   } // end of loadData()
Esempio n. 4
0
   void OrbSysGpsC_30::loadData(const PackedNavBits& msg)
      throw(InvalidParameter)
   {
      setUID(msg);
      if (UID!=30)
      {
         char errStr[80];
         std::string msgString("Expected GPS CNAV MT 30.  Found unique ID ");
         msgString += StringUtils::asString(UID);
         InvalidParameter exc(msgString);
         GPSTK_THROW(exc);    
      } 
      obsID        = msg.getobsID();
      satID        = msg.getsatSys();
      beginValid   = msg.getTransmitTime();

           // Message Type 30 data
      unsigned long testAvail = 4096;    // Pattern in message of 0x1000
                                         // if data quantity not available
                                          
      unsigned long avail = msg.asUnsignedLong(127,13,1);
      avail_Tgd = false;
      if (avail!=testAvail)
      {
         avail_Tgd = true;
         Tgd       = msg.asSignedDouble(127, 13, -35);
      }

      avail = msg.asUnsignedLong(140,13,1);
      avail_L1CA = false;
      if (avail!=testAvail)
      {
         avail_L1CA = true;
         ISC_L1CA  = msg.asSignedDouble(140, 13, -35);
      }
      
      avail = msg.asUnsignedLong(153,13,1);
      avail_L2C = false;
      if (avail!=testAvail)
      {
         avail_L2C = true;
         ISC_L2C   = msg.asSignedDouble(153, 13, -35);
      }
      
      avail = msg.asUnsignedLong(166,13,1);
      avail_L5I5 = false;
      if (avail!=testAvail)
      {
         avail_L5I5 = true;
         ISC_L5I5  = msg.asSignedDouble(166, 13, -35);
      }

      avail = msg.asUnsignedLong(179,13,1);
      avail_L5Q5 = false;
      if (avail!=testAvail)
      {
         avail_L5Q5 = true;
         ISC_L5Q5  = msg.asSignedDouble(179, 13, -35);
      }

      alpha[0] = msg.asSignedDouble(192, 8, -30);
      alpha[1] = msg.asSignedDouble(200, 8, -27);
      alpha[2] = msg.asSignedDouble(208, 8, -24);
      alpha[3] = msg.asSignedDouble(216, 8, -24);
      beta[0]  = msg.asSignedDouble(224, 8,  11);
      beta[1]  = msg.asSignedDouble(232, 8,  14);
      beta[2]  = msg.asSignedDouble(240, 8,  16);
      beta[3]  = msg.asSignedDouble(248, 8,  16);

         // Need to convert from sec/semi-circle to sec/rad
      double conversion = 1.0 / PI; 
      alpha[1] *= conversion;
      beta[1]  *= conversion;
      alpha[2] *= conversion * conversion;
      beta[2]  *= conversion * conversion;
      alpha[3] *= conversion * conversion * conversion;
      beta[3]  *= conversion * conversion * conversion;

      dataLoadedFlag = true;   
   } // end of loadData()
Esempio n. 5
0
   void CNavISC::loadData(const PackedNavBits& message30)
      throw( InvalidParameter )
   {
         // First, verify the correct message type is being passed in. 
      long msgType = message30.asUnsignedLong(14,6,1);
      if(msgType!=30)
      {
         char errStr[80];
         sprintf(errStr,"Expected CNAV MsgType 30.  Found MsgType %ld",msgType);
         std::string tstr(errStr);
         InvalidParameter exc(tstr);
         GPSTK_THROW(exc);    
      } 
      obsID     = message30.getobsID();
      satID     = message30.getsatSys();
      ctXmit    = message30.getTransmitTime();
      ctEpoch   = ctXmit;                     // For ISC, no explicit epoch time.

           // Message Type 30 data
      unsigned long testAvail = 4096;    // Pattern in message of 0x1000
                                         // if data quantity not available
                                          
      unsigned long avail = message30.asUnsignedLong(127,13,1);
      avail_Tgd = false;
      if (avail!=testAvail)
      {
         avail_Tgd = true;
         Tgd       = message30.asSignedDouble(127, 13, -35);
      }

      avail = message30.asUnsignedLong(140,13,1);
      avail_L1CA = false;
      if (avail!=testAvail)
      {
         avail_L1CA = true;
         ISC_L1CA  = message30.asSignedDouble(140, 13, -35);
      }
      
      avail = message30.asUnsignedLong(153,13,1);
      avail_L2C = false;
      if (avail!=testAvail)
      {
         avail_L2C = true;
         ISC_L2C   = message30.asSignedDouble(153, 13, -35);
      }
      
      avail = message30.asUnsignedLong(166,13,1);
      avail_L5I5 = false;
      if (avail!=testAvail)
      {
         avail_L5I5 = true;
         ISC_L5I5  = message30.asSignedDouble(166, 13, -35);
      }

      avail = message30.asUnsignedLong(179,13,1);
      avail_L5Q5 = false;
      if (avail!=testAvail)
      {
         avail_L5Q5 = true;
         ISC_L5Q5  = message30.asSignedDouble(179, 13, -35);
      }

      alpha[0] = message30.asSignedDouble(192, 8, -30);
      alpha[1] = message30.asSignedDouble(200, 8, -27);
      alpha[2] = message30.asSignedDouble(208, 8, -24);
      alpha[3] = message30.asSignedDouble(216, 8, -24);
      beta[0]  = message30.asSignedDouble(224, 8,  11);
      beta[1]  = message30.asSignedDouble(232, 8,  14);
      beta[2]  = message30.asSignedDouble(240, 8,  16);
      beta[3]  = message30.asSignedDouble(248, 8,  16);

         // Need to convert from sec/semi-circle to sec/rad
      double conversion = 1.0 / PI; 
      alpha[1] *= conversion;
      beta[1]  *= conversion;
      alpha[2] *= conversion * conversion;
      beta[2]  *= conversion * conversion;
      alpha[3] *= conversion * conversion * conversion;
      beta[3]  *= conversion * conversion * conversion;

      dataLoadedFlag = true;   
   } // end of loadData()