The Tcpdump Group git mirrors - tcpdump/blobdiff

* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.

*/

* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.

*/

-#ifndef lint

-static const char rcsid[] _U_ =

- "@(#)$Header: /tcpdump/master/tcpdump/print-fr.c,v 1.39 2005-07-21 08:26:45 hannes Exp $ (LBL)";

-#endif

-

+#define NETDISSECT_REWORKED

#ifdef HAVE_CONFIG_H

#include "config.h"

#endif

#ifdef HAVE_CONFIG_H

#include "config.h"

#endif

#include <stdio.h>

#include <string.h>

#include <stdio.h>

#include <string.h>

-#include <pcap.h>

-#include "addrtoname.h"

#include "interface.h"

+#include "addrtoname.h"

#include "ethertype.h"

#include "nlpid.h"

#include "extract.h"

#include "oui.h"

#include "ethertype.h"

#include "nlpid.h"

#include "extract.h"

#include "oui.h"

-static void frf15_print(const u_char *, u_int);

+static void frf15_print(netdissect_options *ndo, const u_char *, u_int);

/*

* the frame relay header has a variable length

/*

* the frame relay header has a variable length

#define FR_SDLC_BIT 0x00000002

-struct tok fr_header_flag_values[] = {

+static const struct tok fr_header_flag_values[] = {

{ FR_CR_BIT, "C!" },

{ FR_DE_BIT, "DE" },

{ FR_BECN_BIT, "BECN" },

{ FR_CR_BIT, "C!" },

{ FR_DE_BIT, "DE" },

{ FR_BECN_BIT, "BECN" },

{ 0, NULL }

};

{ 0, NULL }

};

+/* FRF.15 / FRF.16 */

+#define MFR_B_BIT 0x80

+#define MFR_E_BIT 0x40

+#define MFR_C_BIT 0x20

+#define MFR_BEC_MASK (MFR_B_BIT | MFR_E_BIT | MFR_C_BIT)

+#define MFR_CTRL_FRAME (MFR_B_BIT | MFR_E_BIT | MFR_C_BIT)

+#define MFR_FRAG_FRAME (MFR_B_BIT | MFR_E_BIT )

+

+static const struct tok frf_flag_values[] = {

+ { MFR_B_BIT, "Begin" },

+ { MFR_E_BIT, "End" },

+ { MFR_C_BIT, "Control" },

+ { 0, NULL }

+};

/* Finds out Q.922 address length, DLCI and flags. Returns 0 on success

* save the flags dep. on address length

*/

/* Finds out Q.922 address length, DLCI and flags. Returns 0 on success

* save the flags dep. on address length

*/

-static int parse_q922_addr(const u_char *p, u_int *dlci, u_int *sdlcore,

- u_int *addr_len, u_int8_t *flags)

+static int parse_q922_addr(const u_char *p, u_int *dlci,

+ u_int *addr_len, uint8_t *flags)

{

if ((p[0] & FR_EA_BIT))

return -1;

{

if ((p[0] & FR_EA_BIT))

return -1;

flags[0] = p[0] & 0x02; /* populate the first flag fields */

flags[1] = p[1] & 0x0c;

flags[0] = p[0] & 0x02; /* populate the first flag fields */

flags[1] = p[1] & 0x0c;

+ flags[2] = 0; /* clear the rest of the flags */

+ flags[3] = 0;

if (p[1] & FR_EA_BIT)

return 0; /* 2-byte Q.922 address */

if (p[1] & FR_EA_BIT)

return 0; /* 2-byte Q.922 address */

flags[3] = p[0] & 0x02;

- if (p[0] & 0x02)

- *sdlcore = p[0] >> 2;

- else

- *dlci = (*dlci << 6) | (p[0] >> 2);

+ *dlci = (*dlci << 6) | (p[0] >> 2);

return 0;

}

return 0;

}

+char *q922_string(const u_char *p) {

+

+ static u_int dlci, addr_len;

+ static uint8_t flags[4];

+ static char buffer[sizeof("DLCI xxxxxxxxxx")];

+ memset(buffer, 0, sizeof(buffer));

+

+ if (parse_q922_addr(p, &dlci, &addr_len, flags) == 0){

+ snprintf(buffer, sizeof(buffer), "DLCI %u", dlci);

+ }

+

+ return buffer;

+}

+

/* Frame Relay packet structure, with flags and CRC removed

+---------------------------+

/* Frame Relay packet structure, with flags and CRC removed

+---------------------------+

{

if (!p[addr_len + 1] /* pad exist */)

return addr_len + 1 /* UI */ + 1 /* pad */ + 1 /* NLPID */;

{

if (!p[addr_len + 1] /* pad exist */)

return addr_len + 1 /* UI */ + 1 /* pad */ + 1 /* NLPID */;

- else

+ else

return addr_len + 1 /* UI */ + 1 /* NLPID */;

}

static void

return addr_len + 1 /* UI */ + 1 /* NLPID */;

}

static void

-fr_hdr_print(int length, u_int addr_len, u_int dlci, u_int8_t *flags, u_int16_t nlpid)

+fr_hdr_print(netdissect_options *ndo,

+ int length, u_int addr_len, u_int dlci, uint8_t *flags, uint16_t nlpid)

