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.c781
1 files changed, 479 insertions, 302 deletions
diff --git a/src/mot-encoder.c b/src/mot-encoder.c
index a60a39a..de4987e 100644
--- a/src/mot-encoder.c
+++ b/src/mot-encoder.c
@@ -30,6 +30,7 @@
#include <fcntl.h>
#include <dirent.h>
#include <wand/magick_wand.h>
+#include <getopt.h>
#include "lib_crc.h"
@@ -53,7 +54,7 @@ typedef struct {
unsigned char rindex; // 4 bits
/// Session header - Segment field
unsigned char last; // 1 bit
- unsigned short int segnum; // 16 bits
+ unsigned short int segnum; // 16 bits
// Session header - User access field
unsigned char rfa; // 3 bits
unsigned char tidflag; // 1 bit
@@ -62,7 +63,7 @@ typedef struct {
// MSC data group data field
// Mot Segmentation header
unsigned char rcount; // 3 bits
- unsigned short int seglen; // 13 bits
+ unsigned short int seglen; // 13 bits
// Mot segment
unsigned char* segdata;
// MSC data group CRC
@@ -79,75 +80,140 @@ unsigned char triggertime[5]; // 0x85 0x00 0x00 0x00 0x00 => NOW
unsigned char contname[14]; // 0xCC 0x0C 0x00 imgXXXX.jpg
} MOTSLIDEHDR;
*/
-int encodeFile (char* fname, int fidx, int padlen);
-void createMotHeader(size_t blobsize, int fidx, 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);
+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(unsigned char* mscdg, unsigned short int mscdgsize, unsigned short int padlen);
+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 padlen);
+void writeDLS(int output_fd, int padlen);
void usage(char* name)
{
- fprintf(stderr, "DAB MOT encoder\n"
- "for slideshow and DLS\n\n"
+ fprintf(stderr, "DAB MOT encoder 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");
- fprintf(stderr, "Usage: %s <dirname>\n", name);
+ "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"
+ );
+ 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"
+ );
}
-int main (int argc, char *argv[])
+#define no_argument 0
+#define required_argument 1
+#define optional_argument 2
+int main(int argc, char *argv[])
{
- int len,fidx,ret;
+ int len, fidx, ret;
struct dirent *pDirent;
DIR *pDir;
char imagepath[128];
- char dlstext[MAXDLS],dlstextprev[MAXDLS];
+ char dlstext[MAXDLS], dlstextprev[MAXDLS];
int padlen=53;
+ 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'},
+ {"help", no_argument, 0, 'h'},
+ {0,0,0,0},
+ };
if (argc < 2) {
+ fprintf(stderr, "Error: too few arguments!\n");
usage(argv[0]);
- return 0;
+ return 2;
}
+ int ch=0;
+ int index;
+ while(ch != -1) {
+ ch = getopt_long(argc, argv, "hd:o:t:", longopts, &index);
+ switch (ch) {
+ case 'd':
+ dir = optarg;
+ break;
+ case 'o':
+ output = optarg;
+ break;
+ case 't':
+ dls_file = optarg;
+ break;
+ case '?':
+ case 'h':
+ usage(argv[0]);
+ return 0;
+ }
+ }
+
+ if (!dir) {
+ fprintf(stderr, "Error: image directory not defined!\n");
+ usage(argv[0]);
+ return 3;
+ }
+
+ int output_fd = open(output, O_WRONLY);
+
MagickWandGenesis();
- fidx=0;
+ fidx = 0;
while(1) {
- pDir = opendir (argv[1]);
+ pDir = opendir(dir);
if (pDir == NULL) {
- printf ("Cannot open directory '%s'\n", argv[1]);
+ printf ("Cannot open directory '%s'\n", dir);
return 1;
}
- if (fidx == 9999) fidx=0;
+ if (fidx == 9999) {
+ fidx = 0;
+ }
+
while ((pDirent = readdir(pDir)) != NULL) {
- if (pDirent->d_name[0]!='.') {
- sprintf (imagepath,"%s/%s",argv[1],pDirent->d_name);
- ret=encodeFile(imagepath, fidx, padlen);
- if (ret!=1) {
- fprintf(stderr,"Error - Cannot encode file %s\n",pDirent->d_name);
- } else {
+ 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(padlen);
+ writeDLS(output_fd, padlen);
sleep(10);
}
}
}
- closedir (pDir);
+ closedir(pDir);
}
return 1;
}
-int encodeFile (char* fname, int fidx, int padlen)
+int encodeFile(int output_fd, char* fname, int fidx, int padlen)
{
- int fd=0,ret,mothdrlen,nseg,lastseglen,i,last,curseglen;
+ 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;
+ size_t blobsize, height, width;
unsigned char *blob = NULL, *curseg = NULL;
MagickBooleanType err;
MSCDG msc;
@@ -155,25 +221,25 @@ int encodeFile (char* fname, int fidx, int padlen)
unsigned short int mscblobsize;
//float aspectRatio;
-
m_wand = NewMagickWand();
p_wand = NewPixelWand();
- PixelSetColor(p_wand,"black");
+ PixelSetColor(p_wand, "black");
- err = MagickReadImage(m_wand,fname);
- if (err==MagickFalse) {
- fprintf(stderr,"Error - Unable to load image %s\n",fname);
- ret=0;
+ 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);
+ height = MagickGetImageHeight(m_wand);
+ width = MagickGetImageWidth(m_wand);
//aspectRatio = (width * 1.0)/height;
- fprintf(stderr,"Image: %s (id=%d). Original size: %d x %d. ",fname,fidx,width,height);
+ fprintf(stderr, "Image: %s (id=%d). Original size: %zu x %zu. ",
+ fname, fidx, width, height);
- while (height>240 || width>320) {
+ while (height > 240 || width > 320) {
if (height/240.0 > width/320.0) {
//width = height * aspectRatio;
width = width * 240.0 / height;
@@ -184,49 +250,52 @@ int encodeFile (char* fname, int fidx, int padlen)
height = height * 320.0 / width;
width = 320;
}
- MagickResizeImage(m_wand,width,height,LanczosFilter,1);
+ MagickResizeImage(m_wand, width, height, LanczosFilter, 1);
}
- height=MagickGetImageHeight(m_wand);
- width=MagickGetImageWidth(m_wand);
+ height = MagickGetImageHeight(m_wand);
+ width = MagickGetImageWidth(m_wand);
- MagickBorderImage(m_wand,p_wand,(320-width)/2,(240-height)/2);
+ 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 %d x %d. Size after compression %d bytes\n",width,height,blobsize);
+ 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++;
+ nseg = blobsize / MAXSEGLEN;
+ lastseglen = blobsize % MAXSEGLEN;
+ if (lastseglen != 0) {
+ nseg++;
+ }
- createMotHeader(blobsize,fidx,mothdr,&mothdrlen);
+ createMotHeader(blobsize, fidx, mothdr, &mothdrlen);
// Create the MSC Data Group C-Structure
- createMscDG(&msc,3,0,1,fidx,mothdr,mothdrlen);
+ createMscDG(&msc, 3, 0, 1, fidx, mothdr, mothdrlen);
// Generate the MSC DG frame (Figure 9 en 300 401)
- packMscDG(mscblob,&msc,&mscblobsize);
- writeMotPAD(mscblob,mscblobsize,padlen);
-
- for (i=0;i<nseg;i++) {
- curseg=blob+i*MAXSEGLEN;
- if (i==nseg-1) {
- curseglen=lastseglen;
- last=1;
+ 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;
+ else {
+ curseglen = MAXSEGLEN;
+ last = 0;
}
- createMscDG(&msc,4,i,last,fidx,curseg,curseglen);
- packMscDG(mscblob,&msc,&mscblobsize);
- writeMotPAD(mscblob,mscblobsize,padlen);
+ createMscDG(&msc, 4, i, last, fidx, curseg, curseglen);
+ packMscDG(mscblob, &msc, &mscblobsize);
+ writeMotPAD(output_fd, mscblob, mscblobsize, padlen);
}
- ret=1;
+ ret = 1;
RETURN:
if (m_wand) {
@@ -239,176 +308,214 @@ RETURN:
}
-void createMotHeader(size_t blobsize, int fidx, char* mothdr,int* mothdrlen)
+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 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);
+ 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];
+ 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];
+ *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)
+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;
-
- return;
+ 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) {
-
+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++)
+ 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];
+ 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
+ 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;
+ *bsize = 9 + msc->seglen + 1 + 1;
//write(1,b,9+msc->seglen+1+1);
}
-void writeMotPAD(unsigned char* mscdg, unsigned short int mscdgsize, unsigned short int padlen) {
+void writeMotPAD(int output_fd,
+ unsigned char* mscdg,
+ unsigned short int mscdgsize,
+ unsigned short int padlen)
+{
unsigned char pad[128];
- int xpadlengthmask,i,j,numseg,lastseglen;
+ int xpadlengthmask, i, j, numseg, lastseglen;
unsigned short int crc;
- if (padlen==17)
- xpadlengthmask=3;
- else if (padlen==21)
- xpadlengthmask=4;
- else if (padlen==29)
- xpadlengthmask=5;
- else if (padlen==37)
- xpadlengthmask=6;
- else if (padlen==53)
- xpadlengthmask=7;
+ if (padlen == 17)
+ xpadlengthmask = 3;
+ else if (padlen == 21)
+ xpadlengthmask = 4;
+ else if (padlen == 29)
+ xpadlengthmask = 5;
+ else if (padlen == 37)
+ xpadlengthmask = 6;
+ else if (padlen == 53)
+ xpadlengthmask = 7;
// Write Data Group Length Indicator
crc = 0xffff;
- pad[padlen-1]=0x02; // FF-PAD Byte L (CI=1)
- pad[padlen-2]=0x20; // FF-PAD Byte L-1 (Variable size X_PAD)
- pad[padlen-3]=(xpadlengthmask<<5) | 0x01; // CI => data length = 12 (011) - Application Type=2 (DLS - start of X-PAD data group)
- pad[padlen-4]=0x00; // End of CI list
- pad[padlen-5]=(mscdgsize & 0x3F00)>>8; // RFA+HI Data group length
- pad[padlen-6]=(mscdgsize & 0x00FF);
+
+ // FF-PAD Byte L (CI=1)
+ pad[padlen-1] = 0x02;
+
+ // FF-PAD Byte L-1 (Variable size X_PAD)
+ pad[padlen-2] = 0x20;
+
+ // CI => data length = 12 (011) - Application Type=2 (DLS - start of X-PAD data group)
+ pad[padlen-3] = (xpadlengthmask << 5) | 0x01;
+
+ // End of CI list
+ pad[padlen-4] = 0x00;
+
+ // RFA+HI Data group length
+ pad[padlen-5] = (mscdgsize & 0x3F00) >> 8;
+ pad[padlen-6] = (mscdgsize & 0x00FF);
+
crc = update_crc_ccitt(crc, pad[padlen-5]);
crc = update_crc_ccitt(crc, pad[padlen-6]);
crc = ~crc;
- pad[padlen-7]=(crc & 0xFF00) >> 8; // HI CRC
- pad[padlen-8]=(crc & 0x00FF); // LO CRC
- for (i=padlen-9;i>=0;i--) { // NULL PADDING
- pad[i]=0x00;
- }
- write(STDOUT_FILENO,pad,padlen);
+
+ // HI CRC
+ pad[padlen-7] = (crc & 0xFF00) >> 8;
+
+ // LO CRC
+ pad[padlen-8] = (crc & 0x00FF);
+
+ // NULL PADDING
+ for (i = padlen-9; i >= 0; i--) {
+ pad[i] = 0x00;
+ }
+
+ write(output_fd, pad, padlen);
+
//fprintf(stderr,"Data Group Length Indicator: ");
//for (i=0;i<padlen;i++) fprintf(stderr,"%02x ",pad[i]);
//fprintf(stderr,"\n");
- // Write MSC Data Groupsd
- numseg=mscdgsize / (padlen-5);
- lastseglen=mscdgsize % (padlen-5);
+ // Write MSC Data Groups
+ numseg = mscdgsize / (padlen-5);
+ lastseglen = mscdgsize % (padlen-5);
if (lastseglen > 0) {
- numseg++; // The last incomplete segment
+ numseg++; // The last incomplete segment
}
- for (i=0;i<numseg;i++) {
-
- char* curseg;
+ for (i = 0; i < numseg; i++) {
+ UCHAR* curseg;
int curseglen;
UCHAR firstseg;
curseg = &mscdg[i*(padlen-5)];
//fprintf(stderr,"Segment number %d\n",i+1);
- if (i==0) // First segment
- firstseg=1;
+ if (i == 0) // First segment
+ firstseg = 1;
else
- firstseg=0;
+ firstseg = 0;
- if (i==numseg-1) { //Last segment
+ if (i == numseg-1) { //Last segment
if (lastseglen!=0)
- curseglen=lastseglen;
+ curseglen = lastseglen;
else
- curseglen=padlen-5;
+ curseglen = padlen-5;
} else {
- curseglen=padlen-5;
+ curseglen = padlen-5;
}
- pad[padlen-1]=0x02; // FF-PAD Byte L (CI=1)
- pad[padlen-2]=0x20; // FF-PAD Byte L-1 (Variable size X_PAD)
- if (firstseg==1)
- pad[padlen-3]=(xpadlengthmask<<5) | 12; // CI => data length = 12 (011) - Application Type=12 (start of MOT)
- else
- pad[padlen-3]=(xpadlengthmask<<5) | 13; // CI => data length = 12 (011) - Application Type=13 (MOT)
+ // FF-PAD Byte L (CI=1)
+ pad[padlen-1] = 0x02;
+
+ // FF-PAD Byte L-1 (Variable size X_PAD)
+ pad[padlen-2] = 0x20;
+
+ if (firstseg == 1) {
+ // CI => data length = 12 (011) - Application Type=12 (start of MOT)
+ pad[padlen-3] = (xpadlengthmask<<5) | 12;
+ }
+ else {
+ // CI => data length = 12 (011) - Application Type=13 (MOT)
+ pad[padlen-3] = (xpadlengthmask<<5) | 13;
+ }
- pad[padlen-4]=0x00; // End of CI list
+ // End of CI list
+ pad[padlen-4] = 0x00;
- for (j=0; j<curseglen; j++)
- pad[padlen-5-j]=curseg[j];
- for (j=padlen-5-curseglen;j>=0;j--)
- pad[j]=0x00;
+ for (j = 0; j < curseglen; j++) {
+ pad[padlen-5-j] = curseg[j];
+ }
+ for (j = padlen-5-curseglen; j >= 0; j--) {
+ pad[j] = 0x00;
+ }
- write(STDOUT_FILENO,pad,padlen);
+ 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");
@@ -417,222 +524,292 @@ void writeMotPAD(unsigned char* mscdg, unsigned short int mscdgsize, unsigned sh
}
-void writeDLS(int padlen) {
+void writeDLS(int output_fd, int padlen) {
char dlstext[MAXDLS];
- static char dlstextprev[MAXDLS];
- int dlslen,i;
+ static char dlstextprev[MAXDLS];
+ int dlslen;
+ int i;
static unsigned char** dlsdg;
- static int numdg=0;
+ static int numdg = 0;
+
+ static int dlsfd = 0;
- static int dlsfd=0;
+ if (dlsfd!=0) {
+ close(dlsfd);
+ }
- if (dlsfd!=0) close(dlsfd);
- dlsfd=open("/tmp/dls.file",O_RDONLY);
- if (dlsfd==-1) {
+ dlsfd = open("/tmp/dls.file", O_RDONLY);
+ if (dlsfd == -1) {
fprintf(stderr,"Error - Cannot open dls file\n");
return;
}
- dlslen=read(dlsfd, dlstext, MAXDLS);
- dlstext[dlslen]=0x00;
+ dlslen = read(dlsfd, dlstext, MAXDLS);
+ dlstext[dlslen] = 0x00;
//if (strcmp(dlstext,dlstextprev)!=0) {
- create_dls_datagroup(dlstext,padlen,&dlsdg,&numdg);
- strcpy(dlstextprev,dlstext);
+ create_dls_datagroup(dlstext, padlen, &dlsdg, &numdg);
+ strcpy(dlstextprev, dlstext);
//}
- for (i=0;i<numdg;i++) {
- write(STDOUT_FILENO,dlsdg[i],padlen);
+ 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 od datagroups composing dls text;
+ UCHAR dlsseg[8][16]; // max 8 segments, each max 16 chars
+ UCHAR** dlsdg; // Array od datagroups composing dls text;
- int numseg; // Number of DSL segments
- int lastseglen; // Length of the last segment
- int numdg; // Number of data group
+ 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;
+ int i, j, k, z, idx_start_crc, idx_stop_crc;
USHORT dlscrc;
- static UCHAR toggle=0;
+ static UCHAR toggle = 0;
- if (toggle==0)
- toggle=1;
+ if (toggle == 0)
+ toggle = 1;
else
- toggle=0;
+ toggle = 0;
- numseg=strlen(text) / 16;
- lastseglen=strlen(text) % 16;
+ numseg = strlen(text) / 16;
+ lastseglen = strlen(text) % 16;
if (padlen-9 >= 16) {
- if (lastseglen > 0) numseg++; // The last incomplete segment
- numdg=numseg; // The PAD can contain the full segmnet and overhead (9 bytes)
- } else {
- numdg=numseg*2; // Each 16 char segment span over 2 dg
+ 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;
+ 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 od DLS segments: %d\n",numseg);
- fprintf(stderr,"Number od DLS data grupus: %d\n",numdg);
-
- if (padlen==17)
- xpadlengthmask=3;
- else if (padlen==21)
- xpadlengthmask=4;
- else if (padlen==29)
- xpadlengthmask=5;
- else if (padlen==37)
- xpadlengthmask=6;
- else if (padlen==53)
- xpadlengthmask=7;
-
- *p_dlsdg = (UCHAR**) malloc(numdg*sizeof(UCHAR*));
- dlsdg=*p_dlsdg;
-
- i=0;
- for (z=0;z<numseg;z++) {
+ *p_numdg = numdg;
+ fprintf(stderr, "PAD Length: %d\n", padlen);
+ fprintf(stderr, "DLS text: %s\n", text);
+ fprintf(stderr, "Number od DLS segments: %d\n", numseg);
+ fprintf(stderr, "Number od DLS data grupus: %d\n", numdg);
+
+ if (padlen == 17)
+ xpadlengthmask = 3;
+ else if (padlen == 21)
+ xpadlengthmask = 4;
+ else if (padlen == 29)
+ xpadlengthmask = 5;
+ else if (padlen == 37)
+ xpadlengthmask = 6;
+ else if (padlen == 53)
+ xpadlengthmask = 7;
+
+ *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;
+ UCHAR firstseg, lastseg;
- curseg = &text[z*16];
- fprintf(stderr,"Segment number %d\n",z+1);
+ curseg = &text[z * 16];
+ fprintf(stderr, "Segment number %d\n", z+1);
- if (z==0) // First segment
- firstseg=1;
- else
- firstseg=0;
+ 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 (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 by 1 data group
- dlsdg[i]=(UCHAR*) malloc(padlen*sizeof(UCHAR));
- dlsdg[i][padlen-1]=0x02; // FF-PAD Byte L (CI=1)
- dlsdg[i][padlen-2]=0x20; // FF-PAD Byte L-1 (Variable size X_PAD)
- dlsdg[i][padlen-3]=(xpadlengthmask<<5) | 0x02; // CI => data length = 12 (011) - Application Type=2 (DLS - start of X-PAD data group)
- dlsdg[i][padlen-4]=0x00; // End of CI list
+ if (curseglen <= padlen-9) { // Segment is composed of 1 data group
+ dlsdg[i] = (UCHAR*) malloc(padlen * sizeof(UCHAR));
- dlsdg[i][padlen-5]=((toggle*8+firstseg*4+lastseg*2+0)<<4) | (curseglen-1); // DLS Prefix (T=1,Only one segment,segment length-1)
+ // FF-PAD Byte L (CI=1)
+ dlsdg[i][padlen-1]=0x02;
- if (firstseg==1)
- dlsdg[i][padlen-6]=0x00; // DLS Prefix (Charset standard)
- else
- dlsdg[i][padlen-6]=z<<4; // DLS SegNum
+ // 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;
+ }
- idx_start_crc = padlen-5; // CRC start from prefix
- for (j=0;j<curseglen;j++) { // DLS text
- dlsdg[i][padlen-7-j]=curseg[j];
+ // 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;
+ idx_stop_crc = padlen - 7 - curseglen+1;
dlscrc = 0xffff;
- for (j=idx_start_crc;j>=idx_stop_crc;j--) {
+ 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);
+ 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
- for (j=padlen-7-curseglen-2;j>=0;j--) { // NULL PADDING
+ // 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");
+
+ fprintf(stderr, "Data group: ");
+ for (j = 0; j < padlen; j++)
+ fprintf(stderr, "%x ", dlsdg[i][j]);
+ fprintf(stderr, "\n");
i++;
- } else { // Segment is composed by 2 data groups
+ }
+ else { // Segment is composed of 2 data groups
// FIRST DG (NO CRC)
dlscrc = 0xffff;
- dlsdg[i]=(UCHAR*) malloc(padlen*sizeof(UCHAR));
- dlsdg[i][padlen-1]=0x02; // FF-PAD Byte L (CI=1)
- dlsdg[i][padlen-2]=0x20; // FF-PAD Byte L-1 (Variable size X_PAD)
- dlsdg[i][padlen-3]=(xpadlengthmask<<5) | 0x02; // CI => data length = 12 (011) - Application Type=2 (DLS - start of X-PAD data group)
- dlsdg[i][padlen-4]=0x00; // End of CI list
- dlsdg[i][padlen-5]=((toggle*8+firstseg*4+lastseg*2+0)<<4) | (curseglen-1); // DLS Prefix (T=1,Only one segment,segment length-1)
+ dlsdg[i] = (UCHAR*) malloc(padlen * sizeof(UCHAR));
- if (firstseg==1)
- dlsdg[i][padlen-6]=0x00; // DLS Prefix (Charset standard)
- else
- dlsdg[i][padlen-6]=(i-1)<<4; // DLS SegNum
+ // 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]);
- for (j=0;j < MIN(curseglen,padlen-7); j++) { // DLS text
- dlsdg[i][padlen-7-j]=curseg[j];
+ // 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;
- if (curseglen==padlen-8) { // end of segment
+ 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) {
+ 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);
+ 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, "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));
- dlsdg[i][padlen-1]=0x00; // FF-PAD Byte L (CI=0)
- dlsdg[i][padlen-2]=0x20; // FF-PAD Byte L-1 (Variable size X_PAD)
- if (curseglen==padlen-8) {
+ 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 {
- for (j=0;j < curseglen-k; j++) { // DLS text
- dlsdg[i][padlen-3-j]=curseg[k+j];
+ }
+ 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
+ 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);
+ 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++;
}
-
}
}
generated by cgit v1.2.3 (git 2.39.1) at 2024-09-21 12:32:41 +0000