2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
|
#include <stdlib.h>
|
|
|
|
|
#include <string.h>
|
|
|
|
|
#include <setjmp.h>
|
|
|
|
|
#include <math.h>
|
|
|
|
|
#include "j2k.h"
|
|
|
|
|
#include "cio.h"
|
|
|
|
|
#include "jpw.h"
|
|
|
|
|
|
|
|
|
|
#define J2K_MS_SOC 0xff4f
|
|
|
|
|
#define J2K_MS_SIZ 0xff51
|
|
|
|
|
#define J2K_MS_SOT 0xff90
|
|
|
|
|
#define JPWL_MS_EPC 0xff97
|
|
|
|
|
#define JPWL_MS_EPB 0xff96
|
|
|
|
|
#define JPWL_MS_RED 0xff99
|
|
|
|
|
#define J2K_MS_EOC 0xffd9
|
|
|
|
|
|
|
|
|
|
#define J2K_STATE_MHSOC 0x0001
|
|
|
|
|
#define J2K_STATE_TPHSOT 0x0008
|
|
|
|
|
#define J2K_STATE_MH 0x0004
|
|
|
|
|
#define J2K_STATE_TPH 0x0010
|
|
|
|
|
#define J2K_STATE_MT 0x0020
|
|
|
|
|
|
|
|
|
|
#define mm 8 /* RS code over GF(2**4) - change to suit */
|
|
|
|
|
|
|
|
|
|
int pp [mm+1] = { 1, 0, 1, 1, 1, 0, 0, 0, 1 };
|
|
|
|
|
|
|
|
|
|
int *alpha_to, *index_of, *gg;
|
|
|
|
|
int *recd, *data, *bb;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static long crcSum;
|
|
|
|
|
|
|
|
|
|
static int CrcT16[256] =
|
|
|
|
|
{0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50a5, 0x60c6, 0x70e7,
|
|
|
|
|
0x8108, 0x9129, 0xa14a, 0xb16b, 0xc18c, 0xd1ad, 0xe1ce, 0xf1ef,
|
|
|
|
|
0x1231, 0x0210, 0x3273, 0x2252, 0x52b5, 0x4294, 0x72f7, 0x62d6,
|
|
|
|
|
0x9339, 0x8318, 0xb37b, 0xa35a, 0xd3bd, 0xc39c, 0xf3ff, 0xe3de,
|
|
|
|
|
0x2462, 0x3443, 0x0420, 0x1401, 0x64e6, 0x74c7, 0x44a4, 0x5485,
|
|
|
|
|
0xa56a, 0xb54b, 0x8528, 0x9509, 0xe5ee, 0xf5cf, 0xc5ac, 0xd58d,
|
|
|
|
|
0x3653, 0x2672, 0x1611, 0x0630, 0x76d7, 0x66f6, 0x5695, 0x46b4,
|
|
|
|
|
0xb75b, 0xa77a, 0x9719, 0x8738, 0xf7df, 0xe7fe, 0xd79d, 0xc7bc,
|
|
|
|
|
0x48c4, 0x58e5, 0x6886, 0x78a7, 0x0840, 0x1861, 0x2802, 0x3823,
|
|
|
|
|
0xc9cc, 0xd9ed, 0xe98e, 0xf9af, 0x8948, 0x9969, 0xa90a, 0xb92b,
|
|
|
|
|
0x5af5, 0x4ad4, 0x7ab7, 0x6a96, 0x1a71, 0x0a50, 0x3a33, 0x2a12,
|
|
|
|
|
0xdbfd, 0xcbdc, 0xfbbf, 0xeb9e, 0x9b79, 0x8b58, 0xbb3b, 0xab1a,
|
|
|
|
|
0x6ca6, 0x7c87, 0x4ce4, 0x5cc5, 0x2c22, 0x3c03, 0x0c60, 0x1c41,
|
|
|
|
|
0xedae, 0xfd8f, 0xcdec, 0xddcd, 0xad2a, 0xbd0b, 0x8d68, 0x9d49,
|
|
|
|
|
0x7e97, 0x6eb6, 0x5ed5, 0x4ef4, 0x3e13, 0x2e32, 0x1e51, 0x0e70,
|
|
|
|
|
0xff9f, 0xefbe, 0xdfdd, 0xcffc, 0xbf1b, 0xaf3a, 0x9f59, 0x8f78,
|
|
|
|
|
0x9188, 0x81a9, 0xb1ca, 0xa1eb, 0xd10c, 0xc12d, 0xf14e, 0xe16f,
|
|
|
|
|
0x1080, 0x00a1, 0x30c2, 0x20e3, 0x5004, 0x4025, 0x7046, 0x6067,
|
|
|
|
|
0x83b9, 0x9398, 0xa3fb, 0xb3da, 0xc33d, 0xd31c, 0xe37f, 0xf35e,
|
|
|
|
|
0x02b1, 0x1290, 0x22f3, 0x32d2, 0x4235, 0x5214, 0x6277, 0x7256,
|
|
|
|
|
0xb5ea, 0xa5cb, 0x95a8, 0x8589, 0xf56e, 0xe54f, 0xd52c, 0xc50d,
|
|
|
|
|
0x34e2, 0x24c3, 0x14a0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405,
|
|
|
|
|
0xa7db, 0xb7fa, 0x8799, 0x97b8, 0xe75f, 0xf77e, 0xc71d, 0xd73c,
|
|
|
|
|
0x26d3, 0x36f2, 0x0691, 0x16b0, 0x6657, 0x7676, 0x4615, 0x5634,
|
|
|
|
|
0xd94c, 0xc96d, 0xf90e, 0xe92f, 0x99c8, 0x89e9, 0xb98a, 0xa9ab,
|
|
|
|
|
0x5844, 0x4865, 0x7806, 0x6827, 0x18c0, 0x08e1, 0x3882, 0x28a3,
|
|
|
|
|
0xcb7d, 0xdb5c, 0xeb3f, 0xfb1e, 0x8bf9, 0x9bd8, 0xabbb, 0xbb9a,
|
|
|
|
|
0x4a75, 0x5a54, 0x6a37, 0x7a16, 0x0af1, 0x1ad0, 0x2ab3, 0x3a92,
|
|
|
|
|
0xfd2e, 0xed0f, 0xdd6c, 0xcd4d, 0xbdaa, 0xad8b, 0x9de8, 0x8dc9,
|
|
|
|
|
0x7c26, 0x6c07, 0x5c64, 0x4c45, 0x3ca2, 0x2c83, 0x1ce0, 0x0cc1,
|
|
|
|
|
0xef1f, 0xff3e, 0xcf5d, 0xdf7c, 0xaf9b, 0xbfba, 0x8fd9, 0x9ff8,
|
|
|
|
|
0x6e17, 0x7e36, 0x4e55, 0x5e74, 0x2e93, 0x3eb2, 0x0ed1, 0x1ef0};
|
|
|
|
|
|
|
|
|
|
static long CrcT32[256] = {0x00000000, 0x04c11db7, 0x09823b6e, 0x0d4326d9,
|
|
|
|
|
0x130476dc, 0x17c56b6b, 0x1a864db2, 0x1e475005,
|
|
|
|
|
0x2608edb8, 0x22c9f00f, 0x2f8ad6d6, 0x2b4bcb61,
|
|
|
|
|
0x350c9b64, 0x31cd86d3, 0x3c8ea00a, 0x384fbdbd,
|
|
|
|
|
0x4c11db70, 0x48d0c6c7, 0x4593e01e, 0x4152fda9,
|
|
|
|
|
0x5f15adac, 0x5bd4b01b, 0x569796c2, 0x52568b75,
|
|
|
|
|
0x6a1936c8, 0x6ed82b7f, 0x639b0da6, 0x675a1011,
|
|
|
|
|
0x791d4014, 0x7ddc5da3, 0x709f7b7a, 0x745e66cd,
|
|
|
|
|
0x9823b6e0, 0x9ce2ab57, 0x91a18d8e, 0x95609039,
|
|
|
|
|
0x8b27c03c, 0x8fe6dd8b, 0x82a5fb52, 0x8664e6e5,
|
|
|
|
|
0xbe2b5b58, 0xbaea46ef, 0xb7a96036, 0xb3687d81,
|
|
|
|
|
0xad2f2d84, 0xa9ee3033, 0xa4ad16ea, 0xa06c0b5d,
|
|
|
|
|
0xd4326d90, 0xd0f37027, 0xddb056fe, 0xd9714b49,
|
|
|
|
|
0xc7361b4c, 0xc3f706fb, 0xceb42022, 0xca753d95,
|
|
|
|
|
0xf23a8028, 0xf6fb9d9f, 0xfbb8bb46, 0xff79a6f1,
|
|
|
|
|
0xe13ef6f4, 0xe5ffeb43, 0xe8bccd9a, 0xec7dd02d,
|
|
|
|
|
0x34867077, 0x30476dc0, 0x3d044b19, 0x39c556ae,
|
|
|
|
|
0x278206ab, 0x23431b1c, 0x2e003dc5, 0x2ac12072,
|
|
|
|
|
0x128e9dcf, 0x164f8078, 0x1b0ca6a1, 0x1fcdbb16,
|
|
|
|
|
0x018aeb13, 0x054bf6a4, 0x0808d07d, 0x0cc9cdca,
|
|
|
|
|
0x7897ab07, 0x7c56b6b0, 0x71159069, 0x75d48dde,
|
|
|
|
|
0x6b93dddb, 0x6f52c06c, 0x6211e6b5, 0x66d0fb02,
|
|
|
|
|
0x5e9f46bf, 0x5a5e5b08, 0x571d7dd1, 0x53dc6066,
|
|
|
|
|
0x4d9b3063, 0x495a2dd4, 0x44190b0d, 0x40d816ba,
|
|
|
|
|
0xaca5c697, 0xa864db20, 0xa527fdf9, 0xa1e6e04e,
|
|
|
|
|
0xbfa1b04b, 0xbb60adfc, 0xb6238b25, 0xb2e29692,
|
|
|
|
|
0x8aad2b2f, 0x8e6c3698, 0x832f1041, 0x87ee0df6,
|
|
|
|
|
0x99a95df3, 0x9d684044, 0x902b669d, 0x94ea7b2a,
|
|
|
|
|
0xe0b41de7, 0xe4750050, 0xe9362689, 0xedf73b3e,
|
|
|
|
|
0xf3b06b3b, 0xf771768c, 0xfa325055, 0xfef34de2,
|
|
|
|
|
0xc6bcf05f, 0xc27dede8, 0xcf3ecb31, 0xcbffd686,
|
|
|
|
|
0xd5b88683, 0xd1799b34, 0xdc3abded, 0xd8fba05a,
|
|
|
|
|
0x690ce0ee, 0x6dcdfd59, 0x608edb80, 0x644fc637,
|
|
|
|
|
0x7a089632, 0x7ec98b85, 0x738aad5c, 0x774bb0eb,
|
|
|
|
|
0x4f040d56, 0x4bc510e1, 0x46863638, 0x42472b8f,
|
|
|
|
|
0x5c007b8a, 0x58c1663d, 0x558240e4, 0x51435d53,
|
|
|
|
|
0x251d3b9e, 0x21dc2629, 0x2c9f00f0, 0x285e1d47,
|
|
|
|
|
0x36194d42, 0x32d850f5, 0x3f9b762c, 0x3b5a6b9b,
|
|
|
|
|
0x0315d626, 0x07d4cb91, 0x0a97ed48, 0x0e56f0ff,
|
|
|
|
|
0x1011a0fa, 0x14d0bd4d, 0x19939b94, 0x1d528623,
|
|
|
|
|
0xf12f560e, 0xf5ee4bb9, 0xf8ad6d60, 0xfc6c70d7,
|
|
|
|
|
0xe22b20d2, 0xe6ea3d65, 0xeba91bbc, 0xef68060b,
|
|
|
|
|
0xd727bbb6, 0xd3e6a601, 0xdea580d8, 0xda649d6f,
|
|
|
|
|
0xc423cd6a, 0xc0e2d0dd, 0xcda1f604, 0xc960ebb3,
|
|
|
|
|
0xbd3e8d7e, 0xb9ff90c9, 0xb4bcb610, 0xb07daba7,
|
|
|
|
|
0xae3afba2, 0xaafbe615, 0xa7b8c0cc, 0xa379dd7b,
|
|
|
|
|
0x9b3660c6, 0x9ff77d71, 0x92b45ba8, 0x9675461f,
|
|
|
|
|
0x8832161a, 0x8cf30bad, 0x81b02d74, 0x857130c3,
|
|
|
|
|
0x5d8a9099, 0x594b8d2e, 0x5408abf7, 0x50c9b640,
|
|
|
|
|
0x4e8ee645, 0x4a4ffbf2, 0x470cdd2b, 0x43cdc09c,
|
|
|
|
|
0x7b827d21, 0x7f436096, 0x7200464f, 0x76c15bf8,
|
|
|
|
|
0x68860bfd, 0x6c47164a, 0x61043093, 0x65c52d24,
|
|
|
|
|
0x119b4be9, 0x155a565e, 0x18197087, 0x1cd86d30,
|
|
|
|
|
0x029f3d35, 0x065e2082, 0x0b1d065b, 0x0fdc1bec,
|
|
|
|
|
0x3793a651, 0x3352bbe6, 0x3e119d3f, 0x3ad08088,
|
|
|
|
|
0x2497d08d, 0x2056cd3a, 0x2d15ebe3, 0x29d4f654,
|
|
|
|
|
0xc5a92679, 0xc1683bce, 0xcc2b1d17, 0xc8ea00a0,
|
|
|
|
|
0xd6ad50a5, 0xd26c4d12, 0xdf2f6bcb, 0xdbee767c,
|
|
|
|
|
0xe3a1cbc1, 0xe760d676, 0xea23f0af, 0xeee2ed18,
|
|
|
|
|
0xf0a5bd1d, 0xf464a0aa, 0xf9278673, 0xfde69bc4,
|
|
|
|
|
0x89b8fd09, 0x8d79e0be, 0x803ac667, 0x84fbdbd0,
|
|
|
|
|
0x9abc8bd5, 0x9e7d9662, 0x933eb0bb, 0x97ffad0c,
|
|
|
|
|
0xafb010b1, 0xab710d06, 0xa6322bdf, 0xa2f33668,
|
|
|
|
|
0xbcb4666d, 0xb8757bda, 0xb5365d03, 0xb1f740b4};
|
|
|
|
|
|
|
|
|
|
typedef struct {
|
|
|
|
|
unsigned int id;
|
|
|
|
|
unsigned int lid;
|
|
|
|
|
unsigned char *pid;
|
|
|
|
|
} id_tecn;
|
|
|
|
|
|
|
|
|
|
typedef struct {
|
|
|
|
|
unsigned int lepc;
|
|
|
|
|
unsigned int pcrc;
|
|
|
|
|
unsigned long cl;
|
|
|
|
|
unsigned char pepc;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
id_tecn *tecn;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
} EPC_par;
|
|
|
|
|
|
|
|
|
|
typedef struct {
|
|
|
|
|
unsigned int lepb;
|
|
|
|
|
unsigned char depb;
|
|
|
|
|
unsigned long ldpepb;
|
|
|
|
|
unsigned long pepb;
|
|
|
|
|
unsigned int ldata;
|
|
|
|
|
} EPB_par;
|
|
|
|
|
typedef struct //***********Questa struttura non dovrebbe servire effettivamente!!!!
|
|
|
|
|
{
|
|
|
|
|
unsigned int lesd;
|
|
|
|
|
unsigned char cesd1;
|
|
|
|
|
unsigned int cesd2;
|
|
|
|
|
unsigned char pesd;
|
|
|
|
|
} ESD_MS;
|
|
|
|
|
typedef struct
|
|
|
|
|
{
|
|
|
|
|
unsigned int lred;
|
|
|
|
|
unsigned char pred;
|
|
|
|
|
unsigned char *reddata;
|
|
|
|
|
} RED;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
EPC_par epc;
|
|
|
|
|
ESD_MS *esd;
|
|
|
|
|
RED red;
|
|
|
|
|
int lmex, nbckpar, epbpm, next, startsot;
|
|
|
|
|
unsigned long psot;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
unsigned char *cssrc;
|
|
|
|
|
unsigned int cslen;
|
|
|
|
|
int cspos;
|
|
|
|
|
unsigned int csread;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int redpos;
|
|
|
|
|
int decodeflag; // 1 if there are not errors decoding RS codeword
|
|
|
|
|
unsigned long redlen;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
int redmode; // Se vale 0 allora RED in MH, se vale 1 allora RED in MH e nei vari TPH
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int redlenok;
|
|
|
|
|
int nepbrd; // umber of EPBs already read
|
|
|
|
|
int lastepb; // Is 1 if the current EPB is the last of an header
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// This is the main function which parses the CS searching JPWL marker segments
|
2006-03-13 19:01:33 +01:00
|
|
|
|
int decode_JPWL(unsigned char *src, int len)
|
|
|
|
|
{
|
|
|
|
|
unsigned int temp, nepb, j2k_state, pos, nepc, posi, mem, rest;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int err;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
unsigned long psot, i;
|
|
|
|
|
FILE *f,*g;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cssrc = src;
|
|
|
|
|
cslen = len;
|
|
|
|
|
redpos = 0;
|
|
|
|
|
redlen = 0;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlenok = 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redmode = 0;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
csread = 0;
|
|
|
|
|
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
if (temp != J2K_MS_SOC)
|
|
|
|
|
{
|
|
|
|
|
printf("Expected marker SOT\n");
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
j2k_state = 0;
|
|
|
|
|
nepc = 0;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepbrd = 0;
|
|
|
|
|
lastepb = 0;
|
|
|
|
|
|
|
|
|
|
while (j2k_state != J2K_STATE_MT)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_read(2); // Read SIZ or SOT
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp >> 8 != 0xff) {
|
|
|
|
|
fprintf(stderr, "%.8x: expected a marker instead of %x\n",
|
|
|
|
|
cio_tell() - 2, temp);
|
|
|
|
|
return nepc;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
posi = cio_tell(); // Start of Lsiz or Lsot
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (temp == J2K_MS_SIZ)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_read(2); // Read Lsiz
|
|
|
|
|
|
|
|
|
|
lmex = temp + 17; // Length of data to be protected
|
|
|
|
|
nbckpar = (int)ceil((double)lmex / 96);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nbckpar = 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_read(2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
cio_skip(temp-2);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_read(2); // Read EPB or EPC if there are
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp != JPWL_MS_EPC)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_read(2); // Lepb
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(temp-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_read(2); // EPC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
pos = cio_tell();
|
|
|
|
|
|
|
|
|
|
if ((temp != JPWL_MS_EPC)&&(nepc == 0))
|
|
|
|
|
{
|
|
|
|
|
cio_seek(0);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
return nepc; // NOT JPWL CS
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if ((temp != JPWL_MS_EPC)&&(nepc != 0)) // Current TPH doesn't have EPC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posi); // Lsot
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(4);
|
|
|
|
|
psot = cio_read(4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (psot == 0) // Last TPH
|
|
|
|
|
j2k_state = J2K_STATE_MT; // Next step skip out of the cicle
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posi-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(psot); // End of data of the current TP
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (cio_read(2) == J2K_MS_EOC)
|
|
|
|
|
j2k_state = J2K_STATE_MT;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(-2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (temp == JPWL_MS_EPC) // There is EPB
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
if (nepc == 0)
|
|
|
|
|
{
|
|
|
|
|
j2k_state = J2K_STATE_MHSOC;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posi-4); // SOC
|
|
|
|
|
next = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if (nepc != 0)
|
|
|
|
|
{
|
|
|
|
|
j2k_state = J2K_STATE_TPHSOT;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posi-2); // SOT
|
2006-03-13 19:01:33 +01:00
|
|
|
|
next = cio_tell();
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
red.reddata = (char *) malloc(len * sizeof(char));
|
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
mem = next;
|
|
|
|
|
i = 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (!(rest = read_EPB_2(&j2k_state)))// First EPB
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return nepc;
|
|
|
|
|
i += rest;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
temp = cio_tell(); // End of EPB
|
|
|
|
|
cio_seek(pos); // End of EPC
|
|
|
|
|
err = read_EPC(); // Read the first EPC
|
|
|
|
|
nepc++; // Handle the case of more then on EPC
|
|
|
|
|
nepb = epc.tecn[0].lid / 4; // Number of EPBs in the CS
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (i<nepb)
|
|
|
|
|
{
|
|
|
|
|
if ((j2k_state == J2K_STATE_MH)&&(lastepb == 0))
|
|
|
|
|
{
|
|
|
|
|
cio_seek(temp);
|
|
|
|
|
do
|
|
|
|
|
{
|
|
|
|
|
if (!(rest = read_EPB_2(&j2k_state)))
|
|
|
|
|
return nepc;
|
|
|
|
|
i += rest;
|
|
|
|
|
}
|
|
|
|
|
while (lastepb == 0);
|
|
|
|
|
}
|
|
|
|
|
if (j2k_state == J2K_STATE_TPHSOT)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(temp); // SOT
|
2006-03-13 19:01:33 +01:00
|
|
|
|
pos = cio_tell();
|
|
|
|
|
do
|
|
|
|
|
{
|
|
|
|
|
if (!(rest = read_EPB_2(&j2k_state)))
|
|
|
|
|
return nepc;
|
|
|
|
|
i += rest;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
while (lastepb == 0);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if (j2k_state == J2K_STATE_MH)
|
|
|
|
|
{
|
|
|
|
|
temp = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (temp != J2K_MS_SOT)
|
|
|
|
|
{
|
|
|
|
|
cio_skip(cio_read(2)-2);
|
|
|
|
|
temp = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
}
|
|
|
|
|
temp = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp != J2K_MS_EOC)
|
|
|
|
|
{
|
|
|
|
|
if ((j2k_state == J2K_STATE_TPH)||(temp != J2K_MS_SOT))
|
|
|
|
|
{
|
|
|
|
|
cio_seek(pos);
|
|
|
|
|
cio_skip(6);
|
|
|
|
|
psot = cio_read(4);
|
|
|
|
|
cio_seek(pos);
|
|
|
|
|
cio_skip(psot);
|
|
|
|
|
j2k_state = J2K_STATE_TPHSOT;
|
|
|
|
|
}
|
|
|
|
|
if (temp == J2K_MS_SOT)
|
|
|
|
|
{
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
temp = cio_tell();
|
|
|
|
|
j2k_state = J2K_STATE_TPHSOT;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// All EPBs read
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (temp != J2K_MS_EOC)
|
|
|
|
|
{
|
|
|
|
|
cio_seek(pos);
|
|
|
|
|
cio_skip(6);
|
|
|
|
|
psot = cio_read(4);
|
|
|
|
|
cio_seek(pos);
|
|
|
|
|
cio_skip(psot);
|
|
|
|
|
temp = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(-2); // EOC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
j2k_state = J2K_STATE_MT;
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else // There is EPC after SIZ
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
err = read_EPC();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (nepc == 0)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posi);
|
|
|
|
|
cio_skip(cio_read(2)-2);
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (temp != J2K_MS_SOT)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(cio_read(2)-2);
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(-2); // End of Main-Header
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if (nepc != 0)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posi);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(4);
|
|
|
|
|
psot = cio_read(4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (psot == 0) // Last TPH
|
|
|
|
|
j2k_state = J2K_STATE_MT;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posi-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(psot);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (cio_read(2) == J2K_MS_EOC)
|
|
|
|
|
{
|
|
|
|
|
j2k_state = J2K_STATE_MT;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(-2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepc++;
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(0);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if ((redlen != 0)&&(redmode==0))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
red.lred = redlen + 3;
|
|
|
|
|
red.pred = 0x43; // Pred = 01000011
|
|
|
|
|
// Go to End of MH
|
|
|
|
|
temp = cio_read(2); // SOC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (temp != J2K_MS_SOT)
|
|
|
|
|
{
|
|
|
|
|
cio_skip(2);
|
|
|
|
|
cio_skip(cio_read(2)-2);
|
|
|
|
|
temp = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(-2);
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
insert_RED(cio_tell(),red.lred+2,redlenok);
|
|
|
|
|
g = fopen("output","wb");
|
|
|
|
|
if (g==NULL)
|
|
|
|
|
printf("Unable to open file!\n");
|
|
|
|
|
cio_seek(0);
|
|
|
|
|
for (i=0; i<(epc.cl+redlen+5); i++)
|
|
|
|
|
fputc(cio_read(1),g);
|
|
|
|
|
fclose(g);
|
|
|
|
|
cslen = epc.cl + redlen + 5;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
f = fopen("output","wb");
|
|
|
|
|
if (f==NULL)
|
|
|
|
|
printf("Unable to open file!\n");
|
|
|
|
|
cio_seek(0);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
for (i=0; i<cslen; i++)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
fputc(cio_read(1),f);
|
|
|
|
|
fclose(f);
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(0);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return nepc;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int read_EPC()
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
unsigned int id, lid;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
int i, h, pos, nid;
|
|
|
|
|
unsigned int ltec, count;
|
|
|
|
|
unsigned char *buff;
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
pos = cio_tell()-2; // EPC position
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
epc.lepc = cio_read(2);
|
|
|
|
|
epc.pcrc = cio_read(2);
|
|
|
|
|
epc.cl = cio_read(4);
|
|
|
|
|
epc.pepc = cio_read(1);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if ((epc.pepc>>4)&1) // One or more ESDs
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
esd = (ESD_MS *) malloc(10 * sizeof(ESD_MS));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ltec = epc.lepc - 9;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
count = 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
nid = 0; // umber of techniques used
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (count<ltec)
|
|
|
|
|
{
|
|
|
|
|
id = cio_read(2);
|
|
|
|
|
count += 2;
|
|
|
|
|
lid = cio_read(2);
|
|
|
|
|
count += 2 + lid;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(lid); // Skip over Pid field
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nid ++;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
epc.tecn = (id_tecn *) malloc(nid * sizeof(id_tecn));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos + 11);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<nid; i++)
|
|
|
|
|
{
|
|
|
|
|
epc.tecn[i].id = cio_read(2);
|
|
|
|
|
epc.tecn[i].lid = cio_read(2);
|
|
|
|
|
epc.tecn[i].pid = (char *) malloc(epc.tecn[i].lid * sizeof(char));
|
|
|
|
|
for (h=0; h<epc.tecn[i].lid; h++)
|
|
|
|
|
epc.tecn[i].pid[h] = cio_read(1);
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Check CRC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
buff = (char *) malloc(epc.lepc* sizeof(char));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<4; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[i] = cio_read(1);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
for (i=4; i<epc.lepc; i++)
|
|
|
|
|
buff[i] = cio_read(1);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
ResetCRC();
|
|
|
|
|
for (i=0; i < epc.lepc; i++){
|
|
|
|
|
UpdateCRC16(buff[i]);
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (crcSum == epc.pcrc)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
return 1; // CRC correct
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
return 0; // Errors!
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int read_EPB_2(int *j2k_state) // Returns the number of EPBs read
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
unsigned int lepb, lsiz, temp, ldata, lsot, lbuf;
|
|
|
|
|
int posdata, posdata2, nblock, i,h, pos, lante, lpar;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int nn, kk, tt, nn1, kk1;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
int nepbpm, posfirst, posend, count;
|
|
|
|
|
unsigned long lpack, ldpread;
|
|
|
|
|
EPB_par *epb;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
unsigned long ldpepb, pepb, ndata, datacrc;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
unsigned char depb;
|
|
|
|
|
unsigned char *buff;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int lparity, packall; // If packall=1 all the following EPBs are packed
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
{
|
|
|
|
|
cio_skip(4); // Lsiz
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lsiz = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(lsiz-2); // EPB
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
|
|
|
|
|
nn = 160; kk = 64; tt = 48; // RS(160,64)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = lsiz+4;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if (*j2k_state == J2K_STATE_TPHSOT)
|
|
|
|
|
{
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
startsot = cio_tell(); // SOT
|
|
|
|
|
cio_skip(2); // Lsot
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lsot = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
psot = cio_read(4);
|
|
|
|
|
cio_skip(-6);
|
|
|
|
|
|
|
|
|
|
cio_skip(lsot-2); // EPB
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
|
|
|
|
|
nn = 80; kk = 25; tt = 28; // RS(80,25)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = lsot+2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_TPH))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
pos = cio_tell(); // EPB
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
nn = 40; kk = 13; tt = 14; // RS(40,13)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = 0;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// Decode using default RS codes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
lepb = cio_read(2);
|
|
|
|
|
cio_skip(9); // EPB data field
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posdata = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ldata = lepb - 11; // Length of data field
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
lpar = nn - kk; // Length of parity bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
{
|
|
|
|
|
lpar = nbckpar * (nn-kk);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
nbckpar = 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
for (i=0; i<nbckpar; i++)
|
|
|
|
|
{
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = 0;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// Put parity bytes at the beginning of the buffer
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
write_buff(buff,posdata+i*(nn-kk),(nn-kk)); // Put in buffer parity bytes
|
|
|
|
|
cio_seek(next + i*kk); // Start of protected data
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nbckpar -1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1); // Put in buffer data bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = lmex - ((nbckpar-1) * kk); // Handle last block case
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<((nn-kk)+ndata); h++)
|
|
|
|
|
{
|
|
|
|
|
buff[h] = cio_read(1);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
buff[h] = cio_read(1);
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = buff[h];
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = index_of[recd[h]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(next + i*kk,4); // Start byte
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlen += 4;
|
|
|
|
|
if (i<(nbckpar -1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(next + i*kk + kk - 1,4); // End byte
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(next + i*kk + ndata - 1,4); // End byte
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
|
|
|
|
cio_write(next + i*kk + kk - 1,4);
|
|
|
|
|
}
|
|
|
|
|
redlen += 4;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// 0xFFFF stands for errors occurred
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen += 2;
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH))
|
|
|
|
|
redlenok+=10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// Copy recd[] content in the CS
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_init(cssrc, cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata+i*(nn-kk));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<(nn-kk); h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(next + i*kk);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nbckpar -1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// Decode with the remaining EPB parity bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos); // EPB
|
|
|
|
|
|
|
|
|
|
temp = cio_read(2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp != JPWL_MS_EPB)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
return 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_skip(2);
|
|
|
|
|
depb = cio_read(1);
|
|
|
|
|
|
|
|
|
|
ldpepb = cio_read(4);
|
|
|
|
|
|
|
|
|
|
pepb = cio_read(4);
|
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if (nepbrd!=0)
|
|
|
|
|
{
|
|
|
|
|
temp = cio_tell();
|
|
|
|
|
cio_init(epc.tecn[0].pid, epc.tecn[0].lid);
|
|
|
|
|
cio_seek(nepbrd*4);
|
|
|
|
|
if (pepb!=cio_read(4))
|
|
|
|
|
{
|
|
|
|
|
cio_skip(-4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
pepb=cio_read(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
cio_seek(temp);
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
ldata = ldata - nbckpar*(nn-kk);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata + nbckpar*(nn-kk));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
posdata2 = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (ldpepb == 0)
|
|
|
|
|
next = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (!((depb >> 6)&1)) // Not the last EPB
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lastepb = 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if ((depb >> 6)&1) // Last EPB of the TPH
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lastepb = 1;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (!((depb >> 7)&1)) // Unpacked mode
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_MH;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPH;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
nepbrd++;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (pepb) // If Pepb=0 => default RS codes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
if ((pepb>>28)==2)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
|
|
|
|
/***********/
|
|
|
|
|
kk = (int) pepb & 0x000000ff;
|
|
|
|
|
nn = (int) (pepb>>8) & 0x000000ff;
|
|
|
|
|
tt = (int) ceil((double)(nn-kk)/2);
|
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((pepb>>28)==1)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// CRC decode
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(ldpepb * sizeof(char));
|
|
|
|
|
write_buff(buff,posdata2+ldata,ldpepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (pepb & 0x00000001) // CRC 32
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
ResetCRC();
|
|
|
|
|
for (i=0; i < ldpepb; i++)
|
|
|
|
|
UpdateCRC32(reflectByte(buff[i]));
|
|
|
|
|
reflectCRC32();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
crcSum ^= 0xffffffff; // 1's complement
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else // CRC 16
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
ResetCRC();
|
|
|
|
|
for (i=0; i < ldpepb; i++)
|
|
|
|
|
UpdateCRC16(buff[i]);
|
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
free(buff);
|
|
|
|
|
cio_seek(posdata2 + ldata + ldpepb);
|
|
|
|
|
next = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
if (temp == J2K_MS_SOT)
|
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
|
|
|
|
if (temp == J2K_MS_EOC)
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (pepb>=0x30000000)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// RA techniques
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
return 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (pepb==0xffffffff)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
return 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
nblock = ldata / (nn-kk); // Number of CW
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
|
|
|
|
for (i=0; i<nblock; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = 0;
|
|
|
|
|
write_buff(buff,posdata2+i*(nn-kk),(nn-kk)); // Parity bytes
|
|
|
|
|
cio_seek(posdata2+ldata+i*kk);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1); // Data bytes
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = ldpepb - ((nblock-1) * kk); // Last CW
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1); // Data
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
next = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (cio_read(2) == 0xffd9)
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = buff[h];
|
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = index_of[recd[h]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(posdata2+ldata+i*kk,4); // Start byte
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlen += 4;
|
|
|
|
|
if (i<(nblock -1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posdata2+ldata+i*kk + kk - 1,4); //End byte
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posdata2+ldata+i*kk + ndata - 1,4); // End byte
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlen += 4;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen += 2;
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_TPHSOT))
|
|
|
|
|
redlenok+=10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if ((redlen==0)&(redmode==1))
|
|
|
|
|
free(red.reddata);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
|
|
|
|
|
cio_seek(posdata2+i*(nn-kk)); // Parity block
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<(nn-kk); h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1); // Copy parity bytes
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
cio_seek(posdata2+ldata+i*kk);
|
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1); // Copy data bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = ldpepb - (nblock-1) * kk;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
if (temp == J2K_MS_SOT)
|
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
|
|
|
|
if (temp == J2K_MS_EOC)
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
|
|
|
|
free(buff);
|
|
|
|
|
return 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else // Packed mode
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_TPHSOT)
|
|
|
|
|
packall = 1;
|
|
|
|
|
else
|
|
|
|
|
packall = 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posfirst = pos;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos+2);
|
|
|
|
|
cio_skip(cio_read(2)-2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
pos = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepbpm = 1;
|
|
|
|
|
|
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
|
|
|
|
nn = 40; kk = 13;
|
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
while (lastepb == 0)
|
|
|
|
|
{
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
lepb = cio_read(2);
|
|
|
|
|
cio_skip(9); // EPB data field
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posdata = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ldata = lepb - 11;
|
|
|
|
|
lbuf = 13 + (nn-kk);
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<nn1; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[i] = 0;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
write_buff(buff,posdata,(nn-kk)); // Parity bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos); // Start of protected data
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=(nn-kk); i<lbuf; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[i] = cio_read(1); // Data bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (i=0; i<nn1; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[i] = buff[i];
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (i=0; i<nn1; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[i] = index_of[recd[i]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(pos,4); // Start byte
|
|
|
|
|
cio_write(pos + lbuf - (nn - kk) - 1,4); // End byte
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen += 10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redpos = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata); // Start of data
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<(nn-kk); i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[i],1); // Parity bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(pos);
|
|
|
|
|
for (i=(nn-kk); i<lbuf; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[i],1); // Data bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos); // EPB
|
|
|
|
|
temp = cio_read(2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp != JPWL_MS_EPB)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
depb = cio_read(1);
|
|
|
|
|
|
|
|
|
|
if (!((depb >> 6)&1)) // Not the last EPB of the TPH
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepbpm += 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if ((depb >> 6)&1) // Last EPB of the TPH
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
nepbpm += 1;
|
|
|
|
|
lastepb = 1;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(-3);
|
|
|
|
|
cio_skip(cio_read(2)-2);
|
|
|
|
|
pos = cio_tell(); // Next EPB
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// Decode EPB parity bytes protecting J2K data
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(-2);
|
|
|
|
|
posend = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
lpack = posend-posfirst; // Total EPBs length
|
2006-03-13 19:01:33 +01:00
|
|
|
|
epb = (EPB_par *) malloc(nepbpm * sizeof(EPB_par));
|
|
|
|
|
cio_seek(posfirst);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (count=0; count<nepbpm; count++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
epb[count].lepb = cio_read(2);
|
|
|
|
|
epb[count].depb = cio_read(1);
|
|
|
|
|
epb[count].ldpepb = cio_read(4);
|
|
|
|
|
epb[count].pepb = cio_read(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
temp = cio_tell();
|
|
|
|
|
cio_init(epc.tecn[0].pid, epc.tecn[0].lid);
|
|
|
|
|
cio_seek((nepbrd+count)*4);
|
|
|
|
|
if (epb[count].pepb!=cio_read(4))
|
|
|
|
|
{
|
|
|
|
|
cio_skip(-4);
|
|
|
|
|
epb[count].pepb=cio_read(4);
|
|
|
|
|
}
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
cio_seek(temp);
|
|
|
|
|
|
|
|
|
|
if ((count == 0)&&(packall == 1))
|
|
|
|
|
epb[count].ldata = (epb[count].lepb - 11) - (80-25);
|
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
epb[count].ldata = (epb[count].lepb - 11) - (nn-kk);
|
|
|
|
|
cio_skip(-11);
|
|
|
|
|
cio_skip(epb[count].lepb);
|
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepbrd+=nepbpm;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posfirst); // First of the packed EPBs
|
2006-03-13 19:01:33 +01:00
|
|
|
|
pos = cio_tell();
|
|
|
|
|
ldpread = 0;
|
|
|
|
|
lparity = nn - kk;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (count=0; count<nepbpm; count++)
|
|
|
|
|
{
|
|
|
|
|
cio_seek(pos);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_skip(13); // Data field
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posdata = cio_tell();
|
|
|
|
|
if ((count == 0)&&(packall == 1))
|
|
|
|
|
cio_seek(posdata + (80 - 25));
|
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata + lparity);
|
|
|
|
|
posdata2 = cio_tell();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (epb[count].pepb) // If Pepb=0 => default RS codes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
if ((epb[count].pepb>>28)==2)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
|
|
|
|
/***********/
|
|
|
|
|
kk = (int) epb[count].pepb & 0x000000ff;
|
|
|
|
|
nn = (int) (epb[count].pepb>>8) & 0x000000ff;
|
|
|
|
|
tt = (int) ceil((double)(nn-kk)/2);
|
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((epb[count].pepb>>28)==1)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// CRC decode
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(epb[count].ldpepb * sizeof(char));
|
|
|
|
|
write_buff(buff,posdata2+epb[count].ldata,epb[count].ldpepb);//***Correggi!!!!!!!!!!!
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (epb[count].pepb & 0x00000001) // CRC 32
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
ResetCRC();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posend+ldpread);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i < epb[count].ldpepb; i++)
|
|
|
|
|
UpdateCRC32(reflectByte(buff[i]));
|
|
|
|
|
reflectCRC32();
|
|
|
|
|
if (lastepb==1)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
next = startsot + psot;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(next);
|
|
|
|
|
}
|
|
|
|
|
if ((cio_read(2) == 0xffd9)||(psot == 0))
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
crcSum ^= 0xffffffff;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else // CRC 16
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
ResetCRC();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posend+ldpread);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i < epb[count].ldpepb; i++)
|
|
|
|
|
UpdateCRC16(buff[i]);
|
|
|
|
|
if (lastepb==1)
|
|
|
|
|
{
|
|
|
|
|
next = startsot + psot;
|
|
|
|
|
cio_seek(next);
|
|
|
|
|
}
|
|
|
|
|
if ((cio_read(2) == 0xffd9)||(psot == 0))
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(2);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (epb[count].pepb>=0x30000000)
|
|
|
|
|
{
|
|
|
|
|
next = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// RA
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (epb[count].pepb==0xffffffff)
|
|
|
|
|
{
|
|
|
|
|
next = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (((epb[count].pepb>>28)==2)||(epb[count].pepb==0)) // RS codes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
nblock = epb[count].ldata / (nn-kk); // Number of CW
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<nblock; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = 0;
|
|
|
|
|
write_buff(buff,posdata2+i*(nn-kk),(nn-kk));
|
|
|
|
|
|
|
|
|
|
cio_seek(posend+ldpread+i*kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = epb[count].ldpepb - ((nblock-1) * kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if (lastepb==1)
|
|
|
|
|
{
|
|
|
|
|
next = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if ((cio_read(2) == 0xffd9)||(psot == 0))
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = buff[h];
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = index_of[recd[h]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(posend+ldpread+i*kk,4);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if (i<(nblock -1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posend+ldpread+i*kk + kk - 1,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posend+ldpread+i*kk + ndata - 1,4);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen+=10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata2+i*(nn-kk));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<(nn-kk); h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_seek(posend+ldpread+i*kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = epb[count].ldpepb - (nblock-1) * kk;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ldpread += epb[count].ldpepb;
|
|
|
|
|
cio_seek(pos+2);
|
|
|
|
|
cio_skip(epb[count].lepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
pos = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(next);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
if (temp == J2K_MS_SOT)
|
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
|
|
|
|
if (temp == J2K_MS_EOC)
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
|
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
|
|
|
|
free(buff);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
return nepbpm; // Number of packed EPBs read
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int read_EPB(int next, int *j2k_state)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
unsigned int lepb, lsiz, temp, ldata, lsot;
|
|
|
|
|
int posdata, posdata2, nblock, i,h, pos, lante, lpar;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int nn, kk, tt, nn1, kk1;
|
|
|
|
|
|
|
|
|
|
unsigned long ldpepb, pepb, ndata, datacrc;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
unsigned char depb;
|
|
|
|
|
unsigned char *buff;
|
|
|
|
|
int prova;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(next);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
cio_skip(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lsiz = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(lsiz-2);
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
|
|
|
|
|
nn = 160; kk = 64; tt = 48; // RS(160,64)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = lsiz+4;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if (*j2k_state == J2K_STATE_TPHSOT)
|
|
|
|
|
{
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
startsot = cio_tell();
|
|
|
|
|
cio_skip(2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lsot = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
psot = cio_read(4);
|
|
|
|
|
cio_skip(-6);
|
|
|
|
|
|
|
|
|
|
cio_skip(lsot-2);
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
|
|
|
|
|
nn = 80; kk = 25; tt = 28; // RS(80,25)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = lsot+2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_TPH))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
nn = 40; kk = 13; tt = 14; // RS(40,13)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = 0;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
lepb = cio_read(2);
|
|
|
|
|
|
|
|
|
|
cio_skip(9);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posdata = cio_tell();
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ldata = lepb - 11;
|
|
|
|
|
|
|
|
|
|
lpar = nn - kk;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
{
|
|
|
|
|
lpar = nbckpar * (nn-kk);
|
|
|
|
|
}
|
|
|
|
|
if (*j2k_state == J2K_STATE_TPHSOT)
|
|
|
|
|
nbckpar = 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
for (i=0; i<nbckpar; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = 0;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
write_buff(buff,posdata+i*(nn-kk),(nn-kk)); // Parity bytes
|
|
|
|
|
cio_seek(next + i*kk); // Start of protected data
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nbckpar -1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1); // Data bytes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = lmex - ((nbckpar-1) * kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<((nn-kk)+ndata); h++)
|
|
|
|
|
{
|
|
|
|
|
buff[h] = cio_read(1);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
buff[h] = cio_read(1);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = buff[h];
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = index_of[recd[h]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(next + i*kk,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlen += 4;
|
|
|
|
|
if (i<(nbckpar -1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(next + i*kk + kk,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(next + i*kk + ndata,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
|
|
|
|
cio_write(next + i*kk + kk,4);
|
|
|
|
|
}
|
|
|
|
|
redlen += 4;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen += 2;
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH))
|
|
|
|
|
redlenok+=10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_init(cssrc, cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata+i*(nn-kk));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<(nn-kk); h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(next + i*kk);
|
|
|
|
|
if (i<(nbckpar -1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos); // EPB
|
|
|
|
|
temp = cio_read(2); //
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp != JPWL_MS_EPB)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
return 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_skip(2);
|
|
|
|
|
depb = cio_read(1);
|
|
|
|
|
|
|
|
|
|
ldpepb = cio_read(4);
|
|
|
|
|
|
|
|
|
|
pepb = cio_read(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (nepbrd!=0)
|
|
|
|
|
{
|
|
|
|
|
temp = cio_tell();
|
|
|
|
|
cio_init(epc.tecn[0].pid, epc.tecn[0].lid);
|
|
|
|
|
cio_seek(nepbrd*4);
|
|
|
|
|
if (pepb!=cio_read(4))
|
|
|
|
|
{
|
|
|
|
|
cio_skip(-4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
pepb=cio_read(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
cio_seek(temp);
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
ldata = ldata - nbckpar*(nn-kk);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata + nbckpar*(nn-kk));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
posdata2 = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_MH;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (((depb >> 6)&1)&&((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_MHSOC)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (((depb >> 6)&1)&&((*j2k_state == J2K_STATE_TPH)||(*j2k_state == J2K_STATE_TPHSOT)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPH;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if (!((depb >> 7)&1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
epbpm = 1; // Unpacked mode
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
epbpm = 0; // Packed mode
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
nepbrd++;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
if (pepb)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
if ((pepb>>28)==2)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
kk = (int) pepb & 0x000000ff;
|
|
|
|
|
nn = (int) (pepb>>8) & 0x000000ff;
|
|
|
|
|
tt = (int) ceil((double)(nn-kk)/2);
|
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((pepb>>28)==1)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// CRC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(ldpepb * sizeof(char));
|
|
|
|
|
write_buff(buff,posdata2+ldata,ldpepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (pepb & 0x00000001) // CRC 32
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
ResetCRC();
|
|
|
|
|
for (i=0; i < ldpepb; i++)
|
|
|
|
|
UpdateCRC32(reflectByte(buff[i]));
|
|
|
|
|
reflectCRC32();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
crcSum ^= 0xffffffff;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(4);
|
|
|
|
|
if (datacrc == crcSum)
|
|
|
|
|
printf("CRC corretto!\n");
|
|
|
|
|
else
|
|
|
|
|
printf("CRC errato!\n");
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else // CRC 16
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
ResetCRC();
|
|
|
|
|
for (i=0; i < ldpepb; i++)
|
|
|
|
|
UpdateCRC16(buff[i]);
|
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(2);
|
|
|
|
|
if (datacrc == crcSum)
|
|
|
|
|
printf("CRC corretto!\n");
|
|
|
|
|
else
|
|
|
|
|
printf("CRC errato!\n");
|
|
|
|
|
}
|
|
|
|
|
free(buff);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
return (posdata2 + ldata + ldpepb);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (pepb>=0x30000000)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
//RA
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return (posdata2 + ldata + ldpepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (pepb==0xffffffff)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return (posdata2 + ldata + ldpepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
nblock = ldata / (nn-kk); // Number of CW
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
|
|
|
|
for (i=0; i<nblock; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = 0;
|
|
|
|
|
write_buff(buff,posdata2+i*(nn-kk),(nn-kk));
|
|
|
|
|
cio_seek(posdata2+ldata+i*kk);
|
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = ldpepb - ((nblock-1) * kk);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
next = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (cio_read(2) == 0xffd9)
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = buff[h];
|
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = index_of[recd[h]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(posdata2+ldata+i*kk,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlen += 4;
|
|
|
|
|
if (i<(nblock -1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posdata2+ldata+i*kk + kk,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posdata2+ldata+i*kk + ndata,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
redlen += 4;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen += 2;
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_TPHSOT))
|
|
|
|
|
redlenok+=10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if ((redlen==0)&(redmode==1))
|
|
|
|
|
free(red.reddata);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
|
|
|
|
|
cio_seek(posdata2+i*(nn-kk));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<(nn-kk); h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
cio_seek(posdata2+ldata+i*kk);
|
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = ldpepb - (nblock-1) * kk;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return next; // End of read EPB
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int read_EPB_PM(int *j2k_state)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
unsigned int lepb, lsiz, temp, ldata, lbuf, lsot;
|
|
|
|
|
int posdata, posdata2, nblock, i,h, pos, lante;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
int lastepb, nepbpm, posfirst, posend, count;
|
|
|
|
|
unsigned long lpack, ldpread;
|
|
|
|
|
EPB_par *epb;
|
|
|
|
|
int nn, kk, tt, nn1, kk1;
|
|
|
|
|
unsigned long ldpepb, pepb, ndata, datacrc;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
unsigned char depb;
|
|
|
|
|
unsigned char *buff;
|
|
|
|
|
|
|
|
|
|
int lparity;
|
|
|
|
|
|
|
|
|
|
if (*j2k_state == J2K_STATE_MHSOC)
|
|
|
|
|
{
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_skip(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lsiz = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(lsiz-2);
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
nn = 160; kk = 64; tt = 48; // RS(160,64)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = lsiz+4;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if (*j2k_state == J2K_STATE_TPHSOT)
|
|
|
|
|
{
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lsot = cio_read(2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(lsot-2); // EPB MS
|
|
|
|
|
pos = cio_tell();
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
nn = 80; kk = 25; tt = 28; // RS(80,25)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = lsot+2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_TPH))
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
pos = cio_tell(); // EPB
|
|
|
|
|
temp = cio_read(2);
|
|
|
|
|
nn = 40; kk = 13; tt = 14; // RS(40,13)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
lante = 0;
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
posfirst = pos;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
lastepb = 0;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepbpm = 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
while (lastepb == 0)
|
|
|
|
|
{
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
lepb = cio_read(2);
|
|
|
|
|
cio_skip(9);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posdata = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ldata = lepb - 11;
|
|
|
|
|
|
|
|
|
|
lbuf = lante + 13 + (nn-kk);
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<nn1; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[i] = 0;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
write_buff(buff,posdata,(nn-kk));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=(nn-kk); i<lbuf; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[i] = cio_read(1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (i=0; i<nn1; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[i] = buff[i];
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (i=0; i<nn1; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[i] = index_of[recd[i]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(pos,4);
|
|
|
|
|
cio_write(pos + lbuf - (nn - kk),4);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen += 10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<(nn-kk); i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[i],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(pos);
|
|
|
|
|
for (i=(nn-kk); i<lbuf; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[i],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(pos);
|
|
|
|
|
temp = cio_read(2);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (temp != JPWL_MS_EPB)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
return 0;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
depb = cio_read(1);
|
|
|
|
|
|
|
|
|
|
if (!((depb >> 6)&1))
|
2006-03-13 19:01:33 +01:00
|
|
|
|
nepbpm += 1;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if ((depb >> 6)&1)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
nepbpm += 1;
|
|
|
|
|
lastepb = 1;
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(-3);
|
|
|
|
|
cio_skip(cio_read(2)-2);
|
|
|
|
|
pos = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(-2);
|
|
|
|
|
posend = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
lpack = posend-posfirst; // Total EPBs length
|
2006-03-13 19:01:33 +01:00
|
|
|
|
epb = (EPB_par *) malloc(nepbpm * sizeof(EPB_par));
|
|
|
|
|
cio_seek(posfirst);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (count=0; count<nepbpm; count++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_skip(2);
|
|
|
|
|
epb[count].lepb = cio_read(2);
|
|
|
|
|
epb[count].depb = cio_read(1);
|
|
|
|
|
epb[count].ldpepb = cio_read(4);
|
|
|
|
|
epb[count].pepb = cio_read(4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
temp = cio_tell();
|
|
|
|
|
cio_init(epc.tecn[0].pid, epc.tecn[0].lid);
|
|
|
|
|
cio_seek((nepbrd+count)*4);
|
|
|
|
|
if (epb[count].pepb!=cio_read(4))
|
|
|
|
|
{
|
|
|
|
|
cio_skip(-4);
|
|
|
|
|
epb[count].pepb=cio_read(4);
|
|
|
|
|
}
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
cio_seek(temp);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
epb[count].ldata = (epb[count].lepb - 11) - (nn-kk);
|
|
|
|
|
cio_skip(-11);
|
|
|
|
|
cio_skip(epb[count].lepb);
|
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
nepbrd+=nepbpm;
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posfirst); // First of the packed EPBs
|
2006-03-13 19:01:33 +01:00
|
|
|
|
pos = cio_tell();
|
|
|
|
|
ldpread = 0;
|
|
|
|
|
lparity = nn - kk;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (count=0; count<nepbpm; count++)
|
|
|
|
|
{
|
|
|
|
|
cio_seek(pos);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_skip(13);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
posdata = cio_tell();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_seek(posdata + lparity);
|
|
|
|
|
posdata2 = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
if ((!((epb[count].depb >> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_MH;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (((epb[count].depb >> 6)&1)&&((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_MHSOC)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (((epb[count].depb >> 6)&1)&&((*j2k_state == J2K_STATE_TPH)||(*j2k_state == J2K_STATE_TPHSOT)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPHSOT;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if ((!((epb[count].depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH)))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
*j2k_state = J2K_STATE_TPH;
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (epb[count].pepb)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
if ((epb[count].pepb>>28)==2)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
kk = (int) epb[count].pepb & 0x000000ff;
|
|
|
|
|
nn = (int) (epb[count].pepb>>8) & 0x000000ff;
|
|
|
|
|
tt = (int) ceil((double)(nn-kk)/2);
|
|
|
|
|
nn1 = 255; kk1 = kk + (nn1 - nn);
|
|
|
|
|
alpha_to = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
index_of = (int *) malloc((nn1+1)*sizeof(int));
|
|
|
|
|
gg = (int *) malloc((nn1-kk1+1)*sizeof(int));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd = (int *) malloc((nn1)*sizeof(int));
|
|
|
|
|
data = (int *) malloc((kk1)*sizeof(int));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
bb = (int *) malloc((nn1-kk1)*sizeof(int));
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((epb[count].pepb>>28)==1)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
// CRC
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(epb[count].ldpepb * sizeof(char));
|
|
|
|
|
write_buff(buff,posdata2+epb[count].ldata,epb[count].ldpepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (epb[count].pepb & 0x00000001) // CRC 32
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
ResetCRC();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posend+ldpread);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i < epb[count].ldpepb; i++)
|
|
|
|
|
UpdateCRC32(reflectByte(buff[i]));
|
|
|
|
|
reflectCRC32();
|
|
|
|
|
if (lastepb==1)
|
|
|
|
|
{
|
|
|
|
|
next = startsot + psot;
|
|
|
|
|
cio_seek(next);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if ((cio_read(2) == 0xffd9)||(psot == 0))
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
crcSum ^= 0xffffffff;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(4);
|
|
|
|
|
if (datacrc == crcSum)
|
|
|
|
|
printf("CRC corretto!\n");
|
|
|
|
|
else
|
|
|
|
|
printf("CRC errato!\n");
|
|
|
|
|
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
else // CRC 16
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
|
|
|
|
ResetCRC();
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posend+ldpread);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i < epb[count].ldpepb; i++)
|
|
|
|
|
UpdateCRC16(buff[i]);
|
|
|
|
|
if (lastepb==1)
|
|
|
|
|
{
|
|
|
|
|
next = startsot + psot;
|
|
|
|
|
cio_seek(next);
|
|
|
|
|
}
|
|
|
|
|
if ((cio_read(2) == 0xffd9)||(psot == 0))
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
cio_seek(posdata2);
|
|
|
|
|
datacrc = cio_read(2);
|
|
|
|
|
if (datacrc == crcSum)
|
|
|
|
|
printf("CRC corretto!\n");
|
|
|
|
|
else
|
|
|
|
|
printf("CRC errato!\n");
|
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (epb[count].pepb>=0x30000000)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (epb[count].pepb==0xffffffff)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (((epb[count].pepb>>28)==2)||(epb[count].pepb==0)) // RS codes
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
nblock = epb[count].ldata / (nn-kk); // Number of CW
|
2006-03-13 19:01:33 +01:00
|
|
|
|
free(buff);
|
|
|
|
|
buff = (char *) malloc(nn1 * sizeof(char));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<nblock; i++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = 0;
|
|
|
|
|
write_buff(buff,posdata2+i*(nn-kk),(nn-kk));
|
|
|
|
|
|
|
|
|
|
cio_seek(posend+ldpread+i*kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = epb[count].ldpepb - ((nblock-1) * kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
buff[h] = cio_read(1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
if (lastepb==1)
|
|
|
|
|
{
|
|
|
|
|
next = startsot + psot;
|
|
|
|
|
cio_seek(next);
|
|
|
|
|
}
|
|
|
|
|
if ((cio_read(2) == 0xffd9)||(psot == 0))
|
|
|
|
|
*j2k_state = J2K_STATE_MT;
|
|
|
|
|
cio_skip(-2);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = buff[h];
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
generate_gf(nn1,kk1) ;
|
|
|
|
|
gen_poly(nn1,kk1) ;
|
|
|
|
|
for (h=0; h<nn1; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
recd[h] = index_of[recd[h]] ;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
decode_rs(nn1,kk1,tt);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
if (decodeflag == 0)
|
2006-03-13 19:01:33 +01:00
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(redpos);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(posend+ldpread+i*kk,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock -1))
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posend+ldpread+i*kk + kk,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
else
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(posend+ldpread+i*kk + ndata,4);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_write(0xFFFF,2);
|
|
|
|
|
redlen+=10;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
redpos = cio_tell();
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
cio_init(cssrc, cslen);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(posdata2+i*(nn-kk));
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=0; h<(nn-kk); h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_seek(posend+ldpread+i*kk);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
if (i<(nblock-1))
|
|
|
|
|
{
|
|
|
|
|
for (h=(nn-kk); h<nn; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2006-03-16 17:49:13 +01:00
|
|
|
|
ndata = epb[count].ldpepb - (nblock-1) * kk;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (h=(nn-kk); h<(nn-kk)+ndata; h++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(recd[h],1);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ldpread += epb[count].ldpepb;
|
|
|
|
|
cio_seek(pos+2);
|
|
|
|
|
cio_skip(epb[count].lepb);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
pos = cio_tell();
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
}
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_seek(next);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
free(alpha_to);
|
|
|
|
|
free(index_of);
|
|
|
|
|
free(gg);
|
|
|
|
|
free(recd);
|
|
|
|
|
free(data);
|
|
|
|
|
free(bb);
|
|
|
|
|
free(buff);
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
return nepbpm;
|
2006-03-13 19:01:33 +01:00
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
void insert_RED(int pos, int lred, int redlenok)
|
|
|
|
|
{
|
|
|
|
|
unsigned long i;
|
|
|
|
|
unsigned char *buff;
|
|
|
|
|
int temp, mem;
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
buff = (char *) malloc((epc.cl-pos) * sizeof(char));
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<(epc.cl-pos); i++)
|
|
|
|
|
{
|
|
|
|
|
buff[i] = cio_read(1);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_seek(pos);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
|
|
|
|
cio_write(JPWL_MS_RED,2);
|
|
|
|
|
cio_write(red.lred,2);
|
|
|
|
|
cio_write(red.pred,1);
|
|
|
|
|
|
|
|
|
|
temp = cio_tell();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
cio_init(red.reddata,cslen);
|
|
|
|
|
cio_seek(redlenok);
|
2006-03-13 19:01:33 +01:00
|
|
|
|
for (i=0; i<(redlen-redlenok)/10; i++)
|
|
|
|
|
{
|
|
|
|
|
mem = cio_read(4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(-4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(mem + lred,4); // Start byte refresh
|
2006-03-13 19:01:33 +01:00
|
|
|
|
mem = cio_read(4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_skip(-4);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(mem + lred,4); // End byte refresh
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
cio_init(cssrc,epc.cl+redlen+5);
|
|
|
|
|
cio_seek(temp);
|
|
|
|
|
|
|
|
|
|
for (i=0; i<redlen; i++)
|
2006-03-16 17:49:13 +01:00
|
|
|
|
cio_write(red.reddata[i],1);
|
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
cio_init(cssrc,epc.cl+redlen+5);
|
|
|
|
|
cio_seek(pos + redlen + 5);
|
|
|
|
|
for (i=0; i<(epc.cl-pos); i++)
|
|
|
|
|
{
|
|
|
|
|
cio_write(buff[i],1);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
cio_skip(-2);
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void write_buff(unsigned char *buff,int pos,long cl)
|
|
|
|
|
{
|
|
|
|
|
long i;
|
|
|
|
|
cio_seek(pos);
|
|
|
|
|
for (i=0; i<cl; i++)
|
|
|
|
|
buff[i] = cio_read(1);
|
|
|
|
|
}
|
|
|
|
|
|
2006-03-16 17:49:13 +01:00
|
|
|
|
|
2006-03-13 19:01:33 +01:00
|
|
|
|
void read_buff(unsigned char *buff,int pos,long cl)
|
|
|
|
|
{
|
|
|
|
|
long i;
|
|
|
|
|
cio_seek(pos);
|
|
|
|
|
for (i=0; i<cl; i++)
|
|
|
|
|
cio_write(buff[i],1);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void ResetCRC()
|
|
|
|
|
{
|
|
|
|
|
crcSum = 0xffffffff;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void UpdateCRC16(char x)
|
|
|
|
|
{
|
|
|
|
|
int tmp;
|
|
|
|
|
tmp = ((x ^ (crcSum >> 8)) & 0xff);
|
|
|
|
|
crcSum = ((crcSum << 8) ^ CrcT16[tmp]) & 0xffff;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void UpdateCRC32(char x)
|
|
|
|
|
{
|
|
|
|
|
int tmp;
|
|
|
|
|
tmp = ((x ^ (crcSum >> 24)) & 0xff);
|
|
|
|
|
crcSum = ((crcSum << 8) ^ CrcT32[tmp]);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
char reflectByte(char inbyte)
|
|
|
|
|
{
|
|
|
|
|
// reflect one byte
|
|
|
|
|
|
|
|
|
|
unsigned char outbyte=0;
|
|
|
|
|
unsigned char i=0x01;
|
|
|
|
|
unsigned char j;
|
|
|
|
|
|
|
|
|
|
for (j=0x080; j; j>>=1)
|
|
|
|
|
{
|
|
|
|
|
if (inbyte & i) outbyte|=j;
|
|
|
|
|
i<<=1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return outbyte;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void reflectCRC32()
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
unsigned long outcrc=0;
|
|
|
|
|
unsigned long i=0x00000001;
|
|
|
|
|
unsigned long j;
|
|
|
|
|
|
|
|
|
|
for (j=0x80000000; j; j>>=1)
|
|
|
|
|
{
|
|
|
|
|
if (crcSum & i)
|
|
|
|
|
outcrc|=j;
|
|
|
|
|
i=i<<1;
|
|
|
|
|
}
|
|
|
|
|
crcSum = outcrc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void generate_gf(int nn, int kk)
|
|
|
|
|
/* generate GF(2**mm) from the irreducible polynomial p(X) in pp[0]..pp[mm]
|
|
|
|
|
lookup tables: index->polynomial form alpha_to[] contains j=alpha**i;
|
|
|
|
|
polynomial form -> index form index_of[j=alpha**i] = i
|
|
|
|
|
alpha=2 is the primitive element of GF(2**mm)
|
|
|
|
|
*/
|
|
|
|
|
{
|
|
|
|
|
register int i, mask ;
|
|
|
|
|
|
|
|
|
|
mask = 1 ;
|
|
|
|
|
alpha_to[mm] = 0 ;
|
|
|
|
|
for (i=0; i<mm; i++)
|
|
|
|
|
{ alpha_to[i] = mask ;
|
|
|
|
|
index_of[alpha_to[i]] = i ;
|
|
|
|
|
if (pp[i]!=0)
|
|
|
|
|
alpha_to[mm] ^= mask ;
|
|
|
|
|
mask <<= 1 ;
|
|
|
|
|
}
|
|
|
|
|
index_of[alpha_to[mm]] = mm ;
|
|
|
|
|
mask >>= 1 ;
|
|
|
|
|
for (i=mm+1; i<nn; i++)
|
|
|
|
|
{ if (alpha_to[i-1] >= mask)
|
|
|
|
|
alpha_to[i] = alpha_to[mm] ^ ((alpha_to[i-1]^mask)<<1) ;
|
|
|
|
|
else alpha_to[i] = alpha_to[i-1]<<1 ;
|
|
|
|
|
index_of[alpha_to[i]] = i ;
|
|
|
|
|
}
|
|
|
|
|
index_of[0] = -1 ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void gen_poly(int nn, int kk)
|
|
|
|
|
/* Obtain the generator polynomial of the tt-error correcting, length
|
|
|
|
|
nn=(2**mm -1) Reed Solomon code from the product of (X+alpha**i), i=1..2*tt
|
|
|
|
|
*/
|
|
|
|
|
{
|
|
|
|
|
register int i,j ;
|
|
|
|
|
|
|
|
|
|
gg[0] = 2 ; /* primitive element alpha = 2 for GF(2**mm) */
|
|
|
|
|
gg[1] = 1 ; /* g(x) = (X+alpha) initially */
|
|
|
|
|
for (i=2; i<=nn-kk; i++)
|
|
|
|
|
{ gg[i] = 1 ;
|
|
|
|
|
for (j=i-1; j>0; j--)
|
|
|
|
|
if (gg[j] != 0) gg[j] = gg[j-1]^ alpha_to[(index_of[gg[j]]+i)%nn] ;
|
|
|
|
|
else gg[j] = gg[j-1] ;
|
|
|
|
|
gg[0] = alpha_to[(index_of[gg[0]]+i)%nn] ; /* gg[0] can never be zero */
|
|
|
|
|
}
|
|
|
|
|
/* convert gg[] to index form for quicker encoding */
|
|
|
|
|
for (i=0; i<=nn-kk; i++) gg[i] = index_of[gg[i]] ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void encode_rs(int nn, int kk, int tt)
|
|
|
|
|
/* take the string of symbols in data[i], i=0..(k-1) and encode systematically
|
|
|
|
|
to produce 2*tt parity symbols in bb[0]..bb[2*tt-1]
|
|
|
|
|
data[] is input and bb[] is output in polynomial form.
|
|
|
|
|
Encoding is done by using a feedback shift register with appropriate
|
|
|
|
|
connections specified by the elements of gg[], which was generated above.
|
|
|
|
|
Codeword is c(X) = data(X)*X**(nn-kk)+ b(X) */
|
|
|
|
|
{
|
|
|
|
|
register int i,j ;
|
|
|
|
|
int feedback ;
|
|
|
|
|
|
|
|
|
|
for (i=0; i<nn-kk; i++) bb[i] = 0 ;
|
|
|
|
|
for (i=kk-1; i>=0; i--)
|
|
|
|
|
{ feedback = index_of[data[i]^bb[nn-kk-1]] ;
|
|
|
|
|
if (feedback != -1)
|
|
|
|
|
{ for (j=nn-kk-1; j>0; j--)
|
|
|
|
|
if (gg[j] != -1)
|
|
|
|
|
bb[j] = bb[j-1]^alpha_to[(gg[j]+feedback)%nn] ;
|
|
|
|
|
else
|
|
|
|
|
bb[j] = bb[j-1] ;
|
|
|
|
|
bb[0] = alpha_to[(gg[0]+feedback)%nn] ;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{ for (j=nn-kk-1; j>0; j--)
|
|
|
|
|
bb[j] = bb[j-1] ;
|
|
|
|
|
bb[0] = 0 ;
|
|
|
|
|
} ;
|
|
|
|
|
} ;
|
|
|
|
|
} ;
|
|
|
|
|
|
|
|
|
|
// La funzione seguente, leggermente modificata rispetto al sorgente in "eccpage", ritorna
|
|
|
|
|
// 1 se <20> riuscita a correggere gli errori o se non ci sono errori, 0 se il processo di
|
|
|
|
|
// decodifica RS non <20> stato portato a termine.
|
|
|
|
|
|
|
|
|
|
void decode_rs(int nn, int kk, int tt)
|
|
|
|
|
/* assume we have received bits grouped into mm-bit symbols in recd[i],
|
|
|
|
|
i=0..(nn-1), and recd[i] is index form (ie as powers of alpha).
|
|
|
|
|
We first compute the 2*tt syndromes by substituting alpha**i into rec(X) and
|
|
|
|
|
evaluating, storing the syndromes in s[i], i=1..2tt (leave s[0] zero) .
|
|
|
|
|
Then we use the Berlekamp iteration to find the error location polynomial
|
|
|
|
|
elp[i]. If the degree of the elp is >tt, we cannot correct all the errors
|
|
|
|
|
and hence just put out the information symbols uncorrected. If the degree of
|
|
|
|
|
elp is <=tt, we substitute alpha**i , i=1..n into the elp to get the roots,
|
|
|
|
|
hence the inverse roots, the error location numbers. If the number of errors
|
|
|
|
|
located does not equal the degree of the elp, we have more than tt errors
|
|
|
|
|
and cannot correct them. Otherwise, we then solve for the error value at
|
|
|
|
|
the error location and correct the error. The procedure is that found in
|
|
|
|
|
Lin and Costello. For the cases where the number of errors is known to be too
|
|
|
|
|
large to correct, the information symbols as received are output (the
|
|
|
|
|
advantage of systematic encoding is that hopefully some of the information
|
|
|
|
|
symbols will be okay and that if we are in luck, the errors are in the
|
|
|
|
|
parity part of the transmitted codeword). Of course, these insoluble cases
|
|
|
|
|
can be returned as error flags to the calling routine if desired. */
|
|
|
|
|
{
|
|
|
|
|
register int i,j,u,q ;
|
|
|
|
|
//int elp[nn-kk+2][nn-kk], d[nn-kk+2], l[nn-kk+2], u_lu[nn-kk+2], s[nn-kk+1] ;
|
|
|
|
|
//int count=0, syn_error=0, root[tt], loc[tt], z[tt+1], err[nn], reg[tt+1] ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int **elp, *d, *l, *u_lu, *s;
|
|
|
|
|
int count=0, syn_error=0, *root, *loc, *z, *err, *reg;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
elp = (int **) malloc((nn-kk+2)*sizeof(int));
|
|
|
|
|
for (i=0; i<(nn-kk+2); i++)
|
|
|
|
|
elp[i] = (int *) malloc((nn-kk)*sizeof(int));
|
|
|
|
|
d = (int *) malloc((nn-kk+2)*sizeof(int));
|
|
|
|
|
l = (int *) malloc((nn-kk+2)*sizeof(int));
|
|
|
|
|
u_lu = (int *) malloc((nn-kk+2)*sizeof(int));
|
|
|
|
|
s = (int *) malloc((nn-kk+2)*sizeof(int));
|
|
|
|
|
root = (int *) malloc(tt*sizeof(int));
|
|
|
|
|
loc = (int *) malloc(tt*sizeof(int));
|
|
|
|
|
z = (int *) malloc((tt+1)*sizeof(int));
|
|
|
|
|
err = (int *) malloc(nn*sizeof(int));
|
|
|
|
|
reg = (int *) malloc((tt+1)*sizeof(int));
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* first form the syndromes */
|
|
|
|
|
for (i=1; i<=nn-kk; i++)
|
|
|
|
|
{ s[i] = 0 ;
|
|
|
|
|
for (j=0; j<nn; j++)
|
|
|
|
|
if (recd[j]!=-1)
|
|
|
|
|
s[i] ^= alpha_to[(recd[j]+i*j)%nn] ; /* recd[j] in index form */
|
|
|
|
|
/* convert syndrome from polynomial form to index form */
|
|
|
|
|
if (s[i]!=0) syn_error=1 ; /* set flag if non-zero syndrome => error */
|
|
|
|
|
s[i] = index_of[s[i]] ;
|
|
|
|
|
} ;
|
|
|
|
|
|
|
|
|
|
if (syn_error) /* if errors, try and correct */
|
|
|
|
|
{
|
|
|
|
|
/* compute the error location polynomial via the Berlekamp iterative algorithm,
|
|
|
|
|
following the terminology of Lin and Costello : d[u] is the 'mu'th
|
|
|
|
|
discrepancy, where u='mu'+1 and 'mu' (the Greek letter!) is the step number
|
|
|
|
|
ranging from -1 to 2*tt (see L&C), l[u] is the
|
|
|
|
|
degree of the elp at that step, and u_l[u] is the difference between the
|
|
|
|
|
step number and the degree of the elp.
|
|
|
|
|
*/
|
|
|
|
|
/* initialise table entries */
|
|
|
|
|
d[0] = 0 ; /* index form */
|
|
|
|
|
d[1] = s[1] ; /* index form */
|
|
|
|
|
elp[0][0] = 0 ; /* index form */
|
|
|
|
|
elp[1][0] = 1 ; /* polynomial form */
|
|
|
|
|
for (i=1; i<nn-kk; i++)
|
|
|
|
|
{ elp[0][i] = -1 ; /* index form */
|
|
|
|
|
elp[1][i] = 0 ; /* polynomial form */
|
|
|
|
|
}
|
|
|
|
|
l[0] = 0 ;
|
|
|
|
|
l[1] = 0 ;
|
|
|
|
|
u_lu[0] = -1 ;
|
|
|
|
|
u_lu[1] = 0 ;
|
|
|
|
|
u = 0 ;
|
|
|
|
|
|
|
|
|
|
do
|
|
|
|
|
{
|
|
|
|
|
u++ ;
|
|
|
|
|
if (d[u]==-1)
|
|
|
|
|
{ l[u+1] = l[u] ;
|
|
|
|
|
for (i=0; i<=l[u]; i++)
|
|
|
|
|
{ elp[u+1][i] = elp[u][i] ;
|
|
|
|
|
elp[u][i] = index_of[elp[u][i]] ;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
/* search for words with greatest u_lu[q] for which d[q]!=0 */
|
|
|
|
|
{ q = u-1 ;
|
|
|
|
|
while ((d[q]==-1) && (q>0)) q-- ;
|
|
|
|
|
/* have found first non-zero d[q] */
|
|
|
|
|
if (q>0)
|
|
|
|
|
{ j=q ;
|
|
|
|
|
do
|
|
|
|
|
{ j-- ;
|
|
|
|
|
if ((d[j]!=-1) && (u_lu[q]<u_lu[j]))
|
|
|
|
|
q = j ;
|
|
|
|
|
}while (j>0) ;
|
|
|
|
|
} ;
|
|
|
|
|
|
|
|
|
|
/* have now found q such that d[u]!=0 and u_lu[q] is maximum */
|
|
|
|
|
/* store degree of new elp polynomial */
|
|
|
|
|
if (l[u]>l[q]+u-q) l[u+1] = l[u] ;
|
|
|
|
|
else l[u+1] = l[q]+u-q ;
|
|
|
|
|
|
|
|
|
|
/* form new elp(x) */
|
|
|
|
|
for (i=0; i<nn-kk; i++) elp[u+1][i] = 0 ;
|
|
|
|
|
for (i=0; i<=l[q]; i++)
|
|
|
|
|
if (elp[q][i]!=-1)
|
|
|
|
|
elp[u+1][i+u-q] = alpha_to[(d[u]+nn-d[q]+elp[q][i])%nn] ;
|
|
|
|
|
for (i=0; i<=l[u]; i++)
|
|
|
|
|
{ elp[u+1][i] ^= elp[u][i] ;
|
|
|
|
|
elp[u][i] = index_of[elp[u][i]] ; /*convert old elp value to index*/
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
u_lu[u+1] = u-l[u+1] ;
|
|
|
|
|
|
|
|
|
|
/* form (u+1)th discrepancy */
|
|
|
|
|
if (u<nn-kk) /* no discrepancy computed on last iteration */
|
|
|
|
|
{
|
|
|
|
|
if (s[u+1]!=-1)
|
|
|
|
|
d[u+1] = alpha_to[s[u+1]] ;
|
|
|
|
|
else
|
|
|
|
|
d[u+1] = 0 ;
|
|
|
|
|
for (i=1; i<=l[u+1]; i++)
|
|
|
|
|
if ((s[u+1-i]!=-1) && (elp[u+1][i]!=0))
|
|
|
|
|
d[u+1] ^= alpha_to[(s[u+1-i]+index_of[elp[u+1][i]])%nn] ;
|
|
|
|
|
d[u+1] = index_of[d[u+1]] ; /* put d[u+1] into index form */
|
|
|
|
|
}
|
|
|
|
|
} while ((u<nn-kk) && (l[u+1]<=tt)) ;
|
|
|
|
|
|
|
|
|
|
u++ ;
|
|
|
|
|
if (l[u]<=tt) /* can correct error */
|
|
|
|
|
{
|
|
|
|
|
/* put elp into index form */
|
|
|
|
|
for (i=0; i<=l[u]; i++) elp[u][i] = index_of[elp[u][i]] ;
|
|
|
|
|
|
|
|
|
|
/* find roots of the error location polynomial */
|
|
|
|
|
for (i=1; i<=l[u]; i++)
|
|
|
|
|
reg[i] = elp[u][i] ;
|
|
|
|
|
count = 0 ;
|
|
|
|
|
for (i=1; i<=nn; i++)
|
|
|
|
|
{ q = 1 ;
|
|
|
|
|
for (j=1; j<=l[u]; j++)
|
|
|
|
|
if (reg[j]!=-1)
|
|
|
|
|
{ reg[j] = (reg[j]+j)%nn ;
|
|
|
|
|
q ^= alpha_to[reg[j]] ;
|
|
|
|
|
} ;
|
|
|
|
|
if (!q) /* store root and error location number indices */
|
|
|
|
|
{ root[count] = i;
|
|
|
|
|
loc[count] = nn-i ;
|
|
|
|
|
count++ ;
|
|
|
|
|
};
|
|
|
|
|
} ;
|
|
|
|
|
if (count==l[u]) /* no. roots = degree of elp hence <= tt errors */
|
|
|
|
|
{
|
|
|
|
|
/* form polynomial z(x) */
|
|
|
|
|
for (i=1; i<=l[u]; i++) /* Z[0] = 1 always - do not need */
|
|
|
|
|
{ if ((s[i]!=-1) && (elp[u][i]!=-1))
|
|
|
|
|
z[i] = alpha_to[s[i]] ^ alpha_to[elp[u][i]] ;
|
|
|
|
|
else if ((s[i]!=-1) && (elp[u][i]==-1))
|
|
|
|
|
z[i] = alpha_to[s[i]] ;
|
|
|
|
|
else if ((s[i]==-1) && (elp[u][i]!=-1))
|
|
|
|
|
z[i] = alpha_to[elp[u][i]] ;
|
|
|
|
|
else
|
|
|
|
|
z[i] = 0 ;
|
|
|
|
|
for (j=1; j<i; j++)
|
|
|
|
|
if ((s[j]!=-1) && (elp[u][i-j]!=-1))
|
|
|
|
|
z[i] ^= alpha_to[(elp[u][i-j] + s[j])%nn] ;
|
|
|
|
|
z[i] = index_of[z[i]] ; /* put into index form */
|
|
|
|
|
} ;
|
|
|
|
|
|
|
|
|
|
/* evaluate errors at locations given by error location numbers loc[i] */
|
|
|
|
|
for (i=0; i<nn; i++)
|
|
|
|
|
{ err[i] = 0 ;
|
|
|
|
|
if (recd[i]!=-1) /* convert recd[] to polynomial form */
|
|
|
|
|
recd[i] = alpha_to[recd[i]] ;
|
|
|
|
|
else recd[i] = 0 ;
|
|
|
|
|
}
|
|
|
|
|
for (i=0; i<l[u]; i++) /* compute numerator of error term first */
|
|
|
|
|
{ err[loc[i]] = 1; /* accounts for z[0] */
|
|
|
|
|
for (j=1; j<=l[u]; j++)
|
|
|
|
|
if (z[j]!=-1)
|
|
|
|
|
err[loc[i]] ^= alpha_to[(z[j]+j*root[i])%nn] ;
|
|
|
|
|
if (err[loc[i]]!=0)
|
|
|
|
|
{ err[loc[i]] = index_of[err[loc[i]]] ;
|
|
|
|
|
q = 0 ; /* form denominator of error term */
|
|
|
|
|
for (j=0; j<l[u]; j++)
|
|
|
|
|
if (j!=i)
|
|
|
|
|
q += index_of[1^alpha_to[(loc[j]+root[i])%nn]] ;
|
|
|
|
|
q = q % nn ;
|
|
|
|
|
err[loc[i]] = alpha_to[(err[loc[i]]-q+nn)%nn] ;
|
|
|
|
|
recd[loc[i]] ^= err[loc[i]] ; /*recd[i] must be in polynomial form */
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
decodeflag = 1;
|
|
|
|
|
//printf("Ho corretto gli errori!\n");
|
|
|
|
|
}
|
|
|
|
|
else /* no. roots != degree of elp => >tt errors and cannot solve */
|
|
|
|
|
{ for (i=0; i<nn; i++) /* could return error flag if desired */
|
|
|
|
|
if (recd[i]!=-1) /* convert recd[] to polynomial form */
|
|
|
|
|
recd[i] = alpha_to[recd[i]] ;
|
|
|
|
|
else recd[i] = 0 ; /* just output received codeword as is */
|
|
|
|
|
decodeflag = 0;
|
|
|
|
|
//printf("Non ho corretto!\n");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else /* elp has degree has degree >tt hence cannot solve */
|
|
|
|
|
{ for (i=0; i<nn; i++) /* could return error flag if desired */
|
|
|
|
|
if (recd[i]!=-1) /* convert recd[] to polynomial form */
|
|
|
|
|
recd[i] = alpha_to[recd[i]] ;
|
|
|
|
|
else recd[i] = 0 ; /* just output received codeword as is */
|
|
|
|
|
decodeflag = 0;
|
|
|
|
|
//printf("Non ho corretto!\n");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else /* no non-zero syndromes => no errors: output received codeword */
|
|
|
|
|
{ for (i=0; i<nn; i++)
|
|
|
|
|
if (recd[i]!=-1) /* convert recd[] to polynomial form */
|
|
|
|
|
recd[i] = alpha_to[recd[i]] ;
|
|
|
|
|
else recd[i] = 0 ;
|
|
|
|
|
decodeflag = 1;
|
|
|
|
|
//printf("La codestream non contiene errori!\n");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/******/
|
|
|
|
|
// int **elp, *d, *l, *u_lu, *s;
|
|
|
|
|
//int count=0, syn_error=0, *root, *loc, *z, *err, *reg;
|
|
|
|
|
|
|
|
|
|
//elp = (int *) malloc((nn-kk+2)*sizeof(int));
|
|
|
|
|
|
|
|
|
|
for (i=0; i<(nn-kk+2); i++)
|
|
|
|
|
free(elp[i]);
|
|
|
|
|
free(elp);
|
|
|
|
|
free(d);
|
|
|
|
|
free(l);
|
|
|
|
|
free(u_lu);
|
|
|
|
|
free(s);
|
|
|
|
|
free(root);
|
|
|
|
|
free(loc);
|
|
|
|
|
free(z);
|
|
|
|
|
free(err);
|
|
|
|
|
free(reg);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|