mirror
/
RS-tracker
kopia lustrzana https://github.com/rs1729/RS
1
0
Forkuj 0
Kod Zgłoszenia Projekty Wydania Wiki Aktywność

rinex-Daten sollten wie brdc/hour-Daten von cddis/nasa sein

dump
Zilog80 2015-11-01 12:44:59 +01:00
rodzic 851160fe09
commit c41abc884c
1 zmienionych plików z 21 dodań i 13 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

34
rs92/nav_gps.c
Wyświetl plik

@ -71,7 +71,7 @@ typedef struct {
ui16_t prn; ui16_t prn;
ui16_t week; ui16_t week;
ui32_t toa; ui32_t toa;
char epoch[15]; char epoch[20];
double toe; double toe;
double toc; double toc;
double e; double e;
@ -108,6 +108,7 @@ typedef struct {
double X; double X;
double Y; double Y;
double Z; double Z;
int ephhr;
} SAT_t; } SAT_t;
@ -166,8 +167,9 @@ int read_SEMalmanac(FILE *fp, EPHEM_t *alm) {
int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) { int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) {
int l, i; int l, i;
char buf[64], str[20]; char buf[64], str[20];
char buf_header[81]; char buf_header[82];
//buf_data[80]; // 3 + 4*19 = 79 //buf_data[80]; // 3 + 4*19 = 79
char *pbuf;
unsigned ui; unsigned ui;
double dbl; double dbl;
int c; int c;
@ -175,16 +177,17 @@ int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) {
int hr = 0; int hr = 0;
do { do {
l = fread(buf_header, 81, 1, fp); // besser fgets()? was wenn \r\n? fopen in textmode //l = fread(buf_header, 81, 1, fp); // Zeilen in Header sind nicht immer mit Leerzeichen aufgefuellt
buf_header[80] = '\0'; // \n durch \0 ueberschreiben pbuf = fgets(buf_header, 82, fp); // max 82-1 Zeichen + '\0'
} while ( l == 1 && !strstr(buf_header, "END OF HEADER") ); buf_header[82] = '\0'; // doppelt haelt besser
if (l != 1) return -1; //l = strlen(buf_header);
} while ( pbuf && !strstr(buf_header, "END OF HEADER") );
//l = fread(buf_data, 80, 1, fp); //l = fread(buf_data, 80, 1, fp);
//buf_data[79] = '\0'; //buf_data[79] = '\0';
while (hr < 24) { while (hr < 24) { // brdc/hour-rinex sollte nur Daten von einem Tag enthalten
//memset(&ephem, 0, sizeof(ephem)); //memset(&ephem, 0, sizeof(ephem));
@ -192,11 +195,10 @@ int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) {
ephem.prn = ui; ephem.prn = ui;
for (i = 0; i < 14; i++) ephem.epoch[i] = '0'; for (i = 0; i < 16; i++) ephem.epoch[i] = '0';
ephem.epoch[14] = '\0'; ephem.epoch[16] = '\0';
l = fread(buf, 19, 1, fp); if (l != 1) break; buf[19] = 0; l = fread(buf, 19, 1, fp); if (l != 1) break; buf[19] = 0;
strncpy(ephem.epoch , "20", 2);
for (i = 0; i < 6; i++) { for (i = 0; i < 6; i++) {
c = buf[3*i ]; if (c == ' ') c = '0'; str[2*i ] = c; c = buf[3*i ]; if (c == ' ') c = '0'; str[2*i ] = c;
@ -206,7 +208,9 @@ int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) {
str[13] = buf[18]; str[13] = buf[18];
str[14] = '\0'; str[14] = '\0';
strncpy(ephem.epoch, str, 15); strncpy(ephem.epoch , "20", 2); // vorausgesetzt 21.Jhd; Datum steht auch im Header
strncpy(ephem.epoch+2, str, 15);
ephem.epoch[16] = '\0';
strncpy(str, buf+9, 2); str[2] = '\0'; strncpy(str, buf+9, 2); str[2] = '\0';
hr = atoi(str); hr = atoi(str);
@ -236,7 +240,7 @@ int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) {
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.cic = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.cic = dbl;
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.Omega0 = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.Omega0 = dbl;
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.cis = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.cis = dbl;
if ((c=fgetc(fp)) == EOF) break; //if (c != 0x0a) printf("%c", c); if ((c=fgetc(fp)) == EOF) break;
l = fread(buf, 3, 1, fp); if (l != 1) break; buf[ 3] = 0; l = fread(buf, 3, 1, fp); if (l != 1) break; buf[ 3] = 0;
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.i0 = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); ephem.i0 = dbl;
@ -261,14 +265,18 @@ int read_RNXephemeris(FILE *fp, EPHEM_t eph[][24]) {
l = fread(buf, 3, 1, fp); if (l != 1) break; buf[ 3] = 0; l = fread(buf, 3, 1, fp); if (l != 1) break; buf[ 3] = 0;
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.ttom = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.ttom = dbl;
pbuf = fgets(buf_header, 82, fp);
/* // die letzten beiden Felder (spare) sind manchmal leer (statt 0.00); manchmal fehlt sogar das drittletzte Feld
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.fit = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.fit = dbl;
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.spare1 = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.spare1 = dbl;
l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.spare2 = dbl; l = fread(buf, 19, 1, fp); if (l != 1) break; if (buf[15] == 'D') buf[15] = 'E'; buf[19] = 0; sscanf(buf, "%lf", &dbl); //ephem.spare2 = dbl;
if ((c=fgetc(fp)) == EOF) break; if ((c=fgetc(fp)) == EOF) break; */
ephem.week = 1; // ephem.gpsweek ephem.week = 1; // ephem.gpsweek
eph[ephem.prn][hr] = ephem; eph[ephem.prn][hr] = ephem;
if (pbuf == NULL) break;
} }
return 0; return 0;