ETISnoop refactoring

3 files changed, 733 insertions, 556 deletions

diff --git a/Makefile b/Makefile
index 2acfe75..4fe3609 100644
--- a/Makefile
+++ b/Makefile
@@ -1,10 +1,10 @@
 
-CC=gcc
+CC=g++
 
 all: etisnoop
 
-etisnoop: etisnoop.c lib_crc.c lib_crc.h
-	$(CC) -Wall -ggdb etisnoop.c lib_crc.c -o etisnoop
+etisnoop: etisnoop.cpp lib_crc.c lib_crc.h
+	$(CC) -Wall -ggdb etisnoop.cpp lib_crc.c -o etisnoop
 
 clean:
 	rm -f etisnoop *.o
diff --git a/etisnoop.c b/etisnoop.c
deleted file mode 100644
index 643d3d7..0000000
--- a/etisnoop.c
+++ /dev/null
@@ -1,553 +0,0 @@
-/*
-    Copyright (C) 2014 CSP Innovazione nelle ICT s.c.a r.l. (http://www.csp.it/)
-    All rights reserved.
-
-    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/>.
-
-    etisnoop.c
-          Parse ETI NI G.703 file
-
-    Authors:
-         Sergio Sagliocco <sergio.sagliocco@csp.it> 
-*/
-
-
-
-#include <stdio.h>
-#include <unistd.h>
-#include <stdlib.h>
-#include <sys/types.h>
-#include <sys/stat.h>
-#include <fcntl.h>
-#include <string.h>
-#include "lib_crc.h"
-
-
-#define ETINIPACKETSIZE 6144
-
-
-void printbuf(char* h,int level, unsigned char* b, unsigned short int l, char* d);
-void decodeFIG(unsigned char* figdata, unsigned char figlen,unsigned short int figtype, unsigned short int indent);
-
-int main (int c, char *v[]) {
-
-    int i,j,etifd,ret,offset;
-    unsigned char p[ETINIPACKETSIZE],ficdata[32*4],streamdata[684*8];
-    char desc[256];
-    char prevsync[3]={0x00,0x00,0x00};
-    unsigned char ficf,nst,fp,mid,ficl;
-    unsigned short int fl,mnsc,crch;
-    unsigned short int crc;
-    unsigned int sstc;
-    unsigned char scid,tpl,l1;
-    unsigned short int sad[64],stl[64];
-
-    etifd=open(v[1],O_RDONLY);
-
-    if (etifd == -1) {
-        printf("Cannot open %s\n",v[1]);
-        return -1;
-    }
-
-    while (1) {
-
-        ret=read(etifd,p,ETINIPACKETSIZE);
-        if (ret!=ETINIPACKETSIZE) {
-            printf("End of ETI\n");
-            break;
-        }
-
-        // SYNC
-        printbuf("SYNC",0,p,4,"");
-
-        // SYNC - ERR
-        if (p[0]==0xFF)
-            strcpy(desc,"No error");
-        else
-            strcpy(desc,"Error");
-        printbuf("ERR",1,p,1,desc);
-
-        // SYNC - FSYNC
-
-        if (memcmp(prevsync,"\x00\x00\x00",3)==0) {
-            if ((memcmp(p+1,"\x07\x3a\xb6",3)==0)||(memcmp(p+1,"\xf8\xc5\x49",3)==0)) {
-                strcpy(desc,"OK");
-                memcpy(prevsync,p+1,3);
-            }
-            else {
-                strcpy(desc,"Wrong FSYNC");
-                memcpy(prevsync,"\x00\x00\x00",3);
-            }
-        } else if (memcmp(prevsync,"\x07\x3a\xb6",3)==0) {
-            if (memcmp(p+1,"\xf8\xc5\x49",3)!=0) {
-                strcpy(desc,"Wrong FSYNC");
-                memcpy(prevsync,"\x00\x00\x00",3);
-            } else {
-                strcpy(desc,"OK");
-                memcpy(prevsync,p+1,3);
-            }
-        } else if (memcmp(prevsync,"\xf8\xc5\x49",3)==0) {
-            if (memcmp(p+1,"\x07\x3a\xb6",3)!=0) {
-                strcpy(desc,"Wrong FSYNC");
-                memcpy(prevsync,"\x00\x00\x00",3);
-            } else {
-                strcpy(desc,"OK");
-                memcpy(prevsync,p+1,3);
-            }
-        }
-        printbuf("Sync FSYNC",1,p+1,3,desc);
-
-        // LIDATA
-        printbuf("LDATA",0,NULL,0,"");
-        // LIDATA - FC
-        printbuf("FC - Frame Characterization field",1,p+4,4,"");
-        // LIDATA - FC - FCT
-        sprintf(desc,"%d",p[4]);
-        printbuf("FCT  - Frame Count",2,p+4,1,desc);
-        // LIDATA - FC - FICF
-        ficf=(p[5] & 0x80) >> 7;
-        if (ficf == 1) {
-            sprintf(desc,"%d - FIC Information are present",ficf);
-        }
-        else {
-            sprintf(desc,"%d - FIC Information are not present",ficf);
-        }
-
-        printbuf("FICF - Fast Information Channel Flag",2,NULL,0,desc);
-        // LIDATA - FC - NST
-        nst=p[5] & 0x7F;
-        sprintf(desc,"%d",nst);
-        printbuf("NST  - Number of streams",2,NULL,0,desc);
-        // LIDATA - FC - FP
-        fp=(p[6] & 0xE0) >> 5;
-        sprintf(desc,"%d",fp);
-        printbuf("FP   - Frame Phase",2,&fp,1,desc);
-        // LIDATA - FC - MID
-        mid=(p[6] & 0x18) >> 3;
-        if (mid != 0)
-            sprintf(desc,"Mode %d",mid);
-        else 
-            sprintf(desc,"Mode 4");
-        printbuf("MID  - Mode Identity",2,&mid,1,desc);
-        // LIDATA - FC - FL
-        fl = (p[6] & 0x07) * 256 + p[7];
-        sprintf(desc,"%d words",fl);
-        printbuf("FL   - Frame Length",2,NULL,0,desc);
-
-        if (ficf==0) 
-            ficl=0;
-        else if (mid==3)
-            ficl=32;
-        else
-            ficl=24;
-
-        // STC
-        printbuf("STC - Stream Characterisation",1,NULL,0,"");
-
-        for (i=0;i<nst;i++) {
-            sprintf(desc,"Stream number %d",i);
-            printbuf("STC  - Stream Characterisation",2,p+8+4*i,4,desc);
-            scid = (p[8+4*i] & 0xFC) >> 2;
-            sprintf(desc,"%d",scid);
-            printbuf("SCID - Sub-channel Identifier",3,NULL,0,desc);
-            sad[i] = (p[8+4*i] & 0x03) * 256 + p[9+4*i];
-            sprintf(desc,"%d",sad[i]);
-            printbuf("SAD  - Sub-channel Start Address",3,NULL,0,desc);
-            tpl = (p[10+4*i] & 0xFC) >> 2; 
-
-            if ((tpl & 0x20) >> 5 == 1) {
-                unsigned char opt, plevel;
-                char plevelstr[32];
-                opt = (tpl & 0x16) >> 2;
-                plevel = (tpl & 0x03);
-                if (opt == 0x00) {
-                    if (plevel == 0)
-                        strcpy(plevelstr,"1-A, 1/4, 16 CUs");
-                    else if (plevel == 1)
-                        strcpy(plevelstr,"2-A, 3/8, 8 CUs");
-                    else if (plevel == 2)
-                        strcpy(plevelstr,"3-A, 1/2, 6 CUs");
-                    else if (plevel == 3)
-                        strcpy(plevelstr,"4-A, 3/4, 4 CUs");
-                } else if (opt == 0x01) {
-                    if (plevel == 0)
-                        strcpy(plevelstr,"1-B, 4/9, 27 CUs");
-                    else if (plevel == 1)
-                        strcpy(plevelstr,"2-B, 4/7, 21 CUs");
-                    else if (plevel == 2)
-                        strcpy(plevelstr,"3-B, 4/6, 18 CUs");
-                    else if (plevel == 3)
-                        strcpy(plevelstr,"4-B, 4/5, 15 CUs");
-                } else
-                    sprintf(plevelstr,"Unknown option %d",opt);
-                sprintf(desc,"0x%02x - Equal Error Protection. %s",tpl,plevelstr);
-            } else {
-                unsigned char tsw,uepidx;
-                tsw = (tpl & 0x08);
-                uepidx = tpl & 0x07;
-                sprintf(desc,"0x%02x - Unequal Error Protection. Table switch %d, UEP index %d",tpl,tsw,uepidx);
-            }
-            printbuf("TPL  - Sub-channel Type and Protection Level",3,NULL,0,desc);
-            stl[i] = (p[10+4*i] & 0x03) * 256 + p[11+4*i];
-            sprintf(desc,"%d => %d kbit/s",stl[i],stl[i]*8/3);
-            printbuf("STL  - Sub-channel Stream Length",3,NULL,0,desc);
-        }
-
-        // EOH
-        printbuf("EOH - End Of Header",1,p+8+4*nst,4,"");
-        mnsc = p[8+4*nst]*256+p[8+4*nst+1];
-        printbuf("MNSC - Multiplex Network Signalling Channel",2,p+8+4*nst,2,"");
-
-        crch = p[8+4*nst+2]*256+p[8+4*nst+3];
-        crc=0xffff;
-
-        for (i=4;i<8+4*nst+2;i++)
-            crc=update_crc_ccitt(crc,p[i]);
-        crc=~crc;
-        if (crc == crch) 
-            sprintf(desc,"CRC OK");
-        else
-            sprintf(desc,"CRC Mismatch: %02x",crc);
-
-        printbuf("Header CRC",2,p+8+4*nst+2,2,desc);
-
-        // MST - FIC
-        if (ficf==1) {
-            int endmarker=0,figcount=0;
-            unsigned char *fib, *fig;
-            unsigned short int figcrc;
-
-            memcpy(ficdata,p+12+4*nst,ficl*4);
-            sprintf(desc,"FIC Data (%d bytes)",ficl*4);
-            //printbuf(desc,1,ficdata,ficl*4,"");
-            printbuf(desc,1,NULL,0,"");
-            fib=p+12+4*nst;
-            for(i=0;i<ficl*4/32;i++) {
-                fig=fib;
-                endmarker=0;
-                figcount=0;
-                while (!endmarker) {
-                    unsigned char figtype,figext,figlen;
-                    figtype = (fig[0] & 0xE0) >> 5;
-                    if (figtype != 7) {
-                        figlen = fig[0] & 0x1F;
-                        sprintf(desc,"FIG %d [%d bytes]",figtype,figlen);
-                        printbuf(desc,3,fig+1,figlen,"");
-                        decodeFIG(fig+1,figlen,figtype,4);
-                        fig+=(figlen+1);
-                        figcount+=(figlen+1);
-                        if (figcount >= 29)
-                            endmarker=1;
-                    } else
-                        endmarker=1;
-                }
-                figcrc=fib[30]*256+fib[31];
-                crc=0xffff;
-                for (j=0;j<30;j++)
-                    crc=update_crc_ccitt(crc,fib[j]);
-                crc=~crc;
-                if (crc == figcrc)
-                    sprintf(desc,"FIB CRC OK");
-                else
-                    sprintf(desc,"FIB CRC Mismatch: %02x",crc);
-
-                printbuf("FIB CRC",3,fib+30,2,desc);
-                fib+=32;
-            }
-        }
-
-        offset=0;
-        for (i=0;i<nst;i++) {
-            memcpy(streamdata,p+12+4*nst+ficf*ficl*4+offset,stl[i]*8);
-            offset+=stl[i]*8;
-            sprintf(desc,"%d",i);
-            printbuf("Stream Data",1,streamdata,stl[i]*8,desc);
-        }
-
-        // EOF
-        crch = p[12+4*nst+ficf*ficl*4+offset]*256+p[12+4*nst+ficf*ficl*4+offset+1];
-
-        crc=0xffff;
-
-        for (i=12+4*nst;i<12+4*nst+ficf*ficl*4+offset;i++)
-            crc=update_crc_ccitt(crc,p[i]);
-        crc=~crc;
-        if (crc == crch)
-            sprintf(desc,"CRC OK");
-        else
-            sprintf(desc,"CRC Mismatch: %02x",crc);
-
-        printbuf("EOF",1,p+12+4*nst+ficf*ficl*4+offset,4,"");
-        printbuf("CRC",2,p+12+4*nst+ficf*ficl*4+offset,2,desc);
-
-        //RFU
-        printbuf("RFU",2,p+12+4*nst+ficf*ficl*4+offset+2,2,"");     
-        //TIST
-        l1 = (p[12+4*nst+ficf*ficl*4+offset+5] & 0xfe) >> 1;
-        sprintf(desc,"%d ms",l1*8);
-        printbuf("TIST - Time Stamp",1,p+12+4*nst+ficf*ficl*4+offset+4,4,desc);
-
-
-
-
-
-        printf("-------------------------------------------------------------------------------------------------------------\n");    
-    }
-
-}
-
-void printbuf(char* h,int level, unsigned char* b, unsigned short int l, char* d) {
-    int i;
-
-    for (i=0;i<level;i++) printf("\t");
-    printf("%s",h);
-    if (l!=0)
-        printf(": ");
-    for (i=0;i<l;i++) {
-        printf("%02x ",b[i]);
-    }
-    if (strcmp(d,"") != 0)
-        printf(" [%s] ",d);
-    printf("\n");
-
-}
-
-
-void decodeFIG(unsigned char* f, unsigned char figlen,unsigned short int figtype, unsigned short int indent) {
-
-    char desc[256];
-    int i,j;
-
-    switch (figtype) {
-
-        case 0: {
-                    unsigned short int ext,cn,oe,pd;
-
-                    cn = (f[0] & 0x80) >> 7;
-                    oe = (f[0] & 0x40) >> 6;
-                    pd = (f[0] & 0x20) >> 5;
-                    ext = f[0] & 0x1F;
-                    sprintf(desc,"FIG %d/%d: C/N=%d OE=%d P/D=%d",figtype,ext,cn,oe,pd);
-                    printbuf(desc,indent,f+1,figlen-1,"");
-                    switch (ext) {
-
-                        case 0: {
-                                    unsigned char cid,al,ch,hic,lowc,occ;
-                                    unsigned short int eid,eref;
-
-                                    eid = f[1]*256+f[2]; 
-                                    cid = (f[1] & 0xF0) >> 4;
-                                    eref = (f[1] & 0x0F)*256 + f[2];
-                                    ch  = (f[3] & 0xC0) >> 6;
-                                    al  = (f[3] & 0x20) >> 5;
-                                    hic = f[3] & 0x1F;
-                                    lowc = f[4];
-                                    if (ch != 0) { 
-                                        occ = f[5];
-                                        sprintf(desc,"Ensamble ID=0x%02x (Country id=%d, Ensamble reference=%d), Change flag=%d, Alarm flag=%d, CIF Count=%d/%d, Occurance change=%d",eid,cid,eref,ch,al,hic,lowc,occ);
-                                    } else
-                                        sprintf(desc,"Ensamble ID=0x%02x (Country id=%d, Ensamble reference=%d), Change flag=%d, Alarm flag=%d, CIF Count=%d/%d",eid,cid,eref,ch,al,hic,lowc);
-                                    printbuf(desc,indent+1,NULL,0,"");
-
-                                }
-                                break;
-                        case 2: {
-                                    unsigned short int sref, scid, sid;
-                                    unsigned char cid, ecc, local, caid, ncomp, timd, ps, ca, subchid, scty;
-                                    int k=1;
-                                    char psdesc[16];
-                                    char sctydesc[32];
-
-                                    while (k<figlen) {
-                                        if (pd == 0) {
-                                            sid = f[k] * 256 + f[k+1];
-                                            cid = (f[k] & 0xF0) >> 4;
-                                            sref = (f[k] & 0x0F) * 256 + f[k+1];
-                                            k=k+2;
-                                        } else {
-                                            sid = f[k] * 256 * 256 * 256 + f[k+1] * 256 * 256 + f[k+2] * 256 + f[k+3];
-                                            ecc = f[k];
-                                            cid = (f[k+1] & 0xF0) >> 4;
-                                            sref = (f[k+1] & 0x0F) * 256 * 256 + f[k+2] * 256 + f[k+3];
-                                            k=k+4;
-                                        }
-
-                                        local = (f[k] & 0x80) >> 7;
-                                        caid  = (f[k] & 0x70) >> 4;
-                                        ncomp = f[k] & 0x0F;
-
-                                        if (pd == 0)
-                                            sprintf(desc,"Service ID=0x%02X (Country id=%d, Service referemce=%d), Number of components=%d, Local flag=%d, CAID=%d",sid,cid,sref,ncomp,local,caid);
-                                        else
-                                            sprintf(desc,"Service ID=0x%02X (ECC=%d, Country id=%d, Service referemce=%d), Number of components=%d, Local flag=%d, CAID=%d",sid,ecc,cid,sref,ncomp,local,caid);
-                                        printbuf(desc,indent+1,NULL,0,"");
-
-                                        k++;
-                                        for (i=0;i<ncomp;i++) {  
-                                            unsigned char scomp[2];
-
-                                            memcpy(scomp,f+k,2);
-                                            sprintf(desc,"Component[%d]",i);
-                                            printbuf(desc,indent+2,scomp,2,"");
-                                            timd = (scomp[0] & 0xC0) >> 6;
-                                            ps = (scomp[1] & 0x02) >> 1;
-                                            ca = scomp[1] & 0x01;
-                                            scty = scomp[0] & 0x3F;
-                                            subchid = (scomp[1] & 0xFC) >> 2;
-
-                                            if (timd == 3) {
-                                                scid = scty*64 + subchid;
-                                            }
-
-                                            if (ps == 0) 
-                                                strcpy(psdesc,"Secondary service");
-                                            else 
-                                                strcpy(psdesc,"Primary service");
-
-
-                                            if (timd == 0) {
-                                                //MSC stream audio
-                                                if (scty == 0)
-                                                    sprintf(sctydesc,"MPEG Foreground sound (%d)",scty);
-                                                else if (scty == 1)
-                                                    sprintf(sctydesc,"MPEG Background sound (%d)",scty);
-                                                else if (scty == 2)
-                                                    sprintf(sctydesc,"Multi Chaneel sound (%d)",scty);
-                                                else if (scty == 63)
-                                                    sprintf(sctydesc,"AAC sound (%d)",scty);
-                                                else
-                                                    sprintf(sctydesc,"Unknown ASCTy (%d)",scty);
-
-                                                sprintf(desc,"Stream audio mode, %s, %s, SubChannel ID=%02X, CA=%d",psdesc,sctydesc,subchid,ca);
-                                                printbuf(desc,indent+3,NULL,0,"");
-                                            } else if (timd == 1) {
-                                                //MSC stream data 
-                                                sprintf(sctydesc,"DSCTy=%d",scty);
-                                                sprintf(desc,"Stream data mode, %s, %s, SubChannel ID=%02X, CA=%d",psdesc,sctydesc,subchid,ca);
-                                                printbuf(desc,indent+3,NULL,0,"");
-                                            } else if (timd == 2) {
-                                                // FIDC
-                                                sprintf(sctydesc,"DSCTy=%d",scty);
-                                                sprintf(desc,"FIDC mode, %s, %s, Fast Information Data Channel ID=%02X, CA=%d",psdesc,sctydesc,subchid,ca);
-                                                printbuf(desc,indent+3,NULL,0,"");
-                                            } else if (timd == 3) {
-                                                // MSC PAcket mode
-                                                sprintf(desc,"MSC Packet Mode, %s, Service Component ID=%02X, CA=%d",psdesc,subchid,ca);
-                                                printbuf(desc,indent+3,NULL,0,"");
-                                            }
-                                            k+=2;                                          
-                                        }
-                                    }
-                                }
-
-                                break;
-
-                    }
-                }
-                break;
-
-        case 1: {// SHORT LABELS
-                    unsigned short int ext,oe,charset;
-                    unsigned short int flag;
-                    char label[17];
-
-
-                    charset = (f[0] & 0xF0) >> 4;
-                    oe = (f[0] & 0x80) >> 3;
-                    ext = f[0] & 0x07;
-                    sprintf(desc,"FIG %d/%d: OE=%d, Charset=%d",figtype,ext,oe,charset);
-                    printbuf(desc,indent,f+1,figlen-1,"");
-                    memcpy(label,f+figlen-18,16);
-                    label[16]=0x00;
-                    flag = f[figlen-2] * 256 +f[figlen-1];
-
-                    switch (ext) {
-
-                        case 0: { // ENSAMBLE LABEL
-                                    unsigned short int eid;
-                                    eid = f[1] * 256 + f[2];
-                                    sprintf(desc,"Ensamble ID 0x%04X label: \"%s\", Short label mask: 0x%04X",eid,label,flag);
-                                    printbuf(desc,indent+1,NULL,0,"");
-                                }
-                                break;
-
-                        case 1: { // Programme LABEL
-                                    unsigned short int sid;
-                                    sid = f[1] * 256 + f[2];
-                                    sprintf(desc,"Service ID 0x%04X label: \"%s\", Short label mask: 0x%04X",sid,label,flag);
-                                    printbuf(desc,indent+1,NULL,0,"");
-                                }
-                                break;
-
-                        case 4: { // Service Component LABEL
-                                    unsigned int sid;
-                                    unsigned char pd,SCIdS;
-                                    pd = (f[1] & 0x80) >> 7;
-                                    SCIdS = f[1] & 0x0F;
-                                    if (pd==0) 
-                                        sid = f[2] * 256 + f[3];
-                                    else
-                                        sid = f[2] * 256 * 256 * 256 + f[3] * 256 * 256 + f[4] * 256 + f[5];
-                                    sprintf(desc,"Service ID  0x%08X , Service Component ID 0x%04X Short, label: \"%s\", label mask: 0x%04X",sid,SCIdS,label,flag);
-                                    printbuf(desc,indent+1,NULL,0,"");
-                                }
-                                break;
-
-                        case 5: { // Data Service LABEL
-                                    unsigned int sid;
-                                    sid = sid = f[1] * 256 * 256 * 256 + f[2] * 256 * 256 + f[3] * 256 + f[4];
-                                    sprintf(desc,"Service ID 0x%08X label: \"%s\", Short label mask: 0x%04X",sid,label,flag);
-                                    printbuf(desc,indent+1,NULL,0,"");
-                                }
-                                break;
-
-
-                        case 6: { // X-PAD User Application label
-                                    unsigned int sid;
-                                    unsigned char pd,SCIdS,xpadapp;
-                                    char xpadappdesc[16];
-
-                                    pd = (f[1] & 0x80) >> 7;
-                                    SCIdS = f[1] & 0x0F;
-                                    if (pd==0) {
-                                        sid = f[2] * 256 + f[3];
-                                        xpadapp = f[4] & 0x1F;
-                                    }
-                                    else {
-                                        sid = f[2] * 256 * 256 * 256 + f[3] * 256 * 256 + f[4] * 256 + f[5];
-                                        xpadapp = f[6] & 0x1F;
-                                    }
-
-                                    if (xpadapp==2)
-                                        strcpy(xpadappdesc,"DLS");
-                                    else if (xpadapp==12)
-                                        strcpy(xpadappdesc,"MOT");
-
-
-                                    sprintf(desc,"Service ID  0x%08X , Service Component ID 0x%04X Short, X-PAD App %02X (%s), label: \"%s\", label mask: 0x%04X",sid,SCIdS,xpadapp,xpadappdesc,label,flag);
-                                    printbuf(desc,indent+1,NULL,0,"");
-                                }
-                                break;
-
-
-                    }
-
-                }
-                break;
-
-
-    }
-
-}
-
diff --git a/etisnoop.cpp b/etisnoop.cpp
new file mode 100644
index 0000000..a9f70ca
--- /dev/null
+++ b/etisnoop.cpp
@@ -0,0 +1,730 @@
+/*
+    Copyright (C) 2014 CSP Innovazione nelle ICT s.c.a r.l. (http://www.csp.it/)
+    Copyright (C) 2014 Matthias P. Braendli (http://www.opendigitalradio.org)
+
+    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/>.
+
+    etisnoop.c
+          Parse ETI NI G.703 file
+
+    Authors:
+         Sergio Sagliocco <sergio.sagliocco@csp.it>
+         Matthias P. Braendli <matthias@mpb.li>
+*/
+
+
+
+#include <stdio.h>
+#include <unistd.h>
+#include <getopt.h>
+#include <stdlib.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <string.h>
+#include <string>
+#include <sstream>
+#include "lib_crc.h"
+
+
+#define ETINIPACKETSIZE 6144
+
+using namespace std;
+
+void printbuf(string header,
+        int indent_level,
+        unsigned char* buffer,
+        size_t size,
+        string desc="");
+
+void decodeFIG(unsigned char* figdata,
+        unsigned char figlen,
+        unsigned short int figtype,
+        unsigned short int indent);
+
+int eti_analyse(int etifd, int verbosity);
+
+#define no_argument 0
+#define required_argument 1
+#define optional_argument 2
+const struct option longopts[] = {
+    {"help",               no_argument,        0, 'h'},
+    {"verbose",            no_argument,        0, 'v'},
+    {"input",              required_argument,  0, 'i'},
+    {"save-msc",           required_argument,  0, 's'}
+};
+
+void usage(void)
+{
+    fprintf(stderr,
+            "ETISnoop analyser\n\n"
+            "The ETSnoop analyser decodes and prints out a RAW ETI file in a\n"
+            "form that makes analysis easier.\n"
+            "Usage: etisnoop [-v] [-i filename]\n");
+}
+
+int main(int argc, char *argv[])
+{
+    int index;
+    int ch = 0;
+    string file_name("-");
+
+    int verbosity = 0;
+
+    while(ch != -1) {
+        ch = getopt_long(argc, argv, "hvi:s:", longopts, &index);
+        switch (ch) {
+            case 'i':
+                file_name = optarg;
+                break;
+            case 's':
+                break;
+            case 'v':
+                verbosity++;
+                break;
+            case 'h':
+                usage();
+                return 1;
+                break;
+        }
+    }
+
+    int etifd;
+
+    if (file_name == "-") {
+        etifd = STDIN_FILENO;
+    }
+    else {
+        etifd = open(file_name.c_str(), O_RDONLY);
+        if (etifd == -1) {
+            perror("File open failed");
+            return 1;
+        }
+    }
+
+    eti_analyse(etifd, verbosity);
+    close(etifd);
+}
+
+int eti_analyse(int etifd, int verbosity)
+{
+    unsigned char p[ETINIPACKETSIZE];
+    string desc;
+    char prevsync[3]={0x00,0x00,0x00};
+    unsigned char ficf,nst,fp,mid,ficl;
+    unsigned short int fl,crch;
+    unsigned short int crc;
+    unsigned char scid,tpl,l1;
+    unsigned short int sad[64],stl[64];
+    char sdesc[256];
+
+    while (1) {
+
+        int ret = read(etifd, p, ETINIPACKETSIZE);
+        if (ret != ETINIPACKETSIZE) {
+            fprintf(stderr, "End of ETI\n");
+            break;
+        }
+
+        // SYNC
+        printbuf("SYNC", 0, p, 4);
+
+        // SYNC - ERR
+        if (p[0] == 0xFF)
+            desc = "No error";
+        else
+            desc = "Error";
+        printbuf("ERR", 1, p, 1, desc);
+
+        // SYNC - FSYNC
+
+        if (memcmp(prevsync, "\x00\x00\x00", 3) == 0) {
+            if ( (memcmp(p + 1, "\x07\x3a\xb6", 3) == 0) ||
+                 (memcmp(p + 1, "\xf8\xc5\x49", 3) == 0) ) {
+                desc = "OK";
+                memcpy(prevsync, p+1, 3);
+            }
+            else {
+                desc ="Wrong FSYNC";
+                memcpy(prevsync, "\x00\x00\x00", 3);
+            }
+        } else if (memcmp(prevsync, "\x07\x3a\xb6", 3) == 0) {
+            if (memcmp(p + 1, "\xf8\xc5\x49", 3) != 0) {
+                desc = "Wrong FSYNC";
+                memcpy(prevsync, "\x00\x00\x00", 3);
+            } else {
+                desc = "OK";
+                memcpy(prevsync, p + 1, 3);
+            }
+        } else if (memcmp(prevsync, "\xf8\xc5\x49", 3) == 0) {
+            if (memcmp(p + 1, "\x07\x3a\xb6", 3) != 0) {
+                desc = "Wrong FSYNC";
+                memcpy(prevsync, "\x00\x00\x00", 3);
+            } else {
+                desc = "OK";
+                memcpy(prevsync, p + 1, 3);
+            }
+        }
+        printbuf("Sync FSYNC", 1, p + 1, 3, desc);
+
+        // LIDATA
+        printbuf("LDATA", 0, NULL, 0);
+        // LIDATA - FC
+        printbuf("FC - Frame Characterization field", 1, p+4, 4);
+        // LIDATA - FC - FCT
+        char fct[25];
+        sprintf(fct, "%d", p[4]);
+        printbuf("FCT  - Frame Count", 2, p+4, 1, fct);
+        // LIDATA - FC - FICF
+        ficf = (p[5] & 0x80) >> 7;
+
+        {
+            stringstream ss;
+            ss << ficf;
+            if (ficf == 1) {
+                ss << "- FIC Information are present";
+            }
+            else {
+                ss << "- FIC Information are not present";
+            }
+
+            printbuf("FICF - Fast Information Channel Flag", 2, NULL, 0, ss.str());
+        }
+
+        // LIDATA - FC - NST
+        nst = p[5] & 0x7F;
+        {
+            stringstream ss;
+            ss << nst;
+            printbuf("NST  - Number of streams", 2, NULL, 0, ss.str());
+        }
+
+        // LIDATA - FC - FP
+        fp = (p[6] & 0xE0) >> 5;
+        {
+            stringstream ss;
+            ss << fp;
+            printbuf("FP   - Frame Phase", 2, &fp, 1, ss.str());
+        }
+
+        // LIDATA - FC - MID
+        mid = (p[6] & 0x18) >> 3;
+        {
+            stringstream ss;
+            ss << "Mode ";
+            if (mid != 0) {
+                ss << mid;
+            }
+            else {
+                ss << "4";
+            }
+            printbuf("MID  - Mode Identity", 2, &mid, 1, ss.str());
+        }
+
+        // LIDATA - FC - FL
+        fl = (p[6] & 0x07) * 256 + p[7];
+        {
+            stringstream ss;
+            ss << fl << " words";
+            printbuf("FL   - Frame Length", 2, NULL, 0, ss.str());
+        }
+
+        if (ficf == 0) {
+            ficl = 0;
+        }
+        else if (mid == 3) {
+            ficl = 32;
+        }
+        else {
+            ficl = 24;
+        }
+
+        // STC
+        printbuf("STC - Stream Characterisation", 1, NULL, 0);
+
+        for (int i=0; i < nst; i++) {
+            sprintf(sdesc, "Stream number %d", i);
+            printbuf("STC  - Stream Characterisation", 2, p + 8 + 4*i, 4, sdesc);
+            scid = (p[8 + 4*i] & 0xFC) >> 2;
+            sprintf(sdesc, "%d", scid);
+            printbuf("SCID - Sub-channel Identifier", 3, NULL, 0, sdesc);
+            sad[i] = (p[8+4*i] & 0x03) * 256 + p[9+4*i];
+            sprintf(sdesc, "%d", sad[i]);
+            printbuf("SAD  - Sub-channel Start Address", 3, NULL, 0, sdesc);
+            tpl = (p[10+4*i] & 0xFC) >> 2;
+
+            if ((tpl & 0x20) >> 5 == 1) {
+                unsigned char opt, plevel;
+                string plevelstr;
+                opt = (tpl & 0x16) >> 2;
+                plevel = (tpl & 0x03);
+                if (opt == 0x00) {
+                    if (plevel == 0)
+                        plevelstr = "1-A, 1/4, 16 CUs";
+                    else if (plevel == 1)
+                        plevelstr = "2-A, 3/8, 8 CUs";
+                    else if (plevel == 2)
+                        plevelstr = "3-A, 1/2, 6 CUs";
+                    else if (plevel == 3)
+                        plevelstr = "4-A, 3/4, 4 CUs";
+                }
+                else if (opt == 0x01) {
+                    if (plevel == 0)
+                        plevelstr = "1-B, 4/9, 27 CUs";
+                    else if (plevel == 1)
+                        plevelstr = "2-B, 4/7, 21 CUs";
+                    else if (plevel == 2)
+                        plevelstr = "3-B, 4/6, 18 CUs";
+                    else if (plevel == 3)
+                        plevelstr = "4-B, 4/5, 15 CUs";
+                }
+                else {
+                    stringstream ss;
+                    ss << "Unknown option " << opt;
+                    plevelstr = ss.str();
+                }
+                sprintf(sdesc, "0x%02x - Equal Error Protection. %s", tpl, plevelstr.c_str());
+            } else {
+                unsigned char tsw, uepidx;
+                tsw = (tpl & 0x08);
+                uepidx = tpl & 0x07;
+                sprintf(sdesc, "0x%02x - Unequal Error Protection. Table switch %d,  UEP index %d", tpl, tsw, uepidx);
+            }
+            printbuf("TPL  - Sub-channel Type and Protection Level", 3, NULL, 0, sdesc);
+            stl[i] = (p[10+4*i] & 0x03) * 256 + p[11+4*i];
+            sprintf(sdesc, "%d => %d kbit/s", stl[i], stl[i]*8/3);
+            printbuf("STL  - Sub-channel Stream Length", 3, NULL, 0, sdesc);
+        }
+
+        // EOH
+        printbuf("EOH - End Of Header", 1, p + 8 + 4*nst, 4);
+        unsigned short int mnsc = p[8 + 4*nst] * 256 + \
+                                  p[8 + 4*nst + 1];
+        {
+            stringstream ss;
+            ss << mnsc;
+            printbuf("MNSC - Multiplex Network Signalling Channel", 2, p+8+4*nst, 2, ss.str());
+        }
+
+        crch = p[8 + 4*nst + 2]*256 + \
+               p[8 + 4*nst + 3];
+        crc  = 0xffff;
+
+        for (int i=4; i < 8 + 4*nst + 2; i++)
+            crc = update_crc_ccitt(crc, p[i]);
+        crc =~ crc;
+
+        if (crc == crch) {
+            sprintf(sdesc,"CRC OK");
+        }
+        else {
+            sprintf(sdesc,"CRC Mismatch: %02x",crc);
+        }
+
+        printbuf("Header CRC", 2, p + 8 + 4*nst + 2, 2, sdesc);
+
+        // MST - FIC
+        if (ficf == 1) {
+            int endmarker = 0;
+            int figcount = 0;
+            unsigned char *fib, *fig;
+            unsigned short int figcrc;
+
+            unsigned char ficdata[32*4];
+            memcpy(ficdata, p + 12 + 4*nst, ficl*4);
+            sprintf(sdesc, "FIC Data (%d bytes)", ficl*4);
+            //printbuf(sdesc, 1, ficdata, ficl*4);
+            printbuf(sdesc, 1, NULL, 0);
+            fib = p + 12 + 4*nst;
+            for(int i = 0; i < ficl*4/32; i++) {
+                fig=fib;
+                endmarker=0;
+                figcount=0;
+                while (!endmarker) {
+                    unsigned char figtype, figlen;
+                    figtype = (fig[0] & 0xE0) >> 5;
+                    if (figtype != 7) {
+                        figlen = fig[0] & 0x1F;
+                        sprintf(sdesc, "FIG %d [%d bytes]", figtype, figlen);
+                        printbuf(sdesc, 3, fig+1, figlen);
+                        decodeFIG(fig+1, figlen, figtype, 4);
+                        fig += figlen + 1;
+                        figcount += figlen + 1;
+                        if (figcount >= 29)
+                            endmarker = 1;
+                    }
+                    else {
+                        endmarker = 1;
+                    }
+                }
+                figcrc = fib[30]*256 + fib[31];
+                crc = 0xffff;
+                for (int j = 0; j < 30; j++) {
+                    crc = update_crc_ccitt(crc, fib[j]);
+                }
+                crc =~ crc;
+                if (crc == figcrc)
+                    sprintf(sdesc,"FIB CRC OK");
+                else
+                    sprintf(sdesc,"FIB CRC Mismatch: %02x",crc);
+
+                printbuf("FIB CRC",3,fib+30,2,sdesc);
+                fib += 32;
+            }
+        }
+
+        int offset = 0;
+        for (int i=0; i < nst; i++) {
+            unsigned char streamdata[684*8];
+            memcpy(streamdata, p + 12 + 4*nst + ficf*ficl*4 + offset, stl[i]*8);
+            offset += stl[i] * 8;
+            sprintf(sdesc, "%d", i);
+            printbuf("Stream Data", 1, streamdata, stl[i]*8, sdesc);
+        }
+
+        // EOF
+        crch = p[12 + 4*nst + ficf*ficl*4 + offset] * 256 + \
+               p[12 + 4*nst + ficf*ficl*4 + offset + 1];
+
+        crc = 0xffff;
+
+        for (int i = 12 + 4*nst; i < 12 + 4*nst + ficf*ficl*4 + offset; i++)
+            crc = update_crc_ccitt(crc, p[i]);
+        crc =~ crc;
+        if (crc == crch)
+            sprintf(sdesc, "CRC OK");
+        else
+            sprintf(sdesc, "CRC Mismatch: %02x", crc);
+
+        printbuf("EOF", 1, p + 12 + 4*nst + ficf*ficl*4 + offset, 4);
+        printbuf("CRC", 2, p + 12 + 4*nst + ficf*ficl*4 + offset, 2, sdesc);
+
+        //RFU
+        printbuf("RFU", 2, p + 12 + 4*nst + ficf*ficl*4 + offset + 2, 2);
+
+        //TIST
+        l1 = (p[12 + 4*nst + ficf*ficl*4 + offset + 5] & 0xfe) >> 1;
+        sprintf(sdesc, "%d ms", l1*8);
+        printbuf("TIST - Time Stamp", 1, p+12+4*nst+ficf*ficl*4+offset+4, 4, sdesc);
+
+
+        printf("-------------------------------------------------------------------------------------------------------------\n");
+    }
+}
+
+void printbuf(string header,
+        int indent_level,
+        unsigned char* buffer,
+        size_t size,
+        string desc)
+{
+    for (int i = 0; i < indent_level; i++) {
+        printf("\t");
+    }
+
+    printf("%s", header.c_str());
+    if (size != 0) {
+        printf(": ");
+    }
+
+    for (size_t i = 0; i < size; i++) {
+        printf("%02x ", buffer[i]);
+    }
+
+    if (desc != "") {
+        printf(" [%s] ", desc.c_str());
+    }
+
+    printf("\n");
+}
+
+
+void decodeFIG(unsigned char* f, unsigned char figlen,unsigned short int figtype, unsigned short int indent) {
+
+    char desc[256];
+
+    switch (figtype) {
+        case 0:
+            {
+                unsigned short int ext,cn,oe,pd;
+
+                cn = (f[0] & 0x80) >> 7;
+                oe = (f[0] & 0x40) >> 6;
+                pd = (f[0] & 0x20) >> 5;
+                ext = f[0] & 0x1F;
+                sprintf(desc, "FIG %d/%d: C/N=%d OE=%d P/D=%d", figtype, ext, cn, oe, pd);
+                printbuf(desc, indent, f+1, figlen-1);
+                switch (ext) {
+
+                    case 0:
+                        {
+                            unsigned char cid, al, ch, hic, lowc, occ;
+                            unsigned short int eid, eref;
+
+                            eid  =  f[1]*256+f[2];
+                            cid  = (f[1] & 0xF0) >> 4;
+                            eref = (f[1] & 0x0F)*256 + \
+                                    f[2];
+                            ch   = (f[3] & 0xC0) >> 6;
+                            al   = (f[3] & 0x20) >> 5;
+                            hic  =  f[3] & 0x1F;
+                            lowc =  f[4];
+                            if (ch != 0) {
+                                occ = f[5];
+                                sprintf(desc,
+                                        "Ensamble ID=0x%02x (Country id=%d, Ensamble reference=%d), Change flag=%d, Alarm flag=%d, CIF Count=%d/%d, Occurance change=%d",
+                                        eid, cid, eref, ch, al, hic, lowc, occ);
+                            }
+                            else {
+                                sprintf(desc,
+                                        "Ensamble ID=0x%02x (Country id=%d, Ensamble reference=%d), Change flag=%d, Alarm flag=%d, CIF Count=%d/%d",
+                                        eid, cid, eref, ch, al, hic, lowc);
+                            }
+                            printbuf(desc, indent+1, NULL, 0);
+
+                        }
+                        break;
+                    case 2:
+                        {
+                            unsigned short int sref, scid, sid;
+                            unsigned char cid, ecc, local, caid, ncomp, timd, ps, ca, subchid, scty;
+                            int k=1;
+                            string psdesc;
+                            char sctydesc[32];
+
+                            while (k<figlen) {
+                                if (pd == 0) {
+                                    sid  =  f[k] * 256 + f[k+1];
+                                    cid  = (f[k] & 0xF0) >> 4;
+                                    sref = (f[k] & 0x0F) * 256 + f[k+1];
+                                    k += 2;
+                                }
+                                else {
+                                    sid  =  f[k] * 256 * 256 * 256 + \
+                                            f[k+1] * 256 * 256 + \
+                                            f[k+2] * 256 + \
+                                            f[k+3];
+
+                                    ecc  =  f[k];
+                                    cid  = (f[k+1] & 0xF0) >> 4;
+                                    sref = (f[k+1] & 0x0F) * 256 * 256 + \
+                                           f[k+2] * 256 + \
+                                           f[k+3];
+
+                                    k += 4;
+                                }
+
+                                local = (f[k] & 0x80) >> 7;
+                                caid  = (f[k] & 0x70) >> 4;
+                                ncomp =  f[k] & 0x0F;
+
+                                if (pd == 0)
+                                    sprintf(desc,
+                                            "Service ID=0x%02X (Country id=%d, Service referemce=%d), Number of components=%d, Local flag=%d, CAID=%d",
+                                            sid, cid, sref, ncomp, local, caid);
+                                else
+                                    sprintf(desc,
+                                            "Service ID=0x%02X (ECC=%d, Country id=%d, Service referemce=%d), Number of components=%d, Local flag=%d, CAID=%d",
+                                            sid, ecc, cid, sref, ncomp, local, caid);
+                                printbuf(desc, indent+1, NULL, 0);
+
+                                k++;
+                                for (int i=0; i<ncomp; i++) {
+                                    unsigned char scomp[2];
+
+                                    memcpy(scomp, f+k, 2);
+                                    sprintf(desc, "Component[%d]", i);
+                                    printbuf(desc, indent+2, scomp, 2, "");
+                                    timd    = (scomp[0] & 0xC0) >> 6;
+                                    ps      = (scomp[1] & 0x02) >> 1;
+                                    ca      =  scomp[1] & 0x01;
+                                    scty    =  scomp[0] & 0x3F;
+                                    subchid = (scomp[1] & 0xFC) >> 2;
+
+                                    if (timd == 3) {
+                                        scid = scty*64 + subchid;
+                                    }
+
+                                    if (ps == 0) {
+                                        psdesc = "Secondary service";
+                                    }
+                                    else {
+                                        psdesc = "Primary service";
+                                    }
+
+
+                                    if (timd == 0) {
+                                        //MSC stream audio
+                                        if (scty == 0)
+                                            sprintf(sctydesc, "MPEG Foreground sound (%d)", scty);
+                                        else if (scty == 1)
+                                            sprintf(sctydesc, "MPEG Background sound (%d)", scty);
+                                        else if (scty == 2)
+                                            sprintf(sctydesc, "Multi Chaneel sound (%d)", scty);
+                                        else if (scty == 63)
+                                            sprintf(sctydesc, "AAC sound (%d)", scty);
+                                        else
+                                            sprintf(sctydesc, "Unknown ASCTy (%d)", scty);
+
+                                        sprintf(desc, "Stream audio mode, %s, %s, SubChannel ID=%02X, CA=%d", psdesc.c_str(), sctydesc, subchid, ca);
+                                        printbuf(desc, indent+3, NULL, 0);
+                                    }
+                                    else if (timd == 1) {
+                                        //MSC stream data 
+                                        sprintf(sctydesc, "DSCTy=%d", scty);
+                                        sprintf(desc, "Stream data mode, %s, %s, SubChannel ID=%02X, CA=%d", psdesc.c_str(), sctydesc, subchid, ca);
+                                        printbuf(desc, indent+3, NULL, 0);
+                                    }
+                                    else if (timd == 2) {
+                                        // FIDC
+                                        sprintf(sctydesc, "DSCTy=%d", scty);
+                                        sprintf(desc, "FIDC mode, %s, %s, Fast Information Data Channel ID=%02X, CA=%d", psdesc.c_str(), sctydesc, subchid, ca);
+                                        printbuf(desc, indent+3, NULL, 0);
+                                    }
+                                    else if (timd == 3) {
+                                        // MSC PAcket mode
+                                        sprintf(desc, "MSC Packet Mode, %s, Service Component ID=%02X, CA=%d", psdesc.c_str(), subchid, ca);
+                                        printbuf(desc, indent+3, NULL, 0);
+                                    }
+                                    k += 2;
+                                }
+                            }
+                        }
+
+                        break;
+
+                }
+            }
+            break;
+
+        case 1:
+            {// SHORT LABELS
+                unsigned short int ext,oe,charset;
+                unsigned short int flag;
+                char label[17];
+
+                charset = (f[0] & 0xF0) >> 4;
+                oe = (f[0] & 0x80) >> 3;
+                ext = f[0] & 0x07;
+                sprintf(desc,
+                        "FIG %d/%d: OE=%d, Charset=%d",
+                        figtype, ext, oe, charset);
+
+                printbuf(desc, indent, f+1, figlen-1);
+                memcpy(label, f+figlen-18, 16);
+                label[16] = 0x00;
+                flag = f[figlen-2] * 256 + \
+                       f[figlen-1];
+
+                switch (ext) {
+                    case 0:
+                        { // ENSAMBLE LABEL
+                            unsigned short int eid;
+                            eid = f[1] * 256 + f[2];
+                            sprintf(desc, "Ensemble ID 0x%04X label: \"%s\", Short label mask: 0x%04X", eid, label, flag);
+                            printbuf(desc, indent+1, NULL, 0);
+                        }
+                        break;
+
+                    case 1:
+                        { // Programme LABEL
+                            unsigned short int sid;
+                            sid = f[1] * 256 + f[2];
+                            sprintf(desc, "Service ID 0x%04X label: \"%s\", Short label mask: 0x%04X", sid, label, flag);
+                            printbuf(desc, indent+1, NULL, 0);
+                        }
+                        break;
+
+                    case 4:
+                        { // Service Component LABEL
+                            unsigned int sid;
+                            unsigned char pd, SCIdS;
+                            pd    = (f[1] & 0x80) >> 7;
+                            SCIdS =  f[1] & 0x0F;
+                            if (pd == 0) {
+                                sid = f[2] * 256 + \
+                                      f[3];
+                            }
+                            else {
+                                sid = f[2] * 256 * 256 * 256 + \
+                                      f[3] * 256 * 256 + \
+                                      f[4] * 256 + \
+                                      f[5];
+                            }
+                            sprintf(desc,
+                                    "Service ID  0x%08X , Service Component ID 0x%04X Short, label: \"%s\", label mask: 0x%04X",
+                                    sid, SCIdS, label, flag);
+                            printbuf(desc, indent+1, NULL, 0);
+                        }
+                        break;
+
+                    case 5:
+                        { // Data Service LABEL
+                            unsigned int sid;
+                            sid = f[1] * 256 * 256 * 256 + \
+                                  f[2] * 256 * 256 + \
+                                  f[3] * 256 + \
+                                  f[4];
+
+                            sprintf(desc,
+                                    "Service ID 0x%08X label: \"%s\", Short label mask: 0x%04X",
+                                    sid, label, flag);
+                            printbuf(desc, indent+1, NULL, 0, "");
+                        }
+                        break;
+
+
+                    case 6:
+                        { // X-PAD User Application label
+                            unsigned int sid;
+                            unsigned char pd, SCIdS, xpadapp;
+                            string xpadappdesc;
+
+                            pd    = (f[1] & 0x80) >> 7;
+                            SCIdS =  f[1] & 0x0F;
+                            if (pd == 0) {
+                                sid = f[2] * 256 + \
+                                      f[3];
+                                xpadapp = f[4] & 0x1F;
+                            }
+                            else {
+                                sid = f[2] * 256 * 256 * 256 + \
+                                      f[3] * 256 * 256 + \
+                                      f[4] * 256 + \
+                                      f[5];
+                                xpadapp = f[6] & 0x1F;
+                            }
+
+                            if (xpadapp == 2) {
+                                xpadappdesc = "DLS";
+                            }
+                            else if (xpadapp == 12) {
+                                xpadappdesc = "MOT";
+                            }
+                            else {
+                                xpadappdesc = "?";
+                            }
+
+
+                            sprintf(desc,"Service ID  0x%08X , Service Component ID 0x%04X Short, X-PAD App %02X (%s), label: \"%s\", label mask: 0x%04X",
+                                    sid, SCIdS, xpadapp, xpadappdesc.c_str(), label, flag);
+                            printbuf(desc,indent+1,NULL,0,"");
+                        }
+                        break;
+                }
+            }
+            break;
+    }
+}
+