[1837] | 1 | #ifndef RTCM3TORINEX_H
|
---|
| 2 | #define RTCM3TORINEX_H
|
---|
| 3 |
|
---|
| 4 | /*
|
---|
| 5 | Converter for RTCM3 data to RINEX.
|
---|
[2354] | 6 | $Id: rtcm3torinex.h,v 1.12 2010/03/05 11:11:06 stoecker Exp $
|
---|
[1837] | 7 | Copyright (C) 2005-2006 by Dirk Stöcker <stoecker@alberding.eu>
|
---|
| 8 |
|
---|
| 9 | This program is free software; you can redistribute it and/or modify
|
---|
| 10 | it under the terms of the GNU General Public License as published by
|
---|
| 11 | the Free Software Foundation; either version 2 of the License, or
|
---|
| 12 | (at your option) any later version.
|
---|
| 13 |
|
---|
| 14 | This program is distributed in the hope that it will be useful,
|
---|
| 15 | but WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
| 16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
---|
| 17 | GNU General Public License for more details.
|
---|
| 18 |
|
---|
| 19 | You should have received a copy of the GNU General Public License
|
---|
| 20 | along with this program; if not, write to the Free Software
|
---|
| 21 | Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
---|
| 22 | or read http://www.gnu.org/licenses/gpl.txt
|
---|
| 23 | */
|
---|
| 24 |
|
---|
| 25 | #include <stdio.h>
|
---|
| 26 |
|
---|
[2354] | 27 | #define GNSS_MAXSATS 64
|
---|
| 28 |
|
---|
[1837] | 29 | #define PRN_GPS_START 1
|
---|
| 30 | #define PRN_GPS_END 32
|
---|
| 31 | #define PRN_GLONASS_START 38
|
---|
| 32 | #define PRN_GLONASS_END 61
|
---|
| 33 | #define PRN_WAAS_START 120
|
---|
| 34 | #define PRN_WAAS_END 138
|
---|
| 35 |
|
---|
| 36 | #define GNSSENTRY_C1DATA 0
|
---|
| 37 | #define GNSSENTRY_C2DATA 1
|
---|
| 38 | #define GNSSENTRY_P1DATA 2
|
---|
| 39 | #define GNSSENTRY_P2DATA 3
|
---|
| 40 | #define GNSSENTRY_L1CDATA 4
|
---|
| 41 | #define GNSSENTRY_L1PDATA 5
|
---|
| 42 | #define GNSSENTRY_L2CDATA 6
|
---|
| 43 | #define GNSSENTRY_L2PDATA 7
|
---|
| 44 | #define GNSSENTRY_D1CDATA 8
|
---|
| 45 | #define GNSSENTRY_D1PDATA 9
|
---|
| 46 | #define GNSSENTRY_D2CDATA 10
|
---|
| 47 | #define GNSSENTRY_D2PDATA 11
|
---|
| 48 | #define GNSSENTRY_S1CDATA 12
|
---|
| 49 | #define GNSSENTRY_S1PDATA 13
|
---|
| 50 | #define GNSSENTRY_S2CDATA 14
|
---|
| 51 | #define GNSSENTRY_S2PDATA 15
|
---|
| 52 | #define GNSSENTRY_NUMBER 16 /* number of types!!! */
|
---|
| 53 |
|
---|
| 54 | /* Data flags. These flags are used in the dataflags field of gpsdata structure
|
---|
| 55 | and are used the determine, which data fields are filled with valid data. */
|
---|
| 56 | #define GNSSDF_C1DATA (1<<GNSSENTRY_C1DATA)
|
---|
| 57 | #define GNSSDF_C2DATA (1<<GNSSENTRY_C2DATA)
|
---|
| 58 | #define GNSSDF_P1DATA (1<<GNSSENTRY_P1DATA)
|
---|
| 59 | #define GNSSDF_P2DATA (1<<GNSSENTRY_P2DATA)
|
---|
| 60 | #define GNSSDF_L1CDATA (1<<GNSSENTRY_L1CDATA)
|
---|
| 61 | #define GNSSDF_L1PDATA (1<<GNSSENTRY_L1PDATA)
|
---|
| 62 | #define GNSSDF_L2CDATA (1<<GNSSENTRY_L2CDATA)
|
---|
| 63 | #define GNSSDF_L2PDATA (1<<GNSSENTRY_L2PDATA)
|
---|
| 64 | #define GNSSDF_D1CDATA (1<<GNSSENTRY_D1CDATA)
|
---|
| 65 | #define GNSSDF_D1PDATA (1<<GNSSENTRY_D1PDATA)
|
---|
| 66 | #define GNSSDF_D2CDATA (1<<GNSSENTRY_D2CDATA)
|
---|
| 67 | #define GNSSDF_D2PDATA (1<<GNSSENTRY_D2PDATA)
|
---|
| 68 | #define GNSSDF_S1CDATA (1<<GNSSENTRY_S1CDATA)
|
---|
| 69 | #define GNSSDF_S1PDATA (1<<GNSSENTRY_S1PDATA)
|
---|
| 70 | #define GNSSDF_S2CDATA (1<<GNSSENTRY_S2CDATA)
|
---|
| 71 | #define GNSSDF_S2PDATA (1<<GNSSENTRY_S2PDATA)
|
---|
| 72 |
|
---|
| 73 | #define RINEXENTRY_C1DATA 0
|
---|
| 74 | #define RINEXENTRY_C2DATA 1
|
---|
| 75 | #define RINEXENTRY_P1DATA 2
|
---|
| 76 | #define RINEXENTRY_P2DATA 3
|
---|
| 77 | #define RINEXENTRY_L1DATA 4
|
---|
| 78 | #define RINEXENTRY_L2DATA 5
|
---|
| 79 | #define RINEXENTRY_D1DATA 6
|
---|
| 80 | #define RINEXENTRY_D2DATA 7
|
---|
| 81 | #define RINEXENTRY_S1DATA 8
|
---|
| 82 | #define RINEXENTRY_S2DATA 9
|
---|
| 83 | #define RINEXENTRY_NUMBER 10
|
---|
| 84 |
|
---|
| 85 | #define LIGHTSPEED 2.99792458e8 /* m/sec */
|
---|
| 86 | #define GPS_FREQU_L1 1575420000.0 /* Hz */
|
---|
| 87 | #define GPS_FREQU_L2 1227600000.0 /* Hz */
|
---|
| 88 | #define GPS_WAVELENGTH_L1 (LIGHTSPEED / GPS_FREQU_L1) /* m */
|
---|
| 89 | #define GPS_WAVELENGTH_L2 (LIGHTSPEED / GPS_FREQU_L2) /* m */
|
---|
| 90 |
|
---|
| 91 | #define GLO_FREQU_L1_BASE 1602000000.0 /* Hz */
|
---|
| 92 | #define GLO_FREQU_L2_BASE 1246000000.0 /* Hz */
|
---|
| 93 | #define GLO_FREQU_L1_STEP 562500.0 /* Hz */
|
---|
| 94 | #define GLO_FREQU_L2_STEP 437500.0 /* Hz */
|
---|
| 95 | #define GLO_FREQU_L1(a) (GLO_FREQU_L1_BASE+(a)*GLO_FREQU_L1_STEP)
|
---|
| 96 | #define GLO_FREQU_L2(a) (GLO_FREQU_L2_BASE+(a)*GLO_FREQU_L2_STEP)
|
---|
| 97 | #define GLO_WAVELENGTH_L1(a) (LIGHTSPEED / GLO_FREQU_L1(a)) /* m */
|
---|
| 98 | #define GLO_WAVELENGTH_L2(a) (LIGHTSPEED / GLO_FREQU_L2(a)) /* m */
|
---|
| 99 |
|
---|
| 100 | /* Additional flags for the data field, which tell us more. */
|
---|
| 101 | #define GNSSDF_LOCKLOSSL1 (1<<29) /* lost lock on L1 */
|
---|
| 102 | #define GNSSDF_LOCKLOSSL2 (1<<30) /* lost lock on L2 */
|
---|
| 103 |
|
---|
[2236] | 104 | struct converttimeinfo {
|
---|
| 105 | int second; /* seconds of GPS time [0..59] */
|
---|
| 106 | int minute; /* minutes of GPS time [0..59] */
|
---|
| 107 | int hour; /* hour of GPS time [0..24] */
|
---|
| 108 | int day; /* day of GPS time [1..28..30(31)*/
|
---|
| 109 | int month; /* month of GPS time [1..12]*/
|
---|
| 110 | int year; /* year of GPS time [1980..] */
|
---|
| 111 | };
|
---|
| 112 |
|
---|
[1837] | 113 | struct gnssdata {
|
---|
| 114 | int flags; /* GPSF_xxx */
|
---|
| 115 | int week; /* week number of GPS date */
|
---|
| 116 | int numsats;
|
---|
| 117 | double timeofweek; /* milliseconds in GPS week */
|
---|
[2354] | 118 | double measdata[GNSS_MAXSATS][GNSSENTRY_NUMBER]; /* data fields */
|
---|
| 119 | int dataflags[GNSS_MAXSATS]; /* GPSDF_xxx */
|
---|
| 120 | int satellites[GNSS_MAXSATS]; /* SV - IDs */
|
---|
| 121 | int channels[GNSS_MAXSATS]; /* Glonass channels - valid of Glonass SV only */
|
---|
| 122 | int snrL1[GNSS_MAXSATS]; /* Important: all the 5 SV-specific fields must */
|
---|
| 123 | int snrL2[GNSS_MAXSATS]; /* have the same SV-order */
|
---|
[1837] | 124 | };
|
---|
| 125 |
|
---|
| 126 | #define GPSEPHF_L2PCODEDATA (1<<0) /* set, if NAV data OFF on L2 P-code, s1w4b01 */
|
---|
| 127 | #define GPSEPHF_L2PCODE (1<<1) /* set, if P-code available, s1w3b12 */
|
---|
| 128 | #define GPSEPHF_L2CACODE (1<<2) /* set, if CA-code available, s1w3b11 */
|
---|
| 129 | #define GPSEPHF_VALIDATED (1<<3) /* data is completely valid */
|
---|
| 130 |
|
---|
| 131 | #define R2R_PI 3.1415926535898
|
---|
| 132 |
|
---|
| 133 | struct gpsephemeris {
|
---|
| 134 | int flags; /* GPSEPHF_xxx */
|
---|
| 135 | int satellite; /* SV ID ICD-GPS data position */
|
---|
| 136 | int IODE; /* [s2w3b01-08] */
|
---|
| 137 | int URAindex; /* [1..15] [s1w3b13-16] */
|
---|
| 138 | int SVhealth; /* [s1w3b17-22] */
|
---|
| 139 | int GPSweek; /* [s1w3b01-10] */
|
---|
| 140 | int IODC; /* [s1w3b23-32,w8b01-08] */
|
---|
| 141 | int TOW; /* [s] [s1w2b01-17] */
|
---|
| 142 | int TOC; /* [s] [s1w8b09-24] */
|
---|
| 143 | int TOE; /* [s] [s2w10b1-16] */
|
---|
| 144 | double clock_bias; /* [s] [s1w10b1-22, af0] */
|
---|
| 145 | double clock_drift; /* [s/s] [s1w9b09-24, af1] */
|
---|
| 146 | double clock_driftrate; /* [s/s^2] [s1w9b01-08, af2] */
|
---|
| 147 | double Crs; /* [m] [s2w3b09-24] */
|
---|
| 148 | double Delta_n; /* [rad/s] [s2w4b01-16 * Pi] */
|
---|
| 149 | double M0; /* [rad] [s2w4b17-24,w5b01-24 * Pi]*/
|
---|
| 150 | double Cuc; /* [rad] [s2w6b01-16] */
|
---|
| 151 | double e; /* [s2w6b17-24,w6b01-24] */
|
---|
| 152 | double Cus; /* [rad] [s2w8b01-16] */
|
---|
| 153 | double sqrt_A; /* [m^0.5] [s2w8b16-24,w9b01-24] */
|
---|
| 154 | double Cic; /* [rad] [s3w3b01-16] */
|
---|
| 155 | double OMEGA0; /* [rad] [s3w3b17-24,w4b01-24 * Pi]*/
|
---|
| 156 | double Cis; /* [rad] [s3w5b01-16] */
|
---|
| 157 | double i0; /* [rad] [s3w5b17-24,w6b01-24 * Pi]*/
|
---|
| 158 | double Crc; /* [m] [s3w701-16] */
|
---|
| 159 | double omega; /* [rad] [s3w7b17-24,w8b01-24 * Pi]*/
|
---|
| 160 | double OMEGADOT; /* [rad/s] [s3w9b01-24 * Pi] */
|
---|
| 161 | double IDOT; /* [rad/s] [s3w10b9-22 * Pi] */
|
---|
| 162 | double TGD; /* [s] [s1w7b17-24] */
|
---|
| 163 | };
|
---|
| 164 |
|
---|
| 165 | #define GLOEPHF_UNHEALTHY (1<<0) /* set if unhealty satellite, f2b78 */
|
---|
| 166 | #define GLOEPHF_ALMANACHEALTHOK (1<<1) /* set if ALM health is available */
|
---|
| 167 | #define GLOEPHF_ALMANACHEALTHY (1<<2) /* set if Cn word is true */
|
---|
| 168 | #define GLOEPHF_PAVAILABLE (1<<3) /* set if the 3 P flags are available */
|
---|
| 169 | #define GLOEPHF_P10TRUE (1<<4)
|
---|
| 170 | #define GLOEPHF_P11TRUE (1<<5)
|
---|
| 171 | #define GLOEPHF_P2TRUE (1<<6)
|
---|
| 172 | #define GLOEPHF_P3TRUE (1<<7)
|
---|
| 173 |
|
---|
| 174 | struct glonassephemeris {
|
---|
| 175 | int GPSWeek;
|
---|
| 176 | int GPSTOW;
|
---|
| 177 | int flags; /* GLOEPHF_xxx */
|
---|
| 178 | int almanac_number;
|
---|
| 179 | int frequency_number; /* ICD-GLONASS data position */
|
---|
| 180 | int tb; /* [s] [f2b70-76] */
|
---|
| 181 | int tk; /* [s] [f1b65-76] */
|
---|
| 182 | int E; /* [days] [f4b49-53] */
|
---|
| 183 | double tau; /* [s] [f4b59-80] */
|
---|
| 184 | double gamma; /* [f3b69-79] */
|
---|
| 185 | double x_pos; /* [km] [f1b09-35] */
|
---|
| 186 | double x_velocity; /* [km/s] [f1b41-64] */
|
---|
| 187 | double x_acceleration; /* [km/s^2][f1b36-40] */
|
---|
| 188 | double y_pos; /* [km] [f2b09-35] */
|
---|
| 189 | double y_velocity; /* [km/s] [f2b41-64] */
|
---|
| 190 | double y_acceleration; /* [km/s^2][f2b36-40] */
|
---|
| 191 | double z_pos; /* [km] [f3b09-35] */
|
---|
| 192 | double z_velocity; /* [km/s] [f3b41-64] */
|
---|
| 193 | double z_acceleration; /* [km/s^2][f3b36-40] */
|
---|
| 194 | };
|
---|
| 195 |
|
---|
| 196 | struct RTCM3ParserData {
|
---|
| 197 | unsigned char Message[2048]; /* input-buffer */
|
---|
| 198 | int MessageSize; /* current buffer size */
|
---|
| 199 | int NeedBytes; /* bytes wanted for next run */
|
---|
| 200 | int SkipBytes; /* bytes to skip in next round */
|
---|
| 201 | int GPSWeek;
|
---|
| 202 | int GPSTOW; /* in seconds */
|
---|
| 203 | struct gnssdata Data;
|
---|
| 204 | struct gpsephemeris ephemerisGPS;
|
---|
| 205 | struct glonassephemeris ephemerisGLONASS;
|
---|
| 206 | struct gnssdata DataNew;
|
---|
| 207 | int size;
|
---|
| 208 | int lastlockl1[64];
|
---|
| 209 | int lastlockl2[64];
|
---|
| 210 | #ifdef NO_RTCM3_MAIN
|
---|
| 211 | double antX;
|
---|
| 212 | double antY;
|
---|
| 213 | double antZ;
|
---|
| 214 | double antH;
|
---|
| 215 | char antenna[256+1];
|
---|
| 216 | int blocktype;
|
---|
| 217 | #endif /* NO_RTCM3_MAIN */
|
---|
| 218 | int datapos[RINEXENTRY_NUMBER];
|
---|
| 219 | int dataflag[RINEXENTRY_NUMBER];
|
---|
| 220 | /* for RINEX2 GPS and GLO are both handled in GPS */
|
---|
| 221 | int dataposGPS[RINEXENTRY_NUMBER]; /* SBAS has same entries */
|
---|
| 222 | int dataflagGPS[RINEXENTRY_NUMBER];
|
---|
| 223 | int dataposGLO[RINEXENTRY_NUMBER]; /* only used for RINEX3 */
|
---|
| 224 | int dataflagGLO[RINEXENTRY_NUMBER];
|
---|
| 225 | int numdatatypesGPS;
|
---|
| 226 | int numdatatypesGLO; /* only used for RINEX3 */
|
---|
| 227 | int validwarning;
|
---|
| 228 | int init;
|
---|
| 229 | int startflags;
|
---|
| 230 | int rinex3;
|
---|
| 231 | const char * headerfile;
|
---|
| 232 | const char * glonassephemeris;
|
---|
| 233 | const char * gpsephemeris;
|
---|
| 234 | FILE *glonassfile;
|
---|
| 235 | FILE *gpsfile;
|
---|
| 236 | };
|
---|
| 237 |
|
---|
| 238 | #ifndef PRINTFARG
|
---|
| 239 | #ifdef __GNUC__
|
---|
| 240 | #define PRINTFARG(a,b) __attribute__ ((format(printf, a, b)))
|
---|
| 241 | #else /* __GNUC__ */
|
---|
| 242 | #define PRINTFARG(a,b)
|
---|
| 243 | #endif /* __GNUC__ */
|
---|
| 244 | #endif /* PRINTFARG */
|
---|
| 245 |
|
---|
| 246 | int gnumleap(int year, int month, int day);
|
---|
[2236] | 247 | void updatetime(int *week, int *tow, int tk, int fixnumleap);
|
---|
| 248 | void converttime(struct converttimeinfo *c, int week, int tow);
|
---|
| 249 |
|
---|
[1837] | 250 | void HandleHeader(struct RTCM3ParserData *Parser);
|
---|
| 251 | int RTCM3Parser(struct RTCM3ParserData *handle);
|
---|
| 252 | void HandleByte(struct RTCM3ParserData *Parser, unsigned int byte);
|
---|
| 253 | void PRINTFARG(1,2) RTCM3Error(const char *fmt, ...);
|
---|
| 254 | void PRINTFARG(1,2) RTCM3Text(const char *fmt, ...);
|
---|
| 255 |
|
---|
| 256 | #endif /* RTCM3TORINEX_H */
|
---|