{

- if (qflag) {

- (void)printf("Q.922, DLCI %u, length %u: ",

+ if (ndo->ndo_qflag) {

+ ND_PRINT((ndo, "Q.922, DLCI %u, length %u: ",

dlci,

- length);

+ length));

} else {

if (nlpid <= 0xff) /* if its smaller than 256 then its a NLPID */

} else {

if (nlpid <= 0xff) /* if its smaller than 256 then its a NLPID */

- (void)printf("Q.922, hdr-len %u, DLCI %u, Flags [%s], NLPID %s (0x%02x), length %u: ",

+ ND_PRINT((ndo, "Q.922, hdr-len %u, DLCI %u, Flags [%s], NLPID %s (0x%02x), length %u: ",

addr_len,

dlci,

bittok2str(fr_header_flag_values, "none", EXTRACT_32BITS(flags)),

tok2str(nlpid_values,"unknown", nlpid),

nlpid,

addr_len,

dlci,

bittok2str(fr_header_flag_values, "none", EXTRACT_32BITS(flags)),

tok2str(nlpid_values,"unknown", nlpid),

nlpid,

- length);

+ length));

else /* must be an ethertype */

- (void)printf("Q.922, hdr-len %u, DLCI %u, Flags [%s], cisco-ethertype %s (0x%04x), length %u: ",

+ ND_PRINT((ndo, "Q.922, hdr-len %u, DLCI %u, Flags [%s], cisco-ethertype %s (0x%04x), length %u: ",

addr_len,

dlci,

bittok2str(fr_header_flag_values, "none", EXTRACT_32BITS(flags)),

tok2str(ethertype_values, "unknown", nlpid),

nlpid,

addr_len,

dlci,

bittok2str(fr_header_flag_values, "none", EXTRACT_32BITS(flags)),

tok2str(ethertype_values, "unknown", nlpid),

nlpid,

- length);

+ length));

}

u_int

}

u_int

-fr_if_print(const struct pcap_pkthdr *h, register const u_char *p)

+fr_if_print(netdissect_options *ndo,

+ const struct pcap_pkthdr *h, register const u_char *p)

{

register u_int length = h->len;

register u_int caplen = h->caplen;

{

register u_int length = h->len;

register u_int caplen = h->caplen;

- TCHECK2(*p, 4); /* minimum frame header length */

+ ND_TCHECK2(*p, 4); /* minimum frame header length */

- if ((length = fr_print(p, length)) == 0)

+ if ((length = fr_print(ndo, p, length)) == 0)

return (0);

else

return length;

trunc:

return (0);

else

return length;

trunc:

- printf("[|fr]");

+ ND_PRINT((ndo, "[|fr]"));

return caplen;

}

u_int

return caplen;

}

u_int

-fr_print(register const u_char *p, u_int length)

+fr_print(netdissect_options *ndo,

+ register const u_char *p, u_int length)

{

- u_int16_t extracted_ethertype;

+ uint16_t extracted_ethertype;

u_int dlci;

- u_int sdlcore;

u_int addr_len;

- u_int16_t nlpid;

+ uint16_t nlpid;

u_int hdr_len;

- u_int8_t flags[4];

+ uint8_t flags[4];

- if (parse_q922_addr(p, &dlci, &sdlcore, &addr_len, flags)) {

- printf("Q.922, invalid address");

+ if (parse_q922_addr(p, &dlci, &addr_len, flags)) {

+ ND_PRINT((ndo, "Q.922, invalid address"));

return 0;

}

return 0;

}

- TCHECK2(*p,addr_len+1+1);

+ ND_TCHECK2(*p, addr_len+1+1);

hdr_len = fr_hdrlen(p, addr_len);

- TCHECK2(*p,hdr_len);

+ ND_TCHECK2(*p, hdr_len);

if (p[addr_len] != 0x03 && dlci != 0) {

/* lets figure out if we have cisco style encapsulation: */

extracted_ethertype = EXTRACT_16BITS(p+addr_len);

if (p[addr_len] != 0x03 && dlci != 0) {

/* lets figure out if we have cisco style encapsulation: */

extracted_ethertype = EXTRACT_16BITS(p+addr_len);

- if (eflag)

- fr_hdr_print(length, addr_len, dlci, flags, extracted_ethertype);

+ if (ndo->ndo_eflag)

+ fr_hdr_print(ndo, length, addr_len, dlci, flags, extracted_ethertype);

- if (ether_encap_print(extracted_ethertype,

+ if (ethertype_print(ndo, extracted_ethertype,

p+addr_len+ETHERTYPE_LEN,

length-addr_len-ETHERTYPE_LEN,

p+addr_len+ETHERTYPE_LEN,

length-addr_len-ETHERTYPE_LEN,

- length-addr_len-ETHERTYPE_LEN,

- &extracted_ethertype) == 0)

+ length-addr_len-ETHERTYPE_LEN) == 0)

/* ether_type not known, probably it wasn't one */

- printf("UI %02x! ", p[addr_len]);

+ ND_PRINT((ndo, "UI %02x! ", p[addr_len]));

else

return hdr_len;

}

if (!p[addr_len + 1]) { /* pad byte should be used with 3-byte Q.922 */

if (addr_len != 3)

else

return hdr_len;

}

if (!p[addr_len + 1]) { /* pad byte should be used with 3-byte Q.922 */

if (addr_len != 3)

- printf("Pad! ");

+ ND_PRINT((ndo, "Pad! "));

} else if (addr_len == 3)

- printf("No pad! ");

+ ND_PRINT((ndo, "No pad! "));

nlpid = p[hdr_len - 1];

- if (eflag)

- fr_hdr_print(length, addr_len, dlci, flags, nlpid);

-

+ if (ndo->ndo_eflag)

+ fr_hdr_print(ndo, length, addr_len, dlci, flags, nlpid);

p += hdr_len;

length -= hdr_len;

switch (nlpid) {

case NLPID_IP:

p += hdr_len;

length -= hdr_len;

switch (nlpid) {

case NLPID_IP:

- ip_print(gndo, p, length);

+ ip_print(ndo, p, length);

break;

#ifdef INET6

case NLPID_IP6:

break;

#ifdef INET6

case NLPID_IP6:

- ip6_print(p, length);

+ ip6_print(ndo, p, length);

break;

#endif

case NLPID_CLNP:

case NLPID_ESIS:

case NLPID_ISIS:

break;

#endif

case NLPID_CLNP:

case NLPID_ESIS:

case NLPID_ISIS:

- isoclns_print(p-1, length+1, length+1); /* OSI printers need the NLPID field */

+ isoclns_print(ndo, p - 1, length + 1, length + 1); /* OSI printers need the NLPID field */

break;

case NLPID_SNAP:

break;

case NLPID_SNAP:

- if (snap_print(p, length, length, &extracted_ethertype, 0) == 0) {

+ if (snap_print(ndo, p, length, length, 0) == 0) {

/* ether_type not known, print raw packet */

- if (!eflag)

- fr_hdr_print(length + hdr_len, hdr_len,

+ if (!ndo->ndo_eflag)

+ fr_hdr_print(ndo, length + hdr_len, hdr_len,

dlci, flags, nlpid);

- if (!suppress_default_print)

- default_print(p - hdr_len, length + hdr_len);

+ if (!ndo->ndo_suppress_default_print)

+ ND_DEFAULTPRINT(p - hdr_len, length + hdr_len);

}

break;

case NLPID_Q933:

}

break;

case NLPID_Q933:

- q933_print(p, length);

+ q933_print(ndo, p, length);

break;

case NLPID_MFR:

break;

case NLPID_MFR:

- frf15_print(p, length);

+ frf15_print(ndo, p, length);

+ break;

+

+ case NLPID_PPP:

+ ppp_print(ndo, p, length);

break;

default:

break;

default:

- if (!eflag)

- fr_hdr_print(length + hdr_len, addr_len,

+ if (!ndo->ndo_eflag)

+ fr_hdr_print(ndo, length + hdr_len, addr_len,

dlci, flags, nlpid);

- if (!xflag)

- default_print(p, length);

+ if (!ndo->ndo_xflag)

+ ND_DEFAULTPRINT(p, length);

}

return hdr_len;

trunc:

}

return hdr_len;

trunc:

- printf("[|fr]");

+ ND_PRINT((ndo, "[|fr]"));

return 0;

}

return 0;

}

-#define MFR_B_BIT 0x80

-#define MFR_E_BIT 0x40

-#define MFR_C_BIT 0x20

-#define MFR_BEC_MASK (MFR_B_BIT | MFR_E_BIT | MFR_C_BIT)

-#define MFR_CTRL_FRAME (MFR_B_BIT | MFR_E_BIT | MFR_C_BIT)

-#define MFR_FRAG_FRAME (MFR_B_BIT | MFR_E_BIT )

+u_int

+mfr_if_print(netdissect_options *ndo,

+ const struct pcap_pkthdr *h, register const u_char *p)

+{

+ register u_int length = h->len;

+ register u_int caplen = h->caplen;

+

+ ND_TCHECK2(*p, 2); /* minimum frame header length */

+

+ if ((length = mfr_print(ndo, p, length)) == 0)

+ return (0);

+ else

+ return length;

+ trunc:

+ ND_PRINT((ndo, "[|mfr]"));

+ return caplen;

+}

+

#define MFR_CTRL_MSG_ADD_LINK 1

#define MFR_CTRL_MSG_ADD_LINK_ACK 2

#define MFR_CTRL_MSG_ADD_LINK 1

#define MFR_CTRL_MSG_ADD_LINK_ACK 2

#define MFR_CTRL_MSG_REMOVE_LINK 6

#define MFR_CTRL_MSG_REMOVE_LINK_ACK 7

#define MFR_CTRL_MSG_REMOVE_LINK 6

#define MFR_CTRL_MSG_REMOVE_LINK_ACK 7

-struct tok mfr_ctrl_msg_values[] = {

+static const struct tok mfr_ctrl_msg_values[] = {

{ MFR_CTRL_MSG_ADD_LINK, "Add Link" },

{ MFR_CTRL_MSG_ADD_LINK_ACK, "Add Link ACK" },

{ MFR_CTRL_MSG_ADD_LINK_REJ, "Add Link Reject" },

{ MFR_CTRL_MSG_ADD_LINK, "Add Link" },

{ MFR_CTRL_MSG_ADD_LINK_ACK, "Add Link ACK" },

{ MFR_CTRL_MSG_ADD_LINK_REJ, "Add Link Reject" },

#define MFR_CTRL_IE_VENDOR_EXT 6

#define MFR_CTRL_IE_CAUSE 7

#define MFR_CTRL_IE_VENDOR_EXT 6

#define MFR_CTRL_IE_CAUSE 7

-struct tok mfr_ctrl_ie_values[] = {

- { MFR_CTRL_IE_BUNDLE_ID, "Bundel ID"},

+static const struct tok mfr_ctrl_ie_values[] = {

+ { MFR_CTRL_IE_BUNDLE_ID, "Bundle ID"},

{ MFR_CTRL_IE_LINK_ID, "Link ID"},

{ MFR_CTRL_IE_MAGIC_NUM, "Magic Number"},

{ MFR_CTRL_IE_TIMESTAMP, "Timestamp"},

{ MFR_CTRL_IE_LINK_ID, "Link ID"},

{ MFR_CTRL_IE_MAGIC_NUM, "Magic Number"},

{ MFR_CTRL_IE_TIMESTAMP, "Timestamp"},

#define MFR_ID_STRING_MAXLEN 50

struct ie_tlv_header_t {

#define MFR_ID_STRING_MAXLEN 50

struct ie_tlv_header_t {

- u_int8_t ie_type;

- u_int8_t ie_len;

+ uint8_t ie_type;

+ uint8_t ie_len;

};

u_int

};

u_int

-mfr_print(register const u_char *p, u_int length)

+mfr_print(netdissect_options *ndo,

+ register const u_char *p, u_int length)

{

u_int tlen,idx,hdr_len = 0;

{

u_int tlen,idx,hdr_len = 0;

- u_int16_t sequence_num;

- u_int8_t ie_type,ie_len;

- const char *tptr;

+ uint16_t sequence_num;

+ uint8_t ie_type,ie_len;

+ const uint8_t *tptr;

/*

* FRF.16 Link Integrity Control Frame

/*

* FRF.16 Link Integrity Control Frame

- *

+ *

* 7 6 5 4 3 2 1 0

* +----+----+----+----+----+----+----+----+

* | B | E | C=1| 0 0 0 0 | EA |

* 7 6 5 4 3 2 1 0

* +----+----+----+----+----+----+----+----+

* | B | E | C=1| 0 0 0 0 | EA |

* +----+----+----+----+----+----+----+----+

*/

* +----+----+----+----+----+----+----+----+

*/

- TCHECK2(*p, 4); /* minimum frame header length */

+ ND_TCHECK2(*p, 4); /* minimum frame header length */

if ((p[0] & MFR_BEC_MASK) == MFR_CTRL_FRAME && p[1] == 0) {

- printf("FRF.16 Control, %s, length %u",

+ ND_PRINT((ndo, "FRF.16 Control, Flags [%s], %s, length %u",

+ bittok2str(frf_flag_values,"none",(p[0] & MFR_BEC_MASK)),

tok2str(mfr_ctrl_msg_values,"Unknown Message (0x%02x)",p[2]),

- length);

+ length));

tptr = p + 3;

tlen = length -3;

tptr = p + 3;

tlen = length -3;

+ hdr_len = 3;

+

+ if (!ndo->ndo_vflag)

+ return hdr_len;

+

while (tlen>sizeof(struct ie_tlv_header_t)) {

- TCHECK2(*tptr, sizeof(struct ie_tlv_header_t));

+ ND_TCHECK2(*tptr, sizeof(struct ie_tlv_header_t));

ie_type=tptr[0];

ie_len=tptr[1];

ie_type=tptr[0];

ie_len=tptr[1];

- printf("\n\tIE %s (%u), length %u: ",

+ ND_PRINT((ndo, "\n\tIE %s (%u), length %u: ",

tok2str(mfr_ctrl_ie_values,"Unknown",ie_type),

ie_type,

tok2str(mfr_ctrl_ie_values,"Unknown",ie_type),

ie_type,

- ie_len);

+ ie_len));

/* infinite loop check */

if (ie_type == 0 || ie_len <= sizeof(struct ie_tlv_header_t))

return hdr_len;

/* infinite loop check */

if (ie_type == 0 || ie_len <= sizeof(struct ie_tlv_header_t))

return hdr_len;

- TCHECK2(*tptr,ie_len);

+ ND_TCHECK2(*tptr, ie_len);

tptr+=sizeof(struct ie_tlv_header_t);

/* tlv len includes header */

ie_len-=sizeof(struct ie_tlv_header_t);

tptr+=sizeof(struct ie_tlv_header_t);

/* tlv len includes header */

ie_len-=sizeof(struct ie_tlv_header_t);

switch (ie_type) {

case MFR_CTRL_IE_MAGIC_NUM:

switch (ie_type) {

case MFR_CTRL_IE_MAGIC_NUM:

- printf("0x%08x",EXTRACT_32BITS(tptr));

- break;

-

- case MFR_CTRL_IE_TIMESTAMP:

- ts_print((const struct timeval *)tptr);

+ ND_PRINT((ndo, "0x%08x", EXTRACT_32BITS(tptr)));

break;

case MFR_CTRL_IE_BUNDLE_ID: /* same message format */

case MFR_CTRL_IE_LINK_ID:

break;

case MFR_CTRL_IE_BUNDLE_ID: /* same message format */

case MFR_CTRL_IE_LINK_ID:

- for (idx = 0; idx < ie_len && idx < MFR_ID_STRING_MAXLEN; idx++)

- safeputchar(*(tptr+idx));

+ for (idx = 0; idx < ie_len && idx < MFR_ID_STRING_MAXLEN; idx++) {

+ if (*(tptr+idx) != 0) /* don't print null termination */

+ safeputchar(ndo, *(tptr + idx));

+ else

+ break;

+ }

break;

+ case MFR_CTRL_IE_TIMESTAMP:

+ if (ie_len == sizeof(struct timeval)) {

+ ts_print(ndo, (const struct timeval *)tptr);

+ break;

+ }

+ /* fall through and hexdump if no unix timestamp */

+

/*

* FIXME those are the defined IEs that lack a decoder

* you are welcome to contribute code ;-)

/*

* FIXME those are the defined IEs that lack a decoder

* you are welcome to contribute code ;-)

case MFR_CTRL_IE_CAUSE:

default:

case MFR_CTRL_IE_CAUSE:

default:

- if (vflag >= 1)

- print_unknown_data(tptr,"\n\t ",ie_len);

+ if (ndo->ndo_vflag <= 1)

+ print_unknown_data(ndo, tptr, "\n\t ", ie_len);

break;

}

break;

}

+

+ /* do we want to see a hexdump of the IE ? */

+ if (ndo->ndo_vflag > 1 )

+ print_unknown_data(ndo, tptr, "\n\t ", ie_len);

+

tlen-=ie_len;

tptr+=ie_len;

}

tlen-=ie_len;

tptr+=ie_len;

}

/*

* FRF.16 Fragmentation Frame

}

/*

* FRF.16 Fragmentation Frame

- *

+ *

* 7 6 5 4 3 2 1 0

* +----+----+----+----+----+----+----+----+

* | B | E | C=0|seq. (high 4 bits) | EA |

* 7 6 5 4 3 2 1 0

* +----+----+----+----+----+----+----+----+

* | B | E | C=0|seq. (high 4 bits) | EA |

* +----+----+----+----+----+----+----+----+

*/

* +----+----+----+----+----+----+----+----+

*/

- if ((p[0] & MFR_BEC_MASK) == MFR_FRAG_FRAME) {

- sequence_num = (p[0]&0x1e)<<7 | p[1];

- if (eflag)

- printf("FRF.16 Frag, seq %u, ", sequence_num);

+ sequence_num = (p[0]&0x1e)<<7 | p[1];

+ /* whole packet or first fragment ? */

+ if ((p[0] & MFR_BEC_MASK) == MFR_FRAG_FRAME ||

+ (p[0] & MFR_BEC_MASK) == MFR_B_BIT) {

+ ND_PRINT((ndo, "FRF.16 Frag, seq %u, Flags [%s], ",

+ sequence_num,

+ bittok2str(frf_flag_values,"none",(p[0] & MFR_BEC_MASK))));

hdr_len = 2;

- fr_print(p+hdr_len,length-hdr_len);

+ fr_print(ndo, p+hdr_len,length-hdr_len);

+ return hdr_len;

}

+ /* must be a middle or the last fragment */

+ ND_PRINT((ndo, "FRF.16 Frag, seq %u, Flags [%s]",

+ sequence_num,

+ bittok2str(frf_flag_values,"none",(p[0] & MFR_BEC_MASK))));

+ print_unknown_data(ndo, p, "\n\t", length);

+

return hdr_len;

trunc:

return hdr_len;

trunc:

- printf("[|mfr]");

+ ND_PRINT((ndo, "[|mfr]"));

return length;

}

/* an NLPID of 0xb1 indicates a 2-byte

* FRF.15 header

return length;

}

/* an NLPID of 0xb1 indicates a 2-byte

* FRF.15 header

- *

+ *

* 7 6 5 4 3 2 1 0

* +----+----+----+----+----+----+----+----+

* ~ Q.922 header ~

* 7 6 5 4 3 2 1 0

* +----+----+----+----+----+----+----+----+

* ~ Q.922 header ~

* +----+----+----+----+----+----+----+----+

*/

* +----+----+----+----+----+----+----+----+

*/

-struct tok frf15_flag_values[] = {

- { 0x80, "Begin" },

- { 0x40, "End" },

- { 0x20, "Control" },

- { 0, NULL }

-};

-

#define FR_FRF15_FRAGTYPE 0x01

static void

#define FR_FRF15_FRAGTYPE 0x01

static void

-frf15_print (const u_char *p, u_int length) {

-

- u_int16_t sequence_num, flags;

+frf15_print(netdissect_options *ndo,

+ const u_char *p, u_int length) {

+

+ uint16_t sequence_num, flags;

- flags = p[0]&0xe0;

+ flags = p[0]&MFR_BEC_MASK;

sequence_num = (p[0]&0x1e)<<7 | p[1];

- printf("FRF.15, seq 0x%03x, Flags [%s],%s Fragmentation, length %u",

+ ND_PRINT((ndo, "FRF.15, seq 0x%03x, Flags [%s],%s Fragmentation, length %u",

sequence_num,

- bittok2str(frf15_flag_values,"none",flags),

- flags&FR_FRF15_FRAGTYPE ? "Interface" : "End-to-End",

- length);

+ bittok2str(frf_flag_values,"none",flags),

+ p[0]&FR_FRF15_FRAGTYPE ? "Interface" : "End-to-End",

+ length));

/* TODO:

* depending on all permutations of the B, E and C bit

/* TODO:

* depending on all permutations of the B, E and C bit

*/

/* Q.933 packet format

*/

/* Q.933 packet format

- Format of Other Protocols

+ Format of Other Protocols

using Q.933 NLPID

- +-------------------------------+

- | Q.922 Address |

+ +-------------------------------+

+ | Q.922 Address |

+ +---------------+---------------+

+ |Control 0x03 | NLPID 0x08 |

+---------------+---------------+

- |Control 0x03 | NLPID 0x08 |

- +---------------+---------------+

| L2 Protocol ID |

| octet 1 | octet 2 |

+-------------------------------+

| L2 Protocol ID |

| octet 1 | octet 2 |

+-------------------------------+

#define MSG_TYPE_STATUS 0x7D

#define MSG_TYPE_STATUS_ENQ 0x75

#define MSG_TYPE_STATUS 0x7D

#define MSG_TYPE_STATUS_ENQ 0x75

-struct tok fr_q933_msg_values[] = {

+static const struct tok fr_q933_msg_values[] = {

{ MSG_TYPE_ESC_TO_NATIONAL, "ESC to National" },

{ MSG_TYPE_ALERT, "Alert" },

{ MSG_TYPE_CALL_PROCEEDING, "Call proceeding" },

{ MSG_TYPE_ESC_TO_NATIONAL, "ESC to National" },

{ MSG_TYPE_ALERT, "Alert" },

{ MSG_TYPE_CALL_PROCEEDING, "Call proceeding" },

#define FR_LMI_CCITT_LINK_VERIFY_IE 0x53

#define FR_LMI_CCITT_PVC_STATUS_IE 0x57

#define FR_LMI_CCITT_LINK_VERIFY_IE 0x53

#define FR_LMI_CCITT_PVC_STATUS_IE 0x57

-struct tok fr_q933_ie_values_codeset5[] = {

+static const struct tok fr_q933_ie_values_codeset5[] = {

{ FR_LMI_ANSI_REPORT_TYPE_IE, "ANSI Report Type" },

{ FR_LMI_ANSI_LINK_VERIFY_IE_91, "ANSI Link Verify" },

{ FR_LMI_ANSI_LINK_VERIFY_IE, "ANSI Link Verify" },

{ FR_LMI_ANSI_REPORT_TYPE_IE, "ANSI Report Type" },

{ FR_LMI_ANSI_LINK_VERIFY_IE_91, "ANSI Link Verify" },

{ FR_LMI_ANSI_LINK_VERIFY_IE, "ANSI Link Verify" },

#define FR_LMI_REPORT_TYPE_IE_LINK_VERIFY 1

#define FR_LMI_REPORT_TYPE_IE_ASYNC_PVC 2

#define FR_LMI_REPORT_TYPE_IE_LINK_VERIFY 1

#define FR_LMI_REPORT_TYPE_IE_ASYNC_PVC 2

-struct tok fr_lmi_report_type_ie_values[] = {

+static const struct tok fr_lmi_report_type_ie_values[] = {

{ FR_LMI_REPORT_TYPE_IE_FULL_STATUS, "Full Status" },

{ FR_LMI_REPORT_TYPE_IE_LINK_VERIFY, "Link verify" },

{ FR_LMI_REPORT_TYPE_IE_ASYNC_PVC, "Async PVC Status" },

{ 0, NULL }

};

{ FR_LMI_REPORT_TYPE_IE_FULL_STATUS, "Full Status" },

{ FR_LMI_REPORT_TYPE_IE_LINK_VERIFY, "Link verify" },

{ FR_LMI_REPORT_TYPE_IE_ASYNC_PVC, "Async PVC Status" },

{ 0, NULL }

};

-/* array of 16 codepages - currently we only support codepage 5 */

-static struct tok *fr_q933_ie_codesets[] = {

- NULL,

+/* array of 16 codepages - currently we only support codepage 1,5 */

+static const struct tok *fr_q933_ie_codesets[] = {

NULL,

+ fr_q933_ie_values_codeset5,

NULL,

NULL

};

NULL

};

+static int fr_q933_print_ie_codeset5(netdissect_options *ndo,

+ const struct ie_tlv_header_t *ie_p, const u_char *p);

-struct common_ie_header {

- u_int8_t ie_id;

- u_int8_t ie_len;

-};

-

-static int fr_q933_print_ie_codeset5(const struct common_ie_header *ie_p,

- const u_char *p);

-

-typedef int (*codeset_pr_func_t)(const struct common_ie_header *ie_p,

- const u_char *p);

+typedef int (*codeset_pr_func_t)(netdissect_options *,

+ const struct ie_tlv_header_t *ie_p, const u_char *p);

-/* array of 16 codepages - currently we only support codepage 5 */

-static codeset_pr_func_t fr_q933_print_ie_codeset[] = {

- NULL,

+/* array of 16 codepages - currently we only support codepage 1,5 */

+static const codeset_pr_func_t fr_q933_print_ie_codeset[] = {

NULL,

+ fr_q933_print_ie_codeset5,

NULL,

};

void

};

void

-q933_print(const u_char *p, u_int length)

+q933_print(netdissect_options *ndo,

+ const u_char *p, u_int length)

{

const u_char *ptemp = p;

{

const u_char *ptemp = p;

- struct common_ie_header *ie_p;

+ struct ie_tlv_header_t *ie_p;

int olen;

int is_ansi = 0;

u_int codeset;

u_int ie_is_known = 0;

if (length < 9) { /* shortest: Q.933a LINK VERIFY */

int olen;

int is_ansi = 0;

u_int codeset;

u_int ie_is_known = 0;

if (length < 9) { /* shortest: Q.933a LINK VERIFY */

- printf("[|q.933]");

+ ND_PRINT((ndo, "[|q.933]"));

return;

}

codeset = p[2]&0x0f; /* extract the codeset */

return;

}

codeset = p[2]&0x0f; /* extract the codeset */

- if (p[2] == MSG_ANSI_LOCKING_SHIFT)

- is_ansi = 1;

-

- printf("%s", eflag ? "" : "Q.933, ");

+ if (p[2] == MSG_ANSI_LOCKING_SHIFT) {

+ is_ansi = 1;

+ }

- /* printing out header part */

- printf(is_ansi ? "ANSI" : "CCITT");

+ ND_PRINT((ndo, "%s", ndo->ndo_eflag ? "" : "Q.933, "));

- if (p[0])

- printf(", Call Ref: 0x%02x", p[0]);

+ /* printing out header part */

+ ND_PRINT((ndo, "%s, codeset %u", is_ansi ? "ANSI" : "CCITT", codeset));

- if (vflag)

- printf(", %s (0x%02x), length %u",

- tok2str(fr_q933_msg_values,"unknown message",p[1]),

- p[1],

- length);

- else

- printf(", %s",

- tok2str(fr_q933_msg_values,"unknown message 0x%02x",p[1]));

+ if (p[0]) {

+ ND_PRINT((ndo, ", Call Ref: 0x%02x", p[0]));

+ }

+ if (ndo->ndo_vflag) {

+ ND_PRINT((ndo, ", %s (0x%02x), length %u",

+ tok2str(fr_q933_msg_values,

+ "unknown message", p[1]),

+ p[1],

+ length));

+ } else {

+ ND_PRINT((ndo, ", %s",

+ tok2str(fr_q933_msg_values,

+ "unknown message 0x%02x", p[1])));

+ }

olen = length; /* preserve the original length for non verbose mode */

if (length < (u_int)(2 - is_ansi)) {

olen = length; /* preserve the original length for non verbose mode */

if (length < (u_int)(2 - is_ansi)) {

- printf("[|q.933]");

+ ND_PRINT((ndo, "[|q.933]"));

return;

}

return;

}

- length -= 2 - is_ansi;

+ length -= 2 + is_ansi;

ptemp += 2 + is_ansi;

-

+

/* Loop through the rest of IE */

- while (length > sizeof(struct common_ie_header)) {

- ie_p = (struct common_ie_header *)ptemp;

- if (length < sizeof(struct common_ie_header) ||

- length < sizeof(struct common_ie_header) + ie_p->ie_len) {

- if (vflag) /* not bark if there is just a trailer */

- printf("\n[|q.933]");

- else

- printf(", length %u",olen);

+ while (length > sizeof(struct ie_tlv_header_t)) {

+ ie_p = (struct ie_tlv_header_t *)ptemp;

+ if (length < sizeof(struct ie_tlv_header_t) ||

+ length < sizeof(struct ie_tlv_header_t) + ie_p->ie_len) {

+ if (ndo->ndo_vflag) { /* not bark if there is just a trailer */

+ ND_PRINT((ndo, "\n[|q.933]"));

+ } else {

+ ND_PRINT((ndo, ", length %u", olen));

+ }

return;

}

/* lets do the full IE parsing only in verbose mode

* however some IEs (DLCI Status, Link Verify)

return;

}

/* lets do the full IE parsing only in verbose mode

* however some IEs (DLCI Status, Link Verify)

- * are also intereststing in non-verbose mode */

- if (vflag)

- printf("\n\t%s IE (%u), length %u: ",

- tok2str(fr_q933_ie_codesets[codeset],"unknown",ie_p->ie_id),

- ie_p->ie_id,

- ie_p->ie_len);

-

- if (fr_q933_print_ie_codeset[codeset] != NULL)

- ie_is_known = fr_q933_print_ie_codeset[codeset](ie_p, ptemp);

-

- if (vflag >= 1 && !ie_is_known)

- print_unknown_data(ptemp+2,"\n\t",ie_p->ie_len);

+ * are also interestting in non-verbose mode */

+ if (ndo->ndo_vflag) {

+ ND_PRINT((ndo, "\n\t%s IE (0x%02x), length %u: ",

+ tok2str(fr_q933_ie_codesets[codeset],

+ "unknown", ie_p->ie_type),

+ ie_p->ie_type,

+ ie_p->ie_len));

+ }

+

+ /* sanity check */

+ if (ie_p->ie_type == 0 || ie_p->ie_len == 0) {

+ return;

+ }

+

+ if (fr_q933_print_ie_codeset[codeset] != NULL) {

+ ie_is_known = fr_q933_print_ie_codeset[codeset](ndo, ie_p, ptemp);

+ }

+

+ if (ndo->ndo_vflag >= 1 && !ie_is_known) {

+ print_unknown_data(ndo, ptemp+2, "\n\t", ie_p->ie_len);

+ }

/* do we want to see a hexdump of the IE ? */

- if (vflag> 1 && ie_is_known)

- print_unknown_data(ptemp+2,"\n\t ",ie_p->ie_len);

+ if (ndo->ndo_vflag> 1 && ie_is_known) {

+ print_unknown_data(ndo, ptemp+2, "\n\t ", ie_p->ie_len);

+ }

length = length - ie_p->ie_len - 2;

ptemp = ptemp + ie_p->ie_len + 2;

}

length = length - ie_p->ie_len - 2;

ptemp = ptemp + ie_p->ie_len + 2;

}

- if (!vflag)

- printf(", length %u",olen);

+ if (!ndo->ndo_vflag) {

+ ND_PRINT((ndo, ", length %u", olen));

+ }

}

static int

}

static int

-fr_q933_print_ie_codeset5(const struct common_ie_header *ie_p, const u_char *p)

+fr_q933_print_ie_codeset5(netdissect_options *ndo,

+ const struct ie_tlv_header_t *ie_p, const u_char *p)

{

u_int dlci;

{

u_int dlci;

- switch (ie_p->ie_id) {

+ switch (ie_p->ie_type) {

case FR_LMI_ANSI_REPORT_TYPE_IE: /* fall through */

case FR_LMI_CCITT_REPORT_TYPE_IE:

case FR_LMI_ANSI_REPORT_TYPE_IE: /* fall through */

case FR_LMI_CCITT_REPORT_TYPE_IE:

- if (vflag)

- printf("%s (%u)",

+ if (ndo->ndo_vflag) {

+ ND_PRINT((ndo, "%s (%u)",

tok2str(fr_lmi_report_type_ie_values,"unknown",p[2]),

- p[2]);

+ p[2]));

+ }

return 1;

case FR_LMI_ANSI_LINK_VERIFY_IE: /* fall through */

case FR_LMI_CCITT_LINK_VERIFY_IE:

case FR_LMI_ANSI_LINK_VERIFY_IE_91:

return 1;

case FR_LMI_ANSI_LINK_VERIFY_IE: /* fall through */

case FR_LMI_CCITT_LINK_VERIFY_IE:

case FR_LMI_ANSI_LINK_VERIFY_IE_91:

- if (!vflag)

- printf(", ");

- printf("TX Seq: %3d, RX Seq: %3d", p[2], p[3]);

+ if (!ndo->ndo_vflag) {

+ ND_PRINT((ndo, ", "));

+ }

+ ND_PRINT((ndo, "TX Seq: %3d, RX Seq: %3d", p[2], p[3]));

return 1;

case FR_LMI_ANSI_PVC_STATUS_IE: /* fall through */

case FR_LMI_CCITT_PVC_STATUS_IE:

return 1;

case FR_LMI_ANSI_PVC_STATUS_IE: /* fall through */

case FR_LMI_CCITT_PVC_STATUS_IE:

- if (!vflag)

- printf(", ");

- /* now parse the DLCI information element. */

+ if (!ndo->ndo_vflag) {

+ ND_PRINT((ndo, ", "));

+ }

+ /* now parse the DLCI information element. */

if ((ie_p->ie_len < 3) ||

(p[2] & 0x80) ||

((ie_p->ie_len == 3) && !(p[3] & 0x80)) ||

if ((ie_p->ie_len < 3) ||

(p[2] & 0x80) ||

((ie_p->ie_len == 3) && !(p[3] & 0x80)) ||

((ie_p->ie_len == 5) && ((p[3] & 0x80) || (p[4] & 0x80) ||

!(p[5] & 0x80))) ||

(ie_p->ie_len > 5) ||

((ie_p->ie_len == 5) && ((p[3] & 0x80) || (p[4] & 0x80) ||

!(p[5] & 0x80))) ||

(ie_p->ie_len > 5) ||

- !(p[ie_p->ie_len + 1] & 0x80))

- printf("Invalid DLCI IE");

-

+ !(p[ie_p->ie_len + 1] & 0x80)) {

+ ND_PRINT((ndo, "Invalid DLCI IE"));

+ }

+

dlci = ((p[2] & 0x3F) << 4) | ((p[3] & 0x78) >> 3);

- if (ie_p->ie_len == 4)

+ if (ie_p->ie_len == 4) {

dlci = (dlci << 6) | ((p[4] & 0x7E) >> 1);

- else if (ie_p->ie_len == 5)

+ }

+ else if (ie_p->ie_len == 5) {

dlci = (dlci << 13) | (p[4] & 0x7F) | ((p[5] & 0x7E) >> 1);

+ }

- printf("DLCI %u: status %s%s", dlci,

+ ND_PRINT((ndo, "DLCI %u: status %s%s", dlci,

p[ie_p->ie_len + 1] & 0x8 ? "New, " : "",

- p[ie_p->ie_len + 1] & 0x2 ? "Active" : "Inactive");

+ p[ie_p->ie_len + 1] & 0x2 ? "Active" : "Inactive"));

return 1;

}

return 0;

}

return 1;

}

return 0;

}

+/*

+ * Local Variables:

+ * c-style: whitesmith

+ * c-basic-offset: 8

+ * End:

+ */