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

Meisei: ims-100 SN for json-output

pull/18/head
Zilog80 2019-09-07 22:08:34 +02:00
rodzic 0286740612
commit 9f7ac6c3ee
2 zmienionych plików z 97 dodań i 47 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

8
meisei/meisei-rs.txt
Wyświetl plik

@ -58,7 +58,8 @@ Variante 2 (iMS-100 ?)
0x00..0x02 HEADER 0x049DCE 0x00..0x02 HEADER 0x049DCE
0x03..0x04 16 bit 0.5s-counter, count%2=0: 0x03..0x04 16 bit 0.5s-counter, count%2=0:
0x11..0x12 30xx, xx=C1(ims100?),A2(rg11?) 0x07..0x0A 32 bit cfg[cnt%64] (float32); cfg[0,16,32,48]=SN
0x11..0x12 30xx, xx=C1(ims100?),A2(rs11?)
0x17..0x18 16 bit time ms yyxx, 00.000-59.000 0x17..0x18 16 bit time ms yyxx, 00.000-59.000
0x19..0x1A 16 bit time hh:mm 0x19..0x1A 16 bit time hh:mm
0x1B..0x1D HEADER 0xFB6230 0x1B..0x1D HEADER 0xFB6230
@ -71,10 +72,11 @@ Variante 2 (iMS-100 ?)
0x00..0x02 HEADER 0x049DCE 0x00..0x02 HEADER 0x049DCE
0x03..0x04 16 bit 0.5s-counter, count%2=1: 0x03..0x04 16 bit 0.5s-counter, count%2=1:
0x11..0x12 31xx, xx=C1(ims100?),A2(rg11?) 0x07..0x0A 32 bit cfg[cnt%64] (float32); freq=400e3+cfg[15]*1e2/kHz
0x11..0x12 31xx, xx=C1(ims100?),A2(rs11?)
0x17..0x18 16 bit 1024-counter yyxx, +0x400=1024; rollover synchron zu ms-counter, nach rollover auch +0x300=768 0x17..0x18 16 bit 1024-counter yyxx, +0x400=1024; rollover synchron zu ms-counter, nach rollover auch +0x300=768
0x1B..0x1D HEADER 0xFB6230 0x1B..0x1D HEADER 0xFB6230
0x22..0x23 yy00..yy03 (config?, fast constant, manchmal verschoben) 0x22..0x23 yy00..yy03 (yy00: GPS PRN?)

136
meisei/meisei_ims.c
Wyświetl plik

