Files
pager/main/pocsag_bch.c
T
2026-11-12 19:43:23 +01:00

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;
}