269 lines
7.0 KiB
C
269 lines
7.0 KiB
C
/*
|
|
* Copyright (c) 1996 Gary Jennejohn. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. Neither the name of the author nor the names of any co-contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
*---------------------------------------------------------------------------*
|
|
*
|
|
* q.921.c - print Q.921 traces
|
|
* ----------------------------
|
|
*
|
|
* $Id: q921.c,v 1.4 1999/12/13 21:25:26 hm Exp $
|
|
*
|
|
* $FreeBSD$
|
|
*
|
|
* last edit-date: [Mon Dec 13 21:56:46 1999]
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
#include "trace.h"
|
|
|
|
/*---------------------------------------------------------------------------*
|
|
* decode LAPD (Q.921) protocol
|
|
*---------------------------------------------------------------------------*/
|
|
int
|
|
decode_lapd(char *pbuf, int n, unsigned char *buf, int dir, int raw, int printit)
|
|
{
|
|
int sap, tei, cmd, p_f;
|
|
int cnt = 0;
|
|
int i;
|
|
char locbuf[32000];
|
|
char *lbufp = &locbuf[0];
|
|
|
|
*lbufp = '\0';
|
|
*pbuf = '\0';
|
|
|
|
sap = (buf[0] >> 2) & 0x3f;
|
|
cnt++;
|
|
|
|
tei = buf[1] >> 1;
|
|
cnt++;
|
|
|
|
if(dir == FROM_TE)
|
|
cmd = !(buf[0] & 2);
|
|
else
|
|
cmd = buf[0] & 2;
|
|
|
|
switch (sap)
|
|
{
|
|
/* SAPI control procedures */
|
|
case 0:
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Q921: SAP=%d (Call Control), %c, TEI=%d, ", sap, cmd?'C':'R', tei);
|
|
|
|
if((buf[2] & 0x01) == 0)
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "I-Frame: ");
|
|
|
|
p_f = buf [3] & 1;
|
|
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "N(S) %d N(R) %d P %d ", buf [2] >> 1, buf [3] >> 1, p_f);
|
|
|
|
cnt += 2;
|
|
}
|
|
else if((buf[2] & 0x03) == 0x01)
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "S-Frame: ");
|
|
|
|
p_f = buf [3] & 1;
|
|
cmd = buf [2] & 0x0c;
|
|
|
|
if(printit)
|
|
{
|
|
if (cmd == 0)
|
|
sprintf((lbufp+strlen(lbufp)), "RR N(R) %d PF %d ", buf [3] >> 1, p_f);
|
|
if (cmd == 4)
|
|
sprintf((lbufp+strlen(lbufp)), "RNR N(R) %d PF %d ", buf [3] >> 1, p_f);
|
|
if (cmd == 8)
|
|
sprintf((lbufp+strlen(lbufp)), "REJ N(R) %d PF %d ", buf [3] >> 1, p_f);
|
|
}
|
|
cnt += 2;
|
|
}
|
|
else if((buf[2] & 0x03) == 0x03)
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "U-Frame: ");
|
|
|
|
p_f = (buf [2] & 0x10) >> 4;
|
|
cmd = buf [2] & 0xec;
|
|
|
|
if(printit)
|
|
{
|
|
if (cmd == 0x6c)
|
|
sprintf((lbufp+strlen(lbufp)), "SABME PF %d ", p_f);
|
|
if (cmd == 0x0c)
|
|
sprintf((lbufp+strlen(lbufp)), "DM PF %d ", p_f);
|
|
if (cmd == 0)
|
|
sprintf((lbufp+strlen(lbufp)), "UI PF %d ", p_f);
|
|
if (cmd == 0x40)
|
|
sprintf((lbufp+strlen(lbufp)), "DISC PF %d ", p_f);
|
|
if (cmd == 0x60)
|
|
sprintf((lbufp+strlen(lbufp)), "UA PF %d ", p_f);
|
|
if (cmd == 0x84)
|
|
sprintf((lbufp+strlen(lbufp)), "FRMR PF %d ", p_f);
|
|
if (cmd == 0xac)
|
|
sprintf((lbufp+strlen(lbufp)), "XID PF %d ", p_f);
|
|
/* information field ??? */
|
|
}
|
|
cnt++;
|
|
}
|
|
break;
|
|
}
|
|
|
|
/* D channel X.25 */
|
|
|
|
case 16:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Q921: SAP=%d (X.25), %c, TEI=%d, ", sap, cmd?'C':'R', tei);
|
|
cnt = n;
|
|
goto dump;
|
|
|
|
/* Loopback test */
|
|
|
|
case 32:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Q921: SAP=%d (Loopbacktest), %c, TEI=%d, ", sap, cmd?'C':'R', tei);
|
|
cnt = n;
|
|
goto dump;
|
|
|
|
/* SAPI layer 2 management functions */
|
|
|
|
case 63:
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Q921: SAP=%d (TEI-Management), %c, TEI=%d, ", sap, cmd?'C':'R', tei);
|
|
|
|
if (tei != 127)
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "ILLEGAL TEI\n");
|
|
cnt = n;
|
|
goto dump;
|
|
}
|
|
|
|
if (buf [2] != 3 && buf [3] != 0xf)
|
|
{
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "invalid format!\n");
|
|
cnt = n;
|
|
goto dump;
|
|
}
|
|
cnt+= 2; /* UI + MEI */
|
|
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Ri=0x%04hx, ", *(short *)&buf[4]);
|
|
cnt += 2; /* Ri */
|
|
|
|
switch (buf[6])
|
|
{
|
|
case 1:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdRequest, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
case 2:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdAssign, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
case 3:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdDenied, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
case 4:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdCheckReq, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
case 5:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdCheckResp, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
case 6:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdRemove, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
case 7:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "IdVerify, Ai=%d", (buf [7] >> 1));
|
|
cnt += 2;
|
|
break;
|
|
default:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Unknown Msg Type\n");
|
|
cnt = n;
|
|
goto dump;
|
|
}
|
|
break;
|
|
}
|
|
|
|
/* Illegal SAPI */
|
|
|
|
default:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "Q921: ERROR, SAP=%d (Illegal SAPI), %c, TEI=%d\n", sap, cmd?'C':'R', tei);
|
|
cnt = n;
|
|
goto dump;
|
|
}
|
|
|
|
dump:
|
|
if(printit)
|
|
sprintf((lbufp+strlen(lbufp)), "\n");
|
|
|
|
if(raw && printit)
|
|
{
|
|
int j;
|
|
for (i = 0; i < cnt; i += 16)
|
|
{
|
|
sprintf((pbuf+strlen(pbuf)),"Dump:%.3d ", i);
|
|
for (j = 0; j < 16; j++)
|
|
if (i + j < cnt)
|
|
sprintf((pbuf+strlen(pbuf)),"%02x ", buf[i + j]);
|
|
else
|
|
sprintf((pbuf+strlen(pbuf))," ");
|
|
sprintf((pbuf+strlen(pbuf))," ");
|
|
for (j = 0; j < 16 && i + j < cnt; j++)
|
|
if (isprint(buf[i + j]))
|
|
sprintf((pbuf+strlen(pbuf)),"%c", buf[i + j]);
|
|
else
|
|
sprintf((pbuf+strlen(pbuf)),".");
|
|
sprintf((pbuf+strlen(pbuf)),"\n");
|
|
}
|
|
}
|
|
|
|
sprintf((pbuf+strlen(pbuf)),"%s", &locbuf[0]);
|
|
|
|
return (cnt);
|
|
}
|
|
|
|
/* EOF */
|