git.sur5r.net Git - ngadmin/blob - wireshark/nsdp.lua

   1
   2 p_nsdp = Proto("nsdp", "Netgear Switch Description Protocol")
   3
   4 local f_version = ProtoField.uint8("nsdp.version", "Version", base.DEC)
   5 local f_code = ProtoField.uint8("nsdp.code", "Operation Code", base.DEC)
   6 local f_error = ProtoField.uint8("nsdp.error", "Error Code", base.DEC)
   7 local f_errattr = ProtoField.uint16("nsdp.errattr", "Erroneous Attribute", base.HEX)
   8 local f_clientmac = ProtoField.ether("nsdp.clientmac", "Client MAC")
   9 local f_switchmac = ProtoField.ether("nsdp.switchmac", "Switch MAC")
  10 local f_seqnum = ProtoField.uint32("nsdp.seqnum", "Sequence Number", base.DEC)
  11
  12 p_nsdp.fields = {
  13         f_version,
  14         f_code,
  15         f_error,
  16         f_errattr,
  17         f_clientmac,
  18         f_switchmac,
  19         f_seqnum
  20 }
  21
  22
  23
  24 local op_codes = {
  25         [1] = "Read Request",
  26         [2] = "Read Reply",
  27         [3] = "Write Request",
  28         [4] = "Write Reply"
  29 }
  30
  31
  32 local error_codes = {
  33         [0] = "OK",
  34         [5] = "Invalid Value",
  35         [7] = "Access Denied"
  36 }
  37
  38
  39 local status_codes = {
  40         [0] = "down",
  41         [1] = "10M",
  42         [4] = "100M",
  43         [5] = "1000M"
  44 }
  45
  46
  47 local bitrates_codes = {
  48         [0] = "unlimited",
  49         [1] = "512K",
  50         [2] = "1M",
  51         [3] = "2M",
  52         [4] = "4M",
  53         [5] = "8M",
  54         [6] = "16M",
  55         [7] = "32M",
  56         [8] = "64M",
  57         [9] = "128M",
  58         [10] = "256M",
  59         [11] = "512M"
  60 }
  61
  62
  63 local vlan_type_codes = {
  64         [1] = "port basic",
  65         [2] = "port advanced",
  66         [3] = "802.1Q basic",
  67         [4] = "802.1Q advanced"
  68 }
  69
  70
  71 local qos_type_codes = {
  72         [1] = "port based",
  73         [2] = "802.1p"
  74 }
  75
  76
  77 local prio_codes = {
  78         [1] = "high",
  79         [2] = "medium",
  80         [3] = "normal",
  81         [4] = "low"
  82 }
  83
  84
  85
  86
  87 local function dissect_port_statistics(buffer, offset, subtree)
  88         subtree:add(buffer(offset + 4, 1), string.format("Port: %i", buffer(offset + 4, 1):uint()))
  89         subtree:add(buffer(offset + 4 + 1 + 8 * 0, 8), "Received:", tostring(buffer(offset + 4 + 1 + 8 * 0, 8):uint64()))
  90         subtree:add(buffer(offset + 4 + 1 + 8 * 1, 8), "Sent: ", tostring(buffer(offset + 4 + 1 + 8 * 1, 8):uint64()))
  91         subtree:add(buffer(offset + 4 + 1 + 8 * 5, 8), "CRC Errors:", tostring(buffer(offset + 4 + 1 + 8 * 5, 8):uint64()))
  92 end
  93
  94
  95 local function dissect_port_status(buffer, offset, subtree)
  96         local st = buffer(offset + 5, 1):uint()
  97         subtree:add(buffer(offset + 4, 1), string.format("Port: %i", buffer(offset + 4, 1):uint()))
  98         subtree:add(buffer(offset + 5, 1), string.format("Status: %i (%s)", st, status_codes[st] or "unk"))
  99 end
 100
 101
 102 local function dissect_qos_type(buffer, offset, subtree)
 103         local t = buffer(offset + 4, 1):uint()
 104         subtree:add(buffer(offset + 4, 1), string.format("QoS Type: %i (%s)", t, qos_type_codes[t] or "unk"))
 105 end
 106
 107
 108 local function dissect_qos_config(buffer, offset, subtree)
 109         local p = buffer(offset + 5, 1):uint()
 110         subtree:add(buffer(offset + 4, 1), string.format("Port: %i", buffer(offset + 4, 1):uint()))
 111         subtree:add(buffer(offset + 5, 1), string.format("Priority: %i (%s)", p, prio_codes[p] or "unk"))
 112 end
 113
 114
 115 local function dissect_bitrate(buffer, offset, subtree)
 116         local sp = buffer(offset + 5, 4):uint()
 117         subtree:add(buffer(offset + 4, 1), string.format("Port: %i", buffer(offset + 4, 1):uint()))
 118         subtree:add(buffer(offset + 5, 4), string.format("Speed: %i (%s)", sp, bitrates_codes[sp] or "unk"))
 119 end
 120
 121
 122 local function dissect_vlan_type(buffer, offset, subtree)
 123         local vt = buffer(offset + 4, 1):uint()
 124         subtree:add(buffer(offset + 4, 1), string.format("VLAN Type: %i (%s)", vt, vlan_type_codes[vt] or "unk"))
 125 end
 126
 127
 128 local function parse_ports(val)
 129         local ports = ""
 130
 131         for i = 8, 1, -1 do
 132                 if (val % 2 == 1) then
 133                         ports = ports..i.." "
 134                 end
 135                 val = math.floor(val / 2)
 136         end
 137
 138         return ports
 139 end
 140
 141
 142 local function dissect_vlan_port_conf(buffer, offset, subtree)
 143         subtree:add(buffer(offset + 4, 2), string.format("VLAN: %u", buffer(offset + 4, 2):uint()))
 144
 145         if (buffer(offset + 2, 2):uint() >= 3) then
 146                 subtree:add(buffer(offset + 6, 1), "Ports:", parse_ports(buffer(offset + 6, 1):uint()))
 147         end
 148 end
 149
 150
 151 local function dissect_vlan_8021q_conf(buffer, offset, subtree)
 152         subtree:add(buffer(offset + 4, 2), string.format("VLAN: %u", buffer(offset + 4, 2):uint()))
 153
 154         if (buffer(offset + 2, 2):uint() >= 4) then
 155                 subtree:add(buffer(offset + 6, 1), "Ports:", parse_ports(buffer(offset + 6, 1):uint()))
 156                 subtree:add(buffer(offset + 7, 1), "Tagged Ports:", parse_ports(buffer(offset + 7, 1):uint()))
 157         end
 158 end
 159
 160
 161 local function dissect_vlan_pvid(buffer, offset, subtree)
 162         subtree:add(buffer(offset + 4, 1), string.format("Port: %i", buffer(offset + 4, 1):uint()))
 163         subtree:add(buffer(offset + 5, 2), string.format("VLAN: %u", buffer(offset + 5, 2):uint()))
 164 end
 165
 166
 167 local function dissect_mirror(buffer, offset, subtree)
 168         local op = buffer(offset + 4, 1):uint()
 169
 170         if (op == 0) then
 171                 subtree:add(buffer(offset + 4, 1), "Disabled")
 172         else
 173                 subtree:add(buffer(offset + 4, 1), "Output Port:", op)
 174                 subtree:add(buffer(offset + 6, 1), "Ports:", parse_ports(buffer(offset + 6, 1):uint()))
 175         end
 176 end
 177
 178
 179 local function dissect_igmp_enablevlan(buffer, offset, subtree)
 180         subtree:add(buffer(offset + 4, 2), string.format("Enable: %u", buffer(offset + 4, 2):uint()))
 181         subtree:add(buffer(offset + 6, 2), string.format("VLAN: %u", buffer(offset + 6, 2):uint()))
 182 end
 183
 184
 185 local attributes = {
 186         [0x0001] = {name = "Product", dissect = "string"},
 187         [0x0003] = {name = "Name", dissect = "string"},
 188         [0x0004] = {name = "MAC", dissect = "ether"},
 189         [0x0006] = {name = "IP", dissect = "ipv4"},
 190         [0x0007] = {name = "Mask", dissect = "ipv4"},
 191         [0x0008] = {name = "Gateway", dissect = "ipv4"},
 192         [0x0009] = {name = "New Password", dissect = "string"},
 193         [0x000A] = {name = "Password", dissect = "string"},
 194         [0x000B] = {name = "DHCP", dissect = "uint"},
 195         [0x000D] = {name = "Firmware Version", dissect = "string"},
 196         [0x0010] = {name = "Firmware Upgrade", dissect = "uint"},
 197         [0x0013] = {name = "Restart", dissect = "uint"},
 198         [0x0014] = {name = "Encrypt Passwords", dissect = "uint"},
 199         [0x0400] = {name = "Defaults", dissect = "uint"},
 200         [0x0C00] = {name = "Port Status", dissect = dissect_port_status},
 201         [0x1000] = {name = "Port Statistics", dissect = dissect_port_statistics},
 202         [0x1400] = {name = "Reset Ports Statistics", dissect = "uint"},
 203         [0x1800] = {name = "Cabletest Do", dissect = nill},
 204         [0x1C00] = {name = "Cabletest Result", dissect = nill},
 205         [0x2000] = {name = "VLAN Type", dissect=dissect_vlan_type},
 206         [0x2400] = {name = "VLAN Port Conf", dissect=dissect_vlan_port_conf},
 207         [0x2800] = {name = "VLAN 802.1Q Conf", dissect=dissect_vlan_8021q_conf},
 208         [0x2C00] = {name = "Destroy VLAN", dissect = "uint"},
 209         [0x3000] = {name = "VLAN PVID", dissect = dissect_vlan_pvid},
 210         [0x3400] = {name = "QoS Type", dissect = dissect_qos_type},
 211         [0x3800] = {name = "QoS Config", dissect = dissect_qos_config},
 212         [0x4C00] = {name = "Input Bitrate", dissect = dissect_bitrate},
 213         [0x5000] = {name = "Output Bitrate", dissect = dissect_bitrate},
 214         [0x5400] = {name = "Broadcast Filtering State", dissect = "uint"},
 215         [0x5800] = {name = "Broadcast Filtering Bitrate", dissect = dissect_bitrate},
 216         [0x5C00] = {name = "Mirror", dissect = dissect_mirror},
 217         [0x6000] = {name = "Ports Count", dissect = "uint"},
 218         [0x6400] = {name = "Max 802.1Q VLAN Group", dissect = nill},
 219         [0x6800] = {name = "IGMP Enable & VLAN", dissect = dissect_igmp_enablevlan},
 220         [0x6C00] = {name = "Block Unknown IGMP Addresses", dissect = "uint"},
 221         [0x7000] = {name = "Validate IGMPv3 Headers", dissect = "uint"},
 222         [0x7400] = {name = "TLV Bitmap", dissect = nill},
 223         [0xFFFF] = {name = "End", dissect = nill}
 224 }
 225
 226
 227
 228 local function dissect_header(buffer, subtree)
 229         subtree:add(f_version, buffer(0, 1))
 230         subtree:add(f_code, buffer(1, 1)):append_text(" ("..(op_codes[buffer(1, 1):uint()] or "unknown")..")")
 231
 232         local errcode = buffer(2, 1):uint()
 233         local errattr = buffer(4, 2):uint()
 234         subtree:add(f_error, buffer(2, 1)):append_text(" ("..(error_codes[errcode] or "unknown")..")")
 235
 236         -- add the erroneous attribute only if an error occurred
 237         if (errattr ~= 0) then
 238                 local atf = attributes[errattr]
 239                 subtree:add(f_errattr, buffer(4, 2)):append_text(" ("..(atf and atf.name or "unk")..")")
 240         end
 241
 242         subtree:add(f_clientmac, buffer(8, 6))
 243         subtree:add(f_switchmac, buffer(14, 6))
 244         subtree:add(f_seqnum, buffer(20, 4))
 245 end
 246
 247
 248 local function dissect_attributes(buffer, subtree)
 249         local offset = 32
 250
 251         while (offset < buffer:len()) do
 252                 if (offset + 4 > buffer:len()) then
 253                         -- no room for an attribute header, it is an error
 254                         subtree:add(buffer(offset), "Junk"):set_expert_flags(PI_MALFORMED, PI_ERROR)
 255                         break
 256                 end
 257
 258                 local code = buffer(offset, 2):uint()
 259                 local len = buffer(offset + 2, 2):uint()
 260                 local atf = attributes[code]
 261
 262                 local attr = subtree:add(buffer(offset, math.min(4 + len, buffer:len() - offset)), string.format("Attribute: 0x%04X (%s)", code, atf and atf.name or "unk"))
 263                 attr:add(buffer(offset, 2), string.format("Code: 0x%04X", code))
 264                 attr:add(buffer(offset + 2, 2), string.format("Length: %u", len))
 265
 266                 if (offset + 4 + len > buffer:len()) then
 267                         -- attribute length is bigger than remaining packet size, it is an error
 268                         attr:append_text(" [malformed]")
 269                         attr:set_expert_flags(PI_MALFORMED, PI_ERROR)
 270                         break
 271                 end
 272
 273
 274                 if (len <= 0) then
 275                         -- no data, display nothing
 276                 elseif (atf == nil or atf.dissect == nil) then
 277                         -- unknown attribute, display raw bytes
 278                         attr:add(buffer(offset + 4, len), "Data:", tostring(buffer(offset + 4, len):bytes()))
 279                 elseif (type(atf.dissect) == "function" ) then
 280                         -- custom sub-dissector for complex type
 281                         atf.dissect(buffer, offset, attr)
 282                 else
 283                         -- simple type, directly show it
 284                         local func = assert(loadstring("return function(buffer, offset, len) return tostring(buffer(offset + 4, len):"..atf.dissect.."()) end"))() -- ugly, isn't it ?
 285                         attr:add(buffer(offset + 4, len), atf.name..":", func(buffer, offset, len))
 286                 end
 287
 288                 offset = offset + 4 + len
 289         end
 290 end
 291
 292
 293 function p_nsdp.dissector(buffer, pinfo, tree)
 294         pinfo.cols.protocol = p_nsdp.name
 295         local subtree = tree:add(p_nsdp, buffer())
 296
 297         -- stop if the packet is too small to be valid
 298         if (buffer:len() < 32) then
 299                 return
 300         end
 301
 302         dissect_header(buffer, subtree)
 303
 304         -- stop if it is just a header
 305         if (buffer:len() == 32) then
 306                 return
 307         end
 308
 309         local attr_list = subtree:add(buffer(32), "Attributes list")
 310         dissect_attributes(buffer, attr_list)
 311 end
 312
 313
 314 function p_nsdp.init ()
 315 end
 316
 317
 318 local udp_dissector_table = DissectorTable.get("udp.port")
 319 udp_dissector_table:add(63322, p_nsdp)
 320 udp_dissector_table:add(63321, p_nsdp)
 321
 322