56 lines
1.5 KiB
C
56 lines
1.5 KiB
C
#include "pocsag_bch.h"
|
|
|
|
#include <string.h>
|
|
|
|
#define POCSAG_BCH_POLY 0x769U
|
|
|
|
static uint32_t syndrome_errors[1024];
|
|
|
|
static uint16_t bch_syndrome(uint32_t value)
|
|
{
|
|
for (int bit = 30; bit >= 10; bit--) {
|
|
if (value & (1UL << bit))
|
|
value ^= (uint32_t)POCSAG_BCH_POLY << (bit - 10);
|
|
}
|
|
return (uint16_t)(value & 0x3FFU);
|
|
}
|
|
|
|
/* The shortened BCH(31,21) syndrome table corrects one or two data-bit flips. */
|
|
void pocsag_bch_init(void)
|
|
{
|
|
memset(syndrome_errors, 0, sizeof(syndrome_errors));
|
|
for (int first = 0; first < 31; first++) {
|
|
uint32_t error = 1UL << first;
|
|
syndrome_errors[bch_syndrome(error)] = error;
|
|
}
|
|
for (int first = 0; first < 31; first++) {
|
|
for (int second = first + 1; second < 31; second++) {
|
|
uint32_t error = (1UL << first) | (1UL << second);
|
|
syndrome_errors[bch_syndrome(error)] = error;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool pocsag_bch_correct(uint32_t *word, unsigned *corrected_bits)
|
|
{
|
|
uint32_t upper31 = *word >> 1;
|
|
uint16_t syndrome = bch_syndrome(upper31);
|
|
uint32_t error = syndrome_errors[syndrome];
|
|
if (syndrome && !error)
|
|
return false;
|
|
|
|
upper31 ^= error;
|
|
unsigned parity = 0;
|
|
for (int bit = 0; bit < 31; bit++)
|
|
parity ^= (upper31 >> bit) & 1U;
|
|
|
|
unsigned parity_error = ((*word & 1U) != parity);
|
|
unsigned data_errors = (unsigned)__builtin_popcount(error);
|
|
if (data_errors + parity_error > 2U)
|
|
return false;
|
|
|
|
*word = (upper31 << 1) | parity;
|
|
*corrected_bits = data_errors + parity_error;
|
|
return true;
|
|
}
|