X-Git-Url: https://git.tcpdump.org/tcpdump/blobdiff_plain/b38f324af9dd953a661b9f35910f8c6d8eb2cc06..refs/heads/master:/print-forces.c diff --git a/print-forces.c b/print-forces.c index f98bd061..197d6c65 100644 --- a/print-forces.c +++ b/print-forces.c @@ -18,16 +18,14 @@ /* specification: RFC 5810 */ -#ifdef HAVE_CONFIG_H -#include "config.h" -#endif +#include -#include +#include "netdissect-stdinc.h" +#define ND_LONGJMP_FROM_TCHECK #include "netdissect.h" #include "extract.h" -static const char tstr[] = "[|forces]"; #define ForCES_VERS 1 #define ForCES_HDRL 24 @@ -35,17 +33,17 @@ static const char tstr[] = "[|forces]"; #define TLV_HDRL 4 #define ILV_HDRL 8 -#define TOM_RSVD 0x0 -#define TOM_ASSNSETUP 0x1 -#define TOM_ASSNTEARD 0x2 -#define TOM_CONFIG 0x3 -#define TOM_QUERY 0x4 -#define TOM_EVENTNOT 0x5 -#define TOM_PKTREDIR 0x6 -#define TOM_HEARTBT 0x0F -#define TOM_ASSNSETREP 0x11 -#define TOM_CONFIGREP 0x13 -#define TOM_QUERYREP 0x14 +#define TOM_RSVD 0x0 +#define TOM_ASSNSETUP 0x1 +#define TOM_ASSNTEARD 0x2 +#define TOM_CONFIG 0x3 +#define TOM_QUERY 0x4 +#define TOM_EVENTNOT 0x5 +#define TOM_PKTREDIR 0x6 +#define TOM_HEARTBT 0x0F +#define TOM_ASSNSETREP 0x11 +#define TOM_CONFIGREP 0x13 +#define TOM_QUERYREP 0x14 /* * tom_h Flags: resv1(8b):maxtlvs(4b):resv2(2b):mintlv(2b) @@ -66,7 +64,7 @@ struct tom_h { uint16_t flags; uint16_t op_msk; const char *s; - int (*print) (netdissect_options *ndo, register const u_char * pptr, register u_int len, + int (*print) (netdissect_options *ndo, const u_char * pptr, u_int len, uint16_t op_msk, int indent); }; @@ -86,7 +84,8 @@ enum { }; #define TOM_MAX_IND (_TOM_RSV_MAX - 1) -static inline int tom_valid(uint8_t tom) +static int +tom_valid(uint8_t tom) { if (tom > 0) { if (tom >= 0x7 && tom <= 0xe) @@ -100,7 +99,8 @@ static inline int tom_valid(uint8_t tom) return 0; } -static inline const char *ForCES_node(uint32_t node) +static const char * +ForCES_node(uint32_t node) { if (node <= 0x3FFFFFFF) return "FE"; @@ -153,24 +153,24 @@ static const struct tok ForCES_TPs[] = { * Structure of forces header, naked of TLVs. */ struct forcesh { - uint8_t fm_vrsvd; /* version and reserved */ -#define ForCES_V(forcesh) ((forcesh)->fm_vrsvd >> 4) - uint8_t fm_tom; /* type of message */ - uint16_t fm_len; /* total length * 4 bytes */ -#define ForCES_BLN(forcesh) ((uint32_t)(EXTRACT_16BITS(&(forcesh)->fm_len) << 2)) - uint32_t fm_sid; /* Source ID */ -#define ForCES_SID(forcesh) EXTRACT_32BITS(&(forcesh)->fm_sid) - uint32_t fm_did; /* Destination ID */ -#define ForCES_DID(forcesh) EXTRACT_32BITS(&(forcesh)->fm_did) - uint8_t fm_cor[8]; /* correlator */ - uint32_t fm_flags; /* flags */ -#define ForCES_ACK(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0xC0000000) >> 30) -#define ForCES_PRI(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0x38000000) >> 27) -#define ForCES_RS1(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0x07000000) >> 24) -#define ForCES_EM(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0x00C00000) >> 22) -#define ForCES_AT(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0x00200000) >> 21) -#define ForCES_TP(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0x00180000) >> 19) -#define ForCES_RS2(forcesh) ((EXTRACT_32BITS(&(forcesh)->fm_flags)&0x0007FFFF) >> 0) + nd_uint8_t fm_vrsvd; /* version and reserved */ +#define ForCES_V(forcesh) (GET_U_1((forcesh)->fm_vrsvd) >> 4) + nd_uint8_t fm_tom; /* type of message */ + nd_uint16_t fm_len; /* total length * 4 bytes */ +#define ForCES_BLN(forcesh) ((uint32_t)(GET_BE_U_2((forcesh)->fm_len) << 2)) + nd_uint32_t fm_sid; /* Source ID */ +#define ForCES_SID(forcesh) GET_BE_U_4((forcesh)->fm_sid) + nd_uint32_t fm_did; /* Destination ID */ +#define ForCES_DID(forcesh) GET_BE_U_4((forcesh)->fm_did) + nd_uint8_t fm_cor[8]; /* correlator */ + nd_uint32_t fm_flags; /* flags */ +#define ForCES_ACK(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0xC0000000) >> 30) +#define ForCES_PRI(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0x38000000) >> 27) +#define ForCES_RS1(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0x07000000) >> 24) +#define ForCES_EM(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0x00C00000) >> 22) +#define ForCES_AT(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0x00200000) >> 21) +#define ForCES_TP(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0x00180000) >> 19) +#define ForCES_RS2(forcesh) ((GET_BE_U_4((forcesh)->fm_flags)&0x0007FFFF) >> 0) }; #define ForCES_HLN_VALID(fhl,tlen) ((tlen) >= ForCES_HDRL && \ @@ -188,7 +188,7 @@ static const struct tok ForCES_LFBs[] = { }; /* this is defined in RFC5810 section A.2 */ -/* http://www.iana.org/assignments/forces/forces.xhtml#oper-tlv-types */ +/* https://www.iana.org/assignments/forces/forces.xhtml#oper-tlv-types */ enum { F_OP_RSV = 0, F_OP_SET = 1, @@ -230,25 +230,25 @@ struct optlv_h { uint16_t flags; uint16_t op_msk; const char *s; - int (*print) (netdissect_options *ndo, register const u_char * pptr, register u_int len, + int (*print) (netdissect_options *ndo, const u_char * pptr, u_int len, uint16_t op_msk, int indent); }; -static int genoptlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int genoptlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int recpdoptlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int recpdoptlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int invoptlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int invoptlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); #define OP_MIN_SIZ 8 struct pathdata_h { - uint16_t pflags; - uint16_t pIDcnt; + nd_uint16_t pflags; + nd_uint16_t pIDcnt; }; #define B_FULLD 0x1 -#define B_SPARD 0x2 +#define B_SPARD 0x2 #define B_RESTV 0x4 #define B_KEYIN 0x8 #define B_APPND 0x10 @@ -276,9 +276,10 @@ static const struct optlv_h OPTLV_msg[F_OP_MAX + 1] = { /* F_OP_RTRCOMP */ {ZERO_TTLV, 0, " RTRCOMP", NULL}, }; -static inline const struct optlv_h *get_forces_optlv_h(uint16_t opt) +static const struct optlv_h * +get_forces_optlv_h(uint16_t opt) { - if (opt > F_OP_MAX || opt <= F_OP_RSV) + if (opt > F_OP_MAX || opt == F_OP_RSV) return &OPTLV_msg[F_OP_RSV]; return &OPTLV_msg[opt]; @@ -288,9 +289,10 @@ static inline const struct optlv_h *get_forces_optlv_h(uint16_t opt) #define IND_CHR ' ' #define IND_PREF '\n' #define IND_SUF 0x0 -char ind_buf[IND_SIZE]; +static char ind_buf[IND_SIZE]; -static inline char *indent_pr(int indent, int nlpref) +static char * +indent_pr(int indent, int nlpref) { int i = 0; char *r = ind_buf; @@ -311,14 +313,13 @@ static inline char *indent_pr(int indent, int nlpref) return r; } -static inline int op_valid(uint16_t op, uint16_t mask) +static int +op_valid(uint16_t op, uint16_t mask) { - int opb = 1 << (op - 1); - if (op == 0) return 0; - if (opb & mask) - return 1; + if (op <= F_OP_MAX) + return (1 << (op - 1)) & mask; /* works only for 0x0001 through 0x0010 */ /* I guess we should allow vendor operations? */ if (op >= 0x8000) return 1; @@ -359,7 +360,8 @@ static const struct tok ForCES_TLV[] = { }; #define TLV_HLN 4 -static inline int ttlv_valid(uint16_t ttlv) +static int +ttlv_valid(uint16_t ttlv) { if (ttlv > 0) { if (ttlv == 1 || ttlv == 0x1000) @@ -376,31 +378,27 @@ static inline int ttlv_valid(uint16_t ttlv) } struct forces_ilv { - uint32_t type; - uint32_t length; + nd_uint32_t type; + nd_uint32_t length; }; struct forces_tlv { - uint16_t type; - uint16_t length; + nd_uint16_t type; + nd_uint16_t length; }; -#define F_ALN_LEN(len) ( ((len)+ForCES_ALNL-1) & ~(ForCES_ALNL-1) ) +#define F_ALN_LEN(len) roundup2(len, ForCES_ALNL) #define GET_TOP_TLV(fhdr) ((const struct forces_tlv *)((fhdr) + sizeof (struct forcesh))) #define TLV_SET_LEN(len) (F_ALN_LEN(TLV_HDRL) + (len)) -#define TLV_ALN_LEN(len) F_ALN_LEN(TLV_SET_LEN(len)) -#define TLV_RDAT_LEN(tlv) ((int)(EXTRACT_16BITS(&(tlv)->length) - TLV_SET_LEN(0)) #define TLV_DATA(tlvp) ((const void*)(((const char*)(tlvp)) + TLV_SET_LEN(0))) -#define GO_NXT_TLV(tlv,rlen) ((rlen) -= F_ALN_LEN(EXTRACT_16BITS(&(tlv)->length)), \ +#define GO_NXT_TLV(tlv,rlen) ((rlen) -= F_ALN_LEN(GET_BE_U_2((tlv)->length)), \ (const struct forces_tlv*)(((const char*)(tlv)) \ - + F_ALN_LEN(EXTRACT_16BITS(&(tlv)->length)))) + + F_ALN_LEN(GET_BE_U_2((tlv)->length)))) #define ILV_SET_LEN(len) (F_ALN_LEN(ILV_HDRL) + (len)) -#define ILV_ALN_LEN(len) F_ALN_LEN(ILV_SET_LEN(len)) -#define ILV_RDAT_LEN(ilv) ((int)(EXTRACT_32BITS(&(ilv)->length)) - ILV_SET_LEN(0)) #define ILV_DATA(ilvp) ((const void*)(((const char*)(ilvp)) + ILV_SET_LEN(0))) -#define GO_NXT_ILV(ilv,rlen) ((rlen) -= F_ALN_LEN(EXTRACT_32BITS(&(ilv)->length)), \ +#define GO_NXT_ILV(ilv,rlen) ((rlen) -= F_ALN_LEN(GET_BE_U_4((ilv)->length)), \ (const struct forces_ilv *)(((const char*)(ilv)) \ - + F_ALN_LEN(EXTRACT_32BITS(&(ilv)->length)))) + + F_ALN_LEN(GET_BE_U_4((ilv)->length)))) #define INVALID_RLEN 1 #define INVALID_STLN 2 #define INVALID_LTLN 3 @@ -414,46 +412,48 @@ static const struct tok ForCES_TLV_err[] = { {0, NULL} }; -static inline u_int tlv_valid(const struct forces_tlv *tlv, u_int rlen) +static u_int +tlv_valid(u_int tlvl, u_int rlen) { if (rlen < TLV_HDRL) return INVALID_RLEN; - if (EXTRACT_16BITS(&tlv->length) < TLV_HDRL) + if (tlvl < TLV_HDRL) return INVALID_STLN; - if (EXTRACT_16BITS(&tlv->length) > rlen) + if (tlvl > rlen) return INVALID_LTLN; - if (rlen < F_ALN_LEN(EXTRACT_16BITS(&tlv->length))) + if (rlen < F_ALN_LEN(tlvl)) return INVALID_ALEN; return 0; } -static inline int ilv_valid(const struct forces_ilv *ilv, u_int rlen) +static int +ilv_valid(netdissect_options *ndo, const struct forces_ilv *ilv, u_int rlen) { if (rlen < ILV_HDRL) return INVALID_RLEN; - if (EXTRACT_32BITS(&ilv->length) < ILV_HDRL) + if (GET_BE_U_4(ilv->length) < ILV_HDRL) return INVALID_STLN; - if (EXTRACT_32BITS(&ilv->length) > rlen) + if (GET_BE_U_4(ilv->length) > rlen) return INVALID_LTLN; - if (rlen < F_ALN_LEN(EXTRACT_32BITS(&ilv->length))) + if (rlen < F_ALN_LEN(GET_BE_U_4(ilv->length))) return INVALID_ALEN; return 0; } -static int lfbselect_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int lfbselect_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int redirect_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int redirect_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int asrtlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int asrtlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int asttlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int asttlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); struct forces_lfbsh { - uint32_t class; - uint32_t instance; + nd_uint32_t class; + nd_uint32_t instance; }; #define ASSNS_OPS (B_OP_REPORT) @@ -484,7 +484,8 @@ static const struct tom_h ForCES_msg[TOM_MAX_IND + 1] = { {TOM_QUERYREP, TTLV_T2, CFG_QYR, "Query Response", lfbselect_print}, }; -static inline const struct tom_h *get_forces_tom(uint8_t tom) +static const struct tom_h * +get_forces_tom(uint8_t tom) { int i; for (i = TOM_RSV_I; i <= TOM_MAX_IND; i++) { @@ -500,7 +501,7 @@ struct pdata_ops { uint16_t flags; uint16_t op_msk; const char *s; - int (*print) (netdissect_options *, register const u_char * pptr, register u_int len, + int (*print) (netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); }; @@ -515,26 +516,27 @@ enum { }; #define PD_MAX_IND (_TOM_RSV_MAX - 1) -static inline int pd_valid(uint16_t pd) +static int +pd_valid(uint16_t pd) { if (pd >= F_TLV_PDAT && pd <= F_TLV_REST) return 1; return 0; } -static inline void +static void chk_op_type(netdissect_options *ndo, uint16_t type, uint16_t msk, uint16_t omsk) { if (type != F_TLV_PDAT) { if (msk & B_KEYIN) { if (type != F_TLV_KEYI) { - ND_PRINT((ndo, "Based on flags expected KEYINFO TLV!\n")); + ND_PRINT("Based on flags expected KEYINFO TLV!\n"); } } else { if (!(msk & omsk)) { - ND_PRINT((ndo, "Illegal DATA encoding for type 0x%x programmed %x got %x \n", - type, omsk, msk)); + ND_PRINT("Illegal DATA encoding for type 0x%x programmed %x got %x\n", + type, omsk, msk); } } } @@ -546,18 +548,18 @@ chk_op_type(netdissect_options *ndo, #define F_TABAPPEND 4 struct res_val { - uint8_t result; - uint8_t resv1; - uint16_t resv2; + nd_uint8_t result; + nd_uint8_t resv1; + nd_uint16_t resv2; }; -static int prestlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int prestlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int pkeyitlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int pkeyitlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int fdatatlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int fdatatlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); -static int sdatatlv_print(netdissect_options *, register const u_char * pptr, register u_int len, +static int sdatatlv_print(netdissect_options *, const u_char * pptr, u_int len, uint16_t op_msk, int indent); static const struct pdata_ops ForCES_pdata[PD_MAX_IND + 1] = { @@ -570,7 +572,8 @@ static const struct pdata_ops ForCES_pdata[PD_MAX_IND + 1] = { {F_TLV_PDAT, 0, 0, "Inner PATH-DATA TLV", recpdoptlv_print}, }; -static inline const struct pdata_ops *get_forces_pd(uint16_t pd) +static const struct pdata_ops * +get_forces_pd(uint16_t pd) { int i; for (i = PD_RSV_I + 1; i <= PD_MAX_IND; i++) { @@ -639,17 +642,27 @@ static const struct tok ForCES_errs[] = { {0, NULL} }; +static const struct tok tdr_str[] = { + { 0, "Normal Teardown" }, + { 1, "Loss of Heartbeats" }, + { 2, "Out of bandwidth" }, + { 3, "Out of Memory" }, + { 4, "Application Crash" }, + { 0, NULL } +}; + #define RESLEN 4 static int prestlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { const struct forces_tlv *tlv = (const struct forces_tlv *)pptr; - register const u_char *tdp = (const u_char *) TLV_DATA(tlv); + const u_char *tdp = TLV_DATA(tlv); const struct res_val *r = (const struct res_val *)tdp; u_int dlen; + uint8_t result; /* * pdatacnt_print() has ensured that len (the TLV length) @@ -657,36 +670,36 @@ prestlv_print(netdissect_options *ndo, */ dlen = len - TLV_HDRL; if (dlen != RESLEN) { - ND_PRINT((ndo, "illegal RESULT-TLV: %d bytes!\n", dlen)); - return -1; + ND_PRINT("illegal RESULT-TLV: %u bytes!\n", dlen); + goto invalid; } - ND_TCHECK(*r); - if (r->result >= 0x18 && r->result <= 0xFE) { - ND_PRINT((ndo, "illegal reserved result code: 0x%x!\n", r->result)); - return -1; + ND_TCHECK_SIZE(r); + result = GET_U_1(r->result); + if (result >= 0x18 && result <= 0xFE) { + ND_PRINT("illegal reserved result code: 0x%x!\n", result); + goto invalid; } if (ndo->ndo_vflag >= 3) { char *ib = indent_pr(indent, 0); - ND_PRINT((ndo, "%s Result: %s (code 0x%x)\n", ib, - tok2str(ForCES_errs, NULL, r->result), r->result)); + ND_PRINT("%s Result: %s (code 0x%x)\n", ib, + tok2str(ForCES_errs, NULL, result), result); } return 0; -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int fdatatlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { const struct forces_tlv *tlv = (const struct forces_tlv *)pptr; u_int rlen; - register const u_char *tdp = (const u_char *) TLV_DATA(tlv); + const u_char *tdp = TLV_DATA(tlv); uint16_t type; /* @@ -694,29 +707,28 @@ fdatatlv_print(netdissect_options *ndo, * (the TLV length) >= TLV_HDRL. */ rlen = len - TLV_HDRL; - ND_TCHECK(*tlv); - type = EXTRACT_16BITS(&tlv->type); + ND_TCHECK_SIZE(tlv); + type = GET_BE_U_2(tlv->type); if (type != F_TLV_FULD) { - ND_PRINT((ndo, "Error: expecting FULLDATA!\n")); - return -1; + ND_PRINT("Error: expecting FULLDATA!\n"); + goto invalid; } if (ndo->ndo_vflag >= 3) { char *ib = indent_pr(indent + 2, 1); - ND_PRINT((ndo, "%s[", &ib[1])); - hex_print_with_offset(ndo, ib, tdp, rlen, 0); - ND_PRINT((ndo, "\n%s]\n", &ib[1])); + ND_PRINT("%s[", ib + 1); + hex_print(ndo, ib, tdp, rlen); + ND_PRINT("\n%s]", ib + 1); } return 0; -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int sdatailv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { u_int rlen; @@ -724,50 +736,43 @@ sdatailv_print(netdissect_options *ndo, int invilv; if (len < ILV_HDRL) { - ND_PRINT((ndo, "Error: BAD SPARSEDATA-TLV!\n")); - return -1; + ND_PRINT("Error: BAD SPARSEDATA-TLV!\n"); + goto invalid; } rlen = len; indent += 1; while (rlen != 0) { -#if 0 - ND_PRINT((ndo, "Jamal - outstanding length <%d>\n", rlen)); -#endif char *ib = indent_pr(indent, 1); - register const u_char *tdp = (const u_char *) ILV_DATA(ilv); - ND_TCHECK(*ilv); - invilv = ilv_valid(ilv, rlen); + const u_char *tdp = ILV_DATA(ilv); + invilv = ilv_valid(ndo, ilv, rlen); if (invilv) { - ND_PRINT((ndo, "%s[", &ib[1])); - hex_print_with_offset(ndo, ib, tdp, rlen, 0); - ND_PRINT((ndo, "\n%s]\n", &ib[1])); - return -1; + ND_PRINT("Error: %s, rlen %u\n", + tok2str(ForCES_TLV_err, NULL, invilv), rlen); + goto invalid; } if (ndo->ndo_vflag >= 3) { - int ilvl = EXTRACT_32BITS(&ilv->length); - ND_PRINT((ndo, "\n%s ILV: type %x length %d\n", &ib[1], - EXTRACT_32BITS(&ilv->type), ilvl)); - hex_print_with_offset(ndo, "\t\t[", tdp, ilvl-ILV_HDRL, 0); + u_int ilvl = GET_BE_U_4(ilv->length); + ND_PRINT("\n%s ILV: type %x length %u\n", ib + 1, + GET_BE_U_4(ilv->type), ilvl); + hex_print(ndo, "\t\t[", tdp, ilvl-ILV_HDRL); } ilv = GO_NXT_ILV(ilv, rlen); } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int sdatatlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk, int indent) { const struct forces_tlv *tlv = (const struct forces_tlv *)pptr; u_int rlen; - register const u_char *tdp = (const u_char *) TLV_DATA(tlv); + const u_char *tdp = TLV_DATA(tlv); uint16_t type; /* @@ -775,58 +780,54 @@ sdatatlv_print(netdissect_options *ndo, * >= TLV_HDRL. */ rlen = len - TLV_HDRL; - ND_TCHECK(*tlv); - type = EXTRACT_16BITS(&tlv->type); + ND_TCHECK_SIZE(tlv); + type = GET_BE_U_2(tlv->type); if (type != F_TLV_SPAD) { - ND_PRINT((ndo, "Error: expecting SPARSEDATA!\n")); - return -1; + ND_PRINT("Error: expecting SPARSEDATA!\n"); + goto invalid; } return sdatailv_print(ndo, tdp, rlen, op_msk, indent); -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int pkeyitlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk, int indent) { const struct forces_tlv *tlv = (const struct forces_tlv *)pptr; - register const u_char *tdp = (const u_char *) TLV_DATA(tlv); - register const u_char *dp = tdp + 4; + const u_char *tdp = TLV_DATA(tlv); + const u_char *dp = tdp + 4; const struct forces_tlv *kdtlv = (const struct forces_tlv *)dp; uint32_t id; char *ib = indent_pr(indent, 0); uint16_t type, tll; u_int invtlv; - ND_TCHECK(*tdp); - id = EXTRACT_32BITS(tdp); - ND_PRINT((ndo, "%sKeyinfo: Key 0x%x\n", ib, id)); - ND_TCHECK(*kdtlv); - type = EXTRACT_16BITS(&kdtlv->type); - invtlv = tlv_valid(kdtlv, len); + id = GET_BE_U_4(tdp); + ND_PRINT("%sKeyinfo: Key 0x%x\n", ib, id); + type = GET_BE_U_2(kdtlv->type); + tll = GET_BE_U_2(kdtlv->length); + invtlv = tlv_valid(tll, len); if (invtlv) { - ND_PRINT((ndo, "%s TLV type 0x%x len %d\n", + ND_PRINT("%s TLV type 0x%x len %u\n", tok2str(ForCES_TLV_err, NULL, invtlv), type, - EXTRACT_16BITS(&kdtlv->length))); - return -1; + tll); + goto invalid; } /* * At this point, tlv_valid() has ensured that the TLV * length is large enough but not too large (it doesn't * go past the end of the containing TLV). */ - tll = EXTRACT_16BITS(&kdtlv->length); - dp = (const u_char *) TLV_DATA(kdtlv); + tll = GET_BE_U_2(kdtlv->length); + dp = TLV_DATA(kdtlv); return fdatatlv_print(ndo, dp, tll, op_msk, indent); - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } @@ -834,7 +835,7 @@ trunc: static int pdatacnt_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t IDcnt, uint16_t op_msk, int indent) { u_int i; @@ -842,15 +843,13 @@ pdatacnt_print(netdissect_options *ndo, char *ib = indent_pr(indent, 0); if ((op_msk & B_APPND) && ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "%sTABLE APPEND\n", ib)); + ND_PRINT("%sTABLE APPEND\n", ib); } for (i = 0; i < IDcnt; i++) { - ND_TCHECK2(*pptr, 4); - if (len < 4) - goto trunc; - id = EXTRACT_32BITS(pptr); + ND_ICHECK_U(len, <, 4); + id = GET_BE_U_4(pptr); if (ndo->ndo_vflag >= 3) - ND_PRINT((ndo, "%sID#%02u: %d\n", ib, i + 1, id)); + ND_PRINT("%sID#%02u: %u\n", ib, i + 1, id); len -= 4; pptr += 4; } @@ -860,24 +859,24 @@ pdatacnt_print(netdissect_options *ndo, uint32_t starti, endi; if (len < PTH_DESC_SIZE) { - ND_PRINT((ndo, "pathlength %d with key/range too short %d\n", - len, PTH_DESC_SIZE)); - return -1; + ND_PRINT("pathlength %u with key/range too short %u\n", + len, PTH_DESC_SIZE); + goto invalid; } pptr += sizeof(struct forces_tlv); len -= sizeof(struct forces_tlv); - starti = EXTRACT_32BITS(pptr); + starti = GET_BE_U_4(pptr); pptr += 4; len -= 4; - endi = EXTRACT_32BITS(pptr); + endi = GET_BE_U_4(pptr); pptr += 4; len -= 4; if (ndo->ndo_vflag >= 3) - ND_PRINT((ndo, "%sTable range: [%d,%d]\n", ib, starti, endi)); + ND_PRINT("%sTable range: [%u,%u]\n", ib, starti, endi); } if (op_msk & B_KEYIN) { @@ -885,9 +884,9 @@ pdatacnt_print(netdissect_options *ndo, uint16_t tll; if (len < PTH_DESC_SIZE) { - ND_PRINT((ndo, "pathlength %d with key/range too short %d\n", - len, PTH_DESC_SIZE)); - return -1; + ND_PRINT("pathlength %u with key/range too short %u\n", + len, PTH_DESC_SIZE); + goto invalid; } /* skip keyid */ @@ -898,16 +897,16 @@ pdatacnt_print(netdissect_options *ndo, pptr += sizeof(struct forces_tlv); len -= sizeof(struct forces_tlv); /* skip key content */ - tll = EXTRACT_16BITS(&keytlv->length); + tll = GET_BE_U_2(keytlv->length); if (tll < TLV_HDRL) { - ND_PRINT((ndo, "key content length %u < %u\n", - tll, TLV_HDRL)); - return -1; + ND_PRINT("key content length %u < %u\n", + tll, TLV_HDRL); + goto invalid; } tll -= TLV_HDRL; if (len < tll) { - ND_PRINT((ndo, "key content too short\n")); - return -1; + ND_PRINT("key content too short\n"); + goto invalid; } pptr += tll; len -= tll; @@ -918,18 +917,18 @@ pdatacnt_print(netdissect_options *ndo, if (len) { const struct forces_tlv *pdtlv = (const struct forces_tlv *)pptr; uint16_t type; - uint16_t tll; - int pad = 0; + uint16_t tlvl, tll; + u_int pad = 0; u_int aln; u_int invtlv; - ND_TCHECK(*pdtlv); - type = EXTRACT_16BITS(&pdtlv->type); - invtlv = tlv_valid(pdtlv, len); + type = GET_BE_U_2(pdtlv->type); + tlvl = GET_BE_U_2(pdtlv->length); + invtlv = tlv_valid(tlvl, len); if (invtlv) { - ND_PRINT((ndo, "%s Outstanding bytes %d for TLV type 0x%x TLV len %d\n", + ND_PRINT("%s Outstanding bytes %u for TLV type 0x%x TLV len %u\n", tok2str(ForCES_TLV_err, NULL, invtlv), len, type, - EXTRACT_16BITS(&pdtlv->length))); + tlvl); goto pd_err; } /* @@ -937,15 +936,14 @@ pdatacnt_print(netdissect_options *ndo, * length is large enough but not too large (it doesn't * go past the end of the containing TLV). */ - tll = EXTRACT_16BITS(&pdtlv->length) - TLV_HDRL; - aln = F_ALN_LEN(EXTRACT_16BITS(&pdtlv->length)); - if (aln > EXTRACT_16BITS(&pdtlv->length)) { + tll = tlvl - TLV_HDRL; + aln = F_ALN_LEN(tlvl); + if (aln > tlvl) { if (aln > len) { - ND_PRINT((ndo, - "Invalid padded pathdata TLV type 0x%x len %d missing %d pad bytes\n", - type, EXTRACT_16BITS(&pdtlv->length), aln - len)); + ND_PRINT("Invalid padded pathdata TLV type 0x%x len %u missing %u pad bytes\n", + type, tlvl, aln - len); } else { - pad = aln - EXTRACT_16BITS(&pdtlv->length); + pad = aln - tlvl; } } if (pd_valid(type)) { @@ -953,43 +951,41 @@ pdatacnt_print(netdissect_options *ndo, if (ndo->ndo_vflag >= 3 && ops->v != F_TLV_PDAT) { if (pad) - ND_PRINT((ndo, "%s %s (Length %d DataLen %d pad %d Bytes)\n", - ib, ops->s, EXTRACT_16BITS(&pdtlv->length), tll, pad)); + ND_PRINT("%s %s (Length %u DataLen %u pad %u Bytes)\n", + ib, ops->s, tlvl, tll, pad); else - ND_PRINT((ndo, "%s %s (Length %d DataLen %d Bytes)\n", - ib, ops->s, EXTRACT_16BITS(&pdtlv->length), tll)); + ND_PRINT("%s %s (Length %u DataLen %u Bytes)\n", + ib, ops->s, tlvl, tll); } chk_op_type(ndo, type, op_msk, ops->op_msk); - if (ops->print(ndo, (const u_char *)pdtlv, - tll + pad + TLV_HDRL, op_msk, - indent + 2) == -1) - return -1; + ND_ICHECK_U(ops->print(ndo, (const u_char *)pdtlv, + tll + pad + TLV_HDRL, op_msk, indent + 2), + ==, -1); len -= (TLV_HDRL + pad + tll); } else { - ND_PRINT((ndo, "Invalid path data content type 0x%x len %d\n", - type, EXTRACT_16BITS(&pdtlv->length))); + ND_PRINT("Invalid path data content type 0x%x len %u\n", + type, tlvl); pd_err: - if (EXTRACT_16BITS(&pdtlv->length)) { - hex_print_with_offset(ndo, "Bad Data val\n\t [", - pptr, len, 0); - ND_PRINT((ndo, "]\n")); + if (tlvl) { + hex_print(ndo, "Bad Data val\n\t [", + pptr, len); + ND_PRINT("]\n"); - return -1; + goto invalid; } } } return len; -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int pdata_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk, int indent) { const struct pathdata_h *pdh = (const struct pathdata_h *)pptr; @@ -998,42 +994,42 @@ pdata_print(netdissect_options *ndo, int more_pd = 0; uint16_t idcnt = 0; - ND_TCHECK(*pdh); - if (len < sizeof(struct pathdata_h)) - goto trunc; + ND_TCHECK_SIZE(pdh); + ND_ICHECK_ZU(len, <, sizeof(struct pathdata_h)); if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "\n%sPathdata: Flags 0x%x ID count %d\n", - ib, EXTRACT_16BITS(&pdh->pflags), EXTRACT_16BITS(&pdh->pIDcnt))); + ND_PRINT("\n%sPathdata: Flags 0x%x ID count %u\n", + ib, GET_BE_U_2(pdh->pflags), + GET_BE_U_2(pdh->pIDcnt)); } - if (EXTRACT_16BITS(&pdh->pflags) & F_SELKEY) { + if (GET_BE_U_2(pdh->pflags) & F_SELKEY) { op_msk |= B_KEYIN; } /* Table GET Range operation */ - if (EXTRACT_16BITS(&pdh->pflags) & F_SELTABRANGE) { + if (GET_BE_U_2(pdh->pflags) & F_SELTABRANGE) { op_msk |= B_TRNG; } /* Table SET append operation */ - if (EXTRACT_16BITS(&pdh->pflags) & F_TABAPPEND) { + if (GET_BE_U_2(pdh->pflags) & F_TABAPPEND) { op_msk |= B_APPND; } pptr += sizeof(struct pathdata_h); len -= sizeof(struct pathdata_h); - idcnt = EXTRACT_16BITS(&pdh->pIDcnt); + idcnt = GET_BE_U_2(pdh->pIDcnt); minsize = idcnt * 4; if (len < minsize) { - ND_PRINT((ndo, "\t\t\ttruncated IDs expected %uB got %uB\n", minsize, - len)); - hex_print_with_offset(ndo, "\t\t\tID Data[", pptr, len, 0); - ND_PRINT((ndo, "]\n")); - return -1; + ND_PRINT("\t\t\ttruncated IDs expected %uB got %uB\n", minsize, + len); + hex_print(ndo, "\t\t\tID Data[", pptr, len); + ND_PRINT("]\n"); + goto invalid; } if ((op_msk & B_TRNG) && (op_msk & B_KEYIN)) { - ND_PRINT((ndo, "\t\t\tIllegal to have both Table ranges and keys\n")); - return -1; + ND_PRINT("\t\t\tIllegal to have both Table ranges and keys\n"); + goto invalid; } more_pd = pdatacnt_print(ndo, pptr, len, idcnt, op_msk, indent); @@ -1044,74 +1040,70 @@ pdata_print(netdissect_options *ndo, /* XXX: Argh, recurse some more */ return recpdoptlv_print(ndo, pptr, len, op_msk, indent+1); } else - return 0; + return more_pd; -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int genoptlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk, int indent) { const struct forces_tlv *pdtlv = (const struct forces_tlv *)pptr; uint16_t type; - int tll; + u_int tlvl; u_int invtlv; char *ib = indent_pr(indent, 0); - ND_TCHECK(*pdtlv); - type = EXTRACT_16BITS(&pdtlv->type); - tll = EXTRACT_16BITS(&pdtlv->length) - TLV_HDRL; - invtlv = tlv_valid(pdtlv, len); - ND_PRINT((ndo, "genoptlvprint - %s TLV type 0x%x len %d\n", - tok2str(ForCES_TLV, NULL, type), type, EXTRACT_16BITS(&pdtlv->length))); - if (!invtlv) { - /* - * At this point, tlv_valid() has ensured that the TLV - * length is large enough but not too large (it doesn't - * go past the end of the containing TLV). - */ - register const u_char *dp = (const u_char *) TLV_DATA(pdtlv); - if (!ttlv_valid(type)) { - ND_PRINT((ndo, "%s TLV type 0x%x len %d\n", - tok2str(ForCES_TLV_err, NULL, invtlv), type, - EXTRACT_16BITS(&pdtlv->length))); - return -1; - } - if (ndo->ndo_vflag >= 3) - ND_PRINT((ndo, "%s%s, length %d (data length %d Bytes)", - ib, tok2str(ForCES_TLV, NULL, type), - EXTRACT_16BITS(&pdtlv->length), tll)); + type = GET_BE_U_2(pdtlv->type); + tlvl = GET_BE_U_2(pdtlv->length); + invtlv = tlv_valid(tlvl, len); + ND_PRINT("genoptlvprint - %s TLV type 0x%x len %u\n", + tok2str(ForCES_TLV, NULL, type), type, tlvl); + if (invtlv) { + ND_PRINT("\t\t\tInvalid ForCES TLV type=%x", type); + goto invalid; + } + /* + * At this point, tlv_valid() has ensured that the TLV + * length is large enough but not too large (it doesn't + * go past the end of the containing TLV). + */ + const u_char *dp = TLV_DATA(pdtlv); - return pdata_print(ndo, dp, tll, op_msk, indent + 1); - } else { - ND_PRINT((ndo, "\t\t\tInvalid ForCES TLV type=%x", type)); - return -1; + if (!ttlv_valid(type)) { + ND_PRINT("%s TLV type 0x%x len %u\n", + tok2str(ForCES_TLV_err, NULL, invtlv), type, + tlvl); + goto invalid; } + if (ndo->ndo_vflag >= 3) + ND_PRINT("%s%s, length %u (data length %u Bytes)", + ib, tok2str(ForCES_TLV, NULL, type), + tlvl, tlvl - TLV_HDRL); -trunc: - ND_PRINT((ndo, "%s", tstr)); + return pdata_print(ndo, dp, tlvl - TLV_HDRL, op_msk, indent + 1); +invalid: return -1; } static int recpdoptlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk, int indent) { const struct forces_tlv *pdtlv = (const struct forces_tlv *)pptr; - int tll; - u_int invtlv; - uint16_t type; - register const u_char *dp; - char *ib; while (len != 0) { - ND_TCHECK(*pdtlv); - invtlv = tlv_valid(pdtlv, len); + uint16_t type, tlvl; + u_int invtlv; + char *ib; + const u_char *dp; + + tlvl = GET_BE_U_2(pdtlv->length); + invtlv = tlv_valid(tlvl, len); if (invtlv) { break; } @@ -1122,46 +1114,43 @@ recpdoptlv_print(netdissect_options *ndo, * go past the end of the containing TLV). */ ib = indent_pr(indent, 0); - type = EXTRACT_16BITS(&pdtlv->type); - dp = (const u_char *) TLV_DATA(pdtlv); - tll = EXTRACT_16BITS(&pdtlv->length) - TLV_HDRL; + type = GET_BE_U_2(pdtlv->type); + dp = TLV_DATA(pdtlv); if (ndo->ndo_vflag >= 3) - ND_PRINT((ndo, "%s%s, length %d (data encapsulated %d Bytes)", + ND_PRINT("%s%s, length %u (data encapsulated %u Bytes)", ib, tok2str(ForCES_TLV, NULL, type), - EXTRACT_16BITS(&pdtlv->length), - EXTRACT_16BITS(&pdtlv->length) - TLV_HDRL)); + tlvl, + tlvl - TLV_HDRL); - if (pdata_print(ndo, dp, tll, op_msk, indent + 1) == -1) - return -1; + ND_ICHECK_U(pdata_print(ndo, dp, tlvl - TLV_HDRL, op_msk, indent + 1), + ==, -1); pdtlv = GO_NXT_TLV(pdtlv, len); } if (len) { - ND_PRINT((ndo, - "\n\t\tMessy PATHDATA TLV header, type (0x%x)\n\t\texcess of %d Bytes ", - EXTRACT_16BITS(&pdtlv->type), len - EXTRACT_16BITS(&pdtlv->length))); - return -1; + ND_PRINT("\n\t\tMessy PATHDATA TLV header, type (0x%x)\n\t\texcess of %u Bytes ", + GET_BE_U_2(pdtlv->type), + len - GET_BE_U_2(pdtlv->length)); + goto invalid; } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int invoptlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { char *ib = indent_pr(indent, 1); if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "%sData[", &ib[1])); - hex_print_with_offset(ndo, ib, pptr, len, 0); - ND_PRINT((ndo, "%s]\n", ib)); + ND_PRINT("%sData[", ib + 1); + hex_print(ndo, ib, pptr, len); + ND_PRINT("%s]\n", ib); } return -1; } @@ -1171,30 +1160,29 @@ otlv_print(netdissect_options *ndo, const struct forces_tlv *otlv, uint16_t op_msk _U_, int indent) { int rc = 0; - register const u_char *dp = (const u_char *) TLV_DATA(otlv); + const u_char *dp = TLV_DATA(otlv); uint16_t type; - int tll; + u_int tll; char *ib = indent_pr(indent, 0); const struct optlv_h *ops; /* - * lfbselect_print() has ensured that EXTRACT_16BITS(&otlv->length) + * lfbselect_print() has ensured that GET_BE_U_2(otlv->length) * >= TLV_HDRL. */ - ND_TCHECK(*otlv); - type = EXTRACT_16BITS(&otlv->type); - tll = EXTRACT_16BITS(&otlv->length) - TLV_HDRL; + type = GET_BE_U_2(otlv->type); + tll = GET_BE_U_2(otlv->length) - TLV_HDRL; ops = get_forces_optlv_h(type); if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "%sOper TLV %s(0x%x) length %d\n", ib, ops->s, type, - EXTRACT_16BITS(&otlv->length))); + ND_PRINT("%sOper TLV %s(0x%x) length %u\n", ib, ops->s, type, + GET_BE_U_2(otlv->length)); } /* rest of ops must at least have 12B {pathinfo} */ if (tll < OP_MIN_SIZ) { - ND_PRINT((ndo, "\t\tOper TLV %s(0x%x) length %d\n", ops->s, type, - EXTRACT_16BITS(&otlv->length))); - ND_PRINT((ndo, "\t\tTruncated data size %d minimum required %d\n", tll, - OP_MIN_SIZ)); + ND_PRINT("\t\tOper TLV %s(0x%x) length %u\n", ops->s, type, + GET_BE_U_2(otlv->length)); + ND_PRINT("\t\tTruncated data size %u minimum required %u\n", tll, + OP_MIN_SIZ); return invoptlv_print(ndo, dp, tll, ops->op_msk, indent); } @@ -1204,17 +1192,13 @@ otlv_print(netdissect_options *ndo, rc = ops->print(ndo, dp, tll, ops->op_msk, indent + 1); } return rc; - -trunc: - ND_PRINT((ndo, "%s", tstr)); - return -1; } #define ASTDLN 4 #define ASTMCD 255 static int asttlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { uint32_t rescode; @@ -1227,44 +1211,22 @@ asttlv_print(netdissect_options *ndo, */ dlen = len - TLV_HDRL; if (dlen != ASTDLN) { - ND_PRINT((ndo, "illegal ASTresult-TLV: %d bytes!\n", dlen)); - return -1; + ND_PRINT("illegal ASTresult-TLV: %u bytes!\n", dlen); + goto invalid; } - ND_TCHECK2(*pptr, 4); - rescode = EXTRACT_32BITS(pptr); + rescode = GET_BE_U_4(pptr); if (rescode > ASTMCD) { - ND_PRINT((ndo, "illegal ASTresult result code: %d!\n", rescode)); - return -1; + ND_PRINT("illegal ASTresult result code: %u!\n", rescode); + goto invalid; } if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "Teardown reason:\n%s", ib)); - switch (rescode) { - case 0: - ND_PRINT((ndo, "Normal Teardown")); - break; - case 1: - ND_PRINT((ndo, "Loss of Heartbeats")); - break; - case 2: - ND_PRINT((ndo, "Out of bandwidth")); - break; - case 3: - ND_PRINT((ndo, "Out of Memory")); - break; - case 4: - ND_PRINT((ndo, "Application Crash")); - break; - default: - ND_PRINT((ndo, "Unknown Teardown reason")); - break; - } - ND_PRINT((ndo, "(%x)\n%s", rescode, ib)); + ND_PRINT("Teardown reason:\n%s%s", ib, + tok2str(tdr_str, "unknown (%u)", rescode)); + ND_PRINT("(%x)\n%s", rescode, ib); } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } @@ -1272,7 +1234,7 @@ trunc: #define ASRMCD 3 static int asrtlv_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { uint32_t rescode; @@ -1285,39 +1247,36 @@ asrtlv_print(netdissect_options *ndo, */ dlen = len - TLV_HDRL; if (dlen != ASRDLN) { /* id, instance, oper tlv */ - ND_PRINT((ndo, "illegal ASRresult-TLV: %d bytes!\n", dlen)); - return -1; + ND_PRINT("illegal ASRresult-TLV: %u bytes!\n", dlen); + goto invalid; } - ND_TCHECK2(*pptr, 4); - rescode = EXTRACT_32BITS(pptr); + rescode = GET_BE_U_4(pptr); if (rescode > ASRMCD) { - ND_PRINT((ndo, "illegal ASRresult result code: %d!\n", rescode)); - return -1; + ND_PRINT("illegal ASRresult result code: %u!\n", rescode); + goto invalid; } if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "\n%s", ib)); + ND_PRINT("\n%s", ib); switch (rescode) { case 0: - ND_PRINT((ndo, "Success ")); + ND_PRINT("Success "); break; case 1: - ND_PRINT((ndo, "FE ID invalid ")); + ND_PRINT("FE ID invalid "); break; case 2: - ND_PRINT((ndo, "permission denied ")); + ND_PRINT("permission denied "); break; default: - ND_PRINT((ndo, "Unknown ")); + ND_PRINT("Unknown "); break; } - ND_PRINT((ndo, "(%x)\n%s", rescode, ib)); + ND_PRINT("(%x)\n%s", rescode, ib); } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } @@ -1327,13 +1286,13 @@ trunc: */ static int gentltlv_print(netdissect_options *ndo, - register const u_char * pptr _U_, register u_int len, + const u_char * pptr _U_, u_int len, uint16_t op_msk _U_, int indent _U_) { u_int dlen = len - TLV_HDRL; if (dlen < 4) { /* at least 32 bits must exist */ - ND_PRINT((ndo, "truncated TLV: %d bytes missing! ", 4 - dlen)); + ND_PRINT("truncated TLV: %u bytes missing! ", 4 - dlen); return -1; } return 0; @@ -1344,35 +1303,30 @@ gentltlv_print(netdissect_options *ndo, static int print_metailv(netdissect_options *ndo, - register const u_char * pptr, uint16_t op_msk _U_, int indent) + const struct forces_ilv * ilv, uint16_t op_msk _U_, + const int indent) { u_int rlen; char *ib = indent_pr(indent, 0); /* XXX: check header length */ - const struct forces_ilv *ilv = (const struct forces_ilv *)pptr; /* * print_metatlv() has ensured that len (what remains in the * ILV) >= ILV_HDRL. */ - rlen = EXTRACT_32BITS(&ilv->length) - ILV_HDRL; - ND_TCHECK(*ilv); - ND_PRINT((ndo, "%sMetaID 0x%x length %d\n", ib, EXTRACT_32BITS(&ilv->type), - EXTRACT_32BITS(&ilv->length))); + rlen = GET_BE_U_4(ilv->length) - ILV_HDRL; + ND_PRINT("%sMetaID 0x%x length %u\n", ib, GET_BE_U_4(ilv->type), + GET_BE_U_4(ilv->length)); if (ndo->ndo_vflag >= 3) { - hex_print_with_offset(ndo, "\t\t[", ILV_DATA(ilv), rlen, 0); - ND_PRINT((ndo, " ]\n")); + hex_print(ndo, "\t\t[", ILV_DATA(ilv), rlen); + ND_PRINT(" ]\n"); } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); - return -1; } static int print_metatlv(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { u_int dlen; @@ -1387,10 +1341,9 @@ print_metatlv(netdissect_options *ndo, */ dlen = len - TLV_HDRL; rlen = dlen; - ND_PRINT((ndo, "\n%s METADATA length %d \n", ib, rlen)); + ND_PRINT("\n%s METADATA length %u\n", ib, rlen); while (rlen != 0) { - ND_TCHECK(*ilv); - invilv = ilv_valid(ilv, rlen); + invilv = ilv_valid(ndo, ilv, rlen); if (invilv) { break; } @@ -1400,22 +1353,18 @@ print_metatlv(netdissect_options *ndo, * length is large enough but not too large (it doesn't * go past the end of the containing TLV). */ - print_metailv(ndo, (const u_char *) ilv, 0, indent + 1); + print_metailv(ndo, ilv, 0, indent + 1); ilv = GO_NXT_ILV(ilv, rlen); } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); - return -1; } static int print_reddata(netdissect_options *ndo, - register const u_char * pptr, register u_int len, - uint16_t op_msk _U_, int indent _U_) + const u_char * pptr, u_int len, + uint16_t op_msk _U_, int indent) { u_int dlen; char *ib = indent_pr(indent, 0); @@ -1423,12 +1372,12 @@ print_reddata(netdissect_options *ndo, dlen = len - TLV_HDRL; rlen = dlen; - ND_PRINT((ndo, "\n%s Redirect Data length %d \n", ib, rlen)); + ND_PRINT("\n%s Redirect Data length %u\n", ib, rlen); if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "\t\t[")); - hex_print_with_offset(ndo, "\n\t\t", pptr, rlen, 0); - ND_PRINT((ndo, "\n\t\t]")); + ND_PRINT("\t\t["); + hex_print(ndo, "\n\t\t", pptr, rlen); + ND_PRINT("\n\t\t]"); } return 0; @@ -1436,7 +1385,7 @@ print_reddata(netdissect_options *ndo, static int redirect_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk _U_, int indent) { const struct forces_tlv *tlv = (const struct forces_tlv *)pptr; @@ -1450,18 +1399,21 @@ redirect_print(netdissect_options *ndo, */ dlen = len - TLV_HDRL; if (dlen <= RD_MIN) { - ND_PRINT((ndo, "\n\t\ttruncated Redirect TLV: %d bytes missing! ", - RD_MIN - dlen)); - return -1; + ND_PRINT("\n\t\ttruncated Redirect TLV: %u bytes missing! ", + RD_MIN - dlen); + goto invalid; } rlen = dlen; indent += 1; while (rlen != 0) { - ND_TCHECK(*tlv); - invtlv = tlv_valid(tlv, rlen); + uint16_t type, tlvl; + + type = GET_BE_U_2(tlv->type); + tlvl = GET_BE_U_2(tlv->length); + invtlv = tlv_valid(tlvl, rlen); if (invtlv) { - ND_PRINT((ndo, "Bad Redirect data\n")); + ND_PRINT("Bad Redirect data\n"); break; } @@ -1470,33 +1422,32 @@ redirect_print(netdissect_options *ndo, * length is large enough but not too large (it doesn't * go past the end of the containing TLV). */ - if (EXTRACT_16BITS(&tlv->type) == F_TLV_METD) { - print_metatlv(ndo, (const u_char *) TLV_DATA(tlv), - EXTRACT_16BITS(&tlv->length), 0, indent); - } else if ((EXTRACT_16BITS(&tlv->type) == F_TLV_REDD)) { - print_reddata(ndo, (const u_char *) TLV_DATA(tlv), - EXTRACT_16BITS(&tlv->length), 0, indent); + if (type == F_TLV_METD) { + print_metatlv(ndo, TLV_DATA(tlv), + tlvl, 0, + indent); + } else if (type == F_TLV_REDD) { + print_reddata(ndo, TLV_DATA(tlv), + tlvl, 0, + indent); } else { - ND_PRINT((ndo, "Unknown REDIRECT TLV 0x%x len %d\n", - EXTRACT_16BITS(&tlv->type), - EXTRACT_16BITS(&tlv->length))); + ND_PRINT("Unknown REDIRECT TLV 0x%x len %u\n", + type, + tlvl); } tlv = GO_NXT_TLV(tlv, rlen); } if (rlen) { - ND_PRINT((ndo, - "\n\t\tMessy Redirect TLV header, type (0x%x)\n\t\texcess of %d Bytes ", - EXTRACT_16BITS(&tlv->type), - rlen - EXTRACT_16BITS(&tlv->length))); - return -1; + ND_PRINT("\n\t\tMessy Redirect TLV header, type (0x%x)\n\t\texcess of %u Bytes ", + GET_BE_U_2(tlv->type), + rlen - GET_BE_U_2(tlv->length)); + goto invalid; } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } @@ -1505,7 +1456,7 @@ trunc: static int lfbselect_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len, + const u_char * pptr, u_int len, uint16_t op_msk, int indent) { const struct forces_lfbsh *lfbs; @@ -1521,9 +1472,9 @@ lfbselect_print(netdissect_options *ndo, */ dlen = len - TLV_HDRL; if (dlen <= OP_MIN) { /* id, instance, oper tlv header .. */ - ND_PRINT((ndo, "\n\t\ttruncated lfb selector: %d bytes missing! ", - OP_MIN - dlen)); - return -1; + ND_PRINT("\n\t\tundersized lfb selector: %u bytes missing! ", + OP_MIN - dlen); + goto invalid; } /* @@ -1533,20 +1484,24 @@ lfbselect_print(netdissect_options *ndo, rlen = dlen - OP_OFF; lfbs = (const struct forces_lfbsh *)pptr; - ND_TCHECK(*lfbs); + ND_TCHECK_SIZE(lfbs); if (ndo->ndo_vflag >= 3) { - ND_PRINT((ndo, "\n%s%s(Classid %x) instance %x\n", - ib, tok2str(ForCES_LFBs, NULL, EXTRACT_32BITS(&lfbs->class)), - EXTRACT_32BITS(&lfbs->class), - EXTRACT_32BITS(&lfbs->instance))); + ND_PRINT("\n%s%s(Classid %x) instance %x\n", + ib, + tok2str(ForCES_LFBs, NULL, GET_BE_U_4(lfbs->class)), + GET_BE_U_4(lfbs->class), + GET_BE_U_4(lfbs->instance)); } otlv = (const struct forces_tlv *)(lfbs + 1); indent += 1; while (rlen != 0) { - ND_TCHECK(*otlv); - invtlv = tlv_valid(otlv, rlen); + uint16_t type, tlvl; + + type = GET_BE_U_2(otlv->type); + tlvl = GET_BE_U_2(otlv->length); + invtlv = tlv_valid(tlvl, rlen); if (invtlv) break; @@ -1555,43 +1510,41 @@ lfbselect_print(netdissect_options *ndo, * length is large enough but not too large (it doesn't * go past the end of the containing TLV). */ - if (op_valid(EXTRACT_16BITS(&otlv->type), op_msk)) { + if (op_valid(type, op_msk)) { otlv_print(ndo, otlv, 0, indent); } else { if (ndo->ndo_vflag < 3) - ND_PRINT((ndo, "\n")); - ND_PRINT((ndo, - "\t\tINValid oper-TLV type 0x%x length %d for this ForCES message\n", - EXTRACT_16BITS(&otlv->type), EXTRACT_16BITS(&otlv->length))); + ND_PRINT("\n"); + ND_PRINT("\t\tINValid oper-TLV type 0x%x length %u for this ForCES message\n", + type, tlvl); invoptlv_print(ndo, (const u_char *)otlv, rlen, 0, indent); } otlv = GO_NXT_TLV(otlv, rlen); } if (rlen) { - ND_PRINT((ndo, - "\n\t\tMessy oper TLV header, type (0x%x)\n\t\texcess of %d Bytes ", - EXTRACT_16BITS(&otlv->type), rlen - EXTRACT_16BITS(&otlv->length))); - return -1; + ND_PRINT("\n\t\tMessy oper TLV header, type (0x%x)\n\t\texcess of %u Bytes ", + GET_BE_U_2(otlv->type), + rlen - GET_BE_U_2(otlv->length)); + goto invalid; } return 0; -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } static int forces_type_print(netdissect_options *ndo, - register const u_char * pptr, const struct forcesh *fhdr _U_, - register u_int mlen, const struct tom_h *tops) + const u_char * pptr, const struct forcesh *fhdr _U_, + u_int mlen, const struct tom_h *tops) { const struct forces_tlv *tltlv; u_int rlen; u_int invtlv; int rc = 0; - int ttlv = 0; + u_int ttlv = 0; /* * forces_print() has already checked that mlen >= ForCES_HDRL @@ -1601,15 +1554,15 @@ forces_type_print(netdissect_options *ndo, if (rlen > TLV_HLN) { if (tops->flags & ZERO_TTLV) { - ND_PRINT((ndo, "<0x%x>Illegal Top level TLV!\n", tops->flags)); - return -1; + ND_PRINT("<0x%x>Illegal Top level TLV!\n", tops->flags); + goto invalid; } } else { if (tops->flags & ZERO_MORE_TTLV) return 0; if (tops->flags & ONE_MORE_TTLV) { - ND_PRINT((ndo, "\tTop level TLV Data missing!\n")); - return -1; + ND_PRINT("\tTop level TLV Data missing!\n"); + goto invalid; } } @@ -1623,8 +1576,11 @@ forces_type_print(netdissect_options *ndo, /*XXX: 15 top level tlvs will probably be fine You are nuts if you send more ;-> */ while (rlen != 0) { - ND_TCHECK(*tltlv); - invtlv = tlv_valid(tltlv, rlen); + uint16_t type, tlvl; + + type = GET_BE_U_2(tltlv->type); + tlvl = GET_BE_U_2(tltlv->length); + invtlv = tlv_valid(tlvl, rlen); if (invtlv) break; @@ -1633,23 +1589,22 @@ forces_type_print(netdissect_options *ndo, * length is large enough but not too large (it doesn't * go past the end of the packet). */ - if (!ttlv_valid(EXTRACT_16BITS(&tltlv->type))) { - ND_PRINT((ndo, "\n\tInvalid ForCES Top TLV type=0x%x", - EXTRACT_16BITS(&tltlv->type))); - return -1; + if (!ttlv_valid(type)) { + ND_PRINT("\n\tInvalid ForCES Top TLV type=0x%x", + type); + goto invalid; } if (ndo->ndo_vflag >= 3) - ND_PRINT((ndo, "\t%s, length %d (data length %d Bytes)", - tok2str(ForCES_TLV, NULL, EXTRACT_16BITS(&tltlv->type)), - EXTRACT_16BITS(&tltlv->length), - EXTRACT_16BITS(&tltlv->length) - TLV_HDRL)); - - rc = tops->print(ndo, (const u_char *) TLV_DATA(tltlv), - EXTRACT_16BITS(&tltlv->length), tops->op_msk, 9); - if (rc < 0) { - return -1; - } + ND_PRINT("\t%s, length %u (data length %u Bytes)", + tok2str(ForCES_TLV, NULL, type), + tlvl, + tlvl - TLV_HDRL); + + rc = tops->print(ndo, TLV_DATA(tltlv), + tlvl, + tops->op_msk, 9); + ND_ICHECK_U(rc, <, 0); tltlv = GO_NXT_TLV(tltlv, rlen); ttlv--; if (ttlv <= 0) @@ -1660,66 +1615,63 @@ forces_type_print(netdissect_options *ndo, * short, and didn't have *enough* TLVs in it? */ if (rlen) { - ND_PRINT((ndo, "\tMess TopTLV header: min %u, total %d advertised %d ", - TLV_HDRL, rlen, EXTRACT_16BITS(&tltlv->length))); - return -1; + ND_PRINT("\tMess TopTLV header: min %u, total %u advertised %u ", + TLV_HDRL, rlen, GET_BE_U_2(tltlv->length)); + goto invalid; } return 0; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: return -1; } void forces_print(netdissect_options *ndo, - register const u_char * pptr, register u_int len) + const u_char * pptr, u_int len) { const struct forcesh *fhdr; u_int mlen; uint32_t flg_raw; + uint8_t tom; const struct tom_h *tops; int rc = 0; + ndo->ndo_protocol = "forces"; fhdr = (const struct forcesh *)pptr; - ND_TCHECK(*fhdr); - if (!tom_valid(fhdr->fm_tom)) { - ND_PRINT((ndo, "Invalid ForCES message type %d\n", fhdr->fm_tom)); - goto error; + ND_TCHECK_SIZE(fhdr); + tom = GET_U_1(fhdr->fm_tom); + if (!tom_valid(tom)) { + ND_PRINT("Invalid ForCES message type %u\n", tom); + goto invalid; } mlen = ForCES_BLN(fhdr); - tops = get_forces_tom(fhdr->fm_tom); + tops = get_forces_tom(tom); if (tops->v == TOM_RSVD) { - ND_PRINT((ndo, "\n\tUnknown ForCES message type=0x%x", fhdr->fm_tom)); - goto error; + ND_PRINT("\n\tUnknown ForCES message type=0x%x", tom); + goto invalid; } - ND_PRINT((ndo, "\n\tForCES %s ", tops->s)); + ND_PRINT("\n\tForCES %s ", tops->s); if (!ForCES_HLN_VALID(mlen, len)) { - ND_PRINT((ndo, - "Illegal ForCES pkt len - min %u, total recvd %d, advertised %d ", - ForCES_HDRL, len, ForCES_BLN(fhdr))); - goto error; + ND_PRINT("Illegal ForCES pkt len - min %u, total recvd %u, advertised %u ", + ForCES_HDRL, len, ForCES_BLN(fhdr)); + goto invalid; } - ND_TCHECK2(*(pptr + 20), 4); - flg_raw = EXTRACT_32BITS(pptr + 20); + flg_raw = GET_BE_U_4(pptr + 20); if (ndo->ndo_vflag >= 1) { - ND_PRINT((ndo, "\n\tForCES Version %d len %uB flags 0x%08x ", - ForCES_V(fhdr), mlen, flg_raw)); - ND_PRINT((ndo, - "\n\tSrcID 0x%x(%s) DstID 0x%x(%s) Correlator 0x%" PRIx64, + ND_PRINT("\n\tForCES Version %u len %uB flags 0x%08x ", + ForCES_V(fhdr), mlen, flg_raw); + ND_PRINT("\n\tSrcID 0x%x(%s) DstID 0x%x(%s) Correlator 0x%" PRIx64, ForCES_SID(fhdr), ForCES_node(ForCES_SID(fhdr)), ForCES_DID(fhdr), ForCES_node(ForCES_DID(fhdr)), - EXTRACT_64BITS(fhdr->fm_cor))); + GET_BE_U_8(fhdr->fm_cor)); } if (ndo->ndo_vflag >= 2) { - ND_PRINT((ndo, - "\n\tForCES flags:\n\t %s(0x%x), prio=%d, %s(0x%x),\n\t %s(0x%x), %s(0x%x)\n", + ND_PRINT("\n\tForCES flags:\n\t %s(0x%x), prio=%u, %s(0x%x),\n\t %s(0x%x), %s(0x%x)\n", tok2str(ForCES_ACKs, "ACKUnknown", ForCES_ACK(fhdr)), ForCES_ACK(fhdr), ForCES_PRI(fhdr), @@ -1728,33 +1680,19 @@ forces_print(netdissect_options *ndo, tok2str(ForCES_ATs, "ATUnknown", ForCES_AT(fhdr)), ForCES_AT(fhdr), tok2str(ForCES_TPs, "TPUnknown", ForCES_TP(fhdr)), - ForCES_TP(fhdr))); - ND_PRINT((ndo, - "\t Extra flags: rsv(b5-7) 0x%x rsv(b13-31) 0x%x\n", - ForCES_RS1(fhdr), ForCES_RS2(fhdr))); + ForCES_TP(fhdr)); + ND_PRINT("\t Extra flags: rsv(b5-7) 0x%x rsv(b13-31) 0x%x\n", + ForCES_RS1(fhdr), ForCES_RS2(fhdr)); } rc = forces_type_print(ndo, pptr, fhdr, mlen, tops); - if (rc < 0) { -error: - hex_print_with_offset(ndo, "\n\t[", pptr, len, 0); - ND_PRINT((ndo, "\n\t]")); - return; - } + ND_ICHECK_U(rc, <, 0); if (ndo->ndo_vflag >= 4) { - ND_PRINT((ndo, "\n\t Raw ForCES message\n\t [")); - hex_print_with_offset(ndo, "\n\t ", pptr, len, 0); - ND_PRINT((ndo, "\n\t ]")); + ND_PRINT("\n\t Raw ForCES message\n\t ["); + hex_print(ndo, "\n\t ", pptr, len); + ND_PRINT("\n\t ]"); } - ND_PRINT((ndo, "\n")); return; - -trunc: - ND_PRINT((ndo, "%s", tstr)); +invalid: + nd_print_invalid(ndo); } -/* - * Local Variables: - * c-style: whitesmith - * c-basic-offset: 8 - * End: - */