kopia lustrzana https://github.com/rs1729/RS
DFM06: source
rodzic
7f536e1a07
commit
e3360b193f
|
@ -0,0 +1,600 @@
|
|||
|
||||
/*
|
||||
*
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
|
||||
#ifdef CYGWIN
|
||||
#include <fcntl.h> // cygwin: _setmode()
|
||||
#include <io.h>
|
||||
#endif
|
||||
|
||||
|
||||
typedef unsigned char ui8_t;
|
||||
typedef unsigned int ui32_t;
|
||||
|
||||
typedef struct {
|
||||
int frnr;
|
||||
int sonde_id;
|
||||
int week; int gpssec;
|
||||
int jahr; int monat; int tag;
|
||||
int std; int min; float sek;
|
||||
double lat; double lon; double h;
|
||||
double dir; double horiV; double vertV;
|
||||
} gpx_t;
|
||||
|
||||
gpx_t gpx;
|
||||
|
||||
char dat_str[9][13+1];
|
||||
|
||||
|
||||
int option_verbose = 0, // ausfuehrliche Anzeige
|
||||
option_raw = 0, // rohe Frames
|
||||
option_inv = 0, // invertiert Signal
|
||||
option_auto = 0,
|
||||
wavloaded = 0;
|
||||
int inv = 1;
|
||||
|
||||
int start = 0;
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
#define BAUD_RATE 2500
|
||||
|
||||
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[4+1] = "\0\0\0\0";
|
||||
unsigned char dat[4];
|
||||
int byte, p=0;
|
||||
|
||||
if (fread(txt, 1, 4, fp) < 4) return -1;
|
||||
if (strncmp(txt, "RIFF", 4)) return -1;
|
||||
if (fread(txt, 1, 4, fp) < 4) return -1;
|
||||
// pos_WAVE = 8L
|
||||
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;
|
||||
txt[p % 4] = byte;
|
||||
p++; if (p==4) p=0;
|
||||
if (findstr(txt, "fmt ", p) == 4) break;
|
||||
}
|
||||
if (fread(dat, 1, 4, fp) < 4) return -1;
|
||||
if (fread(dat, 1, 2, fp) < 2) return -1;
|
||||
|
||||
if (fread(dat, 1, 2, fp) < 2) return -1;
|
||||
channels = dat[0] + (dat[1] << 8);
|
||||
|
||||
if (fread(dat, 1, 4, fp) < 4) return -1;
|
||||
memcpy(&sample_rate, dat, 4); //sample_rate = dat[0]|(dat[1]<<8)|(dat[2]<<16)|(dat[3]<<24);
|
||||
|
||||
if (fread(dat, 1, 4, fp) < 4) return -1;
|
||||
if (fread(dat, 1, 2, fp) < 2) return -1;
|
||||
//byte = dat[0] + (dat[1] << 8);
|
||||
|
||||
if (fread(dat, 1, 2, fp) < 2) return -1;
|
||||
bits_sample = dat[0] + (dat[1] << 8);
|
||||
|
||||
// pos_dat = 36L + info
|
||||
for ( ; ; ) {
|
||||
if ( (byte=fgetc(fp)) == EOF ) return -1;
|
||||
txt[p % 4] = byte;
|
||||
p++; if (p==4) p=0;
|
||||
if (findstr(txt, "data", p) == 4) break;
|
||||
}
|
||||
if (fread(dat, 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_RATE;
|
||||
|
||||
fprintf(stderr, "samples/bit: %.2f\n", samples_per_bit);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int par=1, par_alt=1;
|
||||
unsigned long sample_count = 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; // 8bit: 00..FF, centerpoint 0x80=128
|
||||
if (bits_sample == 16) return (short)ret;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int read_bits_fsk(FILE *fp, int *bit, int *len) {
|
||||
static int sample;
|
||||
int n;
|
||||
float l;
|
||||
|
||||
n = 0;
|
||||
do{
|
||||
sample = read_signed_sample(fp);
|
||||
if (sample == EOF_INT) return EOF;
|
||||
if (option_inv) sample = -sample; // 8bit: -sample-1
|
||||
sample_count++;
|
||||
par_alt = par;
|
||||
par = (sample >= 0) ? 1 : -1; // 8bit: 0..127,128..255 (-128..-1,0..127)
|
||||
n++;
|
||||
} while (par*par_alt > 0);
|
||||
|
||||
l = (float)n / samples_per_bit;
|
||||
|
||||
*len = (int)(l+0.5);
|
||||
|
||||
if (inv > 0) *bit = (1+par_alt)/2; // oben 1, unten -1
|
||||
else *bit = (1-par_alt)/2; // sdr#<rev1381?, invers: unten 1, oben -1
|
||||
// *bit = (1+inv*par_alt)/2; // ausser inv=0
|
||||
|
||||
/* Y-offset ? */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
//#define BITS (2*(8)) // 16
|
||||
#define HEADLEN 32 // HEADLEN+HEADOFS=32 <= strlen(header)
|
||||
#define HEADOFS 0
|
||||
char header[] = "01100101011001101010010110101010";
|
||||
|
||||
char buf[HEADLEN+1] = "xxxxxxxxxx\0";
|
||||
int bufpos = -1;
|
||||
|
||||
|
||||
#define BITFRAME_LEN 280
|
||||
#define RAWBITFRAME_LEN (BITFRAME_LEN*2)
|
||||
#define FRAMESTART (HEADOFS+HEADLEN)
|
||||
|
||||
|
||||
char frame_rawbits[RAWBITFRAME_LEN+8] = "01100101011001101010010110101010"; //->"0100010111001111";
|
||||
char frame_bits[BITFRAME_LEN+4];
|
||||
|
||||
|
||||
|
||||
void inc_bufpos() {
|
||||
bufpos = (bufpos+1) % HEADLEN;
|
||||
}
|
||||
|
||||
char cb_inv(char c) {
|
||||
if (c == '0') return '1';
|
||||
if (c == '1') return '0';
|
||||
return c;
|
||||
}
|
||||
|
||||
// Gefahr bei Manchester-Codierung: inverser Header wird leicht fehl-erkannt
|
||||
// da manchester1 und manchester2 nur um 1 bit verschoben
|
||||
int compare2() {
|
||||
int i, j;
|
||||
|
||||
i = 0;
|
||||
j = bufpos;
|
||||
while (i < HEADLEN) {
|
||||
if (j < 0) j = HEADLEN-1;
|
||||
if (buf[j] != header[HEADOFS+HEADLEN-1-i]) break;
|
||||
j--;
|
||||
i++;
|
||||
}
|
||||
if (i == HEADLEN) return 1;
|
||||
|
||||
if (option_auto) {
|
||||
i = 0;
|
||||
j = bufpos;
|
||||
while (i < HEADLEN) {
|
||||
if (j < 0) j = HEADLEN-1;
|
||||
if (buf[j] != cb_inv(header[HEADOFS+HEADLEN-1-i])) break;
|
||||
j--;
|
||||
i++;
|
||||
}
|
||||
if (i == HEADLEN) return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
// manchester1 1->10,0->01: 1.bit
|
||||
// manchester2 0->10,1->01: 2.bit
|
||||
void manchester1(char* frame_rawbits, char *frame_bits) {
|
||||
int i, c, out, buf;
|
||||
char byte, bits[2];
|
||||
c = 0;
|
||||
|
||||
for (i = 0; i < BITFRAME_LEN; i++) { // -16
|
||||
bits[0] = frame_rawbits[2*i];
|
||||
bits[1] = frame_rawbits[2*i+1];
|
||||
|
||||
if ((bits[0] == '0') && (bits[1] == '1')) { byte = '0'; out = 1; }
|
||||
else
|
||||
if ((bits[0] == '1') && (bits[1] == '0')) { byte = '1'; out = 1; }
|
||||
else { //
|
||||
if (buf == 0) { c = !c; out = 0; buf = 1; }
|
||||
else { byte = 'x'; out = 1; buf = 0; }
|
||||
}
|
||||
if (out) frame_bits[i] = byte;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
|
||||
#define B 8 // codeword: 8 bit
|
||||
#define S 4 // davon 4 bit data
|
||||
|
||||
#define HEAD 0 // 16 bit
|
||||
#define CONF (16+0) // 56 bit
|
||||
#define DAT1 (16+56) // 104 bit
|
||||
#define DAT2 (16+160) // 104 bit
|
||||
// frame: 280 bit
|
||||
|
||||
ui8_t hamming_conf[ 7*B]; // 7*8=56
|
||||
ui8_t hamming_dat1[13*B]; // 13*8=104
|
||||
ui8_t hamming_dat2[13*B];
|
||||
|
||||
ui8_t block_conf[ 7*S]; // 7*8=56
|
||||
ui8_t block_dat1[13*S]; // 13*8=104
|
||||
ui8_t block_dat2[13*S];
|
||||
|
||||
void deinterleave(char *str, int L, ui8_t *block) {
|
||||
int i, j;
|
||||
for (j = 0; j < B; j++) { // L = 7, 13
|
||||
for (i = 0; i < L; i++) {
|
||||
if (str[L*j+i] >= 0x30 && str[L*j+i] <= 0x31) {
|
||||
block[B*i+j] = str[L*j+i] - 0x30; // ASCII -> bit
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int hamming(ui8_t *ham, int L, ui8_t *sym) {
|
||||
int i, j;
|
||||
int ret = 0;
|
||||
for (i = 0; i < L; i++) { // L * 2 nibble (data+parity)
|
||||
for (j = 0; j < S; j++) { // systematic: bits 0..S-1 data
|
||||
sym[S*i+j] = ham[B*i+j];
|
||||
}
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
ui32_t bits2val(ui8_t *bits, int len) { // big endian
|
||||
int j;
|
||||
ui32_t val;
|
||||
if ((len < 0) || (len > 32)) return -1;
|
||||
val = 0;
|
||||
for (j = 0; j < len; j++) {
|
||||
val |= (bits[j] << (len-1-j));
|
||||
}
|
||||
return val;
|
||||
}
|
||||
|
||||
char nib2chr(ui8_t nib) {
|
||||
char c = '_';
|
||||
if (nib < 0x10) {
|
||||
if (nib < 0xA) c = 0x30 + nib;
|
||||
else c = 0x41 + nib-0xA;
|
||||
}
|
||||
return c;
|
||||
}
|
||||
|
||||
int dat_out(ui8_t *dat_bits) {
|
||||
int i, ret = 0;
|
||||
static int fr_id;
|
||||
// int jahr = 0, monat = 0, tag = 0, std = 0, min = 0;
|
||||
int frnr = 0;
|
||||
int msek = 0;
|
||||
int lat = 0, lon = 0, height = 0;
|
||||
int nib;
|
||||
int dvv; // signed/unsigned 16bit
|
||||
|
||||
fr_id = bits2val(dat_bits+48, 4);
|
||||
|
||||
|
||||
if (fr_id >= 0 && fr_id <= 8) {
|
||||
for (i = 0; i < 13; i++) {
|
||||
nib = bits2val(dat_bits+4*i, 4);
|
||||
dat_str[fr_id][i] = nib2chr(nib);
|
||||
}
|
||||
dat_str[fr_id][13] = '\0';
|
||||
}
|
||||
|
||||
if (fr_id == 0) {
|
||||
start = 1;
|
||||
frnr = bits2val(dat_bits+24, 8);
|
||||
gpx.frnr = frnr;
|
||||
}
|
||||
|
||||
if (fr_id == 1) {
|
||||
// 00..31: ? GPS-Sats in Sicht?
|
||||
msek = bits2val(dat_bits+32, 16);
|
||||
gpx.sek = msek/1000.0;
|
||||
}
|
||||
|
||||
if (fr_id == 2) {
|
||||
lat = bits2val(dat_bits, 32);
|
||||
gpx.lat = lat/1e7;
|
||||
dvv = (short)bits2val(dat_bits+32, 16); // (short)? zusammen mit dir sollte unsigned sein
|
||||
gpx.horiV = dvv/1e2;
|
||||
}
|
||||
|
||||
if (fr_id == 3) {
|
||||
lon = bits2val(dat_bits, 32);
|
||||
gpx.lon = lon/1e7;
|
||||
dvv = bits2val(dat_bits+32, 16) & 0xFFFF; // unsigned
|
||||
gpx.dir = dvv/1e2;
|
||||
}
|
||||
|
||||
if (fr_id == 4) {
|
||||
height = bits2val(dat_bits, 32);
|
||||
gpx.h = height/1e2;
|
||||
dvv = (short)bits2val(dat_bits+32, 16); // signed
|
||||
gpx.vertV = dvv/1e2;
|
||||
}
|
||||
|
||||
if (fr_id == 5) {
|
||||
}
|
||||
|
||||
if (fr_id == 6) {
|
||||
}
|
||||
|
||||
if (fr_id == 7) {
|
||||
}
|
||||
|
||||
if (fr_id == 8) {
|
||||
gpx.jahr = bits2val(dat_bits, 12);
|
||||
gpx.monat = bits2val(dat_bits+12, 4);
|
||||
gpx.tag = bits2val(dat_bits+16, 5);
|
||||
gpx.std = bits2val(dat_bits+21, 5);
|
||||
gpx.min = bits2val(dat_bits+26, 6);
|
||||
}
|
||||
|
||||
ret = fr_id;
|
||||
return ret;
|
||||
}
|
||||
|
||||
int conf_out(ui8_t *conf_bits) {
|
||||
int conf_id;
|
||||
int ret = 0;
|
||||
|
||||
conf_id = bits2val(conf_bits, 4);
|
||||
if (conf_id == 6) {
|
||||
gpx.sonde_id = bits2val(conf_bits+4, 4*6);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
void print_gpx() {
|
||||
int i, j;
|
||||
|
||||
if (start) {
|
||||
|
||||
if (option_raw == 2) {
|
||||
for (i = 0; i < 9; i++) {
|
||||
printf(" %s", dat_str[i]);
|
||||
}
|
||||
for (i = 0; i < 9; i++) {
|
||||
for (j = 0; j < 13; j++) dat_str[i][j] = ' ';
|
||||
}
|
||||
}
|
||||
else {
|
||||
if (option_auto && option_verbose) printf("[%c] ", inv>0?'+':'-');
|
||||
printf("[%3d] ", gpx.frnr);
|
||||
printf("%4d-%02d-%02d ", gpx.jahr, gpx.monat, gpx.tag);
|
||||
printf("%02d:%02d:%04.1f ", gpx.std, gpx.min, gpx.sek);
|
||||
printf(" ");
|
||||
printf("lat: %.7f ", gpx.lat);
|
||||
printf("lon: %.7f ", gpx.lon);
|
||||
printf("h: %.2f ", gpx.h);
|
||||
if (option_verbose) {
|
||||
printf(" dir: %5.1f ", gpx.dir);
|
||||
printf(" hV: %5.2f ", gpx.horiV);
|
||||
printf(" vV: %5.2f ", gpx.vertV);
|
||||
if (gpx.sonde_id >= 0) {
|
||||
printf(" (ID:%06X) ", gpx.sonde_id);
|
||||
gpx.sonde_id = -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
printf("\n");
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
void print_frame() {
|
||||
int i;
|
||||
int nib = 0;
|
||||
int frid = -1;
|
||||
|
||||
manchester1(frame_rawbits, frame_bits);
|
||||
|
||||
deinterleave(frame_bits+CONF, 7, hamming_conf);
|
||||
deinterleave(frame_bits+DAT1, 13, hamming_dat1);
|
||||
deinterleave(frame_bits+DAT2, 13, hamming_dat2);
|
||||
|
||||
hamming(hamming_conf, 7, block_conf);
|
||||
hamming(hamming_dat1, 13, block_dat1);
|
||||
hamming(hamming_dat2, 13, block_dat2);
|
||||
|
||||
if (option_raw == 1) {
|
||||
|
||||
for (i = 0; i < 7; i++) {
|
||||
nib = bits2val(block_conf+S*i, S);
|
||||
printf("%01X", nib & 0xFF);
|
||||
}
|
||||
printf(" ");
|
||||
for (i = 0; i < 13; i++) {
|
||||
nib = bits2val(block_dat1+S*i, S);
|
||||
printf("%01X", nib & 0xFF);
|
||||
}
|
||||
printf(" ");
|
||||
for (i = 0; i < 13; i++) {
|
||||
nib = bits2val(block_dat2+S*i, S);
|
||||
printf("%01X", nib & 0xFF);
|
||||
}
|
||||
printf("\n");
|
||||
|
||||
}
|
||||
else {
|
||||
|
||||
conf_out(block_conf);
|
||||
frid = dat_out(block_dat1);
|
||||
if (frid == 8) print_gpx();
|
||||
frid = dat_out(block_dat2);
|
||||
if (frid == 8) print_gpx();
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
|
||||
int main(int argc, char **argv) {
|
||||
|
||||
FILE *fp;
|
||||
char *fpname;
|
||||
int pos, i, j, bit, len;
|
||||
int header_found = 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, " -v, --verbose\n");
|
||||
fprintf(stderr, " -r, --raw\n");
|
||||
fprintf(stderr, " -i, --invert\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, "-R") == 0) || (strcmp(*argv, "--RAW") == 0) ) {
|
||||
option_raw = 2;
|
||||
}
|
||||
else if ( (strcmp(*argv, "-i") == 0) || (strcmp(*argv, "--invert") == 0) ) {
|
||||
option_inv = 1;
|
||||
}
|
||||
else if ( (strcmp(*argv, "--auto") == 0) ) {
|
||||
option_auto = 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;
|
||||
}
|
||||
|
||||
|
||||
gpx.sonde_id = -1;
|
||||
for (i = 0; i < 9; i++) {
|
||||
for (j = 0; j < 13; j++) dat_str[i][j] = ' ';
|
||||
}
|
||||
|
||||
|
||||
pos = FRAMESTART;
|
||||
|
||||
while (!read_bits_fsk(fp, &bit, &len)) {
|
||||
|
||||
if (len == 0) { // reset_frame();
|
||||
if (pos > RAWBITFRAME_LEN-10) { // Problem wegen Interleaving
|
||||
print_frame();//byte_count
|
||||
header_found = 0;
|
||||
pos = FRAMESTART;
|
||||
}
|
||||
//inc_bufpos();
|
||||
//buf[bufpos] = 'x';
|
||||
continue; // ...
|
||||
}
|
||||
|
||||
for (i = 0; i < len; i++) {
|
||||
|
||||
inc_bufpos();
|
||||
buf[bufpos] = 0x30 + bit; // Ascii
|
||||
|
||||
if (!header_found) {
|
||||
header_found = compare2();
|
||||
if (header_found != 0) {
|
||||
inv = header_found;
|
||||
}
|
||||
}
|
||||
else {
|
||||
frame_rawbits[pos] = 0x30 + bit; // Ascii
|
||||
pos++;
|
||||
|
||||
if (pos == RAWBITFRAME_LEN) {
|
||||
print_frame();//FRAME_LEN
|
||||
header_found = 0;
|
||||
pos = FRAMESTART;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
fclose(fp);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
Ładowanie…
Reference in New Issue