/* * radiosonde iMet-1-RSB * Bell202 8N1 * open packet format * -> Appendix: Binary Radiosonde Packet Definition * ECC_Ozonesonde.pdf, O3_manual.pdf */ #include #include #ifdef CYGWIN #include // cygwin: _setmode() #include #endif typedef unsigned char ui8_t; typedef unsigned int ui32_t; int //option_verbose = 0, // ausfuehrliche Anzeige option_raw = 0, // rohe Frames option_inv = 0, // invertiert Signal wavloaded = 0; /* -------------------------------------------------------------------------- */ #define BAUD 1200 // iMet-1-RSB: BAUD 1200 /* 1200 Hz: lang -> 1 Schwingung pro bit 1 2200 Hz: kurz -> 2200/1200 Schwingungen pro bit 0 */ #define BIT01 0.71 #define SYNC 128 int sample_rate = 0, bits_sample = 0, channels = 0; float samples_per_bit = 0; int findstr(char *buff, char *str, int pos) { int i; for (i = 0; i < 4; i++) { if (buff[(pos+i)%4] != str[i]) break; } return i; } int read_wav_header(FILE *fp) { char txt[5] = "\0\0\0\0"; char buff[4]; int byte, p=0; char fmt_[5] = "fmt "; char data[5] = "data"; if (fread(txt, 1, 4, fp) < 4) return -1; if (strncmp(txt, "RIFF", 4)) return -1; // pos_WAVE = 8L if (fread(txt, 1, 4, fp) < 4) return -1; if (fread(txt, 1, 4, fp) < 4) return -1; if (strncmp(txt, "WAVE", 4)) return -1; // pos_fmt = 12L for ( ; ; ) { if ( (byte=fgetc(fp)) == EOF ) return -1; buff[p % 4] = byte; p++; if (p==4) p=0; if (findstr(buff, fmt_, p) == 4) break; } if (fread(buff, 1, 4, fp) < 4) return -1; if (fread(buff, 1, 2, fp) < 2) return -1; if (fread(buff, 1, 2, fp) < 2) return -1; channels = buff[0] + (buff[1] << 8); if (fread(buff, 1, 4, fp) < 4) return -1; memcpy(&sample_rate, buff, 4); if (fread(buff, 1, 4, fp) < 4) return -1; if (fread(buff, 1, 2, fp) < 2) return -1; byte = buff[0] + (buff[1] << 8); if (fread(buff, 1, 2, fp) < 2) return -1; bits_sample = buff[0] + (buff[1] << 8); for ( ; ; ) { if ( (byte=fgetc(fp)) == EOF ) return -1; buff[p % 4] = byte; p++; if (p==4) p=0; if (findstr(buff, data, p) == 4) break; } if (fread(buff, 1, 4, fp) < 4) return -1; fprintf(stderr, "sample_rate: %d\n", sample_rate); fprintf(stderr, "bits : %d\n", bits_sample); fprintf(stderr, "channels : %d\n", channels); if ((bits_sample != 8) && (bits_sample != 16)) return -1; samples_per_bit = sample_rate/(float)BAUD; fprintf(stderr, "samples/bit: %.2f\n", samples_per_bit); return 0; } #define EOF_INT 0x1000000 int read_signed_sample(FILE *fp) { // int = i32_t int byte, i, ret; // EOF -> 0x1000000 for (i = 0; i < channels; i++) { // i = 0: links bzw. mono byte = fgetc(fp); if (byte == EOF) return EOF_INT; if (i == 0) ret = byte; if (bits_sample == 16) { byte = fgetc(fp); if (byte == EOF) return EOF_INT; if (i == 0) ret += byte << 8; } } if (bits_sample == 8) return ret-128; if (bits_sample == 16) return (short)ret; return ret; } int par=-1, par_alt=-1; unsigned long sample_count = 0; int read_bits(FILE *fp, char *Bit, float *l) { int n; static int sample; n = 0; do{ sample = read_signed_sample(fp); if (sample == EOF_INT) return EOF; if (option_inv) sample = -sample; sample_count++; par_alt = par; par = (sample >= 0) ? 1 : -1; n++; } while (par*par_alt > 0); *l = (float)n / (samples_per_bit/2.0); //fprintf(stderr, " %.1f\n", *l); if (*l >= BIT01) { if (par_alt < 0) *Bit = 'D'; else *Bit = 'U'; } else if (*l > 0.1) { if (par_alt < 0) *Bit = 'd'; else *Bit = 'u'; } else *l = 0; //*len = (int)(l+0.5); // round(l) return 0; } /* -------------------------------------------------------------------------- */ int crc16poly = 0x1021; // CRC16-CCITT int crc16(ui8_t bytes[], int len) { int rem = 0x1D0F; // initial value int i, j; for (i = 0; i < len; i++) { rem = rem ^ (bytes[i] << 8); for (j = 0; j < 8; j++) { if (rem & 0x8000) { rem = (rem << 1) ^ crc16poly; } else { rem = (rem << 1); } rem &= 0xFFFF; } } return rem; } /* -------------------------------------------------------------------------- */ #define FRAMELEN 150 ui8_t frame[FRAMELEN+6]; ui8_t bitframe[BAUD+10]; /* GPS Data Packet offset bytes description 0 1 SOH = 0x01 1 1 PKT_ID = 0x02 2 4 Latitude, +/- deg (float) 6 4 Longitude, +/- deg (float) 10 2 Altitude, meters (Alt = n-5000) 12 1 nSat (0 - 12) 13 3 Time (hr,min,sec) 16 2 CRC (16-bit) packet size = 18 bytes */ #define pos_GPSlat 0x02 // 4 byte float #define pos_GPSlon 0x06 // 4 byte float #define pos_GPSalt 0x0A // 2 byte int #define pos_GPStim 0x0D // 3 byte #define pos_GPScrc 0x10 // 2 byte void print_GPS(int pos) { float lat, lon; int alt; int std, min, sek; int crc1, crc2; crc1 = ((frame+pos)[pos_GPScrc] << 8) | (frame+pos)[pos_GPScrc+1]; crc2 = crc16(frame+pos, pos_GPScrc); // len=pos lat = *(float*)(frame+pos+pos_GPSlat); lon = *(float*)(frame+pos+pos_GPSlon); alt = ((frame+pos)[pos_GPSalt+1]<<8)+(frame+pos)[pos_GPSalt] - 5000; std = (frame+pos)[pos_GPStim+0]; min = (frame+pos)[pos_GPStim+1]; sek = (frame+pos)[pos_GPStim+2]; fprintf(stdout, "(%02d:%02d:%02d) ", std, min, sek); fprintf(stdout, " lat: %.6f° ", lat); fprintf(stdout, " lon: %.6f° ", lon); fprintf(stdout, " alt: %dm ", alt); fprintf(stdout, " # "); fprintf(stdout, " CRC: %04X ", crc1); fprintf(stdout, "- %04X ", crc2); if (crc1 == crc2) fprintf(stdout, "[OK]"); else fprintf(stdout, "[NO]"); } /* PTU (enhanced) Data Packet offset bytes description 0 1 SOH = 0x01 1 1 PKT_ID = 0x04 2 2 PKT = packet number 4 3 P, mbs (P = n/100) 7 2 T, °C (T = n/100) 9 2 U, % (U = n/100) 11 1 Vbat, V (V = n/10) 12 2 Tint, °C (Tint = n/100) 14 2 Tpr, °C (Tpr = n/100) 16 2 Tu, °C (Tu = n/100) 18 2 CRC (16-bit) packet size = 20 bytes */ #define pos_PCKnum 0x02 // 2 byte #define pos_PTUprs 0x04 // 3 byte #define pos_PTUtem 0x07 // 2 byte int #define pos_PTUhum 0x09 // 2 byte #define pos_PTUbat 0x0B // 1 byte #define pos_PTUcrc 0x12 // 2 byte void print_ePTU(int pos) { int P, U; short T; int bat, pcknum; int crc1, crc2; crc1 = ((frame+pos)[pos_PTUcrc] << 8) | (frame+pos)[pos_PTUcrc+1]; crc2 = crc16(frame+pos, pos_PTUcrc); // len=pos P = (frame+pos)[pos_PTUprs] | ((frame+pos)[pos_PTUprs+1]<<8) | ((frame+pos)[pos_PTUprs+2]<<16); T = (frame+pos)[pos_PTUtem] | ((frame+pos)[pos_PTUtem+1]<<8); U = (frame+pos)[pos_PTUhum] | ((frame+pos)[pos_PTUhum+1]<<8); bat = (frame+pos)[pos_PTUbat]; pcknum = (frame+pos)[pos_PCKnum] | ((frame+pos)[pos_PCKnum+1]<<8); fprintf(stdout, "[%d] ", pcknum); fprintf(stdout, " P:%.2fmb ", P/100.0); fprintf(stdout, " T:%.2f°C ", T/100.0); fprintf(stdout, " U:%.2f%% ", U/100.0); fprintf(stdout, " bat:%.1fV ", bat/10.0); fprintf(stdout, " # "); fprintf(stdout, " CRC: %04X ", crc1); fprintf(stdout, "- %04X ", crc2); if (crc1 == crc2) fprintf(stdout, "[OK]"); else fprintf(stdout, "[NO]"); } /* -------------------------------------------------------------------------- */ int bits2byte(ui8_t *bits) { int i, d = 1, byte = 0; for (i = 0; i < 8; i++) { // little endian if (bits[i] == 1) byte += d; else if (bits[i] == 0) byte += 0; d <<= 1; } return byte & 0xFF; } int print_frame(int len) { int i; int byte; //int err = 0; if ( len < 2 || len > FRAMELEN) return -1; for (i = len; i < FRAMELEN; i++) frame[i] = 0; for (i = 0; i < len; i++) { byte = bits2byte(bitframe+10*i+2); frame[i] = byte; //printf("%02X ", byte); } if (option_raw) { fprintf(stdout, "\n"); // for (i = 0; i < len; i++) { fprintf(stdout, "%02x ", frame[i]); } fprintf(stdout, "\n"); } //else { if ((frame[0] == 0x01) && (frame[1] == 0x02)) { // GPS Data Packet print_GPS(0x00); // packet offset in frame fprintf(stdout, "\n"); } if ((frame[pos_GPScrc+2+0] == 0x01) && (frame[pos_GPScrc+2+1] == 0x04)) { // PTU Data Packet print_ePTU(pos_GPScrc+2); // packet offset in frame fprintf(stdout, "\n"); } /* if ((frame[0] == 0x01) && (frame[1] == 0x04)) { // PTU Data Packet print_ePTU(0x00); // packet offset in frame fprintf(stdout, "\n"); } */ } return 0; } int main(int argc, char **argv) { FILE *fp; char *fpname; int i, len; int bitpos = 0, bit_ = 0, bit; char Bit = 0 /*,Bit0*/; float l = 0, l0 = 0, bitslen = 0; #ifdef CYGWIN _setmode(fileno(stdin), _O_BINARY); // _setmode(_fileno(stdin), _O_BINARY); setbuf(stdout, NULL); #endif fpname = argv[0]; ++argv; while ((*argv) && (!wavloaded)) { if ( (strcmp(*argv, "-h") == 0) || (strcmp(*argv, "--help") == 0) ) { fprintf(stderr, "%s [options] audio.wav\n", fpname); fprintf(stderr, " options:\n"); fprintf(stderr, " -r, --raw\n"); return 0; } /* else if ( (strcmp(*argv, "-v") == 0) || (strcmp(*argv, "--verbose") == 0) ) { option_verbose = 1; } */ else if ( (strcmp(*argv, "-r") == 0) || (strcmp(*argv, "--raw") == 0) ) { option_raw = 1; } else if ( (strcmp(*argv, "-i") == 0) || (strcmp(*argv, "--invert") == 0) ) { option_inv = 1; } else { fp = fopen(*argv, "rb"); if (fp == NULL) { fprintf(stderr, "%s konnte nicht geoeffnet werden\n", *argv); return -1; } wavloaded = 1; } ++argv; } if (!wavloaded) fp = stdin; i = read_wav_header(fp); if (i) { fclose(fp); return -1; } bitpos = 0; while (!read_bits(fp, &Bit, &l)) { if (l < 0.1) { bitslen = 0; continue; } if ((l0 < BIT01 && l < BIT01) || (l0 >= BIT01 && l >= BIT01)) { bitslen += l; } else { //fprintf(stderr, " %.1f\n", bitslen); if (Bit < 'a') bit = 0; else bit = 1; // gesucht ist Bit zuvor len = (int)(bitslen+0.5); if (len < SYNC) { for (i = 0; i < len/2; i++) { //printf("%d", bit); if (bitpos < BAUD+10) { bitframe[bitpos] = bit; } else { /* */ } bitpos++; } //printf(" %.1f=%d ", bitslen, len); } bitslen = l; } l0 = l; if (Bit < 'a') { bit_++; } else { if (bit_> SYNC) { if (bitpos < BAUD) print_frame((bitpos+7)/10); bitframe[0] = 1; bitpos = 1; //printf("\n1"); } bit_ = 0; } } printf("\n"); fclose(fp); return 0; }