Try unrolling the inner loop to speed things up.
This commit is contained in:
Oliver Jowett
parent
ef098a2461
commit
00e232cc4f
199
demod_2400.c
199
demod_2400.c
|
|
@ -266,107 +266,182 @@ void demodulate2400(uint16_t *m, uint32_t mlen) {
|
||||||
bestmsg = NULL; bestscore = -1; bestphase = -1; bestsnr = -1;
|
bestmsg = NULL; bestscore = -1; bestphase = -1; bestsnr = -1;
|
||||||
for (try_phase = first_phase; try_phase <= last_phase; ++try_phase) {
|
for (try_phase = first_phase; try_phase <= last_phase; ++try_phase) {
|
||||||
int sigLevel = base_signal, noiseLevel = base_noise;
|
int sigLevel = base_signal, noiseLevel = base_noise;
|
||||||
uint8_t theByte;
|
|
||||||
uint16_t *pPtr;
|
uint16_t *pPtr;
|
||||||
unsigned char *pMsg;
|
int phase, i, snr, score, bytelen;
|
||||||
int phase, errors, i, snr, score;
|
|
||||||
|
|
||||||
// Decode all the next 112 bits, regardless of the actual message
|
// Decode all the next 112 bits, regardless of the actual message
|
||||||
// size. We'll check the actual message type later
|
// size. We'll check the actual message type later
|
||||||
|
|
||||||
pMsg = &msg[0];
|
|
||||||
pPtr = &m[j+19] + (try_phase/5);
|
pPtr = &m[j+19] + (try_phase/5);
|
||||||
phase = try_phase % 5;
|
phase = try_phase % 5;
|
||||||
theByte = 0;
|
|
||||||
errors = 0;
|
|
||||||
|
|
||||||
for (i = 0; i < MODES_LONG_MSG_BITS && errors < MODES_MSG_ENCODER_ERRS; i++) {
|
bytelen = MODES_LONG_MSG_BYTES;
|
||||||
int test;
|
for (i = 0; i < bytelen; ++i) {
|
||||||
|
uint8_t theByte = 0;
|
||||||
|
|
||||||
switch (phase) {
|
switch (phase) {
|
||||||
case 0:
|
case 0:
|
||||||
test = slice_phase0(pPtr);
|
theByte =
|
||||||
phase = 2;
|
(slice_phase0(pPtr) > 0 ? 0x80 : 0) |
|
||||||
pPtr += 2;
|
(slice_phase2(pPtr+2) > 0 ? 0x40 : 0) |
|
||||||
|
(slice_phase4(pPtr+4) > 0 ? 0x20 : 0) |
|
||||||
|
(slice_phase1(pPtr+7) > 0 ? 0x10 : 0) |
|
||||||
|
(slice_phase3(pPtr+9) > 0 ? 0x08 : 0) |
|
||||||
|
(slice_phase0(pPtr+12) > 0 ? 0x04 : 0) |
|
||||||
|
(slice_phase2(pPtr+14) > 0 ? 0x02 : 0) |
|
||||||
|
(slice_phase4(pPtr+16) > 0 ? 0x01 : 0);
|
||||||
|
|
||||||
|
if (theByte & 0x20) {
|
||||||
|
sigLevel += pPtr[5];
|
||||||
|
noiseLevel += pPtr[6];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[5];
|
||||||
|
sigLevel += pPtr[6];
|
||||||
|
}
|
||||||
|
|
||||||
|
if (theByte & 0x01) {
|
||||||
|
sigLevel += pPtr[17];
|
||||||
|
noiseLevel += pPtr[18];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[17];
|
||||||
|
sigLevel += pPtr[18];
|
||||||
|
}
|
||||||
|
|
||||||
|
phase = 1;
|
||||||
|
pPtr += 19;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 1:
|
case 1:
|
||||||
test = slice_phase1(pPtr);
|
theByte =
|
||||||
phase = 3;
|
(slice_phase1(pPtr) > 0 ? 0x80 : 0) |
|
||||||
pPtr += 2;
|
(slice_phase3(pPtr+2) > 0 ? 0x40 : 0) |
|
||||||
|
(slice_phase0(pPtr+5) > 0 ? 0x20 : 0) |
|
||||||
|
(slice_phase2(pPtr+7) > 0 ? 0x10 : 0) |
|
||||||
|
(slice_phase4(pPtr+9) > 0 ? 0x08 : 0) |
|
||||||
|
(slice_phase1(pPtr+12) > 0 ? 0x04 : 0) |
|
||||||
|
(slice_phase3(pPtr+14) > 0 ? 0x02 : 0) |
|
||||||
|
(slice_phase0(pPtr+17) > 0 ? 0x01 : 0);
|
||||||
|
|
||||||
|
if (theByte & 0x08) {
|
||||||
|
sigLevel += pPtr[10];
|
||||||
|
noiseLevel += pPtr[11];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[10];
|
||||||
|
sigLevel += pPtr[11];
|
||||||
|
}
|
||||||
|
|
||||||
|
phase = 2;
|
||||||
|
pPtr += 19;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 2:
|
case 2:
|
||||||
test = slice_phase2(pPtr);
|
theByte =
|
||||||
phase = 4;
|
(slice_phase2(pPtr) > 0 ? 0x80 : 0) |
|
||||||
pPtr += 2;
|
(slice_phase4(pPtr+2) > 0 ? 0x40 : 0) |
|
||||||
|
(slice_phase1(pPtr+5) > 0 ? 0x20 : 0) |
|
||||||
|
(slice_phase3(pPtr+7) > 0 ? 0x10 : 0) |
|
||||||
|
(slice_phase0(pPtr+10) > 0 ? 0x08 : 0) |
|
||||||
|
(slice_phase2(pPtr+12) > 0 ? 0x04 : 0) |
|
||||||
|
(slice_phase4(pPtr+14) > 0 ? 0x02 : 0) |
|
||||||
|
(slice_phase1(pPtr+17) > 0 ? 0x01 : 0);
|
||||||
|
|
||||||
|
if (theByte & 0x40) {
|
||||||
|
sigLevel += pPtr[3];
|
||||||
|
noiseLevel += pPtr[4];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[3];
|
||||||
|
sigLevel += pPtr[4];
|
||||||
|
}
|
||||||
|
|
||||||
|
if (theByte & 0x02) {
|
||||||
|
sigLevel += pPtr[15];
|
||||||
|
noiseLevel += pPtr[16];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[15];
|
||||||
|
sigLevel += pPtr[16];
|
||||||
|
}
|
||||||
|
|
||||||
|
phase = 3;
|
||||||
|
pPtr += 19;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 3:
|
case 3:
|
||||||
test = slice_phase3(pPtr);
|
theByte =
|
||||||
phase = 0;
|
(slice_phase3(pPtr) > 0 ? 0x80 : 0) |
|
||||||
pPtr += 3;
|
(slice_phase0(pPtr+3) > 0 ? 0x40 : 0) |
|
||||||
|
(slice_phase2(pPtr+5) > 0 ? 0x20 : 0) |
|
||||||
|
(slice_phase4(pPtr+7) > 0 ? 0x10 : 0) |
|
||||||
|
(slice_phase1(pPtr+10) > 0 ? 0x08 : 0) |
|
||||||
|
(slice_phase3(pPtr+12) > 0 ? 0x04 : 0) |
|
||||||
|
(slice_phase0(pPtr+15) > 0 ? 0x02 : 0) |
|
||||||
|
(slice_phase2(pPtr+17) > 0 ? 0x01 : 0);
|
||||||
|
|
||||||
|
if (theByte & 0x10) {
|
||||||
|
sigLevel += pPtr[8];
|
||||||
|
noiseLevel += pPtr[9];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[8];
|
||||||
|
sigLevel += pPtr[9];
|
||||||
|
}
|
||||||
|
|
||||||
|
phase = 4;
|
||||||
|
pPtr += 19;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 4:
|
case 4:
|
||||||
test = slice_phase4(pPtr);
|
theByte =
|
||||||
|
(slice_phase4(pPtr) > 0 ? 0x80 : 0) |
|
||||||
|
(slice_phase1(pPtr+3) > 0 ? 0x40 : 0) |
|
||||||
|
(slice_phase3(pPtr+5) > 0 ? 0x20 : 0) |
|
||||||
|
(slice_phase0(pPtr+8) > 0 ? 0x10 : 0) |
|
||||||
|
(slice_phase2(pPtr+10) > 0 ? 0x08 : 0) |
|
||||||
|
(slice_phase4(pPtr+12) > 0 ? 0x04 : 0) |
|
||||||
|
(slice_phase1(pPtr+15) > 0 ? 0x02 : 0) |
|
||||||
|
(slice_phase3(pPtr+17) > 0 ? 0x01 : 0);
|
||||||
|
|
||||||
// A phase-4 bit exactly straddles a sample boundary.
|
if (theByte & 0x80) {
|
||||||
// Here's what a 1-0 bit with phase 4 looks like:
|
|
||||||
//
|
|
||||||
// |SYM 1|
|
|
||||||
// xxx| | |xxx
|
|
||||||
// |SYM 2|
|
|
||||||
//
|
|
||||||
// 012340123401234012340 <-- sample phase
|
|
||||||
// | 0 | 1 | 2 | 3 | <-- sample boundaries
|
|
||||||
//
|
|
||||||
// Samples 1 and 2 only have power from symbols 1 and 2.
|
|
||||||
// So we can use this to extract signal/noise values
|
|
||||||
// as one of the two symbols is high (signal) and the
|
|
||||||
// other is low (noise)
|
|
||||||
//
|
|
||||||
// This also gives us an equal number of signal and noise
|
|
||||||
// samples, which is convenient. Using the first half of
|
|
||||||
// a phase 0 bit, or the second half of a phase 3 bit, would
|
|
||||||
// also work, but we have no guarantees about how many signal
|
|
||||||
// or noise bits we'd see in those phases.
|
|
||||||
|
|
||||||
if (test < 0) { // 0 1
|
|
||||||
noiseLevel += pPtr[1];
|
|
||||||
sigLevel += pPtr[2];
|
|
||||||
} else { // 1 0
|
|
||||||
sigLevel += pPtr[1];
|
sigLevel += pPtr[1];
|
||||||
noiseLevel += pPtr[2];
|
noiseLevel += pPtr[2];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[1];
|
||||||
|
sigLevel += pPtr[2];
|
||||||
}
|
}
|
||||||
phase = 1;
|
|
||||||
pPtr += 3;
|
if (theByte & 0x04) {
|
||||||
|
sigLevel += pPtr[13];
|
||||||
|
noiseLevel += pPtr[14];
|
||||||
|
} else {
|
||||||
|
noiseLevel += pPtr[13];
|
||||||
|
sigLevel += pPtr[14];
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
phase = 0;
|
||||||
|
pPtr += 20;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
msg[i] = theByte;
|
||||||
|
if (i == 0) {
|
||||||
|
switch (msg[0] >> 3) {
|
||||||
|
case 0: case 4: case 5: case 11:
|
||||||
|
bytelen = MODES_LONG_MSG_BYTES; break;
|
||||||
|
|
||||||
|
case 16: case 17: case 18: case 20: case 21: case 24:
|
||||||
break;
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
test = 0;
|
bytelen = 1; // unknown DF, give up immediately
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (test > 0)
|
|
||||||
theByte |= 1;
|
|
||||||
/* else if (test < 0) theByte |= 0; */
|
|
||||||
else if (test == 0) {
|
|
||||||
++errors;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((i & 7) == 7)
|
|
||||||
*pMsg++ = theByte;
|
|
||||||
|
|
||||||
theByte = theByte << 1;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// Score the mode S message and see if it's any good.
|
// Score the mode S message and see if it's any good.
|
||||||
score = scoreModesMessage(msg, i);
|
score = scoreModesMessage(msg, i*8);
|
||||||
if (score < 0)
|
if (score < 0)
|
||||||
continue; // can't decode
|
continue; // can't decode
|
||||||
|
|
||||||
|
|
||||||
// apply the SNR to the score, so less noisy decodes are better,
|
// apply the SNR to the score, so less noisy decodes are better,
|
||||||
// all things being equal
|
// all things being equal
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue