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