@ -44,7 +44,8 @@ Variante 2 (iMS-100 ?)
0x00..0x02 HEADER 0x049DCE 0x00..0x02 HEADER 0x049DCE
0x03..0x04 16 bit 0.5s-counter, count%2=0: 0x03..0x04 16 bit 0.5s-counter, count%2=0:
0x11..0x12 30xx, xx=C1(ims100?),A2(rg11?) 0x07..0x0A 32 bit cfg[cnt%64] (float32); cfg[0,16,32,48]=SN
0x11..0x12 30xx, xx=C1(ims100?),A2(rs11?)
0x17..0x18 16 bit time ms yyxx, 00.000-59.000 0x17..0x18 16 bit time ms yyxx, 00.000-59.000
0x19..0x1A 16 bit time hh:mm 0x19..0x1A 16 bit time hh:mm
0x1B..0x1D HEADER 0xFB6230 0x1B..0x1D HEADER 0xFB6230
@ -57,10 +58,11 @@ Variante 2 (iMS-100 ?)
0x00..0x02 HEADER 0x049DCE 0x00..0x02 HEADER 0x049DCE
0x03..0x04 16 bit 0.5s-counter, count%2=1: 0x03..0x04 16 bit 0.5s-counter, count%2=1:
0x11..0x12 31xx, xx=C1(ims100?),A2(rg11?) 0x07..0x0A 32 bit cfg[cnt%64] (float32); freq=400e3+cfg[15]*1e2/kHz
0x11..0x12 31xx, xx=C1(ims100?),A2(rs11?)
0x17..0x18 16 bit 1024-counter yyxx, +0x400=1024; rollover synchron zu ms-counter, nach rollover auch +0x300=768 0x17..0x18 16 bit 1024-counter yyxx, +0x400=1024; rollover synchron zu ms-counter, nach rollover auch +0x300=768
0x1B..0x1D HEADER 0xFB6230 0x1B..0x1D HEADER 0xFB6230
0x22..0x23 yy00..yy03 (config?, fast constant, manchmal verschoben) 0x22..0x23 yy00..yy03 (yy00: GPS PRN?)
Die 46bit-Bloecke sind BCH-Codewoerter. Es handelt sich um einen (63,51)-Code mit Generatorpolynom Die 46bit-Bloecke sind BCH-Codewoerter. Es handelt sich um einen (63,51)-Code mit Generatorpolynom
@ -99,6 +101,10 @@ typedef struct {
double lat; double lon; double alt; double lat; double lon; double alt;
double vH; double vD; double vV; double vH; double vD; double vV;
ui32_t ecc; ui32_t ecc;
float cfg[64];
ui32_t _sn;
float sn; // 0 mod 16
float fq; // 15 mod 64
} gpx_t; } gpx_t;
gpx_t gpx; gpx_t gpx;
@ -304,8 +310,8 @@ int read_rawbit(FILE *fp, int *bit) {
#define RAWBITFRAME_LEN (BITFRAME_LEN*2) #define RAWBITFRAME_LEN (BITFRAME_LEN*2)
char frame_rawbits[RAWBITFRAME_LEN+10]; // braucht eigentlich nur 1/2 (vormals 1/4) char frame_rawbits[RAWBITFRAME_LEN+10]; // braucht eigentlich nur 1/2 (vormals 1/4)
char frame_bits[BITFRAME_LEN+10]; ui8_t frame_bits[BITFRAME_LEN+10];
char *subframe_bits; ui8_t *subframe_bits;
#define HEADLEN 24 #define HEADLEN 24
#define RAWHEADLEN (2*HEADLEN) #define RAWHEADLEN (2*HEADLEN)
@ -383,7 +389,6 @@ int compare_subheader() {
} }
/* -------------------------------------------------------------------------- */ /* -------------------------------------------------------------------------- */
int biphi_s(char* frame_rawbits, ui8_t *frame_bits) { int biphi_s(char* frame_rawbits, ui8_t *frame_bits) {
@ -461,6 +466,9 @@ int main(int argc, char **argv) {
double latmin, lonmin; double latmin, lonmin;
ui32_t t1, t2, ms, min, std, tt, mm, jj; ui32_t t1, t2, ms, min, std, tt, mm, jj;
float sn = -1;
float fq = -1;
#ifdef CYGWIN #ifdef CYGWIN
_setmode(fileno(stdin), _O_BINARY); // _setmode(_fileno(stdin), _O_BINARY); _setmode(fileno(stdin), _O_BINARY); // _setmode(_fileno(stdin), _O_BINARY);
@ -562,6 +570,11 @@ int main(int argc, char **argv) {
if (!header_found) { if (!header_found) {
header_found = compare_subheader(); header_found = compare_subheader();
/* //type 1: detect GPS position in FB6230 first
if ( header_found % 2 == 0 && !option2 //header0xFB6230
|| header_found % 2 == 1 && option2 ) { //header0x049DCE
*/
if (header_found % 2 == 1) { //header0x049DCE if (header_found % 2 == 1) { //header0x049DCE
bit_count = 0; bit_count = 0;
for (j = 0; j < HEADLEN; j++) { for (j = 0; j < HEADLEN; j++) {
@ -570,6 +583,7 @@ int main(int argc, char **argv) {
} }
} }
else header_found = 0; else header_found = 0;
} }
else { else {
frame_rawbits[bit_count] = 0x30 + bit; frame_rawbits[bit_count] = 0x30 + bit;
@ -596,7 +610,7 @@ int main(int argc, char **argv) {
err_frm = 0; err_frm = 0;
for (subframe = 0; subframe < 2; subframe++) for (subframe = 0; subframe < 2; subframe++)
{ { // option2:
subframe_bits = frame_bits; // subframe 0: 049DCE subframe_bits = frame_bits; // subframe 0: 049DCE
if (subframe > 0) subframe_bits += BITFRAME_LEN/4; // subframe 1: FB6230 if (subframe > 0) subframe_bits += BITFRAME_LEN/4; // subframe 1: FB6230
@ -637,14 +651,21 @@ int main(int argc, char **argv) {
} }
if (!option2 && !option_raw) { if (!option2 && !option_raw) {
jmpRS11:
if (header_found % 2 == 1) { if (header_found % 2 == 1)
{
val = bits2val(subframe_bits+HEADLEN, 16); val = bits2val(subframe_bits+HEADLEN, 16);
counter = val & 0xFFFF; counter = val & 0xFFFF;
if (counter % 2 == 0) printf("\n");
//printf("[0x%04X = %d] ", counter, counter);
printf("[%d] ", counter); printf("[%d] ", counter);
// 0x30yy, 0x31yy
val = bits2val(subframe_bits+HEADLEN+46*3+17, 16);
if ( (val & 0xFF) >= 0xC0 && err_frm == 0) {
option2 = 1;
printf("\n");
goto jmpIMS;
}
if (counter % 2 == 1) { if (counter % 2 == 1) {
t2 = bits2val(subframe_bits+HEADLEN+5*46 , 8); // LSB t2 = bits2val(subframe_bits+HEADLEN+5*46 , 8); // LSB
t1 = bits2val(subframe_bits+HEADLEN+5*46+8, 8); t1 = bits2val(subframe_bits+HEADLEN+5*46+8, 8);
@ -653,16 +674,13 @@ int main(int argc, char **argv) {
min = bits2val(subframe_bits+HEADLEN+5*46+25, 8); min = bits2val(subframe_bits+HEADLEN+5*46+25, 8);
printf(" "); printf(" ");
printf("%02d:%02d:%06.3f ", std, min, (double)ms/1000.0); printf("%02d:%02d:%06.3f ", std, min, (double)ms/1000.0);
printf(" "); printf("\n");
//printf("\n");
} }
} }
if (header_found % 2 == 0) { if (header_found % 2 == 0)
val = bits2val(subframe_bits+HEADLEN, 16); {
//printf("%04x ", val & 0xFFFF); if ((counter % 2 == 0)) {
if ((counter % 2 == 0)) { // (val & 0xFFFF) > 0) {// == 0x8080
//offset=24+16+1; //offset=24+16+1;
lat1 = bits2val(subframe_bits+HEADLEN+46*0+17, 16); lat1 = bits2val(subframe_bits+HEADLEN+46*0+17, 16);
@ -692,24 +710,46 @@ int main(int argc, char **argv) {
jj = bits2val(subframe_bits+HEADLEN+5*46+ 8, 8) + 0x0700; jj = bits2val(subframe_bits+HEADLEN+5*46+ 8, 8) + 0x0700;
mm = bits2val(subframe_bits+HEADLEN+5*46+17, 8); mm = bits2val(subframe_bits+HEADLEN+5*46+17, 8);
tt = bits2val(subframe_bits+HEADLEN+5*46+25, 8); tt = bits2val(subframe_bits+HEADLEN+5*46+25, 8);
printf(" "); printf(" %4d-%02d-%02d ", jj, mm, tt);
printf("%4d-%02d-%02d ", jj, mm, tt); printf("\n");
printf(" ");
//printf("\n");
} }
} }
} }
else if (option2 && !option_raw) { else if (option2 && !option_raw) { // iMS-100
jmpIMS:
if (header_found % 2 == 1) { // 049DCE if (header_found % 2 == 1) { // 049DCE
ui16_t w16[2];
ui32_t w32;
float *fcfg = (float *)&w32;
// 0x30C1, 0x31C1
val = bits2val(subframe_bits+HEADLEN+46*3+17, 16);
if ( (val & 0xFF) < 0xC0 && err_frm == 0) {
option2 = 0;
printf("\n");
goto jmpRS11;
}
val = bits2val(subframe_bits+HEADLEN, 16); val = bits2val(subframe_bits+HEADLEN, 16);
counter = val & 0xFFFF; counter = val & 0xFFFF;
//if (counter % 2 == 0) printf("\n");
if (counter % 2 == 0) printf("[%d] ", counter); if (counter % 2 == 0) printf("[%d] ", counter);
w16[0] = bits2val(subframe_bits+HEADLEN+46*1 , 16);
w16[1] = bits2val(subframe_bits+HEADLEN+46*1+17, 16);
w32 = (w16[1]<<16) | w16[0];
if (err_frm == 0) // oder kleineren subblock pruefen
{
gpx.cfg[counter%64] = *fcfg;
// (main?) SN
if (counter % 0x10 == 0) { sn = *fcfg; gpx.sn = sn; gpx._sn = w32; }
// freq
if (counter % 64 == 15) { fq = 400e3+(*fcfg)*100.0; gpx.fq = fq; }
}
if (counter % 2 == 0) { if (counter % 2 == 0) {
gpx.frnr = counter; gpx.frnr = counter;
t1 = bits2val(subframe_bits+HEADLEN+5*46 , 8); // MSB t1 = bits2val(subframe_bits+HEADLEN+5*46 , 8); // MSB
@ -726,10 +766,9 @@ int main(int argc, char **argv) {
} }
} }
if (header_found % 2 == 0) { // FB6230 if (header_found % 2 == 0) // FB6230
val = bits2val(subframe_bits+HEADLEN, 16); {
//printf("%04x ", val & 0xFFFF); if ((counter % 2 == 0)) {
if ((counter % 2 == 0)) { // (val & 0xFFFF) > 0) {// == 0x2390
//offset=24+16+1; //offset=24+16+1;
dat2 = bits2val(subframe_bits+HEADLEN, 16); dat2 = bits2val(subframe_bits+HEADLEN, 16);
@ -758,36 +797,45 @@ int main(int argc, char **argv) {
gpx.lat = (double)latdeg+latmin; gpx.lat = (double)latdeg+latmin;
gpx.lon = (double)londeg+lonmin; gpx.lon = (double)londeg+lonmin;
gpx.alt = (double)alt/1e2; gpx.alt = (double)alt/1e2;
//printf("%08X %08X %08X : ", lat, lon, alt);
printf(" "); printf(" ");
printf("lat: %.5f lon: %.5f alt: %.2f", gpx.lat, gpx.lon, gpx.alt); printf("lat: %.5f lon: %.5f alt: %.2f", gpx.lat, gpx.lon, gpx.alt);
printf(" "); printf(" ");
ui16_t vD = bits2val(subframe_bits+HEADLEN+46*4+17, 16); vD = bits2val(subframe_bits+HEADLEN+46*4+17, 16);
ui16_t vX = bits2val(subframe_bits+HEADLEN+46*5 , 16); vH = bits2val(subframe_bits+HEADLEN+46*5 , 16);
//i16_t vU = bits2val(subframe_bits+HEADLEN+46*5+17, 16); velD = (double)vD/1e2; // course, true
double velD = (double)vD/1e2; // course, true velH = (double)vH/1.94384e2; // knots -> m/s
double velX = (double)vX/1.94384e2; // knots -> m/s gpx.vH = velH;
//double velU = (double)vU/1e3;
gpx.vH = velX;
gpx.vD = velD; gpx.vD = velD;
//printf(" (course=%.1f speed=%.2fm/s)", velD, velX);
printf(" (vH: %.1fm/s D: %.2f)", gpx.vH, gpx.vD); printf(" (vH: %.1fm/s D: %.2f)", gpx.vH, gpx.vD);
//printf(" %.2fm/s %.1f %.2fm/s", velH, velD, velU);
printf(" "); printf(" ");
} }
if (counter % 2 == 0) { if (counter % 2 == 0) {
if (option_ecc) { if (option_ecc) {
printf(" ");
if (err_frm) printf("[NO]"); else printf("[OK]"); if (err_frm) printf("[NO]"); else printf("[OK]");
} }
if (option_verbose) {
if (sn > 0) {
printf(" : sn %.0f", sn);
sn = -1;
}
if (fq > 0) {
printf(" : fq %.1f MHz", fq/1e3);
fq = -1;
}
}
printf("\n"); printf("\n");
if (option_jsn && err_frm==0) { if (option_jsn && err_frm==0) {
printf("{ \"frame\": %d, \"id\": \"IMS100\", \"datetime\": \"%04d-%02d-%02dT%02d:%02d:%06.3fZ\", \"lat\": %.5f, \"lon\": %.5f, \"alt\": %.5f, \"vel_h\": %.5f, \"heading\": %.5f }\n", printf("{ \"frame\": %d, \"id\": \"IMS100-%.0f\", \"datetime\": \"%04d-%02d-%02dT%02d:%02d:%06.3fZ\", \"lat\": %.5f, \"lon\": %.5f, \"alt\": %.5f, \"vel_h\": %.5f, \"heading\": %.5f }\n",
gpx.frnr, gpx.jahr, gpx.monat, gpx.tag, gpx.std, gpx.min, gpx.sek, gpx.lat, gpx.lon, gpx.alt, gpx.vH, gpx.vD ); gpx.frnr, gpx.sn, gpx.jahr, gpx.monat, gpx.tag, gpx.std, gpx.min, gpx.sek, gpx.lat, gpx.lon, gpx.alt, gpx.vH, gpx.vD );
printf("\n"); printf("\n");
} }
} }
} }
@ -821,9 +869,9 @@ int main(int argc, char **argv) {
} }
bit_count = 0; bit_count = 0;
header_found = 0; header_found += 1;
} }
header_found = 0;
} }
} }
} }