kopia lustrzana https://github.com/sq8vps/vp-digi
84 wiersze
1.8 KiB
C
84 wiersze
1.8 KiB
C
|
|
#ifdef ENABLE_FX25
|
|
|
|
#include "fx25.h"
|
|
#include <stddef.h>
|
|
#include "rs.h"
|
|
|
|
#define FX25_PREGENERATE_POLYS
|
|
|
|
const struct Fx25Mode Fx25ModeList[11] =
|
|
{
|
|
{.tag = 0xB74DB7DF8A532F3E, .K = 239, .T = 16},
|
|
{.tag = 0x26FF60A600CC8FDE, .K = 128, .T = 16},
|
|
{.tag = 0xC7DC0508F3D9B09E, .K = 64, .T = 16},
|
|
{.tag = 0x8F056EB4369660EE, .K = 32, .T = 16},
|
|
{.tag = 0x6E260B1AC5835FAE, .K = 223, .T = 32},
|
|
{.tag = 0xFF94DC634F1CFF4E, .K = 128, .T = 32},
|
|
{.tag = 0x1EB7B9CDBC09C00E, .K = 64, .T = 32},
|
|
{.tag = 0xDBF869BD2DBB1776, .K = 32, .T = 32},
|
|
{.tag = 0x3ADB0C13DEAE2836, .K = 191, .T = 64},
|
|
{.tag = 0xAB69DB6A543188D6, .K = 128, .T = 64},
|
|
{.tag = 0x4A4ABEC4A724B796, .K = 64, .T = 64}
|
|
};
|
|
|
|
const struct Fx25Mode* Fx25GetMode(uint16_t size)
|
|
{
|
|
if(size <= 32)
|
|
return &Fx25ModeList[3];
|
|
else if(size <= 64)
|
|
return &Fx25ModeList[2];
|
|
else if(size <= 128)
|
|
return &Fx25ModeList[5];
|
|
else if(size <= 191)
|
|
return &Fx25ModeList[8];
|
|
else if(size <= 223)
|
|
return &Fx25ModeList[4];
|
|
else if(size <= 239)
|
|
return &Fx25ModeList[0];
|
|
else
|
|
return NULL; //frame too big, do not use FX.25
|
|
}
|
|
|
|
#ifdef FX25_PREGENERATE_POLYS
|
|
static uint8_t poly16[17], poly32[33], poly64[65];
|
|
#else
|
|
static uint8_t poly[65];
|
|
#endif
|
|
|
|
void Fx25AddParity(uint8_t *buffer, const struct Fx25Mode *mode)
|
|
{
|
|
#ifdef FX25_PREGENERATE_POLYS
|
|
uint8_t *poly = NULL;
|
|
switch(mode->T)
|
|
{
|
|
case 16:
|
|
poly = poly16;
|
|
break;
|
|
case 32:
|
|
poly = poly32;
|
|
break;
|
|
case 64:
|
|
poly = poly64;
|
|
break;
|
|
default:
|
|
poly = poly16;
|
|
}
|
|
#else
|
|
RsGeneratePolynomial(mode->T, poly);
|
|
#endif
|
|
RsEncode(buffer, mode->K + mode->T, poly, mode->T);
|
|
}
|
|
|
|
void Fx25Init(void)
|
|
{
|
|
#ifdef FX25_PREGENERATE_POLYS
|
|
RsGeneratePolynomial(16, poly16);
|
|
RsGeneratePolynomial(32, poly32);
|
|
RsGeneratePolynomial(64, poly64);
|
|
#else
|
|
#endif
|
|
}
|
|
|
|
#endif
|