From cff5df73d9d7e87f1f960ef73f98d50f75a64ef7 Mon Sep 17 00:00:00 2001 From: Giuseppe Baruffa Date: Tue, 8 Nov 2005 17:40:33 +0000 Subject: Initial revision --- jpwl/decoder/libopenjpeg/jpw.c | 3532 ++++++++++++++++++++++++++++++++++++++++ 1 file changed, 3532 insertions(+) create mode 100644 jpwl/decoder/libopenjpeg/jpw.c (limited to 'jpwl/decoder/libopenjpeg/jpw.c') diff --git a/jpwl/decoder/libopenjpeg/jpw.c b/jpwl/decoder/libopenjpeg/jpw.c new file mode 100644 index 00000000..6f46c796 --- /dev/null +++ b/jpwl/decoder/libopenjpeg/jpw.c @@ -0,0 +1,3532 @@ +// In questa versione si aggiunge la funzione che inserisce il marker RED + +// Per ora si suppone che venga aggiunto un solo RED, nel main header, e che sia +// utilizzata la modalità byte-range mode. Osserviamo che ci sono problemi realizzativi +// per l'utilizzo delle modalità a pacchetto (non ci sono pacchetti negli header!). +// Decidiamo di aggiungere il marker RED subito prima di SOT (alla fine di MH!!!). +// Per stare sicuri, come address length utilizziamo 4 bytes (b1=1). + +#include +#include +#include +#include +#include +#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 0xff68 +#define JPWL_MS_EPB 0xff66 +#define JPWL_MS_RED 0xff69 +#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; + id_tecn *tecn; // array di strutture di tipo id_tecn!!! +} 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; + +unsigned char *cssrc;// Queste variabili servono per la gestione della codestream. +unsigned int cslen; // Se voglio utilizzare le funzioni "cio" per gestire un buffer, +int cspos; // queste variabili consentono di reinizializzare cio per la CS!! +unsigned int csread; // Lunghezza della codestream letta...serve per uscire in caso di errori + +int redpos; // Per la gestione del passaggio delle funzioni "cio" al e dal buffer RED +int decodeflag; // Vale 1 se RS è stato decodificato, 0 altrimenti +unsigned long redlen; // Lunghezza del buffer che contiene REDdata +int redmode; // Se vale 0 allora RED in MH, se vale 1 allora RED in MH e nei vari TPH +int redlenok; // Lunghezza del campo dati della RED che non necessita aggiornamento offset +int nepbrd; // Tiene conto del numero di EPB letti +int lastepb; // Se vale 1 l'EPB corrente è l'ultimo dell'header in questione! + + +// La funzione seguente cerca la presenza nella codestream del marker EPC +// in modo da determinare se si tratta di una codestream JPWL +// Ritorna il numero di EPC presenti nella codestream +int decode_JPWL(unsigned char *src, int len) +{ + unsigned int temp, nepb, j2k_state, pos, nepc, posi, mem, rest; + //int flag; // se 0 vuol dire che ha trovato EPC dopo SIZ, se 1 dopo EPB + int err; // se 1 vuol dire che EPC è corretto, se 0 vuol dire che contiene + // ancora errori! + unsigned long psot, i; + FILE *f,*g; + + + cssrc = src; //*********Aggiunta in questa versione 1.7 + cslen = len; //*********Aggiunta in questa versione 1.7 + redpos = 0; //*********Aggiunta in questa versione 1.7 + redlen = 0; //*********Aggiunta in questa versione 1.7 + redlenok = 0; + redmode = 0; //*********Aggiunta in questa versione 1.7 + // Per default si assume che la RED è scritta solo in MH!!! + + csread = 0; + + f = fopen("output.j2c","wb"); + if (f==NULL) + printf("Unable to open file!\n"); + cio_seek(0); + //printf("CL: %d\n",epc.cl); + for (i=0; i> 8 != 0xff) { + // fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + // return 0; + //} + //temp = cio_read(2); // qui dovrebbe leggere la lunghezza di SIZ: Lsiz + //cio_skip(temp-2); + + + j2k_state = 0; // inizializza j2k_state ad un valore indefinito + nepc = 0; // inizializza a zero il numero di EPC finora trovati + nepbrd = 0; + lastepb = 0; + + + //while ((j2k_state != J2K_STATE_MT)&&(csread < cslen)) + while (j2k_state != J2K_STATE_MT) + { + + //nepc = find_EPC(nepc,&j2k_state); + temp = cio_read(2); // qui dovrebbe leggere SIZ o SOT + /*if (temp >> 8 != 0xff) { + fprintf(stderr, "%.8x: expected a marker instead of %x\n", + cio_tell() - 2, temp); + return nepc; + }*/ + //csread+=2; + + posi = cio_tell(); // memorizza la posizione a monte della lunghezza di SIZ o SOT + + //ncomp = 3; // di default si assume che l'immagine abbia 3 componenti!!! + if (temp == J2K_MS_SIZ) // Ha letto SIZ!!! + { + temp = cio_read(2); // legge Lsiz + //csread+=2; + //ncomp = (temp - 38)/3; // calcola il numero di componenti dell'immagine + // nbckpar serve per modificare il numero di blocchi di decodifica per la prima + // parte del primo EPB in base al numero di componenti utilizzate!!! + lmex = temp + 17; // lunghezza dei dati da proteggere; + nbckpar = (int)ceil((double)lmex / 96); // 96 è nn-kk per il primo EPB + // temp=Lsiz, 17 tiene conto di EPB,SIZ,SOC + + } + else // sta leggendo SOT oppure sta leggendo SIZ ma ci sono errori nel marker SIZ!!! + { // ...in tal caso il decoder assume che l'immagine sia composta da 3 componenti + nbckpar = 1; + temp = cio_read(2); // qui dovrebbe leggere la lunghezza di SIZ o SOT + } + cio_skip(temp-2); + //csread += (temp - 2); + + + + temp = cio_read(2); // qui dovrebbe leggere EPC o EPB, se ci sono + //if (temp >> 8 != 0xff) { + // fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + // return nepc; + //} + //csread += 2; + if (temp != JPWL_MS_EPC) + { + temp = cio_read(2); // qui dovrebbe leggere la lunghezza di EPB, se c'è: Lepb + cio_skip(temp-2); + temp = cio_read(2); // qui dovrebbe leggere EPC, se c'è!! + //if (temp >> 8 != 0xff) { + //fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + //return nepc; + //} + //csread += temp + 2; + + pos = cio_tell(); + + if ((temp != JPWL_MS_EPC)&&(nepc == 0)) + { + cio_seek(0); + /*return nepc; */ // non ha trovato EPC => vede la codestream come NON JPWL + _exit(-1); + } + + if ((temp != JPWL_MS_EPC)&&(nepc != 0)) //vuol dire che il TPH in questione non ha EPC + { + cio_seek(posi); // siamo a monte della lunghezza di SOT + cio_skip(4); + psot = cio_read(4); + if (psot == 0) // vuol dire che siamo nell'ultimo TPH + j2k_state = J2K_STATE_MT; // cosi' al passo seguente si esce dal ciclo + cio_seek(posi-2); + cio_skip(psot); // si pone a valle dei dati del tile corrente + if (cio_read(2) == J2K_MS_EOC) + j2k_state = J2K_STATE_MT; + cio_skip(-2); // si pone a valle dei dati del tile corrente + //csread += (psot - pos); + //return nepc; + + } + if (temp == JPWL_MS_EPC) // ha trovato l'EPC non subito dopo SIZ, quindi c'è EPB! + { + if (nepc == 0) + { + j2k_state = J2K_STATE_MHSOC; + cio_seek(posi-4); // si posiziona a monte di SOC + next = cio_tell(); // assegna a next = 0!!!! + } + if (nepc != 0) + { + j2k_state = J2K_STATE_TPHSOT; + cio_seek(posi-2); // si posiziona a monte di SOT + next = cio_tell(); + } + //printf("next: %x\n",next); + red.reddata = (char *) malloc(len * sizeof(char));// Allochiamo lo spazio necessario per RED + // Scegliamo len per "stare larghi" + + // ********Cio' che segue è un'aggiunta in jpwldec1.9!!!!********** + mem = next; + i = 0; + if (!(rest = read_EPB_2(&j2k_state)))// legge il primo EPB(della CS o del tile,caso + EPC!) + return nepc; + i += rest; + temp = cio_tell(); // Memorizza posizione a valle di EPB + cio_seek(pos); // si posiziona a valle del marker EPC + err = read_EPC(); // Legge il primo EPC, o comunque il primo EPC di un tile + //if (err == 1) + // printf("CRC EPC corretto!\n"); + //else + // printf("CRC EPC errato!\n"); + nepc++; // nel caso di più EPC usati nella codestream + nepb = epc.tecn[0].lid / 4; // calcola il numero di EPB presenti + //printf("nepb: %d\n",nepb); + /*********************************************************************** + Qui dovrà essere aggiunta la porzione di codice per la gestione + della scrittura della RED anche nei tile! + *************************************************************************/ + + //while ((i> 8 != 0xff) { + // fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + // return nepc; + //} + + //while ((temp != J2K_MS_SOT)&&(csread < cslen)) + while (temp != J2K_MS_SOT) + { + cio_skip(cio_read(2)-2); + temp = cio_read(2); + //if (temp >> 8 != 0xff) { + //fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + //return nepc; + //} + //csread += 2; + } + cio_skip(-2); + } + j2k_state = J2K_STATE_TPHSOT; + if (j2k_state == J2K_STATE_TPHSOT) + { + cio_seek(temp); // Si posiziona all'inizio di SOT + pos = cio_tell(); + //printf("pos: %x\n",pos); + //system("pause"); + do + { + if (!(rest = read_EPB_2(&j2k_state))) + return nepc; + i += rest; + //printf("state: %x\n",j2k_state); + } + while (lastepb == 0); + //printf("ciao!\n"); + //while ((lastepb == 0)&&(csread < cslen)); + //printf("state: %x\n",j2k_state); + //system("pause"); + } + temp = cio_read(2); + //printf("mrk: %x\n",temp); + //system("pause"); + //if (temp >> 8 != 0xff) { + //fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + //return nepc; + //} + //csread += 2; + 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); + temp = cio_read(2); + if (temp == J2K_MS_EOC) + j2k_state = J2K_STATE_MT; + else + { + j2k_state = J2K_STATE_TPHSOT; + cio_skip(-2); + temp = cio_tell(); + } + + } + if (temp == J2K_MS_SOT) + { + cio_skip(-2); + temp = cio_tell(); + j2k_state = J2K_STATE_TPHSOT; + } + } + } + // Ora sono stati letti tutti gli EPB associati all'ultimo EPC letto + //printf("temp: %x\n",temp); + + //while ((temp != J2K_MS_EOC)&&(csread < cslen)) + //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); + // //if (temp >> 8 != 0xff) { + // //fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // // cio_tell() - 2, temp); + // //return nepc; + // //} + // //csread += 2; + //} + //cio_skip(-2); // A questo punto siamo all'inizio di EOC + //j2k_state = J2K_STATE_MT; + + } + } + else // ho trovato EPC dopo SIZ o SOT + { + err = read_EPC(); + //if (err == 1) + // printf("CRC EPC corretto!\n"); + //else + // printf("CRC EPC errato!\n"); + if (nepc == 0) + { + cio_seek(posi); // siamo a monte della lunghezza di SIZ + cio_skip(cio_read(2)-2); // si pone a valle di SIZ + temp = cio_read(2); // legge il marker successivo + //if (temp >> 8 != 0xff) { + // fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + // return nepc; + //} + + //while ((temp != J2K_MS_SOT)&&(csread < cslen)) + while (temp != J2K_MS_SOT) + { + cio_skip(cio_read(2)-2); // si pone a valle del MS corrente + temp = cio_read(2); // legge il marker successivo + //if (temp >> 8 != 0xff) { + //fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + //return nepc; + //} + //csread += 2; + //printf("MS: %x\n",temp); + } + cio_skip(-2); // si posiziona a valle del main header + } + if (nepc != 0) + { + cio_seek(posi); // siamo a monte della lunghezza di SOT + cio_skip(4); + psot = cio_read(4); + if (psot == 0) // vuol dire che siamo nell'ultimo TPH + j2k_state = J2K_STATE_MT; // cosi' al passo seguente si esce dal cilclo + cio_seek(posi-2); + cio_skip(psot); // si pone a valle dei dati del tile corrente + temp = cio_read(2); + if (temp == J2K_MS_EOC) + { + j2k_state = J2K_STATE_MT; + } + cio_skip(-2); // si pone a valle dei dati del tile corrente + } + //j2k_state = J2K_STATE_MT; + nepc++; + } + } // fine while (j2k_state != J2K_STATE_MT)!! + + //printf("Eccomi!\n"); + //f = fopen("output","wb"); + //if (f==NULL) + // printf("Unable to open file!\n"); + //cio_seek(0); + //printf("CL: %d\n",epc.cl); + //for (i=0; i> 8 != 0xff) { + // fprintf(stderr, "%.8x: expected a marker instead of %x\n", + // cio_tell() - 2, temp); + // return nepc; + //} + cio_skip(-2); + } + //cio_skip(-2); + //printf("sdfpo: %x\n",cio_read(2)); + // A questo punto ci troviamo a valle dell'ultimo marker del MH + // Dobbiamo inserire il marker RED!!! + insert_RED(cio_tell(),red.lred+2,redlenok); + g = fopen("output.j2c","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); + _exit(-1); + cslen = epc.cl + redlen + 5; + //free(red.reddata); + } + else + { + f = fopen("output.j2c","wb"); + if (f==NULL) + printf("Unable to open file!\n"); + cio_seek(0); + //printf("CL: %d\n",epc.cl); + for (i=0; i>4)&1) // E' presente una o più ESD !!! + { + esd = (ESD_MS *) malloc(10 * sizeof(ESD_MS)); // ******Si puo' togliere!!!!! + //printf("La codestream contiene il marker ESD!\n"); + } + ltec = epc.lepc - 9; // lunghezza dell'EPC a partire dalla fine di pepc + count = 0; + nid = 0; // numero di tecniche id usate + while (count> 6)&1)) // quello corrente non è l'ultimo EPB del tile corrente + lastepb = 0; + if ((depb >> 6)&1) // quello corrente è l'ultimo EPB del tile corrente + lastepb = 1; + //printf("lastepb: %d\n",lastepb); + //printf("pack: %d\n",(depb >> 7)&1); + if (!((depb >> 7)&1)) // EPB in modalità unpacked + { + //printf("Unpacked\n"); + //system("pause"); + if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH))) + *j2k_state = J2K_STATE_MH; // vuol dire che il prossimo EPB è in MH ma non è il primo + //if (((depb >> 6)&1)&&((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_MHSOC))) + // *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + //if (((depb >> 6)&1)&&((*j2k_state == J2K_STATE_TPH)||(*j2k_state == J2K_STATE_TPHSOT))) + // *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH))) + *j2k_state = J2K_STATE_TPH; // vuol dire che il prossimo EPB è relativo ad un TPH + + nepbrd++; + // Ora leggendo pepb il decoder deve capire quale codice applicare per la porzione di dati + // cui fa riferimento la seconda parte del campo EPBdata + + if (pepb) // se pepb=0 allora si usano i codici di default precedenti + { + if ((pepb>>28)==2) + { + // in questo caso deve effettuare la decodifica RS + /***********/ + // liberiamo gli spazi allocati + 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)); + recd = (int *) malloc((nn1)*sizeof(int)); ///forse alcune di queste malloc possono + data = (int *) malloc((kk1)*sizeof(int)); // essere eliminate, inutili per decodifica!!! + bb = (int *) malloc((nn1-kk1)*sizeof(int)); + generate_gf(nn1,kk1) ; + gen_poly(nn1,kk1) ; + } + + if ((pepb>>28)==1) + { + // in questo caso deve effettuare le decodifica CRC + free(buff); + buff = (char *) malloc(ldpepb * sizeof(char)); + write_buff(buff,posdata2+ldata,ldpepb); + if (pepb & 0x00000001) // vuol dire che bisogna decodificare secondo CRC 32 + { + /*per fare il crc32 occorre invertire i byte in ingresso, invertire il crc calcolato + e farne il complemento a 1*/ + ResetCRC(); + for (i=0; i < ldpepb; i++) + UpdateCRC32(reflectByte(buff[i])); + reflectCRC32(); + crcSum ^= 0xffffffff; // effettua il complemento a 1 + cio_seek(posdata2); + datacrc = cio_read(4); + //printf("CRCSUM: %x\n",crcSum); + //if (datacrc == crcSum) + // printf("CRC corretto!\n"); + //else + // printf("CRC errato!\n"); + } + else // vuol dire che bisogna decodificare secondo CRC 16 + { + ResetCRC(); + for (i=0; i < ldpepb; i++) + UpdateCRC16(buff[i]); + cio_seek(posdata2); + datacrc = cio_read(2); + //printf("CRCSUM: %x\n",crcSum); + //if (datacrc == crcSum) + // printf("CRC corretto!\n"); + //else + // printf("CRC errato!\n"); + } + free(buff); + cio_seek(posdata2 + ldata + ldpepb); + next = cio_tell(); + //printf("read: %x\n",cio_read(2)); + //cio_skip(-2); + + 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); + //printf("state: %x\n",*j2k_state); + + return 1; + //return (posdata2 + ldata + ldpepb); // ritorna la posizione a valle dei dati successivi a EPB + //return; + } + + if (pepb>=0x30000000) + { + // tecniche registrate in RA + cio_seek(posdata2); + return 1; + //return (posdata2 + ldata + ldpepb); + // Per adesso prevede la semplice uscita dalla funzione + } + + if (pepb==0xffffffff) + { + // non sono usati metodi per i dati seguenti + cio_seek(posdata2); + return 1; + //return (posdata2 + ldata + ldpepb); + //return; + } + }// Fine if (pepb) + + + + /*******************/ + // qui bisogna aggiungere la parte per la gestione della modalità packed/unpacked + /*******************/ + + + //cio_seek(posdata + (nn-kk)); + //posdata2 = cio_tell(); // posizione inizio seconda parte dati EPB + + /********************/ + // Per adesso si suppone che il primo EPB di un header utilizza lo stesso codice + // di default anche per la seconda parte dei dati...in seguito bisognerà aggiungere + // la funzionalità che gestisce l'uso dei vari codici in base al campo pepb + /********************/ + + // Ora bisogna copiare in buff la seconda parte dei dati di EPB e i dati successivi all'epb + // per una lunghezza pari a ldpepb + + nblock = ldata / (nn-kk); // numero di "blocchi di decodifica" + //printf("nblock = %d\n",nblock); + //*system("pause"); + //cio_seek(posdata2); // si posiziona all'inizio della seconda parte dei dati EPB + free(buff); + buff = (char *) malloc(nn1 * sizeof(char)); + for (i=0; i> 6)&1) // quello corrente è l'ultimo EPB del tile corrente + //{ + // lastepb = 1; // l'epb corrente è l'ultimo del tile + //nepbpm = ((depb << 2) >> 2); // numero di EPB accorpati in modalità packed + // nepbpm = (depb & 0x3f); // numero di EPB accorpati in modalità packed + //printf("nepbpm: %d\n",nepbpm); + //} + if (!((depb >> 6)&1)) // quello corrente non è l'ultimo EPB del tile corrente + nepbpm += 1; + if ((depb >> 6)&1) // quello corrente è l'ultimo EPB del tile corrente + { + nepbpm += 1; + lastepb = 1; + } + + //printf("nepbpm: %d\n",nepbpm); + //printf("lastepb: %d\n",lastepb); + //system("pause"); + + cio_skip(-3); // si posiziona all'inizio del campo lepb + cio_skip(cio_read(2)-2); // si posiziona a valle dell'epb corrente + pos = cio_tell(); // memorizza la posizione all'inizio dell'EPB successivo + //printf("pos: %x\n",pos); + //printf("mrk: %x\n",cio_read(2)); + //cio_skip(-2); + //system("pause"); + cio_skip(2); + + //conta++; + + //csread += lepb; + + } // Fine while (lastepb == 0)!!!! + // A questo punto il decoder ha decodificato le porzioni iniziali di tutti gli EPB + // del tile corrente + + + // Ora dobbiamo decodificare le porzioni finali di tutti gli EPB!!! + + // pos contiene la posizione a valle dell'ultimo degli EPB packed!!! + cio_skip(-2); + posend = cio_tell(); + //printf("posend: %x\n",posend); + //system("pause"); + lpack = posend-posfirst; // lunghezza totale della catena di EPB + epb = (EPB_par *) malloc(nepbpm * sizeof(EPB_par)); + cio_seek(posfirst); + //printf("posfirst: %x\n",posfirst); + + //printf("nepbpm: %d\n",nepbpm); + for (count=0; count> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH))) + // *j2k_state = J2K_STATE_MH; // vuol dire che il prossimo EPB è in MH ma non è il primo + //if (((epb[count].depb >> 6)&1)&&((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_MHSOC))) + // *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + //if (((epb[count].depb >> 6)&1)&&((*j2k_state == J2K_STATE_TPH)||(*j2k_state == J2K_STATE_TPHSOT))) + // *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + //if ((!((epb[count].depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH))) + // *j2k_state = J2K_STATE_TPH; // vuol dire che il prossimo EPB è relativo ad un TPH + + // Ora leggendo pepb il decoder deve capire quale codice applicare per la porzione di dati + // cui fa riferimento la seconda parte del campo EPBdata + + if (epb[count].pepb) // se pepb=0 allora si usano i codici di default precedenti + { + if ((epb[count].pepb>>28)==2) + { + // in questo caso deve effettuare la decodifica RS + /***********/ + // liberiamo gli spazi allocati + 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)); + recd = (int *) malloc((nn1)*sizeof(int)); ///forse alcune di queste malloc possono + data = (int *) malloc((kk1)*sizeof(int)); // essere eliminate, inutili per decodifica!!! + bb = (int *) malloc((nn1-kk1)*sizeof(int)); + generate_gf(nn1,kk1) ; + gen_poly(nn1,kk1) ; + } + + if ((epb[count].pepb>>28)==1) + { + // in questo caso deve effettuare le decodifica CRC + free(buff); + buff = (char *) malloc(epb[count].ldpepb * sizeof(char)); + write_buff(buff,posdata2+epb[count].ldata,epb[count].ldpepb);//***Correggi!!!!!!!!!!! + if (epb[count].pepb & 0x00000001) // vuol dire che bisogna decodificare secondo CRC 32 + { + /*per fare il crc32 occorre invertire i byte in ingresso, invertire il crc calcolato + e farne il complemento a 1*/ + ResetCRC(); + cio_seek(posend+ldpread); // si posiziona nel blocco dati corrispondente + for (i=0; i < epb[count].ldpepb; i++) + UpdateCRC32(reflectByte(buff[i])); + reflectCRC32(); + if (lastepb==1) + { + cio_seek(startsot); + cio_skip(6); + psot = cio_read(4); + next = startsot + psot; // **************Da correggere!!!! + cio_seek(next); + //printf("%x\n",cio_read(2)); + //cio_skip(-2); + } + if ((cio_read(2) == 0xffd9)||(psot == 0)) + *j2k_state = J2K_STATE_MT; + cio_skip(-2); + //else + //{ + // next = cio_tell(); // posizione alla fine dei dati protetti (ldpepb) + //} + crcSum ^= 0xffffffff; // effettua il complemento a 1 + cio_seek(posdata2); + datacrc = cio_read(4); + //if (datacrc == crcSum) + // printf("CRC corretto!\n"); + //else + // printf("CRC errato!\n"); + + } + else // vuol dire che bisogna decodificare secondo CRC 16 + { + ResetCRC(); + cio_seek(posend+ldpread); // si posiziona nel blocco dati corrispondente + for (i=0; i < epb[count].ldpepb; i++) + UpdateCRC16(buff[i]); + if (lastepb==1) + { + cio_seek(startsot); + cio_skip(6); + psot = cio_read(4); + 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"); + } + //free(buff); + } + + if (epb[count].pepb>=0x30000000) + { + next = cio_tell(); + // tecniche registrate in RA + } + + if (epb[count].pepb==0xffffffff) + { + next = cio_tell(); + // non sono usati metodi per i dati seguenti + } + } + + if (((epb[count].pepb>>28)==2)||(epb[count].pepb==0)) // Vuol dire che si usano codici RS + { + // Ora bisogna copiare in buff la seconda parte dei dati di EPB e i dati successivi all'epb + // per una lunghezza pari a ldpepb + + //printf("count: %d\n",count); + //printf("ldpread: %d\n",ldpread); + //system("pause"); + //printf("nn: %d\n",nn); + //printf("kk: %d\n",kk); + //system("pause"); + //printf("posiz: %x\n",posdata2 + epb[count].ldata); + nblock = epb[count].ldata / (nn-kk); // numero di "blocchi di decodifica" + //printf("nblock: %d\n",nblock); + free(buff); + buff = (char *) malloc(nn1 * sizeof(char)); + cio_seek(startsot); + cio_skip(6); + psot = cio_read(4); + //printf("ldata: %d\n",epb[count].ldata); + //printf("nblock: %d\n",nblock); + for (i=0; ipepb)) + + // A questo punto abbiamo corretto anche la parte di dati cui fa riferimento la seconda + // parte del campo EPBdata + + ldpread += epb[count].ldpepb; + cio_seek(pos+2); + cio_skip(epb[count].lepb); + pos = cio_tell(); // posizione a valle dell'EPB corrente + + } // fine for (count=0; count> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH))) + *j2k_state = J2K_STATE_MH; // vuol dire che il prossimo EPB è in MH ma non è il primo + if (((depb >> 6)&1)&&((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_MHSOC))) + *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + if (((depb >> 6)&1)&&((*j2k_state == J2K_STATE_TPH)||(*j2k_state == J2K_STATE_TPHSOT))) + *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + if ((!((depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH))) + *j2k_state = J2K_STATE_TPH; // vuol dire che il prossimo EPB è relativo ad un TPH + + if (!((depb >> 7)&1)) + epbpm = 1; // Gli EPB sono scritti in modalità unpacked (epbpm=0) + else + epbpm = 0; // Gli EPB sono scritti in modalità packed (epbpm=1) + + + nepbrd++; + + // Ora leggendo pepb il decoder deve capire quale codice applicare per la porzione di dati + // cui fa riferimento la seconda parte del campo EPBdata + + if (pepb) // se pepb=0 allora si usano i codici di default precedenti + { + if ((pepb>>28)==2) + { + // in questo caso deve effettuare la decodifica RS + /***********/ + // liberiamo gli spazi allocati + 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)); + recd = (int *) malloc((nn1)*sizeof(int)); ///forse alcune di queste malloc possono + data = (int *) malloc((kk1)*sizeof(int)); // essere eliminate, inutili per decodifica!!! + bb = (int *) malloc((nn1-kk1)*sizeof(int)); + generate_gf(nn1,kk1) ; + gen_poly(nn1,kk1) ; + } + + if ((pepb>>28)==1) + { + // in questo caso deve effettuare le decodifica CRC + free(buff); + buff = (char *) malloc(ldpepb * sizeof(char)); + write_buff(buff,posdata2+ldata,ldpepb); + if (pepb & 0x00000001) // vuol dire che bisogna decodificare secondo CRC 32 + { + /*per fare il crc32 occorre invertire i byte in ingresso, invertire il crc calcolato + e farne il complemento a 1*/ + ResetCRC(); + for (i=0; i < ldpepb; i++) + UpdateCRC32(reflectByte(buff[i])); + reflectCRC32(); + crcSum ^= 0xffffffff; // effettua il complemento a 1 + cio_seek(posdata2); + datacrc = cio_read(4); + if (datacrc == crcSum) + printf("CRC corretto!\n"); + else + printf("CRC errato!\n"); + } + else // vuol dire che bisogna decodificare secondo CRC 16 + { + 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); + return (posdata2 + ldata + ldpepb); // ritorna la posizione a valle dei dati successivi a EPB + //return; + } + + if (pepb>=0x30000000) + { + // tecniche registrate in RA + return (posdata2 + ldata + ldpepb); + // Per adesso prevede la semplice uscita dalla funzione + } + + if (pepb==0xffffffff) + { + // non sono usati metodi per i dati seguenti + return (posdata2 + ldata + ldpepb); + //return; + } + } + + + + /*******************/ + // qui bisogna aggiungere la parte per la gestione della modalità packed/unpacked + /*******************/ + + + //cio_seek(posdata + (nn-kk)); + //posdata2 = cio_tell(); // posizione inizio seconda parte dati EPB + + /********************/ + // Per adesso si suppone che il primo EPB di un header utilizza lo stesso codice + // di default anche per la seconda parte dei dati...in seguito bisognerà aggiungere + // la funzionalità che gestisce l'uso dei vari codici in base al campo pepb + /********************/ + + // Ora bisogna copiare in buff la seconda parte dei dati di EPB e i dati successivi all'epb + // per una lunghezza pari a ldpepb + + nblock = ldata / (nn-kk); // numero di "blocchi di decodifica" + //printf("nblock = %d\n",nblock); + //*system("pause"); + //cio_seek(posdata2); // si posiziona all'inizio della seconda parte dei dati EPB + free(buff); + buff = (char *) malloc(nn1 * sizeof(char)); + for (i=0; i> 6)&1) // quello corrente è l'ultimo EPB del tile corrente + //{ + // lastepb = 1; // l'epb corrente è l'ultimo del tile + //nepbpm = ((depb << 2) >> 2); // numero di EPB accorpati in modalità packed + // nepbpm = (depb & 0x3f); // numero di EPB accorpati in modalità packed + //printf("nepbpm: %d\n",nepbpm); + //} + if (!((depb >> 6)&1)) // quello corrente non è l'ultimo EPB del tile corrente + nepbpm += 1; + if ((depb >> 6)&1) // quello corrente è l'ultimo EPB del tile corrente + { + nepbpm += 1; + lastepb = 1; + } + + cio_skip(-3); // si posiziona all'inizio del campo lepb + cio_skip(cio_read(2)-2); // si posiziona a valle dell'epb corrente + pos = cio_tell(); // memorizza la posizione all'inizio dell'EPB successivo + cio_skip(2); + + //conta++; + + } // Fine while (lastepb == 0)!!!! + // A questo punto il decoder ha decodificato le porzioni iniziali di tutti gli EPB + // del tile corrente + + + // Ora dobbiamo decodificare le porzioni finali di tutti gli EPB!!! + + // pos contiene la posizione a valle dell'ultimo degli EPB packed!!! + cio_skip(-2); + posend = cio_tell(); + lpack = posend-posfirst; // lunghezza totale della catena di EPB + epb = (EPB_par *) malloc(nepbpm * sizeof(EPB_par)); + cio_seek(posfirst); + //printf("nepbpm: %d\n",nepbpm); + for (count=0; count> 6)&1))&&((*j2k_state == J2K_STATE_MHSOC)||(*j2k_state == J2K_STATE_MH))) + *j2k_state = J2K_STATE_MH; // vuol dire che il prossimo EPB è in MH ma non è il primo + if (((epb[count].depb >> 6)&1)&&((*j2k_state == J2K_STATE_MH)||(*j2k_state == J2K_STATE_MHSOC))) + *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + if (((epb[count].depb >> 6)&1)&&((*j2k_state == J2K_STATE_TPH)||(*j2k_state == J2K_STATE_TPHSOT))) + *j2k_state = J2K_STATE_TPHSOT; // vuol dire che il prossimo EPB è il primo di un TPH + if ((!((epb[count].depb >> 6)&1))&&((*j2k_state == J2K_STATE_TPHSOT)||(*j2k_state == J2K_STATE_TPH))) + *j2k_state = J2K_STATE_TPH; // vuol dire che il prossimo EPB è relativo ad un TPH + + // Ora leggendo pepb il decoder deve capire quale codice applicare per la porzione di dati + // cui fa riferimento la seconda parte del campo EPBdata + + if (epb[count].pepb) // se pepb=0 allora si usano i codici di default precedenti + { + if ((epb[count].pepb>>28)==2) + { + // in questo caso deve effettuare la decodifica RS + /***********/ + // liberiamo gli spazi allocati + 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)); + recd = (int *) malloc((nn1)*sizeof(int)); ///forse alcune di queste malloc possono + data = (int *) malloc((kk1)*sizeof(int)); // essere eliminate, inutili per decodifica!!! + bb = (int *) malloc((nn1-kk1)*sizeof(int)); + generate_gf(nn1,kk1) ; + gen_poly(nn1,kk1) ; + } + + if ((epb[count].pepb>>28)==1) + { + // in questo caso deve effettuare le decodifica CRC + free(buff); + buff = (char *) malloc(epb[count].ldpepb * sizeof(char)); + write_buff(buff,posdata2+epb[count].ldata,epb[count].ldpepb); + if (epb[count].pepb & 0x00000001) // vuol dire che bisogna decodificare secondo CRC 32 + { + /*per fare il crc32 occorre invertire i byte in ingresso, invertire il crc calcolato + e farne il complemento a 1*/ + ResetCRC(); + cio_seek(posend+ldpread); // si posiziona nel blocco dati corrispondente + for (i=0; i < epb[count].ldpepb; i++) + UpdateCRC32(reflectByte(buff[i])); + reflectCRC32(); + if (lastepb==1) + { + next = startsot + psot; + cio_seek(next); + //printf("%x\n",cio_read(2)); + //cio_skip(-2); + } + if ((cio_read(2) == 0xffd9)||(psot == 0)) + *j2k_state = J2K_STATE_MT; + cio_skip(-2); + //else + //{ + // next = cio_tell(); // posizione alla fine dei dati protetti (ldpepb) + //} + crcSum ^= 0xffffffff; // effettua il complemento a 1 + cio_seek(posdata2); + datacrc = cio_read(4); + if (datacrc == crcSum) + printf("CRC corretto!\n"); + else + printf("CRC errato!\n"); + + } + else // vuol dire che bisogna decodificare secondo CRC 16 + { + ResetCRC(); + cio_seek(posend+ldpread); // si posiziona nel blocco dati corrispondente + 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"); + } + //free(buff); + } + + if (epb[count].pepb>=0x30000000) + { + //if (lastepb==1) + // next = startsot + psot; + // tecniche registrate in RA + } + + if (epb[count].pepb==0xffffffff) + { + //if (lastepb==1) + // next = startsot + psot; + // non sono usati metodi per i dati seguenti + } + } + + if (((epb[count].pepb>>28)==2)||(epb[count].pepb==0)) // Vuol dire che si usano codici RS + { + // Ora bisogna copiare in buff la seconda parte dei dati di EPB e i dati successivi all'epb + // per una lunghezza pari a ldpepb + + //printf("posiz: %x\n",posdata2 + epb[count].ldata); + nblock = epb[count].ldata / (nn-kk); // numero di "blocchi di decodifica" + free(buff); + buff = (char *) malloc(nn1 * sizeof(char)); + //printf("ldata: %d\n",epb[count].ldata); + //printf("nblock: %d\n",nblock); + for (i=0; ipepb)) + + // A questo punto abbiamo corretto anche la parte di dati cui fa riferimento la seconda + // parte del campo EPBdata + + ldpread += epb[count].ldpepb; + cio_seek(pos+2); + cio_skip(epb[count].lepb); + pos = cio_tell(); // posizione a valle dell'EPB corrente + + } // fine for (count=0; count> 8)) & 0xff); + crcSum = ((crcSum << 8) ^ CrcT16[tmp]) & 0xffff; +} + +void UpdateCRC32(char x) +{ + int tmp; + tmp = ((x ^ (crcSum >> 24)) & 0xff); + crcSum = ((crcSum << 8) ^ CrcT32[tmp]); +} +/* funzioni per l'inversione dei byte e del crc32 */ + +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; +} + +// Codice relativo alla CODIFICA/DECODIFICA RS + + + +//#define nn 255 /* nn=2**mm -1 length of codeword */ +//#define tt 48 /* number of errors that can be corrected */ +//#define kk 159 /* kk = nn-2*tt */ + +//int pp [mm+1] = { 1, 1, 0, 0, 1} ; /* specify irreducible polynomial coeffts */ + + + +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>= 1 ; + for (i=mm+1; i= 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=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 è riuscita a correggere gli errori o se non ci sono errori, 0 se il processo di +// decodifica RS non è 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 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; i0)) q-- ; +/* have found first non-zero d[q] */ + if (q>0) + { j=q ; + do + { j-- ; + if ((d[j]!=-1) && (u_lu[q]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 >tt errors and cannot solve */ + { for (i=0; itt hence cannot solve */ + { for (i=0; i no errors: output received codeword */ + { for (i=0; i