huangcm
2024-08-23 d76fb8c8c6d079a3cee81da7072347dcb8bbbc70
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
/*
 * Copyright (c) 1998-2007 The TCPDUMP project
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that: (1) source code
 * distributions retain the above copyright notice and this paragraph
 * in its entirety, and (2) distributions including binary code include
 * the above copyright notice and this paragraph in its entirety in
 * the documentation or other materials provided with the distribution.
 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
 * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
 * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
 * FOR A PARTICULAR PURPOSE.
 *
 * Original code by Carles Kishimoto <carles.kishimoto@gmail.com>
 */
 
/* \summary: Dynamic Trunking Protocol (DTP) printer */
 
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
 
#include <netdissect-stdinc.h>
 
#include "netdissect.h"
#include "addrtoname.h"
#include "extract.h"
 
static const char tstr[] = " [|dtp]";
 
#define DTP_HEADER_LEN            1
#define DTP_DOMAIN_TLV            0x0001
#define DTP_STATUS_TLV            0x0002
#define DTP_DTP_TYPE_TLV        0x0003
#define DTP_NEIGHBOR_TLV        0x0004
 
static const struct tok dtp_tlv_values[] = {
    { DTP_DOMAIN_TLV, "Domain TLV"},
    { DTP_STATUS_TLV, "Status TLV"},
    { DTP_DTP_TYPE_TLV, "DTP type TLV"},
    { DTP_NEIGHBOR_TLV, "Neighbor TLV"},
    { 0, NULL}
};
 
void
dtp_print (netdissect_options *ndo, const u_char *pptr, u_int length)
{
    int type, len;
    const u_char *tptr;
 
    if (length < DTP_HEADER_LEN)
        goto trunc;
 
    tptr = pptr;
 
    ND_TCHECK2(*tptr, DTP_HEADER_LEN);
 
    ND_PRINT((ndo, "DTPv%u, length %u",
           (*tptr),
           length));
 
    /*
     * In non-verbose mode, just print version.
     */
    if (ndo->ndo_vflag < 1) {
   return;
    }
 
    tptr += DTP_HEADER_LEN;
 
    while (tptr < (pptr+length)) {
 
        ND_TCHECK2(*tptr, 4);
   type = EXTRACT_16BITS(tptr);
        len  = EXTRACT_16BITS(tptr+2);
       /* XXX: should not be but sometimes it is, see the test captures */
        if (type == 0)
            return;
        ND_PRINT((ndo, "\n\t%s (0x%04x) TLV, length %u",
               tok2str(dtp_tlv_values, "Unknown", type),
               type, len));
 
        /* infinite loop check */
        if (len < 4)
            goto invalid;
        ND_TCHECK2(*tptr, len);
 
        switch (type) {
   case DTP_DOMAIN_TLV:
       ND_PRINT((ndo, ", "));
       fn_printzp(ndo, tptr+4, len-4, pptr+length);
       break;
 
   case DTP_STATUS_TLV:
   case DTP_DTP_TYPE_TLV:
                if (len < 5)
                    goto invalid;
                ND_PRINT((ndo, ", 0x%x", *(tptr+4)));
                break;
 
   case DTP_NEIGHBOR_TLV:
                if (len < 10)
                    goto invalid;
                ND_PRINT((ndo, ", %s", etheraddr_string(ndo, tptr+4)));
                break;
 
        default:
            break;
        }
        tptr += len;
    }
 
    return;
 
 invalid:
    ND_PRINT((ndo, "%s", istr));
    return;
 trunc:
    ND_PRINT((ndo, "%s", tstr));
}
 
/*
 * Local Variables:
 * c-style: whitesmith
 * c-basic-offset: 4
 * End:
 */