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