packet-mpls.c

   1 /* packet-mpls.c
   2  * Routines for MPLS data packet disassembly
   3  *
   4  * (c) Copyright Ashok Narayanan <ashokn@cisco.com>
   5  *
   6  * $Id: packet-mpls.c,v 1.24 2001/12/10 00:25:30 guy Exp $
   7  *
   8  * Ethereal - Network traffic analyzer
   9  * By Gerald Combs <gerald@ethereal.com>
  10  * Copyright 1998 Gerald Combs
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  25  */
  26
  27 /*
  28  * NOTES
  29  *
  30  * This module defines routines to handle Ethernet-encapsulated MPLS IP packets.
  31  * It should implement all the functionality in <draft-ietf-mpls-label-encaps-07.txt>
  32  * Multicast MPLS support is not tested yet
  33  */
  34
  35
  36 #ifdef HAVE_CONFIG_H
  37 # include "config.h"
  38 #endif
  39
  40 #ifdef HAVE_SYS_TYPES_H
  41 # include <sys/types.h>
  42 #endif
  43
  44 #include <glib.h>
  45 #include "packet.h"
  46 #include "ppptypes.h"
  47 #include "etypes.h"
  48
  49 static gint proto_mpls = -1;
  50
  51 static gint ett_mpls = -1;
  52
  53 /* Special labels in MPLS */
  54 enum {
  55     IP4_EXPLICIT_NULL = 0,
  56     ROUTER_ALERT,
  57     IP6_EXPLICIT_NULL,
  58     IMPLICIT_NULL,
  59
  60     MAX_RESERVED = 15
  61 };
  62
  63 static const value_string special_labels[] = {
  64     {IP4_EXPLICIT_NULL, "IPv4 Explicit-Null"},
  65     {ROUTER_ALERT, "Router Alert"},
  66     {IP6_EXPLICIT_NULL, "IPv6 Explicit-Null"},
  67     {IMPLICIT_NULL, "Implicit-Null"},
  68     {0, NULL }
  69 };
  70
  71 /* MPLS filter values */
  72 enum mpls_filter_keys {
  73
  74     /* Is the packet MPLS-encapsulated? */
  75 /*    MPLSF_PACKET,*/
  76
  77     /* MPLS encap properties */
  78     MPLSF_LABEL,
  79     MPLSF_EXP,
  80     MPLSF_BOTTOM_OF_STACK,
  81     MPLSF_TTL,
  82
  83     MPLSF_MAX
  84 };
  85
  86 static int mpls_filter[MPLSF_MAX];
  87 static hf_register_info mplsf_info[] = {
  88
  89 /*    {&mpls_filter[MPLSF_PACKET],
  90      {"MPLS Label Switched Packet", "mpls", FT_UINT8, BASE_DEC, NULL, 0x0,
  91       "", HFILL }},*/
  92
  93     {&mpls_filter[MPLSF_LABEL],
  94      {"MPLS Label", "mpls.label", FT_UINT32, BASE_DEC, VALS(special_labels), 0x0,
  95       "", HFILL }},
  96
  97     {&mpls_filter[MPLSF_EXP],
  98      {"MPLS Experimental Bits", "mpls.exp", FT_UINT8, BASE_DEC, NULL, 0x0,
  99       "", HFILL }},
 100
 101     {&mpls_filter[MPLSF_BOTTOM_OF_STACK],
 102      {"MPLS Bottom Of Label Stack", "mpls.bottom", FT_UINT8, BASE_DEC, NULL, 0x0,
 103       "", HFILL }},
 104
 105     {&mpls_filter[MPLSF_TTL],
 106      {"MPLS TTL", "mpls.ttl", FT_UINT8, BASE_DEC, NULL, 0x0,
 107       "", HFILL }},
 108 };
 109
 110 static dissector_handle_t ipv4_handle;
 111 static dissector_handle_t ipv6_handle;
 112
 113 /*
 114  * Given a 4-byte MPLS label starting at offset "offset", in tvbuff "tvb",
 115  * decode it.
 116  * Return the label in "label", EXP bits in "exp",
 117  * bottom_of_stack in "bos", and TTL in "ttl"
 118  */
 119 void decode_mpls_label(tvbuff_t *tvb, int offset,
 120                        guint32 *label, guint8 *exp,
 121                        guint8 *bos, guint8 *ttl)
 122 {
 123     guint8 octet0 = tvb_get_guint8(tvb, offset+0);
 124     guint8 octet1 = tvb_get_guint8(tvb, offset+1);
 125     guint8 octet2 = tvb_get_guint8(tvb, offset+2);
 126
 127     *label = (octet0 << 12) + (octet1 << 4) + ((octet2 >> 4) & 0xff);
 128     *exp = (octet2 >> 1) & 0x7;
 129     *bos = (octet2 & 0x1);
 130     *ttl = tvb_get_guint8(tvb, offset+3);
 131 }
 132
 133 static void
 134 dissect_mpls(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
 135 {
 136     int offset = 0;
 137     guint32 label;
 138     guint8 exp;
 139     guint8 bos;
 140     guint8 ttl;
 141     guint8 ipvers;
 142
 143     proto_tree  *mpls_tree;
 144     proto_item  *ti;
 145     tvbuff_t *next_tvb;
 146
 147     if (check_col(pinfo->cinfo, COL_PROTOCOL)) {
 148         col_set_str(pinfo->cinfo,COL_PROTOCOL, "MPLS");
 149     }
 150
 151     if (check_col(pinfo->cinfo,COL_INFO)) {
 152         col_add_fstr(pinfo->cinfo,COL_INFO,"MPLS Label Switched Packet");
 153     }
 154
 155     /* Start Decoding Here. */
 156     while (tvb_reported_length_remaining(tvb, offset) > 0) {
 157         decode_mpls_label(tvb, offset, &label, &exp, &bos, &ttl);
 158
 159         if (tree) {
 160
 161             ti = proto_tree_add_item(tree, proto_mpls, tvb, offset, 4, FALSE);
 162             mpls_tree = proto_item_add_subtree(ti, ett_mpls);
 163
 164             if (label <= MAX_RESERVED)
 165                 proto_tree_add_uint_format(mpls_tree, mpls_filter[MPLSF_LABEL], tvb,
 166                                     offset, 3, label, "Label: %u (%s)",
 167                                     label, val_to_str(label, special_labels,
 168                                                       "Reserved - Unknown"));
 169             else
 170                 proto_tree_add_uint(mpls_tree, mpls_filter[MPLSF_LABEL], tvb,
 171                                     offset, 3, label);
 172
 173             proto_tree_add_uint(mpls_tree,mpls_filter[MPLSF_EXP], tvb,
 174                                 offset+2,1, exp);
 175             proto_tree_add_uint(mpls_tree,mpls_filter[MPLSF_BOTTOM_OF_STACK], tvb,
 176                                 offset+2,1, bos);
 177             proto_tree_add_uint(mpls_tree,mpls_filter[MPLSF_TTL], tvb,
 178                                 offset+3,1, ttl);
 179         }
 180         offset += 4;
 181         if (bos) break;
 182     }
 183     next_tvb = tvb_new_subset(tvb, offset, -1, -1);
 184
 185     ipvers = (tvb_get_guint8(tvb, offset) >> 4) & 0x0F;
 186     if (ipvers == 6) {
 187         call_dissector(ipv6_handle, next_tvb, pinfo, tree);
 188     } else {
 189         call_dissector(ipv4_handle, next_tvb, pinfo, tree);
 190     }
 191 }
 192
 193 void
 194 proto_register_mpls(void)
 195 {
 196         static gint *ett[] = {
 197                 &ett_mpls,
 198         };
 199
 200         proto_mpls = proto_register_protocol("MultiProtocol Label Switching Header",
 201             "MPLS", "mpls");
 202         proto_register_field_array(proto_mpls, mplsf_info, array_length(mplsf_info));
 203         proto_register_subtree_array(ett, array_length(ett));
 204 }
 205
 206 void
 207 proto_reg_handoff_mpls(void)
 208 {
 209         dissector_handle_t mpls_handle;
 210
 211         /*
 212          * Get a handle for the IPv4 and IPv6 dissectors.
 213          */
 214         ipv4_handle = find_dissector("ip");
 215         ipv6_handle = find_dissector("ipv6");
 216
 217         mpls_handle = create_dissector_handle(dissect_mpls, proto_mpls);
 218         dissector_add("ethertype", ETHERTYPE_MPLS, mpls_handle);
 219         dissector_add("ppp.protocol", PPP_MPLS_UNI, mpls_handle);
 220 }