readd missing constants and missing FEC code from previous revert;

This commit is contained in:
Bryan Biedenkapp
2019-01-09 03:02:51 +00:00
parent 2d4829c157
commit 0da6167c61
7 changed files with 210 additions and 89 deletions

View File

@@ -1,6 +1,6 @@
/* /*
* Copyright (C) 2016,2017,2018 by Jonathan Naylor G4KLX * Copyright (C) 2016,2017,2018 by Jonathan Naylor G4KLX
* Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> * Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> N2PLL
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by * it under the terms of the GNU General Public License as published by

View File

@@ -1,6 +1,6 @@
/* /*
* Copyright (C) 2016,2017,2018 by Jonathan Naylor G4KLX * Copyright (C) 2016,2017,2018 by Jonathan Naylor G4KLX
* Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> * Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> N2PLL
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by * it under the terms of the GNU General Public License as published by

View File

@@ -1,6 +1,6 @@
/* /*
* Copyright (C) 2016,2017 by Jonathan Naylor G4KLX * Copyright (C) 2016,2017 by Jonathan Naylor G4KLX
* Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> * Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> N2PLL
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by * it under the terms of the GNU General Public License as published by

View File

@@ -1,6 +1,6 @@
/* /*
* Copyright (C) 2016,2017 by Jonathan Naylor G4KLX * Copyright (C) 2016,2017 by Jonathan Naylor G4KLX
* Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> * Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> N2PLL
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by * it under the terms of the GNU General Public License as published by

View File

@@ -55,6 +55,8 @@ const unsigned int P25_PDU_FEC_LENGTH_BITS = P25_PDU_FEC_LENGTH_BYTES
const unsigned int P25_MI_LENGTH_BYTES = 9U; const unsigned int P25_MI_LENGTH_BYTES = 9U;
const unsigned char P25_ALGO_UNENCRYPT = 0x80U;
const unsigned char P25_LCF_GROUP = 0x00U; const unsigned char P25_LCF_GROUP = 0x00U;
const unsigned char P25_LCF_PRIVATE = 0x03U; const unsigned char P25_LCF_PRIVATE = 0x03U;

View File

@@ -1,5 +1,6 @@
/* /*
* Copyright (C) 2016 by Jonathan Naylor G4KLX * Copyright (C) 2016 by Jonathan Naylor G4KLX
* Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> N2PLL
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by * it under the terms of the GNU General Public License as published by
@@ -20,6 +21,7 @@
#include <cstdio> #include <cstdio>
#include <cassert> #include <cassert>
#include <cstring>
const unsigned char ENCODE_MATRIX[12U][24U] = { const unsigned char ENCODE_MATRIX[12U][24U] = {
{1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 062, 044, 003, 025, 014, 016, 027, 003, 053, 004, 036, 047}, {1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 062, 044, 003, 025, 014, 016, 027, 003, 053, 004, 036, 047},
@@ -35,6 +37,46 @@ const unsigned char ENCODE_MATRIX[12U][24U] = {
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 073, 065, 036, 061, 042, 022, 017, 004, 044, 020, 025, 005}, {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 073, 065, 036, 061, 042, 022, 017, 004, 044, 020, 025, 005},
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 071, 005, 055, 003, 071, 034, 060, 011, 074, 002, 041, 050}}; {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 071, 005, 055, 003, 071, 034, 060, 011, 074, 002, 041, 050}};
const unsigned char ENCODE_MATRIX_24169[16U][24U] = {
{ 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 051, 045, 067, 015, 064, 067, 052, 012 },
{ 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 057, 025, 063, 073, 071, 022, 040, 015 },
{ 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 005, 001, 031, 004, 016, 054, 025, 076 },
{ 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 073, 007, 047, 014, 041, 077, 047, 011 },
{ 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 075, 015, 051, 051, 017, 067, 017, 057 },
{ 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 020, 032, 014, 042, 075, 042, 070, 054 },
{ 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 002, 075, 043, 005, 001, 040, 012, 064 },
{ 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 024, 074, 015, 072, 024, 026, 074, 061 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 042, 064, 007, 022, 061, 020, 040, 065 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 032, 032, 055, 041, 057, 066, 021, 077 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 065, 036, 025, 007, 050, 016, 040, 051 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 064, 006, 054, 032, 076, 046, 014, 036 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 062, 063, 074, 070, 005, 027, 037, 046 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 055, 043, 034, 071, 057, 076, 050, 064 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 024, 023, 023, 005, 050, 070, 042, 023 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 067, 075, 045, 060, 057, 024, 006, 026 } };
const unsigned char ENCODE_MATRIX_362017[20U][36U] = {
{ 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 074, 037, 034, 006, 002, 007, 044, 064, 026, 014, 026, 044, 054, 013, 077, 005 },
{ 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 004, 017, 050, 024, 011, 005, 030, 057, 033, 003, 002, 002, 015, 016, 025, 026 },
{ 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 007, 023, 037, 046, 056, 075, 043, 045, 055, 021, 050, 031, 045, 027, 071, 062 },
{ 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 026, 005, 007, 063, 063, 027, 063, 040, 006, 004, 040, 045, 047, 030, 075, 007 },
{ 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 023, 073, 073, 041, 072, 034, 021, 051, 067, 016, 031, 074, 011, 021, 012, 021 },
{ 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 024, 051, 025, 023, 022, 041, 074, 066, 074, 065, 070, 036, 067, 045, 064, 001 },
{ 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 052, 033, 014, 002, 020, 006, 014, 025, 052, 023, 035, 074, 075, 075, 043, 027 },
{ 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 055, 062, 056, 025, 073, 060, 015, 030, 013, 017, 020, 002, 070, 055, 014, 047 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 054, 051, 032, 065, 077, 012, 054, 013, 035, 032, 056, 012, 075, 001, 072, 063 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 074, 041, 030, 041, 043, 022, 051, 006, 064, 033, 003, 047, 027, 012, 055, 047 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 054, 070, 011, 003, 013, 022, 016, 057, 003, 045, 072, 031, 030, 056, 035, 022 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 051, 007, 072, 030, 065, 054, 006, 021, 036, 063, 050, 061, 064, 052, 001, 060 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 001, 065, 032, 070, 013, 044, 073, 024, 012, 052, 021, 055, 012, 035, 014, 072 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 011, 070, 005, 010, 065, 024, 015, 077, 022, 024, 024, 074, 007, 044, 007, 046 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 006, 002, 065, 011, 041, 020, 045, 042, 046, 054, 035, 012, 040, 064, 065, 033 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 034, 031, 001, 015, 044, 064, 016, 024, 052, 016, 006, 062, 020, 013, 055, 057 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 063, 043, 025, 044, 077, 063, 017, 017, 064, 014, 040, 074, 031, 072, 054, 006 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 071, 021, 070, 044, 056, 004, 030, 074, 004, 023, 071, 070, 063, 045, 056, 043 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 002, 001, 053, 074, 002, 014, 052, 074, 012, 057, 024, 063, 015, 042, 052, 033 },
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 034, 035, 002, 023, 021, 027, 022, 033, 064, 042, 005, 073, 051, 046, 073, 060 } };
const unsigned int rsGFexp[64] = { const unsigned int rsGFexp[64] = {
1, 2, 4, 8, 16, 32, 3, 6, 12, 24, 48, 35, 5, 10, 20, 40, 1, 2, 4, 8, 16, 32, 3, 6, 12, 24, 48, 35, 5, 10, 20, 40,
19, 38, 15, 30, 60, 59, 53, 41, 17, 34, 7, 14, 28, 56, 51, 37, 19, 38, 15, 30, 60, 59, 53, 41, 17, 34, 7, 14, 28, 56, 51, 37,
@@ -85,21 +127,121 @@ CRS241213::~CRS241213()
} }
bool CRS241213::decode(unsigned char* data) bool CRS241213::decode(unsigned char* data)
{
return decode(data, 24U, 39, 12);
}
void CRS241213::encode(unsigned char* data)
{ {
assert(data != NULL); assert(data != NULL);
unsigned char HB[24U]; unsigned char codeword[24U];
for (unsigned int i = 0U; i < 24U; i++) {
codeword[i] = 0x00U;
unsigned int offset = 0U;
for (unsigned int j = 0U; j < 12U; j++, offset += 6U) {
unsigned char hexbit = bin2Hex(data, offset);
codeword[i] ^= gf6Mult(hexbit, ENCODE_MATRIX[j][i]);
}
}
unsigned int offset = 0U; unsigned int offset = 0U;
for (unsigned int i = 0U; i < 24U; i++, offset += 6U) for (unsigned int i = 0U; i < 24U; i++, offset += 6U)
hex2Bin(codeword[i], data, offset);
}
bool CRS241213::decode24169(unsigned char* data)
{
return decode(data, 24U, 39, 8);
}
void CRS241213::encode24169(unsigned char* data)
{
assert(data != NULL);
unsigned char codeword[24U];
for (unsigned int i = 0U; i < 24U; i++) {
codeword[i] = 0x00U;
unsigned int offset = 0U;
for (unsigned int j = 0U; j < 16U; j++, offset += 6U) {
unsigned char hexbit = bin2Hex(data, offset);
codeword[i] ^= gf6Mult(hexbit, ENCODE_MATRIX_24169[j][i]);
}
}
unsigned int offset = 0U;
for (unsigned int i = 0U; i < 24U; i++, offset += 6U)
hex2Bin(codeword[i], data, offset);
}
bool CRS241213::decode362017(unsigned char* data)
{
return decode(data, 36U, 27, 16);
}
void CRS241213::encode362017(unsigned char* data)
{
assert(data != NULL);
unsigned char codeword[36U];
for (unsigned int i = 0U; i < 36U; i++) {
codeword[i] = 0x00U;
unsigned int offset = 0U;
for (unsigned int j = 0U; j < 20U; j++, offset += 6U) {
unsigned char hexbit = bin2Hex(data, offset);
codeword[i] ^= gf6Mult(hexbit, ENCODE_MATRIX_362017[j][i]);
}
}
unsigned int offset = 0U;
for (unsigned int i = 0U; i < 36U; i++, offset += 6U)
hex2Bin(codeword[i], data, offset);
}
// GF(2 ^ 6) multiply(for Reed - Solomon encoder)
unsigned char CRS241213::gf6Mult(unsigned char a, unsigned char b) const
{
unsigned char p = 0x00U;
for (unsigned int i = 0U; i < 6U; i++) {
if ((b & 0x01U) == 0x01U)
p ^= a;
a <<= 1;
if ((a & 0x40U) == 0x40U)
a ^= 0x43U; // primitive polynomial : x ^ 6 + x + 1
b >>= 1;
}
return p;
}
bool CRS241213::decode(unsigned char* data, const unsigned int bitLength, const int firstData, const int roots)
{
assert(data != NULL);
//unsigned char HB[24U];
unsigned char HB[63U];
::memset(HB, 0x00U, 63U);
unsigned int offset = 0U;
for (unsigned int i = 0U; i < bitLength; i++, offset += 6)
HB[i] = bin2Hex(data, offset); HB[i] = bin2Hex(data, offset);
//RS (63,63-nroots,nroots+1) decoder where nroots = number of parity bits //RS (63,63-nroots,nroots+1) decoder where nroots = number of parity bits
// rsDec(8, 39) rsDec(16, 27) rsDec(12, 39) // rsDec(8, 39) rsDec(16, 27) rsDec(12, 39)
const int nroots = 12; const int nroots = roots;
int lambda[18];//Err+Eras Locator poly int lambda[18]; // Err+Eras Locator poly
int S[17];//syndrome poly int S[17]; // syndrome poly
int b[18]; int b[18];
int t[18]; int t[18];
int omega[18]; int omega[18];
@@ -109,22 +251,25 @@ bool CRS241213::decode(unsigned char* data)
int i, j, count, r, el, SynError, DiscrR, q, DegOmega, tmp, num1, num2, den, DegLambda; int i, j, count, r, el, SynError, DiscrR, q, DegOmega, tmp, num1, num2, den, DegLambda;
//form the syndromes; i.e., evaluate HB(x) at roots of g(x) // form the syndromes; i.e., evaluate HB(x) at roots of g(x)
for (i = 0; i <= nroots - 1; i++) { for (i = 0; i <= nroots - 1; i++) {
S[i] = HB[0]; S[i] = HB[0];
} }
for (j = 1; j <= 23; j++) { // XXX was 62 //for (j = 1; j <= 24; j++) { // XXX was 62
//for (j = 1; j <= (int)(bitLength - 1); j++) {
for (j = 1; j <= 62; j++) {
for (i = 0; i <= nroots - 1; i++) { for (i = 0; i <= nroots - 1; i++) {
if (S[i] == 0) { if (S[i] == 0) {
S[i] = HB[j]; S[i] = HB[j];
} else { }
else {
S[i] = HB[j] ^ rsGFexp[(rsGFlog[S[i]] + i + 1) % 63]; S[i] = HB[j] ^ rsGFexp[(rsGFlog[S[i]] + i + 1) % 63];
} }
} }
} }
//convert syndromes to index form, checking for nonzero condition // convert syndromes to index form, checking for nonzero condition
SynError = 0; SynError = 0;
for (i = 0; i <= nroots - 1; i++) { for (i = 0; i <= nroots - 1; i++) {
@@ -133,8 +278,8 @@ bool CRS241213::decode(unsigned char* data)
} }
if (SynError == 0) { if (SynError == 0) {
//if syndrome is zero, rsData[] is a codeword and there are // if syndrome is zero, rsData[] is a codeword and there are
//no errors to correct. So return rsData[] unmodified // no errors to correct. So return rsData[] unmodified
count = 0; count = 0;
return true; return true;
} }
@@ -149,13 +294,14 @@ bool CRS241213::decode(unsigned char* data)
b[i] = rsGFlog[lambda[i]]; b[i] = rsGFlog[lambda[i]];
} }
//begin Berlekamp-Massey algorithm to determine error+erasure // begin Berlekamp-Massey algorithm to determine error+erasure
//locator polynomial // locator polynomial
r = 0; r = 0;
el = 0; el = 0;
while (r < nroots) { //r is the step number while (++r <= nroots) {
r = r + 1; // r is the step number
//compute discrepancy at the r-th step in poly-form //r = r + 1;
// compute discrepancy at the r-th step in poly-form
DiscrR = 0; DiscrR = 0;
for (i = 0; i <= r - 1; i++) { for (i = 0; i <= r - 1; i++) {
@@ -164,44 +310,48 @@ bool CRS241213::decode(unsigned char* data)
} }
} }
DiscrR = rsGFlog[DiscrR];//index form DiscrR = rsGFlog[DiscrR]; // index form
if (DiscrR == 63) { if (DiscrR == 63) {
//shift elements upward one step // shift elements upward one step
for (i = nroots; i >= 1; i += -1) { for (i = nroots; i >= 1; i += -1) {
b[i] = b[i - 1]; b[i] = b[i - 1];
} }
b[0] = 63; b[0] = 63;
} else { }
//t(x) <-- lambda(x) - DiscrR*x*b(x) else {
// t(x) <-- lambda(x) - DiscrR*x*b(x)
t[0] = lambda[0]; t[0] = lambda[0];
for (i = 0; i <= nroots - 1; i++) { for (i = 0; i <= nroots - 1; i++) {
if (b[i] != 63) { if (b[i] != 63) {
t[i + 1] = lambda[i + 1] ^ rsGFexp[(DiscrR + b[i]) % 63]; t[i + 1] = lambda[i + 1] ^ rsGFexp[(DiscrR + b[i]) % 63];
} else { }
else {
t[i + 1] = lambda[i + 1]; t[i + 1] = lambda[i + 1];
} }
} }
if (2 * el <= r - 1) { if (2 * el <= r - 1) {
el = r - el; el = r - el;
//b(x) <-- inv(DiscrR) * lambda(x) // b(x) <-- inv(DiscrR) * lambda(x)
for (i = 0; i <= nroots; i++) { for (i = 0; i <= nroots; i++) {
if (lambda[i]) { if (lambda[i]) {
b[i] = (rsGFlog[lambda[i]] - DiscrR + 63) % 63; b[i] = (rsGFlog[lambda[i]] - DiscrR + 63) % 63;
} else { }
else {
b[i] = 63; b[i] = 63;
} }
} }
} else { }
//shift elements upward one step else {
// shift elements upward one step
for (i = nroots; i >= 1; i += -1) { for (i = nroots; i >= 1; i += -1) {
b[i] = b[i - 1]; b[i] = b[i - 1];
} }
b[0] = 63; b[0] = 63;
} }
@@ -209,9 +359,9 @@ bool CRS241213::decode(unsigned char* data)
lambda[i] = t[i]; lambda[i] = t[i];
} }
} }
} /* end while() */ } /* end while() */
//convert lambda to index form and compute deg(lambda(x)) // convert lambda to index form and compute deg(lambda(x))
DegLambda = 0; DegLambda = 0;
for (i = 0; i <= nroots; i++) { for (i = 0; i <= nroots; i++) {
lambda[i] = rsGFlog[lambda[i]]; lambda[i] = rsGFlog[lambda[i]];
@@ -221,16 +371,16 @@ bool CRS241213::decode(unsigned char* data)
} }
} }
//Find roots of the error+erasure locator polynomial by Chien search // Find roots of the error+erasure locator polynomial by Chien search
for (i = 1; i <= nroots; i++) { for (i = 1; i <= nroots; i++) {
reg[i] = lambda[i]; reg[i] = lambda[i];
} }
count = 0;//number of roots of lambda(x) count = 0;// number of roots of lambda(x)
for (i = 1; i <= 63; i++) { for (i = 1; i <= 63; i++) {
q = 1;//lambda[0] is always 0 q = 1;// lambda[0] is always 0
for (j = DegLambda; j >= 1; j += -1) { for (j = DegLambda; j >= 1; j += -1) {
if (reg[j] != 63) { if (reg[j] != 63) {
reg[j] = (reg[j] + j) % 63; reg[j] = (reg[j] + j) % 63;
@@ -238,13 +388,14 @@ bool CRS241213::decode(unsigned char* data)
} }
} }
if (q == 0) { //it is a root // it is a root
//store root (index-form) and error location number if (q == 0) {
// store root (index-form) and error location number
root[count] = i; root[count] = i;
locn[count] = i - 40; locn[count] = i - 40;
//if wehave max possible roots, abort search to save time // if we have max possible roots, abort search to save time
count = count + 1; count = count + 1;
if (count == DegLambda) { if (count == DegLambda) {
break; break;
} }
@@ -252,18 +403,19 @@ bool CRS241213::decode(unsigned char* data)
} }
if (DegLambda != count) { if (DegLambda != count) {
//deg(lambda) unequal to number of roots => uncorrectable error detected // deg(lambda) unequal to number of roots => uncorrectable error detected
return false; return false;
} }
//compute err+eras evaluator poly omega(x) // compute err+eras evaluator poly omega(x)
// = s(x)*lambda(x) (modulo x**nroots). in index form. Also find deg(omega). // = s(x)*lambda(x) (modulo x**nroots). in index form. Also find deg(omega).
DegOmega = 0; DegOmega = 0;
for (i = 0; i <= nroots - 1; i++) { for (i = 0; i <= nroots - 1; i++) {
tmp = 0; tmp = 0;
if (DegLambda < i) { if (DegLambda < i) {
j = DegLambda; j = DegLambda;
} else { }
else {
j = i; j = i;
} }
@@ -301,7 +453,8 @@ bool CRS241213::decode(unsigned char* data)
// lambda[i+1] for i even is the formal derivative lambda_pr of lambda[i] // lambda[i+1] for i even is the formal derivative lambda_pr of lambda[i]
if (DegLambda < nroots) { if (DegLambda < nroots) {
i = DegLambda; i = DegLambda;
} else { }
else {
i = nroots; i = nroots;
} }
@@ -317,55 +470,15 @@ bool CRS241213::decode(unsigned char* data)
// apply error to data // apply error to data
if (num1 != 0) { if (num1 != 0) {
if(locn[j] < 24) if (locn[j] < firstData)
HB[locn[j]] = HB[locn[j]] ^ (rsGFexp[(rsGFlog[num1] + rsGFlog[num2] + 63 - rsGFlog[den]) % 63]); return false;
HB[locn[j]] = HB[locn[j]] ^ (rsGFexp[(rsGFlog[num1] + rsGFlog[num2] + 63 - rsGFlog[den]) % 63]);
} }
} }
offset = 0U; offset = 0U;
for (unsigned int i = 0U; i < 12U; i++, offset += 6U) for (unsigned int i = 0U; i < (unsigned int)nroots; i++, offset += 6)
hex2Bin(HB[i], data, offset); hex2Bin(HB[i], data, offset);
return true; return true;
} }
void CRS241213::encode(unsigned char* data)
{
assert(data != NULL);
unsigned char codeword[24U];
for (unsigned int i = 0U; i < 24U; i++) {
codeword[i] = 0x00U;
unsigned int offset = 0U;
for (unsigned int j = 0U; j < 12U; j++, offset += 6U) {
unsigned char hexbit = bin2Hex(data, offset);
codeword[i] ^= gf6Mult(hexbit, ENCODE_MATRIX[j][i]);
}
}
unsigned int offset = 0U;
for (unsigned int i = 0U; i < 24U; i++, offset += 6U)
hex2Bin(codeword[i], data, offset);
}
// GF(2 ^ 6) multiply(for Reed - Solomon encoder)
unsigned char CRS241213::gf6Mult(unsigned char a, unsigned char b) const
{
unsigned char p = 0x00U;
for (unsigned int i = 0U; i < 6U; i++) {
if ((b & 0x01U) == 0x01U)
p ^= a;
a <<= 1;
if ((a & 0x40U) == 0x40U)
a ^= 0x43U; // primitive polynomial : x ^ 6 + x + 1
b >>= 1;
}
return p;
}

View File

@@ -1,5 +1,6 @@
/* /*
* Copyright (C) 2016 by Jonathan Naylor G4KLX * Copyright (C) 2016 by Jonathan Naylor G4KLX
* Copyright (C) 2018 by Bryan Biedenkapp <gatekeep@gmail.com> N2PLL
* *
* This program is free software; you can redistribute it and/or modify * This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by * it under the terms of the GNU General Public License as published by
@@ -26,11 +27,16 @@ public:
~CRS241213(); ~CRS241213();
bool decode(unsigned char* data); bool decode(unsigned char* data);
bool decode24169(unsigned char* data);
bool decode362017(unsigned char* data);
void encode(unsigned char* data); void encode(unsigned char* data);
void encode24169(unsigned char* data);
void encode362017(unsigned char* data);
private: private:
unsigned char gf6Mult(unsigned char a, unsigned char b) const; unsigned char gf6Mult(unsigned char a, unsigned char b) const;
bool decode(unsigned char* data, const unsigned int bitLength, const int firstData, const int roots);
}; };
#endif #endif