2017-10-24 08:37:52 +13:00
|
|
|
/**
|
|
|
|
|
2013-05-17 05:26:38 +12:00
|
|
|
This is a simple Reed-Solomon encoder
|
|
|
|
(C) Cliff Hones 2004
|
2017-10-24 08:37:52 +13:00
|
|
|
|
2013-05-17 05:26:38 +12:00
|
|
|
Redistribution and use in source and binary forms, with or without
|
|
|
|
modification, are permitted provided that the following conditions
|
|
|
|
are met:
|
|
|
|
|
2017-10-24 08:37:52 +13:00
|
|
|
1. Redistributions of source code must retain the above copyright
|
|
|
|
notice, this list of conditions and the following disclaimer.
|
2013-05-17 05:26:38 +12:00
|
|
|
2. Redistributions in binary form must reproduce the above copyright
|
|
|
|
notice, this list of conditions and the following disclaimer in the
|
2017-10-24 08:37:52 +13:00
|
|
|
documentation and/or other materials provided with the distribution.
|
2013-05-17 05:26:38 +12:00
|
|
|
3. Neither the name of the project nor the names of its contributors
|
|
|
|
may be used to endorse or promote products derived from this software
|
2017-10-24 08:37:52 +13:00
|
|
|
without specific prior written permission.
|
2013-05-17 05:26:38 +12:00
|
|
|
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
|
|
|
|
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
|
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
|
|
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE
|
|
|
|
FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
|
|
DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
|
|
OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
|
|
HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
|
|
LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
2017-10-24 08:37:52 +13:00
|
|
|
OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
|
|
SUCH DAMAGE.
|
2016-02-21 00:29:19 +13:00
|
|
|
*/
|
2008-07-14 09:15:55 +12:00
|
|
|
|
|
|
|
// It is not written with high efficiency in mind, so is probably
|
|
|
|
// not suitable for real-time encoding. The aim was to keep it
|
|
|
|
// simple, general and clear.
|
|
|
|
//
|
|
|
|
// <Some notes on the theory and implementation need to be added here>
|
|
|
|
|
|
|
|
// Usage:
|
|
|
|
// First call rs_init_gf(poly) to set up the Galois Field parameters.
|
|
|
|
// Then call rs_init_code(size, index) to set the encoding size
|
|
|
|
// Then call rs_encode(datasize, data, out) to encode the data.
|
|
|
|
//
|
|
|
|
// These can be called repeatedly as required - but note that
|
|
|
|
// rs_init_code must be called following any rs_init_gf call.
|
|
|
|
//
|
|
|
|
// If the parameters are fixed, some of the statics below can be
|
|
|
|
// replaced with constants in the obvious way, and additionally
|
|
|
|
// malloc/free can be avoided by using static arrays of a suitable
|
|
|
|
// size.
|
|
|
|
|
|
|
|
#include <stdio.h> // only needed for debug (main)
|
2019-12-07 02:09:39 +13:00
|
|
|
#ifdef _MSC_VER
|
2019-10-30 20:46:36 +13:00
|
|
|
#include <malloc.h>
|
2019-12-09 05:15:34 +13:00
|
|
|
#else
|
|
|
|
#include <stdlib.h>
|
2019-12-07 02:09:39 +13:00
|
|
|
#endif
|
2009-06-03 08:23:38 +12:00
|
|
|
#include "reedsol.h"
|
2016-02-21 00:29:19 +13:00
|
|
|
static int logmod; // 2**symsize - 1
|
2008-07-14 09:15:55 +12:00
|
|
|
static int rlen;
|
|
|
|
|
2009-06-03 08:23:38 +12:00
|
|
|
static int *logt = NULL, *alog = NULL, *rspoly = NULL;
|
2008-07-14 09:15:55 +12:00
|
|
|
|
|
|
|
// rs_init_gf(poly) initialises the parameters for the Galois Field.
|
|
|
|
// The symbol size is determined from the highest bit set in poly
|
|
|
|
// This implementation will support sizes up to 30 bits (though that
|
|
|
|
// will result in very large log/antilog tables) - bit sizes of
|
|
|
|
// 8 or 4 are typical
|
|
|
|
//
|
|
|
|
// The poly is the bit pattern representing the GF characteristic
|
|
|
|
// polynomial. e.g. for ECC200 (8-bit symbols) the polynomial is
|
|
|
|
// a**8 + a**5 + a**3 + a**2 + 1, which translates to 0x12d.
|
|
|
|
|
2016-03-01 08:42:32 +13:00
|
|
|
void rs_init_gf(const int poly) {
|
2016-02-21 00:29:19 +13:00
|
|
|
int m, b, p, v;
|
|
|
|
|
|
|
|
// Find the top bit, and hence the symbol size
|
|
|
|
for (b = 1, m = 0; b <= poly; b <<= 1)
|
|
|
|
m++;
|
|
|
|
b >>= 1;
|
|
|
|
m--;
|
|
|
|
|
2019-10-30 20:46:36 +13:00
|
|
|
// Ensure m not negative to supress gcc -Walloc-size-larger-than
|
|
|
|
if (m < 0) {
|
|
|
|
m = 0;
|
|
|
|
}
|
|
|
|
|
2016-02-21 00:29:19 +13:00
|
|
|
// Calculate the log/alog tables
|
|
|
|
logmod = (1 << m) - 1;
|
|
|
|
logt = (int *) malloc(sizeof (int) * (logmod + 1));
|
|
|
|
alog = (int *) malloc(sizeof (int) * logmod);
|
|
|
|
|
|
|
|
for (p = 1, v = 0; v < logmod; v++) {
|
|
|
|
alog[v] = p;
|
|
|
|
logt[p] = v;
|
|
|
|
p <<= 1;
|
|
|
|
if (p & b)
|
|
|
|
p ^= poly;
|
|
|
|
}
|
2008-07-14 09:15:55 +12:00
|
|
|
}
|
|
|
|
|
|
|
|
// rs_init_code(nsym, index) initialises the Reed-Solomon encoder
|
|
|
|
// nsym is the number of symbols to be generated (to be appended
|
|
|
|
// to the input data). index is usually 1 - it is the index of
|
|
|
|
// the constant in the first term (i) of the RS generator polynomial:
|
|
|
|
// (x + 2**i)*(x + 2**(i+1))*... [nsym terms]
|
|
|
|
// For ECC200, index is 1.
|
|
|
|
|
2016-03-03 10:12:38 +13:00
|
|
|
void rs_init_code(const int nsym, int index) {
|
2016-02-21 00:29:19 +13:00
|
|
|
int i, k;
|
|
|
|
|
|
|
|
rspoly = (int *) malloc(sizeof (int) * (nsym + 1));
|
|
|
|
|
|
|
|
rlen = nsym;
|
|
|
|
|
|
|
|
rspoly[0] = 1;
|
|
|
|
for (i = 1; i <= nsym; i++) {
|
|
|
|
rspoly[i] = 1;
|
|
|
|
for (k = i - 1; k > 0; k--) {
|
|
|
|
if (rspoly[k])
|
|
|
|
rspoly[k] = alog[(logt[rspoly[k]] + index) % logmod];
|
|
|
|
rspoly[k] ^= rspoly[k - 1];
|
|
|
|
}
|
|
|
|
rspoly[0] = alog[(logt[rspoly[0]] + index) % logmod];
|
|
|
|
index++;
|
|
|
|
}
|
2008-07-14 09:15:55 +12:00
|
|
|
}
|
|
|
|
|
2017-05-29 21:43:47 +12:00
|
|
|
void rs_encode(const size_t len,const unsigned char *data, unsigned char *res) {
|
2017-09-11 03:03:09 +12:00
|
|
|
int i, k;
|
2016-02-21 00:29:19 +13:00
|
|
|
for (i = 0; i < rlen; i++)
|
|
|
|
res[i] = 0;
|
|
|
|
for (i = 0; i < len; i++) {
|
2017-09-11 03:03:09 +12:00
|
|
|
int m = res[rlen - 1] ^ data[i];
|
2016-02-21 00:29:19 +13:00
|
|
|
for (k = rlen - 1; k > 0; k--) {
|
|
|
|
if (m && rspoly[k])
|
2016-03-03 10:12:38 +13:00
|
|
|
res[k] = (unsigned char) (res[k - 1] ^ alog[(logt[m] + logt[rspoly[k]]) % logmod]);
|
2016-02-21 00:29:19 +13:00
|
|
|
else
|
|
|
|
res[k] = res[k - 1];
|
|
|
|
}
|
|
|
|
if (m && rspoly[0])
|
2016-03-03 10:12:38 +13:00
|
|
|
res[0] = (unsigned char) (alog[(logt[m] + logt[rspoly[0]]) % logmod]);
|
2016-02-21 00:29:19 +13:00
|
|
|
else
|
|
|
|
res[0] = 0;
|
|
|
|
}
|
2008-07-14 09:15:55 +12:00
|
|
|
}
|
|
|
|
|
2016-02-21 00:29:19 +13:00
|
|
|
/* The same as above but for larger bitlengths - Aztec code compatible */
|
2016-03-03 10:12:38 +13:00
|
|
|
void rs_encode_long(const int len, const unsigned int *data, unsigned int *res) {
|
2017-09-11 03:03:09 +12:00
|
|
|
int i, k;
|
2016-02-21 00:29:19 +13:00
|
|
|
for (i = 0; i < rlen; i++)
|
|
|
|
res[i] = 0;
|
|
|
|
for (i = 0; i < len; i++) {
|
2017-09-11 03:03:09 +12:00
|
|
|
int m = res[rlen - 1] ^ data[i];
|
2016-02-21 00:29:19 +13:00
|
|
|
for (k = rlen - 1; k > 0; k--) {
|
|
|
|
if (m && rspoly[k])
|
|
|
|
res[k] = res[k - 1] ^ alog[(logt[m] + logt[rspoly[k]]) % logmod];
|
|
|
|
else
|
|
|
|
res[k] = res[k - 1];
|
|
|
|
}
|
|
|
|
if (m && rspoly[0])
|
|
|
|
res[0] = alog[(logt[m] + logt[rspoly[0]]) % logmod];
|
|
|
|
else
|
|
|
|
res[0] = 0;
|
|
|
|
}
|
2008-10-13 07:52:54 +13:00
|
|
|
}
|
|
|
|
|
2016-02-21 00:29:19 +13:00
|
|
|
/* Free memory */
|
2016-03-03 10:12:38 +13:00
|
|
|
void rs_free(void) {
|
2016-02-21 00:29:19 +13:00
|
|
|
free(logt);
|
|
|
|
free(alog);
|
|
|
|
free(rspoly);
|
|
|
|
rspoly = NULL;
|
2008-07-14 09:15:55 +12:00
|
|
|
}
|
2017-10-24 08:37:52 +13:00
|
|
|
|