summaryrefslogtreecommitdiffstats
path: root/src/mot-encoder.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/mot-encoder.c')
-rw-r--r--src/mot-encoder.c815
1 files changed, 0 insertions, 815 deletions
diff --git a/src/mot-encoder.c b/src/mot-encoder.c
deleted file mode 100644
index 6f83eab..0000000
--- a/src/mot-encoder.c
+++ /dev/null
@@ -1,815 +0,0 @@
-/*
- Copyright (C) 2014 CSP Innovazione nelle ICT s.c.a r.l. (http://rd.csp.it/)
-
- This program is free software: you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation, either version 3 of the License, or
- (at your option) any later version.
-
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
-
- You should have received a copy of the GNU General Public License
- along with this program. If not, see <http://www.gnu.org/licenses/>.
-
- MotEncoder.c
- Generete PAD data for MOT Slideshow and DLS
-
- Authors:
- Sergio Sagliocco <sergio.sagliocco@csp.it>
-*/
-
-#include <stdio.h>
-#include <stdlib.h>
-#include <unistd.h>
-#include <string.h>
-#include <sys/types.h>
-#include <sys/stat.h>
-#include <fcntl.h>
-#include <dirent.h>
-#include <wand/magick_wand.h>
-#include <getopt.h>
-
-#include "lib_crc.h"
-
-#define MIN(a,b) (((a)<(b))?(a):(b))
-#define MAX(a,b) (((a)>(b))?(a):(b))
-
-#define MAXSEGLEN 8179
-#define MAXDLS 129
-
-typedef unsigned char UCHAR;
-typedef unsigned short int USHORT;
-
-typedef struct {
- // MSC Data Group Header (extension field not supported)
- unsigned char extflag; // 1 bit
- unsigned char crcflag; // 1 bit
- unsigned char segflag; // 1 bit
- unsigned char accflag; // 1 bit
- unsigned char dgtype; // 4 bits
- unsigned char cindex; // 4 bits
- unsigned char rindex; // 4 bits
- /// Session header - Segment field
- unsigned char last; // 1 bit
- unsigned short int segnum; // 16 bits
- // Session header - User access field
- unsigned char rfa; // 3 bits
- unsigned char tidflag; // 1 bit
- unsigned char lenid; // 4 bits - Fixed to value 2 in this implemntation
- unsigned short int tid; // 16 bits
- // MSC data group data field
- // Mot Segmentation header
- unsigned char rcount; // 3 bits
- unsigned short int seglen; // 13 bits
- // Mot segment
- unsigned char* segdata;
- // MSC data group CRC
- unsigned short int crc; // 16 bits
-} MSCDG;
-/*
- typedef struct {
-// MOT HEADER CUSTOMIZED FOR SLIDESHOW APP
-unsigned int bodysize; // 28 bits
-unsigned short int headsize; // 13 bits
-unsigned char ctype; // 6 bits
-unsigned char sctype; // 9 bits
-unsigned char triggertime[5]; // 0x85 0x00 0x00 0x00 0x00 => NOW
-unsigned char contname[14]; // 0xCC 0x0C 0x00 imgXXXX.jpg
-} MOTSLIDEHDR;
-*/
-int encodeFile(int output_fd, char* fname, int fidx, int padlen);
-void createMotHeader(size_t blobsize, int fidx, unsigned char* mothdr, int* mothdrlen);
-void createMscDG(MSCDG* msc, unsigned short int dgtype, unsigned short int cindex,
- unsigned short int lastseg, unsigned short int tid, unsigned char* data,
- unsigned short int datalen);
-
-void packMscDG(unsigned char* mscblob, MSCDG* msc, unsigned short int *bsize);
-void writeMotPAD(int output_fd,
- unsigned char* mscdg,
- unsigned short int mscdgsize,
- unsigned short int padlen);
-
-void create_dls_datagroup (char* text, int padlen, unsigned char*** p_dlsdg, int* p_numdg);
-void writeDLS(int output_fd, const char* dls_file, int padlen);
-
-int get_xpadlengthmask(int padlen);
-#define ALLOWED_PADLEN "23, 26, 34, 42, 58"
-
-
-void usage(char* name)
-{
- fprintf(stderr, "DAB MOT encoder %s for slideshow and DLS\n\n"
- "By CSP Innovazione nelle ICT s.c.a r.l. (http://rd.csp.it/)\n\n"
- "Reads image data from the specified directory, and outputs PAD data\n"
- "on standard output\n"
- "Reads DLS from /tmp/dls.file\n\n"
- "WARNING: This program has memory leaks! Do not attempt\n"
- "to leave it running for long periods of time!\n\n"
- " http://opendigitalradio.org\n\n",
-#if defined(GITVERSION)
- GITVERSION
-#else
- PACKAGE_VERSION
-#endif
- );
- fprintf(stderr, "Usage: %s [OPTIONS...]\n", name);
- fprintf(stderr, " -d, --dir=DIRNAME Directory to read images from.\n"
- " Mandatory.\n"
- " -o, --output=FILENAME Fifo to write PAD data into.\n"
- " Default: /tmp/pad.fifo\n"
- " -t, --dls=FILENAME Fifo or file to read DLS text from.\n"
- " Default: /tmp/dls.txt\n"
- " -p, --pad=LENGTH Set the pad length.\n"
- " Possible values: " ALLOWED_PADLEN "\n"
- " Default: 58\n"
- );
-}
-
-#define no_argument 0
-#define required_argument 1
-#define optional_argument 2
-int main(int argc, char *argv[])
-{
- int len, fidx, ret;
- struct dirent *pDirent;
- DIR *pDir;
- char imagepath[128];
- char dlstext[MAXDLS], dlstextprev[MAXDLS];
- int padlen=58;
-
- char* dir = NULL;
- char* output = "/tmp/pad.fifo";
- char* dls_file = "/tmp/dls.txt";
-
- const struct option longopts[] = {
- {"dir", required_argument, 0, 'd'},
- {"output", required_argument, 0, 'o'},
- {"dls", required_argument, 0, 't'},
- {"pad", required_argument, 0, 'p'},
- {"help", no_argument, 0, 'h'},
- {0,0,0,0},
- };
-
- if (argc < 2) {
- fprintf(stderr, "Error: too few arguments!\n");
- usage(argv[0]);
- return 2;
- }
-
- int ch=0;
- int index;
- while(ch != -1) {
- ch = getopt_long(argc, argv, "hd:o:t:p:", longopts, &index);
- switch (ch) {
- case 'd':
- dir = optarg;
- break;
- case 'o':
- output = optarg;
- break;
- case 't':
- dls_file = optarg;
- break;
- case 'p':
- padlen = atoi(optarg);
- break;
- case '?':
- case 'h':
- usage(argv[0]);
- return 0;
- }
- }
-
- if (get_xpadlengthmask(padlen) == -1) {
- fprintf(stderr, "Error: pad length %d invalid: Possible values: "
- ALLOWED_PADLEN "\n",
- padlen);
- return 2;
- }
-
- if (!dir) {
- fprintf(stderr, "Error: image directory not defined!\n");
- usage(argv[0]);
- return 2;
- }
-
- int output_fd = open(output, O_WRONLY);
- if (output_fd == -1) {
- perror("Failed to open output");
- return 3;
- }
-
- MagickWandGenesis();
-
- fidx = 0;
- while(1) {
- pDir = opendir(dir);
- if (pDir == NULL) {
- printf ("Cannot open directory '%s'\n", dir);
- return 1;
- }
- if (fidx == 9999) {
- fidx = 0;
- }
-
- while ((pDirent = readdir(pDir)) != NULL) {
- if (pDirent->d_name[0] != '.') {
- sprintf(imagepath, "%s/%s", dir, pDirent->d_name);
- ret = encodeFile(output_fd, imagepath, fidx, padlen);
- if (ret != 1) {
- fprintf(stderr, "Error - Cannot encode file %s\n", pDirent->d_name);
- }
- else {
- fidx++;
- writeDLS(output_fd, dls_file, padlen);
- sleep(10);
- }
- }
- }
- closedir(pDir);
- }
- return 1;
-}
-
-int encodeFile(int output_fd, char* fname, int fidx, int padlen)
-{
- int fd=0, ret, mothdrlen, nseg, lastseglen, i, last, curseglen;
- unsigned char mothdr[32];
- MagickWand *m_wand = NULL;
- PixelWand *p_wand = NULL;
- size_t blobsize, height, width;
- unsigned char *blob = NULL, *curseg = NULL;
- MagickBooleanType err;
- MSCDG msc;
- unsigned char mscblob[8200];
- unsigned short int mscblobsize;
- //float aspectRatio;
-
- m_wand = NewMagickWand();
- p_wand = NewPixelWand();
- PixelSetColor(p_wand, "black");
-
- err = MagickReadImage(m_wand, fname);
- if (err == MagickFalse) {
- fprintf(stderr, "Error - Unable to load image %s\n", fname);
- ret = 0;
- goto RETURN;
- }
-
- height = MagickGetImageHeight(m_wand);
- width = MagickGetImageWidth(m_wand);
- //aspectRatio = (width * 1.0)/height;
-
- fprintf(stderr, "Image: %s (id=%d). Original size: %zu x %zu. ",
- fname, fidx, width, height);
-
- while (height > 240 || width > 320) {
- if (height/240.0 > width/320.0) {
- //width = height * aspectRatio;
- width = width * 240.0 / height;
- height = 240;
- }
- else {
- //height = width * (1.0/aspectRatio);
- height = height * 320.0 / width;
- width = 320;
- }
- MagickResizeImage(m_wand, width, height, LanczosFilter, 1);
- }
-
-
-
- height = MagickGetImageHeight(m_wand);
- width = MagickGetImageWidth(m_wand);
-
- MagickBorderImage(m_wand, p_wand, (320-width)/2, (240-height)/2);
-
- MagickSetImageCompressionQuality(m_wand, 75);
- MagickSetImageFormat(m_wand, "jpg");
- blob = MagickGetImagesBlob(m_wand, &blobsize);
- fprintf(stderr, "Resized to %zu x %zu. Size after compression %zu bytes\n",
- width, height, blobsize);
-
- nseg = blobsize / MAXSEGLEN;
- lastseglen = blobsize % MAXSEGLEN;
- if (lastseglen != 0) {
- nseg++;
- }
-
- createMotHeader(blobsize, fidx, mothdr, &mothdrlen);
- // Create the MSC Data Group C-Structure
- createMscDG(&msc, 3, 0, 1, fidx, mothdr, mothdrlen);
- // Generate the MSC DG frame (Figure 9 en 300 401)
- packMscDG(mscblob, &msc, &mscblobsize);
- writeMotPAD(output_fd, mscblob, mscblobsize, padlen);
-
- for (i = 0; i < nseg; i++) {
- curseg = blob + i * MAXSEGLEN;
- if (i == nseg-1) {
- curseglen = lastseglen;
- last = 1;
- }
- else {
- curseglen = MAXSEGLEN;
- last = 0;
- }
-
- createMscDG(&msc, 4, i, last, fidx, curseg, curseglen);
- packMscDG(mscblob, &msc, &mscblobsize);
- writeMotPAD(output_fd, mscblob, mscblobsize, padlen);
- }
-
- ret = 1;
-
-RETURN:
- if (m_wand) {
- m_wand = DestroyMagickWand(m_wand);
- }
- if (blob) {
- free(blob);
- }
- return ret;
-}
-
-
-void createMotHeader(size_t blobsize, int fidx, unsigned char* mothdr, int* mothdrlen)
-{
- int ret;
- struct stat s;
- char MotHeaderCore[7] = {0x00,0x00,0x00,0x00,0x0D,0x04,0x01};
- char MotHeaderExt[19] = {0x85,0x00,0x00,0x00,0x00,0xcc,0x0c,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
- char cntemp[12];
- int i;
-
- MotHeaderCore[0] = (blobsize<<4 & 0xFF000000) >> 24;
- MotHeaderCore[1] = (blobsize<<4 & 0x00FF0000) >> 16;
- MotHeaderCore[2] = (blobsize<<4 & 0x0000FF00) >> 8;
- MotHeaderCore[3] = (blobsize<<4 & 0x000000FF);
-
- sprintf(cntemp, "img%04d.jpg", fidx);
- for (i = 0; i < sizeof(cntemp); i++) {
- MotHeaderExt[8+i] = cntemp[i];
- }
- *mothdrlen = 26;
- for (i = 0; i < 7; i++)
- mothdr[i] = MotHeaderCore[i];
- for (i = 0; i < 19; i++)
- mothdr[7+i] = MotHeaderExt[i];
-
- return;
-}
-
-void createMscDG(MSCDG* msc, unsigned short int dgtype,
- unsigned short int cindex, unsigned short int lastseg,
- unsigned short int tid, unsigned char* data,
- unsigned short int datalen)
-{
- msc->extflag = 0;
- msc->crcflag = 1;
- msc->segflag = 1;
- msc->accflag = 1;
- msc->dgtype = dgtype;
- msc->cindex = cindex;
- msc->rindex = 0;
- msc->last = lastseg;
- msc->segnum = cindex;
- msc->rfa = 0;
- msc->tidflag = 1;
- msc->lenid = 2;
- msc->tid = tid;
- msc->segdata = data;
- msc->rcount = 0;
- msc->seglen = datalen;
-}
-
-
-void packMscDG(unsigned char* b, MSCDG* msc, unsigned short int* bsize)
-{
- int i;
- unsigned short int crc=0xFFFF;
-
- b[0] = (msc->extflag<<7) | (msc->crcflag<<6) | (msc->segflag<<5) |
- (msc->accflag<<4) | msc->dgtype;
-
- b[1] = (msc->cindex<<4) | msc->rindex;
- b[2] = (msc->last<<7) | ((msc->segnum & 0x7F00) >> 8);
- b[3] = msc->segnum & 0x00FF;
- b[4] = 0;
- b[4] = (msc->rfa << 5) | (msc->tidflag << 4) | msc->lenid;
- b[5] = (msc->tid & 0xFF00) >> 8;
- b[6] = msc->tid & 0x00FF;
- b[7] = (msc->rcount << 5) | ((msc->seglen & 0x1F00)>>8);
- b[8] = msc->seglen & 0x00FF;
-
- for (i = 0; i<9; i++) {
- crc = update_crc_ccitt(crc, b[i]);
- }
-
- for(i = 0; i < msc->seglen; i++) {
- b[i+9] = (msc->segdata)[i];
- crc = update_crc_ccitt(crc, b[i+9]);
- }
-
- crc = ~crc;
- b[9+msc->seglen] = (crc & 0xFF00) >> 8; // HI CRC
- b[9+msc->seglen+1] = crc & 0x00FF; // LO CRC
-
- *bsize = 9 + msc->seglen + 1 + 1;
-
- //write(1,b,9+msc->seglen+1+1);
-
-}
-
-
-void writeMotPAD(int output_fd,
- unsigned char* mscdg,
- unsigned short int mscdgsize,
- unsigned short int padlen)
-{
-
- unsigned char pad[128];
- int xpadlengthmask, i, j,k, numseg, lastseglen;
- unsigned short int crc;
-
-
- xpadlengthmask = get_xpadlengthmask(padlen);
-
- // Write MSC Data Groups
- int curseglen, non_ci_seglen;
- for (i = 0; i < mscdgsize; i += curseglen) {
- UCHAR* curseg;
- UCHAR firstseg;
-
- curseg = &mscdg[i];
- //fprintf(stderr,"Segment offset %d\n",i);
-
- if (i == 0) { // First segment
- firstseg = 1;
- curseglen = padlen-10;
-
- non_ci_seglen = curseglen + 4 + 1 + 2; // size of first X-PAD = MSC-DG + DGLI-DG + End of CI list + 2x CI = size of subsequent non-CI X-PADs
- }
- else {
- firstseg = 0;
- curseglen = MIN(non_ci_seglen,mscdgsize-i);
- }
-
- if (firstseg == 1) {
- // FF-PAD Byte L (CI=1)
- pad[padlen-1] = 0x02;
-
- // FF-PAD Byte L-1 (Variable size X_PAD)
- pad[padlen-2] = 0x20;
-
- // Write Data Group Length Indicator
- crc = 0xffff;
- // CI for data group length indicator: data length=4, Application Type=1
- pad[padlen-3]=0x01;
- // CI for data group length indicator: Application Type=12 (Start of MOT)
- pad[padlen-4]=(xpadlengthmask<<5) | 12;
- // End of CI list
- pad[padlen-5]=0x00;
- // RFA+HI Data group length
- pad[padlen-6]=(mscdgsize & 0x3F00)>>8;
- pad[padlen-7]=(mscdgsize & 0x00FF);
- crc = update_crc_ccitt(crc, pad[padlen-6]);
- crc = update_crc_ccitt(crc, pad[padlen-7]);
- crc = ~crc;
- // HI CRC
- pad[padlen-8]=(crc & 0xFF00) >> 8;
- // LO CRC
- pad[padlen-9]=(crc & 0x00FF);
- k=10;
- }
- else {
- // FF-PAD Byte L (CI=0)
- pad[padlen-1] = 0x00;
-
- // FF-PAD Byte L-1 (Variable size X_PAD)
- pad[padlen-2] = 0x20;
- k=3;
- }
-
- for (j = 0; j < curseglen; j++) {
- pad[padlen-k-j] = curseg[j];
- }
- for (j = padlen-k-curseglen; j >= 0; j--) {
- pad[j] = 0x00;
- }
-
- write(output_fd, pad, padlen);
- //fprintf(stderr,"MSC Data Group - Segment %d: ",i);
- //for (j=0;j<padlen;j++) fprintf(stderr,"%02x ",pad[j]);
- // fprintf(stderr,"\n");
-
- }
-}
-
-
-void writeDLS(int output_fd, const char* dls_file, int padlen) {
- char dlstext[MAXDLS];
- static char dlstextprev[MAXDLS];
- int dlslen;
- int i;
- static unsigned char** dlsdg;
- static int numdg = 0;
-
- static int dlsfd = 0;
-
- if (dlsfd!=0) {
- close(dlsfd);
- }
-
- dlsfd = open(dls_file, O_RDONLY);
- if (dlsfd == -1) {
- fprintf(stderr,"Error - Cannot open dls file\n");
- return;
- }
-
- dlslen = read(dlsfd, dlstext, MAXDLS);
- dlstext[dlslen] = 0x00;
- //if (strcmp(dlstext,dlstextprev)!=0) {
- create_dls_datagroup(dlstext, padlen, &dlsdg, &numdg);
- strcpy(dlstextprev, dlstext);
- //}
- for (i = 0; i < numdg; i++) {
- write(output_fd, dlsdg[i], padlen);
- }
-
-}
-
-void create_dls_datagroup (char* text, int padlen, UCHAR*** p_dlsdg, int* p_numdg) {
-
- UCHAR dlsseg[8][16]; // max 8 segments, each max 16 chars
- UCHAR** dlsdg; // Array of datagroups composing dls text;
-
-
- int numseg; // Number of DSL segments
- int lastseglen; // Length of the last segment
- int numdg; // Number of data group
- int xpadlengthmask;
- int i, j, k, z, idx_start_crc, idx_stop_crc;
- USHORT dlscrc;
- static UCHAR toggle = 0;
-
- if (toggle == 0)
- toggle = 1;
- else
- toggle = 0;
-
- numseg = strlen(text) / 16;
- lastseglen = strlen(text) % 16;
- if (padlen-9 >= 16) {
- if (lastseglen > 0) {
- numseg++; // The last incomplete segment
- }
-
- // The PAD can contain the full segmnet and overhead (9 bytes)
- numdg = numseg;
-
- }
- else {
- // Each 16 char segment span over 2 dg
- numdg = numseg * 2;
-
- if (lastseglen > 0) {
- numseg++; // The last incomplete segment
-
- if (lastseglen <= padlen-9) {
- numdg += 1;
- }
- else {
- numdg += 2;
- }
- }
- }
-
- *p_numdg = numdg;
- fprintf(stderr, "PAD Length: %d\n", padlen);
- fprintf(stderr, "DLS text: %s\n", text);
- fprintf(stderr, "Number of DLS segments: %d\n", numseg);
- fprintf(stderr, "Number of DLS data groups: %d\n", numdg);
-
- xpadlengthmask = get_xpadlengthmask(padlen);
-
- *p_dlsdg = (UCHAR**) malloc(numdg * sizeof(UCHAR*));
- dlsdg = *p_dlsdg;
-
- i = 0;
- for (z=0; z < numseg; z++) {
- char* curseg;
- int curseglen;
- UCHAR firstseg, lastseg;
-
- curseg = &text[z * 16];
- fprintf(stderr, "Segment number %d\n", z+1);
-
- if (z == 0) { // First segment
- firstseg = 1;
- }
- else {
- firstseg = 0;
- }
-
- if (z == numseg-1) { //Last segment
- if (lastseglen != 0) {
- curseglen = lastseglen;
- }
- else {
- curseglen = 16;
- }
- lastseg = 1;
- }
- else {
- curseglen = 16;
- lastseg = 0;
- }
-
- if (curseglen <= padlen-9) { // Segment is composed of 1 data group
- dlsdg[i] = (UCHAR*) malloc(padlen * sizeof(UCHAR));
-
- // FF-PAD Byte L (CI=1)
- dlsdg[i][padlen-1]=0x02;
-
- // FF-PAD Byte L-1 (Variable size X_PAD)
- dlsdg[i][padlen-2]=0x20;
-
- // CI => data length = 12 (011) - Application Type=2
- // (DLS - start of X-PAD data group)
- dlsdg[i][padlen-3]=(xpadlengthmask<<5) | 0x02;
-
- // End of CI list
- dlsdg[i][padlen-4]=0x00;
-
- // DLS Prefix (T=1,Only one segment,segment length-1)
- dlsdg[i][padlen-5]=((toggle*8+firstseg*4+lastseg*2+0)<<4) | (curseglen-1);
-
- if (firstseg==1) {
- // DLS Prefix (Charset standard)
- dlsdg[i][padlen-6]=0x00;
- }
- else {
- // DLS SegNum
- dlsdg[i][padlen-6]=z<<4;
- }
-
- // CRC start from prefix
- idx_start_crc = padlen-5;
-
- // DLS text
- for (j = 0; j < curseglen; j++) {
- dlsdg[i][padlen-7-j] = curseg[j];
- }
-
- idx_stop_crc = padlen - 7 - curseglen+1;
-
- dlscrc = 0xffff;
- for (j = idx_start_crc; j >= idx_stop_crc; j--) {
- dlscrc = update_crc_ccitt(dlscrc, dlsdg[i][j]);
- }
-
- dlscrc = ~dlscrc;
- fprintf(stderr, "crc=%x ~crc=%x\n", ~dlscrc, dlscrc);
-
- dlsdg[i][padlen-7-curseglen] = (dlscrc & 0xFF00) >> 8; // HI CRC
- dlsdg[i][padlen-7-curseglen-1] = dlscrc & 0x00FF; // LO CRC
-
- // NULL PADDING
- for (j = padlen-7-curseglen-2; j >= 0; j--) {
- dlsdg[i][j]=0x00;
- }
-
- fprintf(stderr, "Data group: ");
- for (j = 0; j < padlen; j++)
- fprintf(stderr, "%x ", dlsdg[i][j]);
- fprintf(stderr, "\n");
- i++;
-
- }
- else { // Segment is composed of 2 data groups
-
- // FIRST DG (NO CRC)
- dlscrc = 0xffff;
-
- dlsdg[i] = (UCHAR*) malloc(padlen * sizeof(UCHAR));
-
- // FF-PAD Byte L (CI=1)
- dlsdg[i][padlen-1]=0x02;
-
- // FF-PAD Byte L-1 (Variable size X_PAD)
- dlsdg[i][padlen-2]=0x20;
-
- // CI => data length = 12 (011) - Application Type=2
- // (DLS - start of X-PAD data group)
- dlsdg[i][padlen-3]=(xpadlengthmask<<5) | 0x02;
-
- // End of CI list
- dlsdg[i][padlen-4]=0x00;
-
- // DLS Prefix (T=1,Only one segment,segment length-1)
- dlsdg[i][padlen-5]=((toggle*8+firstseg*4+lastseg*2+0)<<4) | (curseglen-1);
-
-
- if (firstseg == 1) {
- // DLS Prefix (Charset standard)
- dlsdg[i][padlen-6] = 0x00;
- }
- else {
- // DLS SegNum
- dlsdg[i][padlen-6]=(i-1)<<4;
- }
-
- dlscrc = update_crc_ccitt(dlscrc, dlsdg[i][padlen-5]);
- dlscrc = update_crc_ccitt(dlscrc, dlsdg[i][padlen-6]);
-
- // DLS text
- for (j=0; j < MIN(curseglen, padlen-7); j++) {
- dlsdg[i][padlen-7-j] = curseg[j];
- dlscrc = update_crc_ccitt(dlscrc, dlsdg[i][padlen-7-j]);
- }
- k = j;
-
- // end of segment
- if (curseglen == padlen-8) {
- dlscrc = ~dlscrc;
- dlsdg[i][1] = (dlscrc & 0xFF00) >> 8; // HI CRC
- fprintf(stderr, "crc=%x ~crc=%x\n", ~dlscrc, dlscrc);
- }
- else if (curseglen == padlen-7) {
- dlscrc = ~dlscrc;
- fprintf(stderr, "crc=%x ~crc=%x\n", ~dlscrc, dlscrc);
- }
- dlsdg[i][0]=0x00;
-
- fprintf(stderr, "First Data group: ");
- for (j = 0; j < padlen; j++)
- fprintf(stderr, "%x ", dlsdg[i][j]);
- fprintf(stderr,"\n");
-
- // SECOND DG (NO CI, NO PREFIX)
- i++;
-
- dlsdg[i] = (UCHAR*) malloc(padlen*sizeof(UCHAR));
-
- // FF-PAD Byte L (CI=0)
- dlsdg[i][padlen-1] = 0x00;
-
- // FF-PAD Byte L-1 (Variable size X_PAD)
- dlsdg[i][padlen-2] = 0x20;
-
- if (curseglen == padlen-8) {
- dlsdg[i][padlen-3] = dlscrc & 0x00FF; // LO CRC
- }
- else if (curseglen==padlen-7) {
- dlsdg[i][padlen-3] = (dlscrc & 0xFF00) >> 8; // HI CRC
- dlsdg[i][padlen-4] = dlscrc & 0x00FF; // LO CRC
- }
- else {
- // DLS text
- for (j = 0; j < curseglen-k; j++) {
- dlsdg[i][padlen-3-j] = curseg[k+j];
- dlscrc = update_crc_ccitt(dlscrc, dlsdg[i][padlen-3-j]);
- }
- dlscrc = ~dlscrc;
- dlsdg[i][padlen-3-curseglen+k] = (dlscrc & 0xFF00) >> 8; // HI CRC
- dlsdg[i][padlen-3-curseglen+k-1] = dlscrc & 0x00FF; // LO CRC
- }
-
- fprintf(stderr, "Second Data group: ");
- for (j = 0; j < padlen; j++)
- fprintf(stderr, "%x ", dlsdg[i][j]);
-
- fprintf(stderr, "\n");
- fprintf(stderr, "**** crc=%x ~crc=%x\n", ~dlscrc, dlscrc);
- i++;
- }
- }
-}
-
-int get_xpadlengthmask(int padlen)
-{
- int xpadlengthmask;
-
- /* Don't forget to change ALLOWED_PADLEN
- * if you change this check
- */
- if (padlen == 23)
- xpadlengthmask = 3;
- else if (padlen == 26)
- xpadlengthmask = 4;
- else if (padlen == 34)
- xpadlengthmask = 5;
- else if (padlen == 42)
- xpadlengthmask = 6;
- else if (padlen == 58)
- xpadlengthmask = 7;
- else
- xpadlengthmask = -1; // Error
-
- return xpadlengthmask;
-}
-