Changeset 8805 in ntrip for branches/BNC_2.12
- Timestamp:
- Sep 20, 2019, 2:51:58 PM (5 years ago)
- Location:
- branches/BNC_2.12/src
- Files:
-
- 5 edited
Legend:
- Unmodified
- Added
- Removed
-
branches/BNC_2.12/src/RTCM3/RTCM3Decoder.cpp
r8795 r8805 243 243 {GPS_WAVELENGTH_L1, "1P"}, 244 244 {GPS_WAVELENGTH_L1, "1W"}, 245 {0.0, 0} /*{GPS_WAVELENGTH_L1,"1Y"}*/,245 {0.0, 0}, 246 246 {0.0, 0}, 247 247 {0.0, 0}, … … 249 249 {GPS_WAVELENGTH_L2, "2P"}, 250 250 {GPS_WAVELENGTH_L2, "2W"}, 251 {0.0, 0} /*{GPS_WAVELENGTH_L2,"2Y"}*/,251 {0.0, 0}, 252 252 {0.0, 0}, 253 253 {0.0, 0}, … … 288 288 {1.0, "2C"}, 289 289 {1.0, "2P"}, 290 { 0.0, 0},291 { 0.0, 0},292 { 0.0, 0},293 { 0.0, 0},294 { 0.0, 0},295 { 0.0, 0},296 { 0.0, 0},297 { 0.0, 0},298 { 0.0, 0},290 {GLO_WAVELENGTH_L1a, "4A"}, 291 {GLO_WAVELENGTH_L1a, "4B"}, 292 {GLO_WAVELENGTH_L1a, "4X"}, 293 {GLO_WAVELENGTH_L2a, "6A"}, 294 {GLO_WAVELENGTH_L2a, "6B"}, 295 {GLO_WAVELENGTH_L2a, "6X"}, 296 {GLO_WAVELENGTH_L3, "3I"}, 297 {GLO_WAVELENGTH_L3, "3Q"}, 298 {GLO_WAVELENGTH_L3, "3X"}, 299 299 {0.0, 0}, 300 300 {0.0, 0}, … … 346 346 {0.0, 0}, 347 347 {0.0, 0}, 348 {0.0, 0} ,348 {0.0, 0} 349 349 }; 350 350 … … 421 421 }; 422 422 423 /** 424 * MSM signal types for IRNSS 425 * 426 * NOTE: Uses 0.0, 1.0 for wavelength as sat index dependence is done later! 427 */ 428 static struct CodeData irn[RTCM3_MSM_NUMSIG] = { 429 {0.0, 0}, 430 {0.0, 0}, 431 {0.0, 0}, 432 {0.0, 0}, 433 {0.0, 0}, 434 {0.0, 0}, 435 {0.0, 0}, 436 {IRNSS_WAVELENGTH_S, "9A"}, 437 {0.0, 0}, 438 {0.0, 0}, 439 {0.0, 0}, 440 {0.0, 0}, 441 {0.0, 0}, 442 {0.0, 0}, 443 {0.0, 0}, 444 {0.0, 0}, 445 {0.0, 0}, 446 {0.0, 0}, 447 {0.0, 0}, 448 {0.0, 0}, 449 {0.0, 0}, 450 {IRNSS_WAVELENGTH_L5, "5A"}, 451 {0.0, 0}, 452 {0.0, 0}, 453 {0.0, 0}, 454 {0.0, 0}, 455 {0.0, 0}, 456 {0.0, 0}, 457 {0.0, 0}, 458 {0.0, 0}, 459 {0.0, 0}, 460 {0.0, 0} 461 }; 462 423 463 #define UINT64(c) c ## ULL 424 464 425 465 // 426 466 //////////////////////////////////////////////////////////////////////////// 427 bool RTCM3Decoder::DecodeRTCM3MSM(unsigned char* data, int size) 428 { 467 bool RTCM3Decoder::DecodeRTCM3MSM(unsigned char* data, int size) { 429 468 bool decoded = false; 430 469 int type, syncf, i; … … 438 477 /* id */ 439 478 char sys; 440 if (type >= 1121)479 if (type >= 1121) 441 480 sys = 'C'; 442 481 else if (type >= 1111) … … 448 487 else if (type >= 1081) 449 488 sys = 'R'; 450 else 489 else if (type >= 1071) 451 490 sys = 'G'; 491 else if (type >= 21) // test 492 sys = 'I'; 452 493 453 494 bncTime CurrentObsTime; … … 483 524 int sigmask, numsat = 0, numsig = 0; 484 525 uint64_t satmask, cellmask, ui; 485 double rrmod[RTCM3_MSM_NUMSAT]; 486 int rrint[RTCM3_MSM_NUMSAT], rdop[RTCM3_MSM_NUMSAT], 487 extsat[RTCM3_MSM_NUMSAT]; 488 int ll[RTCM3_MSM_NUMCELLS]/*, hc[RTCM3_MSM_NUMCELLS]*/; 489 double cnr[RTCM3_MSM_NUMCELLS]; 490 double cp[RTCM3_MSM_NUMCELLS], psr[RTCM3_MSM_NUMCELLS], 491 dop[RTCM3_MSM_NUMCELLS]; 526 // satellite data 527 double rrmod[RTCM3_MSM_NUMSAT]; // GNSS sat rough ranges modulo 1 millisecond 528 int rrint[RTCM3_MSM_NUMSAT]; // number of integer msecs in GNSS sat rough ranges 529 int rdop[RTCM3_MSM_NUMSAT]; // GNSS sat rough phase range rates 530 int extsat[RTCM3_MSM_NUMSAT];// extended sat info 531 // signal data 532 int ll[RTCM3_MSM_NUMCELLS]; // lock time indicator 533 /*int hc[RTCM3_MSM_NUMCELLS];*/ // half cycle ambiguity indicator 534 double cnr[RTCM3_MSM_NUMCELLS]; // signal cnr 535 double cp[RTCM3_MSM_NUMCELLS]; // fine phase range data 536 double psr[RTCM3_MSM_NUMCELLS]; // fine psr 537 double dop[RTCM3_MSM_NUMCELLS]; // fine phase range rates 492 538 493 539 SKIPBITS(3 + 7 + 2 + 2 + 1 + 3) … … 505 551 i = numsat * numsig; 506 552 GETBITS64(cellmask, (unsigned )i) 507 553 // satellite data 508 554 switch (type % 10) { 509 555 case 1: … … 533 579 break; 534 580 } 535 581 // signal data 536 582 int numcells = numsat * numsig; 537 583 /** Drop anything which exceeds our cell limit. Increase limit definition … … 684 730 { 685 731 int k = GLOFreq[RTCM3_MSM_NUMSAT - i - 1]; 686 if (extsat[numsat] < 14) { 687 k = GLOFreq[RTCM3_MSM_NUMSAT - i - 1] = 100 + extsat[numsat] 688 - 7; 732 if (extsat[numsat] < 14) { // channel number is available as extended info for MSM5/7 733 k = GLOFreq[RTCM3_MSM_NUMSAT - i - 1] = 100 + extsat[numsat] - 7; 689 734 } 690 if (k) 691 cd.wl = ( 692 cd.wl == 0.0 ? 693 GLO_WAVELENGTH_L1(k - 100) : 694 GLO_WAVELENGTH_L2(k - 100)); 695 else 735 if (k) { 736 if (cd.wl == 0.0) { 737 cd.wl = GLO_WAVELENGTH_L1(k - 100); 738 } 739 else if (cd.wl == 1.0) { 740 cd.wl = GLO_WAVELENGTH_L2(k - 100); 741 } 742 } 743 else if (!k && cd.wl <= 1) { 696 744 cd.code = 0; 745 } 697 746 } 698 747 break; … … 700 749 cd = gal[RTCM3_MSM_NUMSIG - j - 1]; 701 750 break; 751 case 'I': 752 cd = irn[RTCM3_MSM_NUMSIG - j - 1]; 753 break; 702 754 } 703 755 if (cd.code) { … … 748 800 if (cp[count] > -1.0 / (1 << 8)) { 749 801 frqObs->_phase = cp[count] * LIGHTSPEED / 1000.0 / cd.wl 750 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 751 / cd.wl; 802 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 / cd.wl; 752 803 frqObs->_phaseValid = true; 753 804 frqObs->_lockTime = lti2sec(type,ll[count]); … … 768 819 if (cp[count] > -1.0 / (1 << 8)) { 769 820 frqObs->_phase = cp[count] * LIGHTSPEED / 1000.0 / cd.wl 770 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 771 / cd.wl; 821 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 / cd.wl; 772 822 frqObs->_phaseValid = true; 773 823 frqObs->_lockTime = lti2sec(type,ll[count]); … … 793 843 if (cp[count] > -1.0 / (1 << 8)) { 794 844 frqObs->_phase = cp[count] * LIGHTSPEED / 1000.0 / cd.wl 795 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 796 / cd.wl; 845 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 / cd.wl; 797 846 frqObs->_phaseValid = true; 798 847 frqObs->_lockTime = lti2sec(type,ll[count]); … … 813 862 if (cp[count] > -1.0 / (1 << 8)) { 814 863 frqObs->_phase = cp[count] * LIGHTSPEED / 1000.0 / cd.wl 815 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 816 / cd.wl; 864 + (rrmod[numsat] + rrint[numsat]) * LIGHTSPEED / 1000.0 / cd.wl; 817 865 frqObs->_phaseValid = true; 818 866 frqObs->_lockTime = lti2sec(type,ll[count]); … … 834 882 } 835 883 } 836 if (CurrentObs._obs.size() > 0) 884 if (CurrentObs._obs.size() > 0) { 837 885 _CurrentObsList.push_back(CurrentObs); 886 } 838 887 } 839 888 } … … 1002 1051 i <<= 4; 1003 1052 eph._TOC.set(i * 1000); 1004 GETFLOATSIGN(eph._clock_driftrate, 8, 1005 1.0 / (double )(1 << 30) / (double )(1 << 25)) 1006 GETFLOATSIGN(eph._clock_drift, 16, 1007 1.0 / (double )(1 << 30) / (double )(1 << 13)) 1008 GETFLOATSIGN(eph._clock_bias, 22, 1009 1.0 / (double )(1 << 30) / (double )(1 << 1)) 1053 GETFLOATSIGN(eph._clock_driftrate, 8, 1.0 / (double )(1 << 30) / (double )(1 << 25)) 1054 GETFLOATSIGN(eph._clock_drift, 16, 1.0 / (double )(1 << 30) / (double )(1 << 13)) 1055 GETFLOATSIGN(eph._clock_bias, 22, 1.0 / (double )(1 << 30) / (double )(1 << 1)) 1056 1010 1057 GETBITS(eph._IODC, 10) 1011 1058 GETFLOATSIGN(eph._Crs, 16, 1.0 / (double )(1 << 5)) … … 1076 1123 GETBITS(i, 1) 1077 1124 tk += i * 30; 1078 eph._tki = tk < 3 * 60 * 60 ? tk - 3 * 60 * 60 + 86400 : tk - 3 * 60 * 60; 1125 eph._tki = tk - 3*60*60; 1126 if(eph._tki < 0.0) { 1127 eph._tki += 86400.0; 1128 } 1079 1129 GETBITS(eph._health, 1) /* MSB of Bn*/ 1080 1130 GETBITS(eph._P2, 1) /* P2 */ … … 1153 1203 eph._TOC.set(i * 1000); 1154 1204 1155 GETFLOATSIGN(eph._clock_driftrate, 8, 1156 1.0 / (double )(1 << 30) / (double )(1 << 25)) 1157 GETFLOATSIGN(eph._clock_drift, 16, 1158 1.0 / (double )(1 << 30) / (double )(1 << 13)) 1159 GETFLOATSIGN(eph._clock_bias, 22, 1160 1.0 / (double )(1 << 30) / (double )(1 << 1)) 1205 GETFLOATSIGN(eph._clock_driftrate, 8, 1.0 / (double )(1 << 30) / (double )(1 << 25)) 1206 GETFLOATSIGN(eph._clock_drift, 16, 1.0 / (double )(1 << 30) / (double )(1 << 13)) 1207 GETFLOATSIGN(eph._clock_bias, 22, 1.0 / (double )(1 << 30) / (double )(1 << 1)) 1208 1161 1209 GETBITS(eph._IODE, 8) 1162 1210 GETFLOATSIGN(eph._Crs, 16, 1.0 / (double )(1 << 5)) … … 1199 1247 GETBITS(eph._fitInterval, 1) 1200 1248 eph._TOT = 0.9999e9; 1201 eph._L2PFlag = 0; /* does not exist for QZSS */ 1249 1250 emit newGPSEph(eph); 1251 decoded = true; 1252 } 1253 return decoded; 1254 } 1255 1256 // 1257 //////////////////////////////////////////////////////////////////////////// 1258 bool RTCM3Decoder::DecodeIRNSSEphemeris(unsigned char* data, int size) { 1259 bool decoded = false; 1260 1261 if (size == 67) { 1262 t_ephGPS eph; 1263 int i, week, L5Flag, SFlag; 1264 uint64_t numbits = 0, bitfield = 0; 1265 1266 data += 3; /* header */ 1267 size -= 6; /* header + crc */ 1268 SKIPBITS(12) 1269 1270 eph._receptDateTime = currentDateAndTimeGPS(); 1271 1272 GETBITS(i, 6) 1273 eph._prn.set('I', i); 1274 GETBITS(week, 10) 1275 GETFLOATSIGN(eph._clock_bias, 22, 1.0 / (double )(1 << 30) / (double )(1 << 1)) 1276 GETFLOATSIGN(eph._clock_drift, 16, 1.0 / (double )(1 << 30) / (double )(1 << 13)) 1277 GETFLOATSIGN(eph._clock_driftrate, 8, 1.0 / (double )(1 << 30) / (double )(1 << 25)) 1278 GETBITS(i, 4) 1279 eph._ura = accuracyFromIndex(i, eph.type()); 1280 GETBITS(i, 16) 1281 i <<= 4; 1282 eph._TOC.set(i * 1000); 1283 GETFLOATSIGN(eph._TGD, 8, 1.0 / (double )(1 << 30) / (double )(1 << 1)) 1284 GETFLOATSIGN(eph._Delta_n, 22, R2R_PI/(double)(1<<30)/(double)(1 << 11)) 1285 // IODCE 1286 GETBITS(eph._IODE, 8) 1287 eph._IODC = eph._IODE; 1288 SKIPBITS(10) 1289 GETBITS(L5Flag, 1) 1290 GETBITS(SFlag, 1) 1291 if (L5Flag == 0 && SFlag == 0) { 1292 eph._health = 0.0; 1293 } 1294 else if (L5Flag == 0 && SFlag == 1) { 1295 eph._health = 1.0; 1296 } 1297 else if (L5Flag == 1 && SFlag == 0) { 1298 eph._health = 2.0; 1299 } 1300 else if (L5Flag == 1 && SFlag == 1) { 1301 eph._health = 3.0; 1302 } 1303 GETFLOATSIGN(eph._Cuc, 15, 1.0 / (double )(1 << 28)) 1304 GETFLOATSIGN(eph._Cus, 15, 1.0 / (double )(1 << 28)) 1305 GETFLOATSIGN(eph._Cic, 15, 1.0 / (double )(1 << 28)) 1306 GETFLOATSIGN(eph._Cis, 15, 1.0 / (double )(1 << 28)) 1307 GETFLOATSIGN(eph._Crc, 15, 1.0 / (double )(1 << 4)) 1308 GETFLOATSIGN(eph._Crs, 15, 1.0 / (double )(1 << 4)) 1309 GETFLOATSIGN(eph._IDOT, 14, R2R_PI/(double)(1<<30)/(double)(1<<13)) 1310 GETFLOATSIGN(eph._M0, 32, R2R_PI/(double)(1<<30)/(double)(1<< 1)) 1311 GETBITS(i, 16) 1312 i <<= 4; 1313 eph._TOEsec = i; 1314 bncTime t; 1315 t.set(i * 1000); 1316 eph._TOEweek = t.gpsw(); 1317 int numOfRollOvers = int(floor(t.gpsw()/1024.0)); 1318 week += (numOfRollOvers * 1024); 1319 /* week from HOW, differs from TOC, TOE week, we use adapted value instead */ 1320 if (eph._TOEweek > week + 1 || eph._TOEweek < week - 1) /* invalid week */ 1321 return false; 1322 GETFLOAT(eph._e, 32, 1.0 / (double )(1 << 30) / (double )(1 << 3)) 1323 GETFLOAT(eph._sqrt_A, 32, 1.0 / (double )(1 << 19)) 1324 GETFLOATSIGN(eph._OMEGA0, 32, R2R_PI/(double)(1<<30)/(double)(1<< 1)) 1325 GETFLOATSIGN(eph._omega, 32, R2R_PI/(double)(1<<30)/(double)(1<< 1)) 1326 GETFLOATSIGN(eph._OMEGADOT, 22, R2R_PI/(double)(1<<30)/(double)(1<<11)) 1327 GETFLOATSIGN(eph._i0, 32, R2R_PI/(double)(1<<30)/(double)(1<< 1)) 1328 SKIPBITS(2) 1329 SKIPBITS(2) 1330 eph._TOT = 0.9999e9; 1202 1331 1203 1332 emit newGPSEph(eph); … … 1273 1402 eph._prn.set('E', i, eph._inav ? 1 : 0); 1274 1403 1275 GETBITS(eph._TOEweek, 12) 1404 GETBITS(eph._TOEweek, 12) //FIXME: roll-over after week 4095!! 1276 1405 GETBITS(eph._IODnav, 10) 1277 1406 GETBITS(i, 8) … … 1280 1409 GETBITSFACTOR(i, 14, 60) 1281 1410 eph._TOC.set(1024 + eph._TOEweek, i); 1282 GETFLOATSIGN(eph._clock_driftrate, 6, 1283 1.0 / (double )(1 << 30) / (double )(1 << 29)) 1284 GETFLOATSIGN(eph._clock_drift, 21, 1285 1.0 / (double )(1 << 30) / (double )(1 << 16)) 1286 GETFLOATSIGN(eph._clock_bias, 31, 1287 1.0 / (double )(1 << 30) / (double )(1 << 4)) 1411 GETFLOATSIGN(eph._clock_driftrate, 6, 1.0 / (double )(1 << 30) / (double )(1 << 29)) 1412 GETFLOATSIGN(eph._clock_drift, 21, 1.0 / (double )(1 << 30) / (double )(1 << 16)) 1413 GETFLOATSIGN(eph._clock_bias, 31, 1.0 / (double )(1 << 30) / (double )(1 << 4)) 1288 1414 GETFLOATSIGN(eph._Crs, 16, 1.0 / (double )(1 << 5)) 1289 1415 GETFLOATSIGN(eph._Delta_n, 16, R2R_PI/(double)(1<<30)/(double)(1<<13)) … … 1310 1436 eph._e5aDataInValid = false; 1311 1437 1312 GETFLOATSIGN(eph._BGD_1_5B, 10, 1313 1.0 / (double )(1 << 30) / (double )(1 << 2)) 1438 GETFLOATSIGN(eph._BGD_1_5B, 10, 1.0 / (double )(1 << 30) / (double )(1 << 2)) 1314 1439 GETBITS(eph._E5bHS, 2) 1315 1440 GETBITS(eph._e5bDataInValid, 1) … … 1364 1489 i <<= 3; 1365 1490 eph._TOC.setBDS(i * 1000); 1366 GETFLOATSIGN(eph._clock_driftrate, 11, 1367 1.0 / (double )(1 << 30) / (double )(1 << 30) / (double )(1 << 6)) 1368 GETFLOATSIGN(eph._clock_drift, 22, 1369 1.0 / (double )(1 << 30) / (double )(1 << 20)) 1370 GETFLOATSIGN(eph._clock_bias, 24, 1371 1.0 / (double )(1 << 30) / (double )(1 << 3)) 1491 GETFLOATSIGN(eph._clock_driftrate, 11, 1.0 / (double )(1 << 30) / (double )(1 << 30) / (double )(1 << 6)) 1492 GETFLOATSIGN(eph._clock_drift, 22, 1.0 / (double )(1 << 30) / (double )(1 << 20)) 1493 GETFLOATSIGN(eph._clock_bias, 24, 1.0 / (double )(1 << 30) / (double )(1 << 3)) 1372 1494 GETBITS(eph._AODC, 5) 1373 1495 GETFLOATSIGN(eph._Crs, 18, 1.0 / (double )(1 << 6)) … … 1511 1633 } 1512 1634 } 1513 else if (id >= 1070 && id <= 1229) /* MSM */ { 1635 else if ((id >= 1070 && id <= 1229) || 1636 (id >= 21 && id <= 27)) /* MSM */ { 1514 1637 if (DecodeRTCM3MSM(_Message, _BlockSize)) 1515 1638 decoded = true; … … 1555 1678 decoded = true; 1556 1679 break; 1680 case 29: 1681 if (DecodeIRNSSEphemeris(_Message, _BlockSize)) 1682 decoded = true; 1683 break; 1557 1684 case 1045: 1558 1685 case 1046: -
branches/BNC_2.12/src/RTCM3/RTCM3Decoder.h
r8200 r8805 132 132 bool DecodeQZSSEphemeris(unsigned char* buffer, int bufLen); 133 133 /** 134 * Extract ephemeris data from 29 (allocated for testing) RTCM3 messages. 135 * @param buffer the buffer containing an 29 RTCM block 136 * @param bufLen the length of the buffer (the message length including header+crc) 137 * @return <code>true</code> when data block was decodable 138 */ 139 bool DecodeIRNSSEphemeris(unsigned char* buffer, int bufLen); 140 /** 134 141 * Extract ephemeris data from 1045 and 1046 RTCM3 messages. 135 142 * @param buffer the buffer containing an 1045 and 1046 RTCM block -
branches/BNC_2.12/src/RTCM3/clock_and_orbit/clock_orbit_rtcm.h
r8744 r8805 108 108 CLOCKORBIT_NUMQZSS=10, 109 109 CLOCKORBIT_NUMSBAS=38, 110 CLOCKORBIT_NUMBDS= 37,110 CLOCKORBIT_NUMBDS=63, 111 111 CLOCKORBIT_NUMBIAS=100, 112 112 CLOCKORBIT_NUMIONOLAYERS=4, … … 236 236 CODETYPE_BDS_B2a_D = 12, 237 237 CODETYPE_BDS_B2a_P = 13, 238 CODETYPE_BDS_B2a_DP = 14 238 CODETYPE_BDS_B2a_DP = 14, 239 240 CODETYPE_IRNSS_S_SPS = 8, 241 CODETYPE_IRNSS_L5_SPS = 22 239 242 }; 240 243 -
branches/BNC_2.12/src/bncutils.cpp
r8691 r8805 173 173 } 174 174 } 175 176 175 } 177 176 … … 463 462 // 464 463 //////////////////////////////////////////////////////////////////////////// 465 intfactorial(int n) {464 double factorial(int n) { 466 465 if (n == 0) { 467 466 return 1; … … 809 808 810 809 double accuracyFromIndex(int index, t_eph::e_type type) { 811 812 if (type == t_eph::GPS || type == t_eph::BDS || type == t_eph::SBAS 813 || type == t_eph::QZSS) { 814 810 double accuracy = -1.0; 811 812 if (type == t_eph::GPS || 813 type == t_eph::BDS || 814 type == t_eph::SBAS|| 815 type == t_eph::QZSS) { 815 816 if ((index >= 0) && (index <= 6)) { 816 817 if (index == 3) { 817 returnceil(10.0 * pow(2.0, (double(index) / 2.0) + 1.0)) / 10.0;818 accuracy = ceil(10.0 * pow(2.0, (double(index) / 2.0) + 1.0)) / 10.0; 818 819 } 819 820 else { 820 returnfloor(10.0 * pow(2.0, (double(index) / 2.0) + 1.0)) / 10.0;821 accuracy = floor(10.0 * pow(2.0, (double(index) / 2.0) + 1.0)) / 10.0; 821 822 } 822 823 } 823 824 else if ((index > 6) && (index <= 15)) { 824 return(10.0 * pow(2.0, (double(index) - 2.0))) / 10.0;825 accuracy = (10.0 * pow(2.0, (double(index) - 2.0))) / 10.0; 825 826 } 826 827 else { 827 return 8192.0; 828 } 829 } 830 831 if (type == t_eph::Galileo) { 832 828 accuracy = 8192.0; 829 } 830 } 831 else if (type == t_eph::Galileo) { 833 832 if ((index >= 0) && (index <= 49)) { 834 return(double(index) / 100.0);833 accuracy = (double(index) / 100.0); 835 834 } 836 835 else if ((index > 49) && (index <= 74)) { 837 return(50.0 + (double(index) - 50.0) * 2.0) / 100.0;836 accuracy = (50.0 + (double(index) - 50.0) * 2.0) / 100.0; 838 837 } 839 838 else if ((index > 74) && (index <= 99)) { 840 return1.0 + (double(index) - 75.0) * 0.04;839 accuracy = 1.0 + (double(index) - 75.0) * 0.04; 841 840 } 842 841 else if ((index > 99) && (index <= 125)) { 843 return2.0 + (double(index) - 100.0) * 0.16;842 accuracy = 2.0 + (double(index) - 100.0) * 0.16; 844 843 } 845 844 else { 846 return -1.0; 847 } 848 } 849 850 return double(index); 851 } 845 accuracy = -1.0; 846 } 847 } 848 else if (type == t_eph::IRNSS) { 849 if ((index >= 0) && (index <= 6)) { 850 if (index == 1) { 851 accuracy = 2.8; 852 } 853 else if (index == 3) { 854 accuracy = 5.7; 855 } 856 else if (index == 5) { 857 accuracy = 11.3; 858 } 859 else { 860 accuracy = pow(2, 1 + index / 2); 861 } 862 } 863 else if ((index > 6) && (index <= 15)) { 864 accuracy = pow(2, index - 2); 865 } 866 } 867 return accuracy; 868 } 869 852 870 853 871 int indexFromAccuracy(double accuracy, t_eph::e_type type) { -
branches/BNC_2.12/src/bncutils.h
r8616 r8805 140 140 double associatedLegendreFunction(int n, int m, double t); 141 141 142 intfactorial(int n);142 double factorial(int n); 143 143 144 144 /** Convert RTCM3 lock-time indicator to lock time in seconds
Note:
See TracChangeset
for help on using the changeset viewer.