|
|
|
@ -34,7 +34,8 @@
|
|
|
|
////////////////////////////////////////////////////////////////////////////////////////
|
|
|
|
////////////////////////////////////////////////////////////////////////////////////////
|
|
|
|
// constants & defines
|
|
|
|
// constants & defines
|
|
|
|
|
|
|
|
|
|
|
|
const unsigned int PRNG_TABLE[] = {
|
|
|
|
const unsigned int PRNG_TABLE[] =
|
|
|
|
|
|
|
|
{
|
|
|
|
0x42CC47U, 0x19D6FEU, 0x304729U, 0x6B2CD0U, 0x60BF47U, 0x39650EU, 0x7354F1U, 0xEACF60U, 0x819C9FU, 0xDE25CEU,
|
|
|
|
0x42CC47U, 0x19D6FEU, 0x304729U, 0x6B2CD0U, 0x60BF47U, 0x39650EU, 0x7354F1U, 0xEACF60U, 0x819C9FU, 0xDE25CEU,
|
|
|
|
0xD7B745U, 0x8CC8B8U, 0x8D592BU, 0xF71257U, 0xBCA084U, 0xA5B329U, 0xEE6AFAU, 0xF7D9A7U, 0xBCC21CU, 0x4712D9U,
|
|
|
|
0xD7B745U, 0x8CC8B8U, 0x8D592BU, 0xF71257U, 0xBCA084U, 0xA5B329U, 0xEE6AFAU, 0xF7D9A7U, 0xBCC21CU, 0x4712D9U,
|
|
|
|
0x4F2922U, 0x14FA37U, 0x5D43ECU, 0x564115U, 0x299A92U, 0x20A9EBU, 0x7B707DU, 0x3BE3A4U, 0x20D95BU, 0x6B085AU,
|
|
|
|
0x4F2922U, 0x14FA37U, 0x5D43ECU, 0x564115U, 0x299A92U, 0x20A9EBU, 0x7B707DU, 0x3BE3A4U, 0x20D95BU, 0x6B085AU,
|
|
|
|
@ -444,26 +445,33 @@ const unsigned int PRNG_TABLE[] = {
|
|
|
|
0xC9D7C8U, 0x98661FU, 0x93BDC6U, 0xC88EE5U, 0xC15438U, 0xBA45C3U, 0xF2FE56U, 0xE9290DU, 0x2230E8U, 0x3B9273U,
|
|
|
|
0xC9D7C8U, 0x98661FU, 0x93BDC6U, 0xC88EE5U, 0xC15438U, 0xBA45C3U, 0xF2FE56U, 0xE9290DU, 0x2230E8U, 0x3B9273U,
|
|
|
|
0x70C98FU, 0x0958DCU, 0x02A343U, 0x58B0A2U, 0x150A7DU, 0x0E5BC4U, 0x6FC897U, 0x74F33AU, 0x3F23E9U, 0x66A834U,
|
|
|
|
0x70C98FU, 0x0958DCU, 0x02A343U, 0x58B0A2U, 0x150A7DU, 0x0E5BC4U, 0x6FC897U, 0x74F33AU, 0x3F23E9U, 0x66A834U,
|
|
|
|
0xECDB0FU, 0xB542DAU, 0x9E5131U, 0xC7ABA5U, 0x8C38FEU, 0x97010BU, 0xDED290U, 0xA4CC7DU, 0xAD3D2EU, 0xF6B6B3U,
|
|
|
|
0xECDB0FU, 0xB542DAU, 0x9E5131U, 0xC7ABA5U, 0x8C38FEU, 0x97010BU, 0xDED290U, 0xA4CC7DU, 0xAD3D2EU, 0xF6B6B3U,
|
|
|
|
0xF9A540U, 0x205ED9U, 0x634EB6U, 0x5A9567U, 0x11A6D8U, 0x0B3F09U};
|
|
|
|
0xF9A540U, 0x205ED9U, 0x634EB6U, 0x5A9567U, 0x11A6D8U, 0x0B3F09U
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
const unsigned int DMR_A_TABLE[] = {0U, 4U, 8U, 12U, 16U, 20U, 24U, 28U, 32U, 36U, 40U, 44U,
|
|
|
|
const unsigned int DMR_A_TABLE[] = {0U, 4U, 8U, 12U, 16U, 20U, 24U, 28U, 32U, 36U, 40U, 44U,
|
|
|
|
48U, 52U, 56U, 60U, 64U, 68U, 1U, 5U, 9U, 13U, 17U, 21U};
|
|
|
|
48U, 52U, 56U, 60U, 64U, 68U, 1U, 5U, 9U, 13U, 17U, 21U
|
|
|
|
|
|
|
|
};
|
|
|
|
const unsigned int DMR_B_TABLE[] = {25U, 29U, 33U, 37U, 41U, 45U, 49U, 53U, 57U, 61U, 65U, 69U,
|
|
|
|
const unsigned int DMR_B_TABLE[] = {25U, 29U, 33U, 37U, 41U, 45U, 49U, 53U, 57U, 61U, 65U, 69U,
|
|
|
|
2U, 6U, 10U, 14U, 18U, 22U, 26U, 30U, 34U, 38U, 42U};
|
|
|
|
2U, 6U, 10U, 14U, 18U, 22U, 26U, 30U, 34U, 38U, 42U
|
|
|
|
|
|
|
|
};
|
|
|
|
const unsigned int DMR_C_TABLE[] = {46U, 50U, 54U, 58U, 62U, 66U, 70U, 3U, 7U, 11U, 15U, 19U, 23U,
|
|
|
|
const unsigned int DMR_C_TABLE[] = {46U, 50U, 54U, 58U, 62U, 66U, 70U, 3U, 7U, 11U, 15U, 19U, 23U,
|
|
|
|
27U, 31U, 35U, 39U, 43U, 47U, 51U, 55U, 59U, 63U, 67U, 71U};
|
|
|
|
27U, 31U, 35U, 39U, 43U, 47U, 51U, 55U, 59U, 63U, 67U, 71U
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
const unsigned char BIT_MASK_TABLE[] = {0x80U, 0x40U, 0x20U, 0x10U, 0x08U, 0x04U, 0x02U, 0x01U};
|
|
|
|
const unsigned char BIT_MASK_TABLE[] = {0x80U, 0x40U, 0x20U, 0x10U, 0x08U, 0x04U, 0x02U, 0x01U};
|
|
|
|
|
|
|
|
|
|
|
|
const unsigned int INTERLEAVE_TABLE_26_4[] = {
|
|
|
|
const unsigned int INTERLEAVE_TABLE_26_4[] =
|
|
|
|
|
|
|
|
{
|
|
|
|
0U, 4U, 8U, 12U, 16U, 20U, 24U, 28U, 32U, 36U, 40U, 44U, 48U, 52U, 56U, 60U, 64U, 68U, 72U, 76U, 80U, 84U, 88U, 92U, 96U, 100U,
|
|
|
|
0U, 4U, 8U, 12U, 16U, 20U, 24U, 28U, 32U, 36U, 40U, 44U, 48U, 52U, 56U, 60U, 64U, 68U, 72U, 76U, 80U, 84U, 88U, 92U, 96U, 100U,
|
|
|
|
1U, 5U, 9U, 13U, 17U, 21U, 25U, 29U, 33U, 37U, 41U, 45U, 49U, 53U, 57U, 61U, 65U, 69U, 73U, 77U, 81U, 85U, 89U, 93U, 97U, 101U,
|
|
|
|
1U, 5U, 9U, 13U, 17U, 21U, 25U, 29U, 33U, 37U, 41U, 45U, 49U, 53U, 57U, 61U, 65U, 69U, 73U, 77U, 81U, 85U, 89U, 93U, 97U, 101U,
|
|
|
|
2U, 6U, 10U, 14U, 18U, 22U, 26U, 30U, 34U, 38U, 42U, 46U, 50U, 54U, 58U, 62U, 66U, 70U, 74U, 78U, 82U, 86U, 90U, 94U, 98U, 102U,
|
|
|
|
2U, 6U, 10U, 14U, 18U, 22U, 26U, 30U, 34U, 38U, 42U, 46U, 50U, 54U, 58U, 62U, 66U, 70U, 74U, 78U, 82U, 86U, 90U, 94U, 98U, 102U,
|
|
|
|
3U, 7U, 11U, 15U, 19U, 23U, 27U, 31U, 35U, 39U, 43U, 47U, 51U, 55U, 59U, 63U, 67U, 71U, 75U, 79U, 83U, 87U, 91U, 95U, 99U, 103U};
|
|
|
|
3U, 7U, 11U, 15U, 19U, 23U, 27U, 31U, 35U, 39U, 43U, 47U, 51U, 55U, 59U, 63U, 67U, 71U, 75U, 79U, 83U, 87U, 91U, 95U, 99U, 103U
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
const unsigned char WHITENING_DATA[] = {0x93U, 0xD7U, 0x51U, 0x21U, 0x9CU, 0x2FU, 0x6CU, 0xD0U, 0xEFU, 0x0FU,
|
|
|
|
const unsigned char WHITENING_DATA[] = {0x93U, 0xD7U, 0x51U, 0x21U, 0x9CU, 0x2FU, 0x6CU, 0xD0U, 0xEFU, 0x0FU,
|
|
|
|
0xF8U, 0x3DU, 0xF1U, 0x73U, 0x20U, 0x94U, 0xEDU, 0x1EU, 0x7CU, 0xD8U};
|
|
|
|
0xF8U, 0x3DU, 0xF1U, 0x73U, 0x20U, 0x94U, 0xEDU, 0x1EU, 0x7CU, 0xD8U
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
////////////////////////////////////////////////////////////////////////////////////////
|
|
|
|
////////////////////////////////////////////////////////////////////////////////////////
|
|
|
|
// macros
|
|
|
|
// macros
|
|
|
|
@ -483,7 +491,8 @@ void CYsfUtils::DecodeVD2Vchs(uint8 *data, uint8 **ambe)
|
|
|
|
unsigned int offset = 40U; // DCH(0)
|
|
|
|
unsigned int offset = 40U; // DCH(0)
|
|
|
|
|
|
|
|
|
|
|
|
// We have a total of 5 VCH sections, iterate through each
|
|
|
|
// We have a total of 5 VCH sections, iterate through each
|
|
|
|
for (unsigned int j = 0U; j < 5U; j++, offset += 144U) {
|
|
|
|
for (unsigned int j = 0U; j < 5U; j++, offset += 144U)
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
|
|
unsigned char vch[13U];
|
|
|
|
unsigned char vch[13U];
|
|
|
|
unsigned int dat_a = 0U;
|
|
|
|
unsigned int dat_a = 0U;
|
|
|
|
@ -491,7 +500,8 @@ void CYsfUtils::DecodeVD2Vchs(uint8 *data, uint8 **ambe)
|
|
|
|
unsigned int dat_c = 0U;
|
|
|
|
unsigned int dat_c = 0U;
|
|
|
|
|
|
|
|
|
|
|
|
// Deinterleave
|
|
|
|
// Deinterleave
|
|
|
|
for (unsigned int i = 0U; i < 104U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 104U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int n = INTERLEAVE_TABLE_26_4[i];
|
|
|
|
unsigned int n = INTERLEAVE_TABLE_26_4[i];
|
|
|
|
bool s = READ_BIT(data, offset + n);
|
|
|
|
bool s = READ_BIT(data, offset + n);
|
|
|
|
WRITE_BIT(vch, i, s);
|
|
|
|
WRITE_BIT(vch, i, s);
|
|
|
|
@ -501,28 +511,32 @@ void CYsfUtils::DecodeVD2Vchs(uint8 *data, uint8 **ambe)
|
|
|
|
for (unsigned int i = 0U; i < 13U; i++)
|
|
|
|
for (unsigned int i = 0U; i < 13U; i++)
|
|
|
|
vch[i] ^= WHITENING_DATA[i];
|
|
|
|
vch[i] ^= WHITENING_DATA[i];
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
dat_a <<= 1U;
|
|
|
|
dat_a <<= 1U;
|
|
|
|
if (READ_BIT(vch, 3U*i + 1U))
|
|
|
|
if (READ_BIT(vch, 3U*i + 1U))
|
|
|
|
dat_a |= 0x01U;;
|
|
|
|
dat_a |= 0x01U;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
dat_b <<= 1U;
|
|
|
|
dat_b <<= 1U;
|
|
|
|
if (READ_BIT(vch, 3U*(i + 12U) + 1U))
|
|
|
|
if (READ_BIT(vch, 3U*(i + 12U) + 1U))
|
|
|
|
dat_b |= 0x01U;;
|
|
|
|
dat_b |= 0x01U;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 3U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 3U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
dat_c <<= 1U;
|
|
|
|
dat_c <<= 1U;
|
|
|
|
if (READ_BIT(vch, 3U*(i + 24U) + 1U))
|
|
|
|
if (READ_BIT(vch, 3U*(i + 24U) + 1U))
|
|
|
|
dat_c |= 0x01U;;
|
|
|
|
dat_c |= 0x01U;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 22U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 22U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
dat_c <<= 1U;
|
|
|
|
dat_c <<= 1U;
|
|
|
|
if (READ_BIT(vch, i + 81U))
|
|
|
|
if (READ_BIT(vch, i + 81U))
|
|
|
|
dat_c |= 0x01U;;
|
|
|
|
dat_c |= 0x01U;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// convert to ambe2plus
|
|
|
|
// convert to ambe2plus
|
|
|
|
@ -534,19 +548,22 @@ void CYsfUtils::DecodeVD2Vchs(uint8 *data, uint8 **ambe)
|
|
|
|
b ^= p;
|
|
|
|
b ^= p;
|
|
|
|
|
|
|
|
|
|
|
|
unsigned int MASK = 0x800000U;
|
|
|
|
unsigned int MASK = 0x800000U;
|
|
|
|
for (unsigned int i = 0U; i < 24U; i++, MASK >>= 1) {
|
|
|
|
for (unsigned int i = 0U; i < 24U; i++, MASK >>= 1)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int aPos = DMR_A_TABLE[i];
|
|
|
|
unsigned int aPos = DMR_A_TABLE[i];
|
|
|
|
WRITE_BIT(v_dmr, aPos, a & MASK);
|
|
|
|
WRITE_BIT(v_dmr, aPos, a & MASK);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
MASK = 0x400000U;
|
|
|
|
MASK = 0x400000U;
|
|
|
|
for (unsigned int i = 0U; i < 23U; i++, MASK >>= 1) {
|
|
|
|
for (unsigned int i = 0U; i < 23U; i++, MASK >>= 1)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int bPos = DMR_B_TABLE[i];
|
|
|
|
unsigned int bPos = DMR_B_TABLE[i];
|
|
|
|
WRITE_BIT(v_dmr, bPos, b & MASK);
|
|
|
|
WRITE_BIT(v_dmr, bPos, b & MASK);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
MASK = 0x1000000U;
|
|
|
|
MASK = 0x1000000U;
|
|
|
|
for (unsigned int i = 0U; i < 25U; i++, MASK >>= 1) {
|
|
|
|
for (unsigned int i = 0U; i < 25U; i++, MASK >>= 1)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int cPos = DMR_C_TABLE[i];
|
|
|
|
unsigned int cPos = DMR_C_TABLE[i];
|
|
|
|
WRITE_BIT(v_dmr, cPos, dat_c & MASK);
|
|
|
|
WRITE_BIT(v_dmr, cPos, dat_c & MASK);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
@ -560,7 +577,8 @@ void CYsfUtils::EncodeVD2Vch(uint8 *ambe, uint8 *data)
|
|
|
|
// convert from ambe2plus
|
|
|
|
// convert from ambe2plus
|
|
|
|
unsigned int a = 0U;
|
|
|
|
unsigned int a = 0U;
|
|
|
|
unsigned int MASK = 0x800000U;
|
|
|
|
unsigned int MASK = 0x800000U;
|
|
|
|
for (unsigned int i = 0U; i < 24U; i++, MASK >>= 1) {
|
|
|
|
for (unsigned int i = 0U; i < 24U; i++, MASK >>= 1)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int aPos = DMR_A_TABLE[i];
|
|
|
|
unsigned int aPos = DMR_A_TABLE[i];
|
|
|
|
|
|
|
|
|
|
|
|
if (READ_BIT(ambe, aPos))
|
|
|
|
if (READ_BIT(ambe, aPos))
|
|
|
|
@ -569,7 +587,8 @@ void CYsfUtils::EncodeVD2Vch(uint8 *ambe, uint8 *data)
|
|
|
|
|
|
|
|
|
|
|
|
unsigned int b = 0U;
|
|
|
|
unsigned int b = 0U;
|
|
|
|
MASK = 0x400000U;
|
|
|
|
MASK = 0x400000U;
|
|
|
|
for (unsigned int i = 0U; i < 23U; i++, MASK >>= 1) {
|
|
|
|
for (unsigned int i = 0U; i < 23U; i++, MASK >>= 1)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int bPos = DMR_B_TABLE[i];
|
|
|
|
unsigned int bPos = DMR_B_TABLE[i];
|
|
|
|
|
|
|
|
|
|
|
|
if (READ_BIT(ambe, bPos))
|
|
|
|
if (READ_BIT(ambe, bPos))
|
|
|
|
@ -578,7 +597,8 @@ void CYsfUtils::EncodeVD2Vch(uint8 *ambe, uint8 *data)
|
|
|
|
|
|
|
|
|
|
|
|
unsigned int dat_c = 0U;
|
|
|
|
unsigned int dat_c = 0U;
|
|
|
|
MASK = 0x1000000U;
|
|
|
|
MASK = 0x1000000U;
|
|
|
|
for (unsigned int i = 0U; i < 25U; i++, MASK >>= 1) {
|
|
|
|
for (unsigned int i = 0U; i < 25U; i++, MASK >>= 1)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int cPos = DMR_C_TABLE[i];
|
|
|
|
unsigned int cPos = DMR_C_TABLE[i];
|
|
|
|
|
|
|
|
|
|
|
|
if (READ_BIT(ambe, cPos))
|
|
|
|
if (READ_BIT(ambe, cPos))
|
|
|
|
@ -598,28 +618,32 @@ void CYsfUtils::EncodeVD2Vch(uint8 *ambe, uint8 *data)
|
|
|
|
|
|
|
|
|
|
|
|
unsigned int dat_b = b >> 11;
|
|
|
|
unsigned int dat_b = b >> 11;
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
bool s = (dat_a << (20U + i)) & 0x80000000U;
|
|
|
|
bool s = (dat_a << (20U + i)) & 0x80000000U;
|
|
|
|
WRITE_BIT(vch, 3*i + 0U, s);
|
|
|
|
WRITE_BIT(vch, 3*i + 0U, s);
|
|
|
|
WRITE_BIT(vch, 3*i + 1U, s);
|
|
|
|
WRITE_BIT(vch, 3*i + 1U, s);
|
|
|
|
WRITE_BIT(vch, 3*i + 2U, s);
|
|
|
|
WRITE_BIT(vch, 3*i + 2U, s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 12U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
bool s = (dat_b << (20U + i)) & 0x80000000U;
|
|
|
|
bool s = (dat_b << (20U + i)) & 0x80000000U;
|
|
|
|
WRITE_BIT(vch, 3*(i + 12U) + 0U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 12U) + 0U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 12U) + 1U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 12U) + 1U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 12U) + 2U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 12U) + 2U, s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 3U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 3U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
bool s = (dat_c << (7U + i)) & 0x80000000U;
|
|
|
|
bool s = (dat_c << (7U + i)) & 0x80000000U;
|
|
|
|
WRITE_BIT(vch, 3*(i + 24U) + 0U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 24U) + 0U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 24U) + 1U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 24U) + 1U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 24U) + 2U, s);
|
|
|
|
WRITE_BIT(vch, 3*(i + 24U) + 2U, s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
for (unsigned int i = 0U; i < 22U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 22U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
bool s = (dat_c << (10U + i)) & 0x80000000U;
|
|
|
|
bool s = (dat_c << (10U + i)) & 0x80000000U;
|
|
|
|
WRITE_BIT(vch, i + 81U, s);
|
|
|
|
WRITE_BIT(vch, i + 81U, s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
@ -631,11 +655,12 @@ void CYsfUtils::EncodeVD2Vch(uint8 *ambe, uint8 *data)
|
|
|
|
vch[i] ^= WHITENING_DATA[i];
|
|
|
|
vch[i] ^= WHITENING_DATA[i];
|
|
|
|
|
|
|
|
|
|
|
|
// Interleave
|
|
|
|
// Interleave
|
|
|
|
for (unsigned int i = 0U; i < 104U; i++) {
|
|
|
|
for (unsigned int i = 0U; i < 104U; i++)
|
|
|
|
|
|
|
|
{
|
|
|
|
unsigned int n = INTERLEAVE_TABLE_26_4[i];
|
|
|
|
unsigned int n = INTERLEAVE_TABLE_26_4[i];
|
|
|
|
bool s = READ_BIT(vch, i);
|
|
|
|
bool s = READ_BIT(vch, i);
|
|
|
|
WRITE_BIT(ysfFrame, n, s);
|
|
|
|
WRITE_BIT(ysfFrame, n, s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
::memcpy(data, ysfFrame, 13U);
|
|
|
|
::memcpy(data, ysfFrame, 13U);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|