Changeset 8974 in ntrip for trunk/BNC/src/RTCM3


Ignore:
Timestamp:
Jul 17, 2020, 11:26:14 AM (4 years ago)
Author:
stuerze
Message:

debug output added regarding rtcm ssr decoding

File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/BNC/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.c

    r8970 r8974  
    694694#define G_RESERVEDH(a)                   GETBITS(a,6)
    695695#define G_SIZE(a)                        GETBITS(a, 10)
    696 #define G_MESSAGE_NUMBER(a)              GETBITS(a, 12)          /* DF002 */
     696#define G_RTCM_MESSAGE_NUMBER(a)         GETBITS(a, 12)          /* DF002 */
    697697#define G_GPS_SATELLITE_ID(a)            GETBITS(a, 6)           /* DF068 */
    698698#define G_QZSS_SATELLITE_ID(a)           GETBITS(a, 4)           /* DF249 */
     
    766766    return GCOBR_SHORTBUFFER;
    767767
    768 #ifdef DEBUG
    769   fprintf(stderr, "GetClockOrbitBias START: size %d, numbits %d\n",size, numbits);
     768#ifdef BNC_DEBUG
     769  fprintf(stderr, "GetSSR START: size %d, numbits %d\n",(int)size, numbits);
    770770#endif
    771771
     
    785785  size = sizeofrtcmblock; /* reduce size, so overflows are detected */
    786786
    787   G_MESSAGE_NUMBER(type)
    788 #ifdef DEBUG
     787  G_RTCM_MESSAGE_NUMBER(type)
     788#ifdef BNC_DEBUG
    789789  fprintf(stderr, "type %d size %d\n",type,sizeofrtcmblock);
    790790#endif
     
    804804    G_VTEC_QUALITY_INDICATOR(v->Quality)
    805805    G_NO_IONO_LAYERS(v->NumLayers)
     806#ifdef BNC_DEBUG
     807          fprintf(stderr, "epochTime %d ui %d mmi %d ssrIod %d providerId %d solId %d vtecQ %8.3f numLay %d \n",
     808                          v->EpochTime, v->UpdateInterval, mmi,
     809                                  v->SSRIOD, v->SSRProviderID, v->SSRSolutionID, v->Quality, v->NumLayers);
     810#endif
    806811    for (l = 0; l < v->NumLayers; ++l) {
    807812      G_IONO_HEIGHT(v->Layers[l].Height)
    808813      G_IONO_DEGREE(v->Layers[l].Degree)
    809814      G_IONO_ORDER(v->Layers[l].Order)
     815#ifdef BNC_DEBUG
     816          fprintf(stderr, "h  %8.3f deg %d ord %d \n",
     817                          v->Layers[l].Height, v->Layers[l].Degree, v->Layers[l].Order);
     818#endif
    810819      for (o = 0; o <= v->Layers[l].Order; ++o) {
    811820        for (d = o; d <= v->Layers[l].Degree; ++d) {
    812821          G_IONO_COEFF(v->Layers[l].Cosinus[d][o])
     822          #ifdef BNC_DEBUG
     823          fprintf(stderr, "C[%d][%d]  %8.3f \n",
     824                          d, o, v->Layers[l].Cosinus[d][o]);
     825#endif
    813826        }
    814827      }
     
    816829        for (d = o; d <= v->Layers[l].Degree; ++d) {
    817830          G_IONO_COEFF(v->Layers[l].Sinus[d][o])
     831#ifdef BNC_DEBUG
     832          fprintf(stderr, "S[%d][%d]  %8.3f \n",
     833                          d, o, v->Layers[l].Sinus[d][o]);
     834#endif
    818835        }
    819836      }
    820837    }
    821 #ifdef DEBUG
     838#ifdef BNC_DEBUG
    822839    for(type = 0; type < (int)size && (unsigned char)buffer[type] != 0xD3; ++type)
    823840    numbits += 8;
     
    851868      G_MW_CONSISTENCY_INDICATOR(pb->MWConsistencyIndicator)
    852869      G_NO_OF_SATELLITES(nums)
     870#ifdef BNC_DEBUG
     871          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d dispInd %d mwInd %d\n",
     872                          pb->EpochTime[s], pb->UpdateInterval,mmi,pb->NumberOfSat[s],nums,
     873                                  pb->SSRIOD, pb->SSRProviderID, pb->SSRSolutionID,
     874                                  pb->DispersiveBiasConsistencyIndicator, pb->MWConsistencyIndicator);
     875#endif
    853876      for (i = 0; i < nums; ++i) {
    854877        switch (s) {
     
    875898          ++pb->NumberOfSat[s];
    876899        pb->Sat[pos].ID = id;
    877 
    878900        G_NO_OF_PHASE_BIASES(pb->Sat[pos].NumberOfPhaseBiases)
    879901        G_YAW_ANGLE(pb->Sat[pos].YawAngle)
    880902        G_YAW_RATE(pb->Sat[pos].YawRate)
     903#ifdef BNC_DEBUG
     904            fprintf(stderr, "id %2d #%d y %8.3f yr %8.3f ",
     905                    pb->Sat[pos].ID, pb->Sat[pos].NumberOfPhaseBiases,
     906                                        pb->Sat[pos].YawAngle, pb->Sat[pos].YawRate);
     907#endif
    881908        for (j = 0; j < pb->Sat[pos].NumberOfPhaseBiases; ++j) {
    882909          G_SIGNAL_IDENTIFIER(pb->Sat[pos].Biases[j].Type)
     
    887914              pb->Sat[pos].Biases[j].SignalDiscontinuityCounter)
    888915          G_PHASE_BIAS(pb->Sat[pos].Biases[j].Bias)
     916#ifdef BNC_DEBUG
     917            fprintf(stderr, "t%d int %d wl %d disc %d b %8.4f ",
     918                    pb->Sat[pos].Biases[j].Type,
     919                                        pb->Sat[pos].Biases[j].SignalIntegerIndicator,
     920                                        pb->Sat[pos].Biases[j].SignalsWideLaneIntegerIndicator,
     921                                        pb->Sat[pos].Biases[j].SignalDiscontinuityCounter,
     922                                        pb->Sat[pos].Biases[j].Bias);
     923#endif
    889924        }
    890       }
    891 #ifdef DEBUG
     925#ifdef BNC_DEBUG
     926            fprintf(stderr, "\n");
     927#endif
     928      }
     929#ifdef BNC_DEBUG
    892930      for(type = 0; type < (int)size && (unsigned char)buffer[type] != 0xD3; ++type)
    893931      numbits += 8;
     
    922960          G_NO_OF_SATELLITES(nums)
    923961          co->Supplied[COBOFS_ORBIT] |= 1;
    924 #ifdef DEBUG
    925           fprintf(stderr, "epochtime %d ui %d mmi %d sats %d/%d rd %d\n",co->EpochTime[s],
    926               co->UpdateInterval,mmi,co->NumberOfSat[s],nums, co->SatRefDatum);
     962#ifdef BNC_DEBUG
     963          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d rd %d ssrIod %d providerId %d solId %d\n",
     964                          co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums,
     965                                  co->SatRefDatum, co->SSRIOD, co->SSRProviderID, co->SSRSolutionID);
    927966#endif
    928967          for (i = 0; i < nums; ++i) {
     
    9771016            G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack)
    9781017            G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack)
    979 #ifdef DEBUG
     1018#ifdef BNC_DEBUG
    9801019            fprintf(stderr, "id %2d iod %3d dr %8.3f da %8.3f dc %8.3f dr %8.3f da %8.3f dc %8.3f\n",
    9811020                co->Sat[pos].ID,co->Sat[pos].IOD,co->Sat[pos].Orbit.DeltaRadial,
     
    10101049          G_NO_OF_SATELLITES(nums)
    10111050          co->Supplied[COBOFS_CLOCK] |= 1;
    1012 #ifdef DEBUG
    1013           fprintf(stderr, "epochtime %d ui %d mmi %d sats %d/%d\n",co->EpochTime[s],
    1014               co->UpdateInterval,mmi,co->NumberOfSat[s],nums);
     1051#ifdef BNC_DEBUG
     1052          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n",
     1053                          co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums,
     1054                                  co->SSRIOD, co->SSRProviderID, co->SSRSolutionID);
    10151055#endif
    10161056          for (i = 0; i < nums; ++i) {
     
    10421082            G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1)
    10431083            G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2)
    1044 #ifdef DEBUG
     1084#ifdef BNC_DEBUG
    10451085            fprintf(stderr, "id %2d c0 %8.3f c1 %8.3f c2 %8.3f\n",
    10461086                co->Sat[pos].ID, co->Sat[pos].Clock.DeltaA0, co->Sat[pos].Clock.DeltaA1,
     
    10741114          co->Supplied[COBOFS_ORBIT] |= 1;
    10751115          co->Supplied[COBOFS_CLOCK] |= 1;
     1116#ifdef BNC_DEBUG
     1117          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d rd %d ssrIod %d providerId %d solId %d\n",
     1118                          co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums,
     1119                                  co->SatRefDatum, co->SSRIOD, co->SSRProviderID, co->SSRSolutionID);
     1120#endif
    10761121          for (i = 0; i < nums; ++i) {
    10771122            switch (s) {
     
    11281173            G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1)
    11291174            G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2)
     1175#ifdef BNC_DEBUG
     1176            fprintf(stderr, "id %2d iod %3d dr %8.4f da %8.4f dc %8.4f dr %8.3f da %8.3f dc %8.3f  c0 %8.3f c1 %8.3f c2 %8.3f\n",
     1177                co->Sat[pos].ID,co->Sat[pos].IOD,co->Sat[pos].Orbit.DeltaRadial,
     1178                co->Sat[pos].Orbit.DeltaAlongTrack,co->Sat[pos].Orbit.DeltaCrossTrack,
     1179                co->Sat[pos].Orbit.DotDeltaRadial, co->Sat[pos].Orbit.DotDeltaAlongTrack,
     1180                co->Sat[pos].Orbit.DotDeltaCrossTrack,
     1181                                co->Sat[pos].Clock.DeltaA0, co->Sat[pos].Clock.DeltaA1, co->Sat[pos].Clock.DeltaA2);
     1182#endif
    11301183          }
    11311184          break;
     
    11531206          G_NO_OF_SATELLITES(nums)
    11541207          co->Supplied[COBOFS_URA] |= 1;
     1208#ifdef BNC_DEBUG
     1209          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n",
     1210                          co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums,
     1211                                  co->SSRIOD, co->SSRProviderID, co->SSRSolutionID);
     1212#endif
    11551213          for (i = 0; i < nums; ++i) {
    11561214            switch (s) {
     
    11771235              ++co->NumberOfSat[s];
    11781236            co->Sat[pos].ID = id;
    1179 
    11801237            G_SSR_URA(co->Sat[pos].UserRangeAccuracy)
     1238#ifdef BNC_DEBUG
     1239            fprintf(stderr, "id %2d ura %8.3f \n",
     1240                co->Sat[pos].ID, co->Sat[pos].UserRangeAccuracy);
     1241#endif
    11811242          }
    11821243          break;
     
    12041265          G_NO_OF_SATELLITES(nums)
    12051266          co->Supplied[COBOFS_HR] |= 1;
     1267#ifdef BNC_DEBUG
     1268          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n",
     1269                          co->EpochTime[s], co->UpdateInterval,mmi,co->NumberOfSat[s],nums,
     1270                                  co->SSRIOD, co->SSRProviderID, co->SSRSolutionID);
     1271#endif
    12061272          for (i = 0; i < nums; ++i) {
    12071273            switch (s) {
     
    12291295            co->Sat[pos].ID = id;
    12301296            G_HR_CLOCK_CORRECTION(co->Sat[pos].hrclock)
     1297#ifdef BNC_DEBUG
     1298            fprintf(stderr, "id %2d hrClock %8.3f \n",
     1299                    co->Sat[pos].ID, co->Sat[pos].hrclock);
     1300#endif
    12311301          }
    12321302          break;
     
    12531323          G_SSR_SOLUTION_ID(b->SSRSolutionID)
    12541324          G_NO_OF_SATELLITES(nums)
     1325#ifdef BNC_DEBUG
     1326          fprintf(stderr, "epochTime %d ui %d mmi %d sats %d/%d ssrIod %d providerId %d solId %d\n",
     1327                          b->EpochTime[s], b->UpdateInterval,mmi,b->NumberOfSat[s],nums,
     1328                                  b->SSRIOD, b->SSRProviderID, b->SSRSolutionID);
     1329#endif
    12551330          for (i = 0; i < nums; ++i) {
    12561331            switch (s) {
     
    12771352              ++b->NumberOfSat[s];
    12781353            b->Sat[pos].ID = id;
    1279 
    12801354            G_NO_OF_CODE_BIASES(b->Sat[pos].NumberOfCodeBiases)
     1355            #ifdef BNC_DEBUG
     1356            fprintf(stderr, "id %2d #%d ",
     1357                    b->Sat[pos].ID, b->Sat[pos].NumberOfCodeBiases);
     1358#endif
    12811359            for (j = 0; j < b->Sat[pos].NumberOfCodeBiases; ++j) {
    12821360              G_SIGNAL_IDENTIFIER(b->Sat[pos].Biases[j].Type)
    12831361              G_CODE_BIAS(b->Sat[pos].Biases[j].Bias)
     1362#ifdef BNC_DEBUG
     1363            fprintf(stderr, "t%d b %8.2f ",
     1364                    b->Sat[pos].Biases[j].Type, b->Sat[pos].Biases[j].Bias);
     1365#endif
    12841366            }
     1367#ifdef BNC_DEBUG
     1368            fprintf(stderr, "\n");
     1369#endif
    12851370          }
    12861371          break;
     
    12881373          continue;
    12891374      }
    1290 #ifdef DEBUG
     1375#ifdef BNC_DEBUG
    12911376      for(type = 0; type < (int)size && (unsigned char)buffer[type] != 0xD3; ++type)
    12921377      numbits += 8;
Note: See TracChangeset for help on using the changeset viewer.