source: ntrip/trunk/BNS/RTCM/rtcm3torinex.h@ 2382

Last change on this file since 2382 was 2354, checked in by weber, 15 years ago

* empty log message *
File size: 10.5 KB
Line 
1#ifndef RTCM3TORINEX_H
2#define RTCM3TORINEX_H
3
4/*
5 Converter for RTCM3 data to RINEX.
6 $Id: rtcm3torinex.h,v 1.12 2010/03/05 11:11:06 stoecker Exp $
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
27#define GNSS_MAXSATS 64
28
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
104struct 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
113struct gnssdata {
114 int flags; /* GPSF_xxx */
115 int week; /* week number of GPS date */
116 int numsats;
117 double timeofweek; /* milliseconds in GPS week */
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 */
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
133struct 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
174struct 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
196struct 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
246int gnumleap(int year, int month, int day);
247void updatetime(int *week, int *tow, int tk, int fixnumleap);
248void converttime(struct converttimeinfo *c, int week, int tow);
249
250void HandleHeader(struct RTCM3ParserData *Parser);
251int RTCM3Parser(struct RTCM3ParserData *handle);
252void HandleByte(struct RTCM3ParserData *Parser, unsigned int byte);
253void PRINTFARG(1,2) RTCM3Error(const char *fmt, ...);
254void PRINTFARG(1,2) RTCM3Text(const char *fmt, ...);
255
256#endif /* RTCM3TORINEX_H */
Note: See TracBrowser for help on using the repository browser.