Changeset 3581 in ntrip for trunk/rtcm3torinex/lib


Ignore:
Timestamp:
Jan 9, 2012, 5:18:58 PM (12 years ago)
Author:
stoecker
Message:

update MSM data format to current layout

File:
1 edited

Legend:

Unmodified
Added
Removed

  • trunk/rtcm3torinex/lib/rtcm3torinex.c

    r3270 r3581  
    930930          {GNSSENTRY_P1DATA,GNSSENTRY_L1PDATA,GNSSENTRY_D1PDATA,
    931931          GNSSENTRY_S1PDATA,GNSSDF2_LOCKLOSSL1,GPS_WAVELENGTH_L1,"1W"},
    932           {GNSSENTRY_P1DATA,GNSSENTRY_L1PDATA,GNSSENTRY_D1PDATA,
    933           GNSSENTRY_S1PDATA,GNSSDF2_LOCKLOSSL1,GPS_WAVELENGTH_L1,"1Y"},
     932          {0,0,0,0,0,0,0}/*{GNSSENTRY_P1DATA,GNSSENTRY_L1PDATA,GNSSENTRY_D1PDATA,
     933          GNSSENTRY_S1PDATA,GNSSDF2_LOCKLOSSL1,GPS_WAVELENGTH_L1,"1Y"}*/,
    934934          {0,0,0,0,0,0,0},
    935935          {0,0,0,0,0,0,0},
    … …  
    940940          {GNSSENTRY_P2DATA,GNSSENTRY_L2PDATA,GNSSENTRY_D2PDATA,
    941941          GNSSENTRY_S2PDATA,GNSSDF2_LOCKLOSSL2,GPS_WAVELENGTH_L2,"2W"},
    942           {GNSSENTRY_P2DATA,GNSSENTRY_L2PDATA,GNSSENTRY_D2PDATA,
    943           GNSSENTRY_S2PDATA,GNSSDF2_LOCKLOSSL2,GPS_WAVELENGTH_L2,"2Y"},
     942          {0,0,0,0,0,0,0}/*{GNSSENTRY_P2DATA,GNSSENTRY_L2PDATA,GNSSENTRY_D2PDATA,
     943          GNSSENTRY_S2PDATA,GNSSDF2_LOCKLOSSL2,GPS_WAVELENGTH_L2,"2Y"}*/,
    944944          {0,0,0,0,0,0,0},
    945945          {0,0,0,0,0,0,0},
    … …  
    960960          GNSSENTRY_S5DATA,GNSSDF2_LOCKLOSSL5,GPS_WAVELENGTH_L5,"5Q"},
    961961          {GNSSENTRY_C5DATA,GNSSENTRY_L5DATA,GNSSENTRY_D5DATA,
    962           GNSSENTRY_S5DATA,GNSSDF2_LOCKLOSSL5,GPS_WAVELENGTH_L5,"5X"}
     962          GNSSENTRY_S5DATA,GNSSDF2_LOCKLOSSL5,GPS_WAVELENGTH_L5,"5X"},
     963          {0,0,0,0,0,0,0},
     964          {0,0,0,0,0,0,0},
     965          {0,0,0,0,0,0,0},
     966          {0,0,0,0,0,0,0},
     967          {0,0,0,0,0,0,0},
     968          {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
     969          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,0.0,"1S"},
     970          {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
     971          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,0.0,"1L"},
     972          {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
     973          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,0.0,"1X"}
    963974        };
    964975        /* NOTE: Uses 0.0, 1.0 for wavelength as sat index dependence is done later! */
    … …  
    9921003          {0,0,0,0,0,0,0},
    9931004          {0,0,0,0,0,0,0},
     1005          {0,0,0,0,0,0,0},
     1006          {0,0,0,0,0,0,0},
     1007          {0,0,0,0,0,0,0},
     1008          {0,0,0,0,0,0,0},
     1009          {0,0,0,0,0,0,0},
     1010          {0,0,0,0,0,0,0},
     1011          {0,0,0,0,0,0,0},
     1012          {0,0,0,0,0,0,0},
    9941013          {0,0,0,0,0,0,0}
    9951014        };
    … …  
    9991018          {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
    10001019          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1C"},
    1001           {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
    1002           GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1A"},
     1020          {0,0,0,0,0,0,0}/*{GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
     1021          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1A"}*/,
    10031022          {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
    10041023          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1B"},
    1005           {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
    1006           GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1X"},
    1007           {GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
    1008           GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1Z"},
     1024          {0,0,0,0,0,0,0}/*{GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
     1025          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1X"}*/,
     1026          {0,0,0,0,0,0,0}/*{GNSSENTRY_C1DATA,GNSSENTRY_L1CDATA,GNSSENTRY_D1CDATA,
     1027          GNSSENTRY_S1CDATA,GNSSDF2_LOCKLOSSL1,GAL_WAVELENGTH_E1,"1Z"}*/,
    10091028          {0,0,0,0,0,0,0},
    10101029          {GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
    1011           GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6I"},
     1030          GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6C"},
     1031          {0,0,0,0,0,0,0}/*{GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
     1032          GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6A"}*/,
    10121033          {GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
    1013           GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6Q"},
    1014           {GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
    1015           GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6I"},
    1016           {GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
    1017           GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6Q"},
    1018           {GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
    1019           GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6X"},
     1034          GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6B"},
     1035          {0,0,0,0,0,0,0}/*{GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
     1036          GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6X"}*/,
     1037          {0,0,0,0,0,0,0}/*{GNSSENTRY_C6DATA,GNSSENTRY_L6DATA,GNSSENTRY_D6DATA,
     1038          GNSSENTRY_S6DATA,GNSSDF2_LOCKLOSSE6,GAL_WAVELENGTH_E6,"6Z"}*/,
    10201039          {0,0,0,0,0,0,0},
    10211040          {GNSSENTRY_C5BDATA,GNSSENTRY_L5BDATA,GNSSENTRY_D5BDATA,
    … …  
    10231042          {GNSSENTRY_C5BDATA,GNSSENTRY_L5BDATA,GNSSENTRY_D5BDATA,
    10241043          GNSSENTRY_S5BDATA,GNSSDF2_LOCKLOSSE5B,GAL_WAVELENGTH_E5B,"7Q"},
    1025           {GNSSENTRY_C5BDATA,GNSSENTRY_L5BDATA,GNSSENTRY_D5BDATA,
    1026           GNSSENTRY_S5BDATA,GNSSDF2_LOCKLOSSE5B,GAL_WAVELENGTH_E5B,"7X"},
     1044          {0,0,0,0,0,0,0}/*{GNSSENTRY_C5BDATA,GNSSENTRY_L5BDATA,GNSSENTRY_D5BDATA,
     1045          GNSSENTRY_S5BDATA,GNSSDF2_LOCKLOSSE5B,GAL_WAVELENGTH_E5B,"7X"}*/,
    10271046          {0,0,0,0,0,0,0},
    10281047          {GNSSENTRY_C5ABDATA,GNSSENTRY_L5ABDATA,GNSSENTRY_D5ABDATA,
    … …  
    10301049          {GNSSENTRY_C5ABDATA,GNSSENTRY_L5ABDATA,GNSSENTRY_D5ABDATA,
    10311050          GNSSENTRY_S5ABDATA,GNSSDF2_LOCKLOSSE5AB,GAL_WAVELENGTH_E5AB,"8Q"},
    1032           {GNSSENTRY_C5ABDATA,GNSSENTRY_L5ABDATA,GNSSENTRY_D5ABDATA,
    1033           GNSSENTRY_S5ABDATA,GNSSDF2_LOCKLOSSE5AB,GAL_WAVELENGTH_E5AB,"8X"},
     1051          {0,0,0,0,0,0,0}/*{GNSSENTRY_C5ABDATA,GNSSENTRY_L5ABDATA,GNSSENTRY_D5ABDATA,
     1052          GNSSENTRY_S5ABDATA,GNSSDF2_LOCKLOSSE5AB,GAL_WAVELENGTH_E5AB,"8X"}*/,
    10341053          {0,0,0,0,0,0,0},
    10351054          {GNSSENTRY_C5DATA,GNSSENTRY_L5DATA,GNSSENTRY_D5DATA,
    … …  
    10371056          {GNSSENTRY_C5DATA,GNSSENTRY_L5DATA,GNSSENTRY_D5DATA,
    10381057          GNSSENTRY_S5DATA,GNSSDF2_LOCKLOSSL5,GAL_WAVELENGTH_E5A,"5Q"},
    1039           {GNSSENTRY_C5DATA,GNSSENTRY_L5DATA,GNSSENTRY_D5DATA,
    1040           GNSSENTRY_S5DATA,GNSSDF2_LOCKLOSSL5,GAL_WAVELENGTH_E5A,"5X"},
     1058          {0,0,0,0,0,0,0}/*{GNSSENTRY_C5DATA,GNSSENTRY_L5DATA,GNSSENTRY_D5DATA,
     1059          GNSSENTRY_S5DATA,GNSSDF2_LOCKLOSSL5,GAL_WAVELENGTH_E5A,"5X"}*/,
     1060          {0,0,0,0,0,0,0},
     1061          {0,0,0,0,0,0,0},
     1062          {0,0,0,0,0,0,0},
     1063          {0,0,0,0,0,0,0},
     1064          {0,0,0,0,0,0,0},
     1065          {0,0,0,0,0,0,0},
     1066          {0,0,0,0,0,0,0},
     1067          {0,0,0,0,0,0,0},
    10411068        };
    10421069
    … …  
    10451072        uint64_t satmask, cellmask, ui;
    10461073        double rrmod[RTCM3_MSM_NUMSAT];
    1047         int rrint[RTCM3_MSM_NUMSAT], rdop[RTCM3_MSM_NUMSAT];
     1074        int rrint[RTCM3_MSM_NUMSAT], rdop[RTCM3_MSM_NUMSAT],
     1075        extsat[RTCM3_MSM_NUMSAT];
    10481076        int ll[RTCM3_MSM_NUMCELLS];
    10491077        double cnr[RTCM3_MSM_NUMCELLS];
    … …  
    10871115
    10881116        GETBITS(syncf, 1)
    1089         SKIPBITS(3+7+1)
     1117        SKIPBITS(3+7+2+2+1+3)
    10901118        GETBITS64(satmask, RTCM3_MSM_NUMSAT)
    10911119
    … …  
    11041132          ++wasnoamb;
    11051133          for(j = numsat; j--;)
    1106             GETFLOAT(rrmod[j], 10, 1/1024.0)
     1134            GETFLOAT(rrmod[j], 10, 1.0/1024.0)
    11071135          break;
    11081136        case 4: case 6:
    … …  
    11101138            GETBITS(rrint[j], 8)
    11111139          for(j = numsat; j--;)
    1112             GETFLOAT(rrmod[j], 10, 1/1024.0)
     1140            GETFLOAT(rrmod[j], 10, 1.0/1024.0)
    11131141          break;
    11141142        case 5: case 7:
    … …  
    11161144            GETBITS(rrint[j], 8)
    11171145          for(j = numsat; j--;)
    1118             GETFLOAT(rrmod[j], 10, 1/1024.0)
     1146            GETBITS(extsat[j], 4)
     1147          for(j = numsat; j--;)
     1148            GETFLOAT(rrmod[j], 10, 1.0/1024.0)
    11191149          for(j = numsat; j--;)
    11201150            GETBITSSIGN(rdop[j], 14)
    … …  
    11301160            for(count = numcells; count--;)
    11311161              if(cellmask & (UINT64(1)<<count))
    1132                 GETFLOATSIGN(psr[count], 15, 0.02)
     1162                GETFLOATSIGN(psr[count], 15, 1.0/(1<<24))
    11331163            break;
    11341164          case 2:
    11351165            for(count = numcells; count--;)
    11361166              if(cellmask & (UINT64(1)<<count))
    1137                 GETFLOATSIGN(cp[count], 20, 1/256.0)
     1167                GETFLOATSIGN(cp[count], 22, 1.0/(1<<29))
    11381168            for(count = numcells; count--;)
    11391169              if(cellmask & (UINT64(1)<<count))
    … …  
    11431173            for(count = numcells; count--;)
    11441174              if(cellmask & (UINT64(1)<<count))
    1145                 GETFLOATSIGN(psr[count], 15, 0.02)
     1175                GETFLOATSIGN(psr[count], 15, 1.0/(1<<24))
    11461176            for(count = numcells; count--;)
    11471177              if(cellmask & (UINT64(1)<<count))
    1148                 GETFLOATSIGN(cp[count], 20, 1/256.0)
     1178                GETFLOATSIGN(cp[count], 22, 1.0/(1<<29))
    11491179            for(count = numcells; count--;)
    11501180              if(cellmask & (UINT64(1)<<count))
    … …  
    11541184            for(count = numcells; count--;)
    11551185              if(cellmask & (UINT64(1)<<count))
    1156                 GETFLOATSIGN(psr[count], 15, 0.02)
     1186                GETFLOATSIGN(psr[count], 15, 1.0/(1<<24))
    11571187            for(count = numcells; count--;)
    11581188              if(cellmask & (UINT64(1)<<count))
    1159                 GETFLOATSIGN(cp[count], 20, 1/256.0)
     1189                GETFLOATSIGN(cp[count], 22, 1.0/(1<<29))
    11601190            for(count = numcells; count--;)
    11611191              if(cellmask & (UINT64(1)<<count))
    … …  
    11681198            for(count = numcells; count--;)
    11691199              if(cellmask & (UINT64(1)<<count))
    1170                 GETFLOATSIGN(psr[count], 15, 0.02)
     1200                GETFLOATSIGN(psr[count], 15, 1.0/(1<<24))
    11711201            for(count = numcells; count--;)
    11721202              if(cellmask & (UINT64(1)<<count))
    1173                 GETFLOATSIGN(cp[count], 20, 1/256.0)
     1203                GETFLOATSIGN(cp[count], 22, 1.0/(1<<29))
    11741204            for(count = numcells; count--;)
    11751205              if(cellmask & (UINT64(1)<<count))
    … …  
    11851215            for(count = numcells; count--;)
    11861216              if(cellmask & (UINT64(1)<<count))
    1187                 GETFLOATSIGN(psr[count], 20, 0.001)
     1217                GETFLOATSIGN(psr[count], 20, 1.0/(1<<29))
    11881218            for(count = numcells; count--;)
    11891219              if(cellmask & (UINT64(1)<<count))
    1190                 GETFLOATSIGN(cp[count], 22, 1/1024.0)
     1220                GETFLOATSIGN(cp[count], 24, 1.0/(1U<<31))
    11911221            for(count = numcells; count--;)
    11921222              if(cellmask & (UINT64(1)<<count))
    … …  
    11951225              if(cellmask & (UINT64(1)<<count))
    11961226                GETFLOAT(cnr[count], 10, 0.1)
     1227            break;
    11971228          case 7:
    11981229            for(count = numcells; count--;)
    11991230              if(cellmask & (UINT64(1)<<count))
    1200                 GETFLOATSIGN(psr[count], 20, 0.001)
     1231                GETFLOATSIGN(psr[count], 20, 1.0/(1<<29))
    12011232            for(count = numcells; count--;)
    12021233              if(cellmask & (UINT64(1)<<count))
    1203                 GETFLOATSIGN(cp[count], 22, 1/1024.0)
     1234                GETFLOATSIGN(cp[count], 24, 1.0/(1U<<31))
    12041235            for(count = numcells; count--;)
    12051236              if(cellmask & (UINT64(1)<<count))
    … …  
    12721303                {
    12731304                case 1:
    1274                   if(psr[count] > -327.68)
     1305                  if(psr[count] > -1.0/(1<<10))
    12751306                  {
    1276                     gnss->measdata[num][cd.typeR] = psr[count]
     1307                    gnss->measdata[num][cd.typeR] = psr[count]*LIGHTSPEED/1000.0
    12771308                    +(rrmod[numsat])*LIGHTSPEED/1000.0;
    12781309                    gnss->dataflags[num] |= (1<<cd.typeR);
    … …  
    12801311                  break;
    12811312                case 2:
    1282                   if(wl && cp[count] > -2048.0)
     1313                  if(wl && cp[count] > -1.0/(1<<8))
    12831314                  {
    1284                     gnss->measdata[num][cd.typeP] = cp[count]
     1315                    gnss->measdata[num][cd.typeP] = cp[count]*LIGHTSPEED/1000.0
    12851316                    +(rrmod[numsat])*LIGHTSPEED/1000.0/wl;
    12861317                    if(handle->lastlockmsm[j][i] != ll[count])
    … …  
    12931324                  break;
    12941325                case 3:
    1295                   if(psr[count] > -327.68)
     1326                  if(psr[count] > -1.0/(1<<10))
    12961327                  {
    1297                     gnss->measdata[num][cd.typeR] = psr[count]
     1328                    gnss->measdata[num][cd.typeR] = psr[count]*LIGHTSPEED/1000.0
    12981329                    +(rrmod[numsat])*LIGHTSPEED/1000.0;
    12991330                    gnss->dataflags[num] |= (1<<cd.typeR);
    13001331                  }
    13011332
    1302                   if(wl && cp[count] > -2048.0)
     1333                  if(wl && cp[count] > -1.0/(1<<8))
    13031334                  {
    1304                     gnss->measdata[num][cd.typeP] = cp[count]
     1335                    gnss->measdata[num][cd.typeP] = cp[count]*LIGHTSPEED/1000.0
    13051336                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0/wl;
    13061337                    if(handle->lastlockmsm[j][i] != ll[count])
    … …  
    13131344                  break;
    13141345                case 4:
    1315                   if(psr[count] > -327.68)
     1346                  if(psr[count] > -1.0/(1<<10))
    13161347                  {
    1317                     gnss->measdata[num][cd.typeR] = psr[count]
     1348                    gnss->measdata[num][cd.typeR] = psr[count]*LIGHTSPEED/1000.0
    13181349                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0;
    13191350                    gnss->dataflags[num] |= (1<<cd.typeR);
    13201351                  }
    13211352
    1322                   if(wl && cp[count] > -2048.0)
     1353                  if(wl && cp[count] > -1.0/(1<<8))
    13231354                  {
    1324                     gnss->measdata[num][cd.typeP] = cp[count]
     1355                    gnss->measdata[num][cd.typeP] = cp[count]*LIGHTSPEED/1000.0
    13251356                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0/wl;
    13261357                    if(handle->lastlockmsm[j][i] != ll[count])
    … …  
    13361367                  break;
    13371368                case 5:
    1338                   if(psr[count] > -327.68)
     1369                  if(psr[count] > -1.0/(1<<10))
    13391370                  {
    1340                     gnss->measdata[num][cd.typeR] = psr[count]
     1371                    gnss->measdata[num][cd.typeR] = psr[count]*LIGHTSPEED/1000.0
    13411372                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0;
    13421373                    gnss->dataflags[num] |= (1<<cd.typeR);
    13431374                  }
    13441375
    1345                   if(wl && cp[count] > -2048.0)
     1376                  if(wl && cp[count] > -1.0/(1<<8))
    13461377                  {
    1347                     gnss->measdata[num][cd.typeP] = cp[count]
     1378                    gnss->measdata[num][cd.typeP] = cp[count]*LIGHTSPEED/1000.0
    13481379                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0/wl;
    13491380                    if(handle->lastlockmsm[j][i] != ll[count])
    … …  
    13661397                  break;
    13671398                case 6:
    1368                   if(psr[count] > -524.288)
     1399                  if(psr[count] > -1.0/(1<<10))
    13691400                  {
    1370                     gnss->measdata[num][cd.typeR] = psr[count]
     1401                    gnss->measdata[num][cd.typeR] = psr[count]*LIGHTSPEED/1000.0
    13711402                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0;
    13721403                    gnss->dataflags[num] |= (1<<cd.typeR);
    13731404                  }
    13741405
    1375                   if(wl && cp[count] > -2048.0)
     1406                  if(wl && cp[count] > -1.0/(1<<8))
    13761407                  {
    1377                     gnss->measdata[num][cd.typeP] = cp[count]
     1408                    gnss->measdata[num][cd.typeP] = cp[count]*LIGHTSPEED/1000.0
    13781409                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0/wl;
    13791410                    if(handle->lastlockmsm[j][i] != ll[count])
    … …  
    13891420                  break;
    13901421                case 7:
    1391                   if(psr[count] > -524.288)
     1422                  if(psr[count] > -1.0/(1<<10))
    13921423                  {
    1393                     gnss->measdata[num][cd.typeR] = psr[count]
     1424                    gnss->measdata[num][cd.typeR] = psr[count]*LIGHTSPEED/1000.0
    13941425                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0;
    13951426                    gnss->dataflags[num] |= (1<<cd.typeR);
    13961427                  }
    13971428
    1398                   if(wl && cp[count] > -2048.0)
     1429                  if(wl && cp[count] > -1.0/(1<<8))
    13991430                  {
    1400                     gnss->measdata[num][cd.typeP] = cp[count]
     1431                    gnss->measdata[num][cd.typeP] = cp[count]*LIGHTSPEED/1000.0
    14011432                    +(rrmod[numsat]+rrint[numsat])*LIGHTSPEED/1000.0/wl;
    14021433                    if(handle->lastlockmsm[j][i] != ll[count])
Note: See TracChangeset for help on using the changeset viewer.