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