diff options
Diffstat (limited to 'etisnoop.c')
-rw-r--r-- | etisnoop.c | 553 |
1 files changed, 0 insertions, 553 deletions
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; - - - } - -} - |