NetBSD-5.0.2/usr.sbin/isdn/isdntrace/q921.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.2 2003/10/06 09:43:28 itojun 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 */