epan/dissectors/packet-rpl.c

   1 /* packet-rpl.c
   2  * Routines for RPL
   3  * Jochen Friedrich <jochen@scram.de>
   4  *
   5  * $Id$
   6  *
   7  * Wireshark - Network traffic analyzer
   8  * By Gerald Combs <gerald@wireshark.org>
   9  * Copyright 1998 Gerald Combs
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License
  13  * as published by the Free Software Foundation; either version 2
  14  * of the License, or (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  * GNU General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with this program; if not, write to the Free Software
  23  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  24  */
  25
  26 #include "config.h"
  27
  28 #include <glib.h>
  29 #include <epan/packet.h>
  30
  31 #include <epan/llcsaps.h>
  32 #include "packet-llc.h"
  33
  34 static int proto_rpl          = -1;
  35
  36 static int hf_rpl_type        = -1;
  37 static int hf_rpl_corrval     = -1;
  38 static int hf_rpl_respval     = -1;
  39 static int hf_rpl_maxframe    = -1;
  40 static int hf_rpl_connclass   = -1;
  41 static int hf_rpl_lmac        = -1;
  42 static int hf_rpl_smac        = -1;
  43 static int hf_rpl_sap         = -1;
  44 static int hf_rpl_equipment   = -1;
  45 static int hf_rpl_memsize     = -1;
  46 static int hf_rpl_bsmversion  = -1;
  47 static int hf_rpl_adapterid   = -1;
  48 static int hf_rpl_shortname   = -1;
  49 static int hf_rpl_laddress    = -1;
  50 static int hf_rpl_xaddress    = -1;
  51 static int hf_rpl_sequence    = -1;
  52 static int hf_rpl_config      = -1;
  53 static int hf_rpl_flags       = -1;
  54 static int hf_rpl_data        = -1;
  55 static int hf_rpl_ec          = -1;
  56
  57 static gint ett_rpl           = -1;
  58 static gint ett_rpl_0004      = -1;
  59 static gint ett_rpl_0008      = -1;
  60 static gint ett_rpl_4003      = -1;
  61 static gint ett_rpl_4006      = -1;
  62 static gint ett_rpl_4007      = -1;
  63 static gint ett_rpl_4009      = -1;
  64 static gint ett_rpl_400a      = -1;
  65 static gint ett_rpl_400b      = -1;
  66 static gint ett_rpl_400c      = -1;
  67 static gint ett_rpl_4011      = -1;
  68 static gint ett_rpl_4018      = -1;
  69 static gint ett_rpl_c005      = -1;
  70 static gint ett_rpl_c014      = -1;
  71 static gint ett_rpl_unkn      = -1;
  72
  73 static const value_string rpl_type_vals[] = {
  74         { 1,            "FIND Command" },
  75         { 2,            "FOUND Frame" },
  76         { 4,            "Search Vector" },
  77         { 8,            "Connect Info Vector" },
  78         { 0x10,         "Send File Request" },
  79         { 0x20,         "File Data Response" },
  80         { 0x4003,       "Correlator Vector" },
  81         { 0x4006,       "Loader Address Vector" },
  82         { 0x4007,       "Loader SAP Vector" },
  83         { 0x4009,       "Frame Size Sub-Vector" },
  84         { 0x400a,       "Connect Class Sub-Vector" },
  85         { 0x400b,       "Response Correlator" },
  86         { 0x400c,       "Set Address Vector" },
  87         { 0x4011,       "Sequence Header" },
  88         { 0x4018,       "File Data Vector" },
  89         { 0xc005,       "Loader Info Sub-Vector" },
  90         { 0xc014,       "Loader Header" },
  91         { 0x0,  NULL }
  92 };
  93
  94 static dissector_handle_t data_handle;
  95
  96 static void
  97 dissect_rpl_container(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
  98 {
  99         guint16 len, type, sublen, subtyp;
 100         proto_item *ti;
 101         proto_tree *rpl_container_tree;
 102         guint16 offset;
 103         gint ett_type;
 104         gint length, reported_length;
 105
 106         len = tvb_get_ntohs(tvb, 0);
 107         proto_tree_add_text(tree, tvb, 0, 2, "Length: %u", len);
 108
 109         type = tvb_get_ntohs(tvb, 2);
 110         proto_tree_add_text(tree, tvb, 2, 2, "Type: %s",
 111                 val_to_str_const(type, rpl_type_vals, "Unknown Type"));
 112         offset = 4;
 113
 114         switch (type) {
 115                 case 1:
 116                 case 2:
 117                 case 4:
 118                 case 8:
 119                 case 0x10:
 120                 case 0x20:
 121                         while (len >= offset+4) {
 122                                 sublen = tvb_get_ntohs(tvb, offset);
 123                                 subtyp = tvb_get_ntohs(tvb, offset+2);
 124                                 ett_type = ett_rpl_unkn;
 125                                 if(subtyp == 0x0004) ett_type = ett_rpl_0004;
 126                                 if(subtyp == 0x0008) ett_type = ett_rpl_0008;
 127                                 if(subtyp == 0x4003) ett_type = ett_rpl_4003;
 128                                 if(subtyp == 0x4006) ett_type = ett_rpl_4006;
 129                                 if(subtyp == 0x4007) ett_type = ett_rpl_4007;
 130                                 if(subtyp == 0x4009) ett_type = ett_rpl_4009;
 131                                 if(subtyp == 0x400a) ett_type = ett_rpl_400a;
 132                                 if(subtyp == 0x400b) ett_type = ett_rpl_400b;
 133                                 if(subtyp == 0x400c) ett_type = ett_rpl_400c;
 134                                 if(subtyp == 0x4011) ett_type = ett_rpl_4011;
 135                                 if(subtyp == 0x4018) ett_type = ett_rpl_4018;
 136                                 if(subtyp == 0xc005) ett_type = ett_rpl_c005;
 137                                 if(subtyp == 0xc014) ett_type = ett_rpl_c014;
 138                                 ti = proto_tree_add_text(tree, tvb,
 139                                         offset, sublen, "%s",
 140                                         val_to_str_const(subtyp,
 141                                                 rpl_type_vals,
 142                                                 "Unknown Type"));
 143                                 rpl_container_tree = proto_item_add_subtree(ti,
 144                                         ett_type);
 145                                 length = tvb_length_remaining(tvb, offset);
 146                                 if (length > sublen)
 147                                         length = sublen;
 148                                 reported_length = tvb_reported_length_remaining(tvb, offset);
 149                                 if (reported_length > sublen)
 150                                         reported_length = sublen;
 151                                 if ( length > 0) {
 152                                   dissect_rpl_container(tvb_new_subset(tvb,
 153                                         offset, length, reported_length),
 154                                         pinfo, rpl_container_tree);
 155                                   offset += reported_length;
 156                                 } else {
 157                                   /* no more data, exit the loop */
 158                                   offset += reported_length;
 159                                   break;
 160                                 }
 161                         }
 162                         break;
 163
 164                 case 0x4003:
 165                         proto_tree_add_item(tree, hf_rpl_corrval,
 166                                 tvb, offset, 4, ENC_BIG_ENDIAN);
 167                         offset += 4;
 168                         break;
 169
 170                 case 0x4006:
 171                         proto_tree_add_item(tree, hf_rpl_lmac,
 172                                 tvb, offset, 6, ENC_NA);
 173                         offset += 6;
 174                         break;
 175
 176                 case 0x4007:
 177                         proto_tree_add_item(tree, hf_rpl_sap,
 178                                 tvb, offset, 1, ENC_BIG_ENDIAN);
 179                         offset ++;
 180                         break;
 181
 182                 case 0x4009:
 183                         proto_tree_add_item(tree, hf_rpl_maxframe,
 184                                 tvb, offset, 2, ENC_BIG_ENDIAN);
 185                         offset += 2;
 186                         break;
 187
 188                 case 0x400a:
 189                         proto_tree_add_item(tree, hf_rpl_connclass,
 190                                 tvb, offset, 2, ENC_BIG_ENDIAN);
 191                         offset += 2;
 192                         break;
 193
 194                 case 0x400b:
 195                         proto_tree_add_item(tree, hf_rpl_respval,
 196                                 tvb, offset, 1, ENC_BIG_ENDIAN);
 197                         offset ++;
 198                         break;
 199
 200                 case 0x400c:
 201                         proto_tree_add_item(tree, hf_rpl_smac,
 202                                 tvb, offset, 6, ENC_NA);
 203                         offset += 6;
 204                         break;
 205
 206                 case 0x4011:
 207                         proto_tree_add_item(tree, hf_rpl_sequence,
 208                                 tvb, offset, 4, ENC_BIG_ENDIAN);
 209                         offset += 4;
 210                         break;
 211
 212                 case 0x4018:
 213                         proto_tree_add_item(tree, hf_rpl_data,
 214                                 tvb, offset, len-4, ENC_NA);
 215                         offset += len - 4;
 216                         break;
 217
 218                 case 0xc005:
 219                         proto_tree_add_item(tree, hf_rpl_config,
 220                                 tvb, offset, 8, ENC_NA);
 221                         offset += 8;
 222                         proto_tree_add_item(tree, hf_rpl_equipment,
 223                                 tvb, offset, 2, ENC_BIG_ENDIAN);
 224                         offset += 2;
 225                         proto_tree_add_item(tree, hf_rpl_memsize,
 226                                 tvb, offset, 2, ENC_BIG_ENDIAN);
 227                         offset += 2;
 228                         proto_tree_add_item(tree, hf_rpl_bsmversion,
 229                                 tvb, offset, 2, ENC_BIG_ENDIAN);
 230                         offset += 2;
 231                         proto_tree_add_item(tree, hf_rpl_ec,
 232                                 tvb, offset, 6, ENC_NA);
 233                         offset += 6;
 234                         proto_tree_add_item(tree, hf_rpl_adapterid,
 235                                 tvb, offset, 2, ENC_BIG_ENDIAN);
 236                         offset += 2;
 237                         proto_tree_add_item(tree, hf_rpl_shortname,
 238                                 tvb, offset, 10, ENC_NA);
 239                         offset += 10;
 240                         break;
 241
 242                 case 0xc014:
 243                         proto_tree_add_item(tree, hf_rpl_laddress,
 244                                 tvb, offset, 4, ENC_BIG_ENDIAN);
 245                         offset += 4;
 246                         proto_tree_add_item(tree, hf_rpl_xaddress,
 247                                 tvb, offset, 4, ENC_BIG_ENDIAN);
 248                         offset += 4;
 249                         proto_tree_add_item(tree, hf_rpl_flags,
 250                                 tvb, offset, 1, ENC_BIG_ENDIAN);
 251                         offset ++;
 252                         break;
 253
 254                 default:
 255                         call_dissector(data_handle,
 256                                 tvb_new_subset_remaining(tvb, 4), pinfo,
 257                                 tree);
 258                         break;
 259         }
 260         if (tvb_reported_length(tvb) > offset)
 261                 call_dissector(data_handle,
 262                         tvb_new_subset_remaining(tvb, offset), pinfo, tree);
 263 }
 264
 265 static void
 266 dissect_rpl(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
 267 {
 268         guint16 rpl_len, rpl_type;
 269         proto_item *ti, *hidden_item;
 270         proto_tree *rpl_tree;
 271         tvbuff_t *next_tvb;
 272
 273         col_set_str(pinfo->cinfo, COL_PROTOCOL, "RPL");
 274
 275         rpl_len  = tvb_get_ntohs(tvb, 0);
 276         rpl_type = tvb_get_ntohs(tvb, 2);
 277
 278         col_set_str(pinfo->cinfo, COL_INFO,
 279                     val_to_str_const(rpl_type, rpl_type_vals, "Unknown Type"));
 280
 281         if (tree) {
 282                 ti = proto_tree_add_item(tree, proto_rpl, tvb, 0,
 283                         rpl_len, ENC_NA);
 284                 rpl_tree = proto_item_add_subtree(ti, ett_rpl);
 285                 hidden_item = proto_tree_add_uint(rpl_tree, hf_rpl_type, tvb, 2, 2,
 286                         rpl_type);
 287                 PROTO_ITEM_SET_HIDDEN(hidden_item);
 288                 next_tvb = tvb_new_subset_remaining(tvb, 0);
 289                 set_actual_length(next_tvb, rpl_len);
 290                 dissect_rpl_container(next_tvb, pinfo, rpl_tree);
 291
 292                 if (tvb_reported_length(tvb) > rpl_len)
 293                         call_dissector(data_handle,
 294                                 tvb_new_subset_remaining(tvb, rpl_len), pinfo,
 295                                     tree);
 296         }
 297 }
 298
 299 void
 300 proto_register_rpl(void)
 301 {
 302         static hf_register_info hf[] = {
 303                 { &hf_rpl_type,
 304                         { "Type", "rpl.type",
 305                                 FT_UINT16, BASE_DEC, NULL, 0x0,
 306                                 "RPL Packet Type", HFILL }},
 307                 { &hf_rpl_corrval,
 308                         { "Correlator Value", "rpl.corrval",
 309                                 FT_UINT32, BASE_HEX, NULL, 0x0,
 310                                 "RPL Correlator Value", HFILL }},
 311                 { &hf_rpl_respval,
 312                         { "Response Code", "rpl.respval",
 313                                 FT_UINT8, BASE_DEC, NULL, 0x0,
 314                                 "RPL Response Code", HFILL }},
 315                 { &hf_rpl_maxframe,
 316                         { "Maximum Frame Size", "rpl.maxframe",
 317                                 FT_UINT16, BASE_DEC, NULL, 0x0,
 318                                 "RPL Maximum Frame Size", HFILL }},
 319                 { &hf_rpl_connclass,
 320                         { "Connection Class", "rpl.connclass",
 321                                 FT_UINT16, BASE_HEX, NULL, 0x0,
 322                                 "RPL Connection Class", HFILL }},
 323                 { &hf_rpl_lmac,
 324                         { "Loader MAC Address", "rpl.lmac",
 325                                 FT_ETHER, BASE_NONE, NULL, 0x0,
 326                                 "RPL Loader MAC Address", HFILL }},
 327                 { &hf_rpl_smac,
 328                         { "Set MAC Address", "rpl.smac",
 329                                 FT_ETHER, BASE_NONE, NULL, 0x0,
 330                                 "RPL Set MAC Address", HFILL }},
 331                 { &hf_rpl_sap,
 332                         { "SAP", "rpl.sap",
 333                                 FT_UINT8, BASE_HEX, VALS(sap_vals), 0x0,
 334                                 "RPL SAP", HFILL }},
 335                 { &hf_rpl_equipment,
 336                         { "Equipment", "rpl.equipment",
 337                                 FT_UINT16, BASE_HEX, NULL, 0x0,
 338                                 "RPL Equipment - AX from INT 11h", HFILL }},
 339                 { &hf_rpl_memsize,
 340                         { "Memory Size", "rpl.memsize",
 341                                 FT_UINT16, BASE_DEC, NULL, 0x0,
 342                                 "RPL Memory Size - AX from INT 12h MINUS 32k MINUS the Boot ROM Size", HFILL }},
 343                 { &hf_rpl_bsmversion,
 344                         { "BSM Version", "rpl.bsmversion",
 345                                 FT_UINT16, BASE_HEX, NULL, 0x0,
 346                                 "RPL Version of BSM.obj", HFILL }},
 347                 { &hf_rpl_adapterid,
 348                         { "Adapter ID", "rpl.adapterid",
 349                                 FT_UINT16, BASE_HEX, NULL, 0x0,
 350                                 "RPL Adapter ID", HFILL }},
 351                 { &hf_rpl_shortname,
 352                         { "Short Name", "rpl.shortname",
 353                                 FT_BYTES, BASE_NONE, NULL, 0x0,
 354                                 "RPL BSM Short Name", HFILL }},
 355                 { &hf_rpl_laddress,
 356                         { "Locate Address", "rpl.laddress",
 357                                 FT_UINT32, BASE_HEX, NULL, 0x0,
 358                                 "RPL Locate Address", HFILL }},
 359                 { &hf_rpl_xaddress,
 360                         { "XFER Address", "rpl.xaddress",
 361                                 FT_UINT32, BASE_HEX, NULL, 0x0,
 362                                 "RPL Transfer Control Address", HFILL }},
 363                 { &hf_rpl_sequence,
 364                         { "Sequence Number", "rpl.sequence",
 365                                 FT_UINT32, BASE_HEX, NULL, 0x0,
 366                                 "RPL Sequence Number", HFILL }},
 367                 { &hf_rpl_config,
 368                         { "Configuration", "rpl.config",
 369                                 FT_BYTES, BASE_NONE, NULL, 0x0,
 370                                  "RPL Configuration", HFILL }},
 371                 { &hf_rpl_flags,
 372                         { "Flags", "rpl.flags",
 373                                 FT_UINT8, BASE_HEX, NULL, 0x0,
 374                                 "RPL Bit Significant Option Flags", HFILL }},
 375                 { &hf_rpl_data,
 376                         { "Data", "rpl.data",
 377                                 FT_BYTES, BASE_NONE, NULL, 0x0,
 378                                 "RPL Binary File Data", HFILL }},
 379                 { &hf_rpl_ec,
 380                         { "EC", "rpl.ec",
 381                                 FT_BYTES, BASE_NONE, NULL, 0x0,
 382                                 "RPL EC", HFILL }},
 383         };
 384
 385         static gint *ett[] = {
 386                 &ett_rpl,
 387                 &ett_rpl_0004,
 388                 &ett_rpl_0008,
 389                 &ett_rpl_4003,
 390                 &ett_rpl_4006,
 391                 &ett_rpl_4007,
 392                 &ett_rpl_4009,
 393                 &ett_rpl_400a,
 394                 &ett_rpl_400b,
 395                 &ett_rpl_400c,
 396                 &ett_rpl_4011,
 397                 &ett_rpl_4018,
 398                 &ett_rpl_c005,
 399                 &ett_rpl_c014,
 400                 &ett_rpl_unkn
 401         };
 402
 403         proto_rpl = proto_register_protocol("Remote Program Load",
 404             "RPL", "rpl");
 405         proto_register_field_array(proto_rpl, hf, array_length(hf));
 406         proto_register_subtree_array(ett, array_length(ett));
 407         register_dissector("rpl", dissect_rpl, proto_rpl);
 408 }
 409
 410 void
 411 proto_reg_handoff_rpl(void)
 412 {
 413         dissector_handle_t rpl_handle;
 414
 415         data_handle = find_dissector("data");
 416         rpl_handle = find_dissector("rpl");
 417         dissector_add_uint("llc.dsap", SAP_RPL, rpl_handle);
 418 }