Changeset 6819 in ntrip


Ignore:
Timestamp:
May 6, 2015, 7:01:50 PM (9 years ago)
Author:
stoecker
Message:

add QZSS RTCM out

File:
1 edited

Legend:

Unmodified
Added
Removed

  • trunk/BNC/src/RTCM3/ephEncoder.cpp

    r6818 r6819  
    4141  int numbits = 0;
    4242  unsigned long long bitbuffer = 0;
    43   eph._ura = indexFromAccuracy(eph._ura, eph.type());
     43  int ura = indexFromAccuracy(eph._ura, eph.type());
    4444  if (eph.type() == t_eph::QZSS) {
    4545    GPSADDBITS(12, 1044)
     46    GPSADDBITS(4,eph._prn.number())
     47    GPSADDBITS(16, static_cast<int>(eph._TOC.gpssec())>>4)
     48    GPSADDBITSFLOAT(8, eph._clock_driftrate, 1.0/static_cast<double>(1<<30)
     49    /static_cast<double>(1<<25))
     50    GPSADDBITSFLOAT(16, eph._clock_drift, 1.0/static_cast<double>(1<<30)
     51    /static_cast<double>(1<<13))
     52    GPSADDBITSFLOAT(22, eph._clock_bias, 1.0/static_cast<double>(1<<30)
     53    /static_cast<double>(1<<1))
     54    GPSADDBITS(8, eph._IODE)
     55    GPSADDBITSFLOAT(16, eph._Crs, 1.0/static_cast<double>(1<<5))
     56    GPSADDBITSFLOAT(16, eph._Delta_n, M_PI/static_cast<double>(1<<30)
     57    /static_cast<double>(1<<13))
     58    GPSADDBITSFLOAT(32, eph._M0, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<1))
     59    GPSADDBITSFLOAT(16, eph._Cuc, 1.0/static_cast<double>(1<<29))
     60    GPSADDBITSFLOAT(32, eph._e, 1.0/static_cast<double>(1<<30)/static_cast<double>(1<<3))
     61    GPSADDBITSFLOAT(16, eph._Cus, 1.0/static_cast<double>(1<<29))
     62    GPSADDBITSFLOAT(32, eph._sqrt_A, 1.0/static_cast<double>(1<<19))
     63    GPSADDBITS(16, static_cast<int>(eph._TOEsec)>>4)
     64    GPSADDBITSFLOAT(16, eph._Cic, 1.0/static_cast<double>(1<<29))
     65    GPSADDBITSFLOAT(32, eph._OMEGA0, M_PI/static_cast<double>(1<<30)
     66    /static_cast<double>(1<<1))
     67    GPSADDBITSFLOAT(16, eph._Cis, 1.0/static_cast<double>(1<<29))
     68    GPSADDBITSFLOAT(32, eph._i0, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<1))
     69    GPSADDBITSFLOAT(16, eph._Crc, 1.0/static_cast<double>(1<<5))
     70    GPSADDBITSFLOAT(32, eph._omega, M_PI/static_cast<double>(1<<30)
     71    /static_cast<double>(1<<1))
     72    GPSADDBITSFLOAT(24, eph._OMEGADOT, M_PI/static_cast<double>(1<<30)
     73    /static_cast<double>(1<<13))
     74    GPSADDBITSFLOAT(14, eph._IDOT, M_PI/static_cast<double>(1<<30)
     75    /static_cast<double>(1<<13))
     76    GPSADDBITS(2,eph._L2Codes)
     77    GPSADDBITS(10, eph._TOC.gpsw())
     78    GPSADDBITS(4, ura)
     79    GPSADDBITS(6, eph._health)
     80    GPSADDBITSFLOAT(8, eph._TGD, 1.0/static_cast<double>(1<<30)/static_cast<double>(1<<1))
     81    GPSADDBITS(10, eph._IODC)
     82    GPSADDBITS(1, eph._fitInterval)
     83    GPSADDBITS(3, 0) /* padding */
    4684  }
    4785  else {
    4886    GPSADDBITS(12, 1019)
     87    GPSADDBITS(6,eph._prn.number())
     88    GPSADDBITS(10, eph._TOC.gpsw())
     89    GPSADDBITS(4, ura)
     90    GPSADDBITS(2,eph._L2Codes)
     91    GPSADDBITSFLOAT(14, eph._IDOT, M_PI/static_cast<double>(1<<30)
     92    /static_cast<double>(1<<13))
     93    GPSADDBITS(8, eph._IODE)
     94    GPSADDBITS(16, static_cast<int>(eph._TOC.gpssec())>>4)
     95    GPSADDBITSFLOAT(8, eph._clock_driftrate, 1.0/static_cast<double>(1<<30)
     96    /static_cast<double>(1<<25))
     97    GPSADDBITSFLOAT(16, eph._clock_drift, 1.0/static_cast<double>(1<<30)
     98    /static_cast<double>(1<<13))
     99    GPSADDBITSFLOAT(22, eph._clock_bias, 1.0/static_cast<double>(1<<30)
     100    /static_cast<double>(1<<1))
     101    GPSADDBITS(10, eph._IODC)
     102    GPSADDBITSFLOAT(16, eph._Crs, 1.0/static_cast<double>(1<<5))
     103    GPSADDBITSFLOAT(16, eph._Delta_n, M_PI/static_cast<double>(1<<30)
     104    /static_cast<double>(1<<13))
     105    GPSADDBITSFLOAT(32, eph._M0, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<1))
     106    GPSADDBITSFLOAT(16, eph._Cuc, 1.0/static_cast<double>(1<<29))
     107    GPSADDBITSFLOAT(32, eph._e, 1.0/static_cast<double>(1<<30)/static_cast<double>(1<<3))
     108    GPSADDBITSFLOAT(16, eph._Cus, 1.0/static_cast<double>(1<<29))
     109    GPSADDBITSFLOAT(32, eph._sqrt_A, 1.0/static_cast<double>(1<<19))
     110    GPSADDBITS(16, static_cast<int>(eph._TOEsec)>>4)
     111    GPSADDBITSFLOAT(16, eph._Cic, 1.0/static_cast<double>(1<<29))
     112    GPSADDBITSFLOAT(32, eph._OMEGA0, M_PI/static_cast<double>(1<<30)
     113    /static_cast<double>(1<<1))
     114    GPSADDBITSFLOAT(16, eph._Cis, 1.0/static_cast<double>(1<<29))
     115    GPSADDBITSFLOAT(32, eph._i0, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<1))
     116    GPSADDBITSFLOAT(16, eph._Crc, 1.0/static_cast<double>(1<<5))
     117    GPSADDBITSFLOAT(32, eph._omega, M_PI/static_cast<double>(1<<30)
     118    /static_cast<double>(1<<1))
     119    GPSADDBITSFLOAT(24, eph._OMEGADOT, M_PI/static_cast<double>(1<<30)
     120    /static_cast<double>(1<<13))
     121    GPSADDBITSFLOAT(8, eph._TGD, 1.0/static_cast<double>(1<<30)/static_cast<double>(1<<1))
     122    GPSADDBITS(6, eph._health)
     123    GPSADDBITS(1, eph._L2PFlag)
     124    GPSADDBITS(1, eph._fitInterval)
    49125  }
    50   GPSADDBITS(6,eph._prn.number())
    51   GPSADDBITS(10, eph._TOC.gpsw())
    52   GPSADDBITS(4, eph._ura)
    53   GPSADDBITS(2,eph._L2Codes)
    54   GPSADDBITSFLOAT(14, eph._IDOT, M_PI/static_cast<double>(1<<30)
    55   /static_cast<double>(1<<13))
    56   GPSADDBITS(8, eph._IODE)
    57   GPSADDBITS(16, static_cast<int>(eph._TOC.gpssec())>>4)
    58   GPSADDBITSFLOAT(8, eph._clock_driftrate, 1.0/static_cast<double>(1<<30)
    59   /static_cast<double>(1<<25))
    60   GPSADDBITSFLOAT(16, eph._clock_drift, 1.0/static_cast<double>(1<<30)
    61   /static_cast<double>(1<<13))
    62   GPSADDBITSFLOAT(22, eph._clock_bias, 1.0/static_cast<double>(1<<30)
    63   /static_cast<double>(1<<1))
    64   GPSADDBITS(10, eph._IODC)
    65   GPSADDBITSFLOAT(16, eph._Crs, 1.0/static_cast<double>(1<<5))
    66   GPSADDBITSFLOAT(16, eph._Delta_n, M_PI/static_cast<double>(1<<30)
    67   /static_cast<double>(1<<13))
    68   GPSADDBITSFLOAT(32, eph._M0, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<1))
    69   GPSADDBITSFLOAT(16, eph._Cuc, 1.0/static_cast<double>(1<<29))
    70   GPSADDBITSFLOAT(32, eph._e, 1.0/static_cast<double>(1<<30)/static_cast<double>(1<<3))
    71   GPSADDBITSFLOAT(16, eph._Cus, 1.0/static_cast<double>(1<<29))
    72   GPSADDBITSFLOAT(32, eph._sqrt_A, 1.0/static_cast<double>(1<<19))
    73   GPSADDBITS(16, static_cast<int>(eph._TOEsec)>>4)
    74   GPSADDBITSFLOAT(16, eph._Cic, 1.0/static_cast<double>(1<<29))
    75   GPSADDBITSFLOAT(32, eph._OMEGA0, M_PI/static_cast<double>(1<<30)
    76   /static_cast<double>(1<<1))
    77   GPSADDBITSFLOAT(16, eph._Cis, 1.0/static_cast<double>(1<<29))
    78   GPSADDBITSFLOAT(32, eph._i0, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<1))
    79   GPSADDBITSFLOAT(16, eph._Crc, 1.0/static_cast<double>(1<<5))
    80   GPSADDBITSFLOAT(32, eph._omega, M_PI/static_cast<double>(1<<30)
    81   /static_cast<double>(1<<1))
    82   GPSADDBITSFLOAT(24, eph._OMEGADOT, M_PI/static_cast<double>(1<<30)
    83   /static_cast<double>(1<<13))
    84   GPSADDBITSFLOAT(8, eph._TGD, 1.0/static_cast<double>(1<<30)/static_cast<double>(1<<1))
    85   GPSADDBITS(6, eph._health)
    86   GPSADDBITS(1, eph._L2PFlag)
    87   GPSADDBITS(1, 0) /* GPS fit interval */
    88126
    89127  startbuffer[0]=0xD3;
    … …  
    204242  buffer= buffer+3;
    205243
    206   eph._SISA = indexFromAccuracy(eph._SISA, eph.type());
     244  int SISA = indexFromAccuracy(eph._SISA, eph.type());
    207245
    208246  GALILEOADDBITS(12, eph._inav ? 1046 : 1045)
    … …  
    210248  GALILEOADDBITS(12, eph._TOC.gpsw())
    211249  GALILEOADDBITS(10, eph._IODnav)
    212   GALILEOADDBITS(8, eph._SISA)
     250  GALILEOADDBITS(8, SISA)
    213251  GALILEOADDBITSFLOAT(14, eph._IDOT, M_PI/static_cast<double>(1<<30)
    214252  /static_cast<double>(1<<13))
    … …  
    288326  buffer= buffer+3;
    289327
    290   eph._ura = indexFromAccuracy(eph._ura, eph.type());
     328  int ura = indexFromAccuracy(eph._ura, eph.type());
    291329  SBASADDBITS(12, 1043)
    292330  SBASADDBITS(6, eph._prn.number()-20)
    293331  SBASADDBITS(8, eph._IODN)
    294332  SBASADDBITS(13, static_cast<int>(eph._TOC.daysec())>>4)
    295   SBASADDBITS(4, eph._ura)
     333  SBASADDBITS(4, ura)
    296334  SBASADDBITSFLOAT(30, eph._x_pos, 0.08)
    297335  SBASADDBITSFLOAT(30, eph._y_pos, 0.08)
    … …  
    337375  buffer= buffer+3;
    338376
    339   eph._URA = indexFromAccuracy(eph._URA, eph.type());
     377  int URA = indexFromAccuracy(eph._URA, eph.type());
    340378  BDSADDBITS(12, RTCM3ID_BDS)
    341379  BDSADDBITS(6, eph._prn.number())
    342380  BDSADDBITS(13, eph._TOC.bdsw() - 1356.0)
    343   BDSADDBITS(4, eph._URA);
     381  BDSADDBITS(4, URA);
    344382  BDSADDBITSFLOAT(14, eph._IDOT, M_PI/static_cast<double>(1<<30)/static_cast<double>(1<<13))
    345383  BDSADDBITS(5, eph._AODE)
Note: See TracChangeset for help on using the changeset viewer.