From Sami Farin:
[obnox/wireshark/wip.git] / epan / xdlc.c
1 /* xdlc.c
2  * Routines for use by various SDLC-derived protocols, such as HDLC
3  * and its derivatives LAPB, IEEE 802.2 LLC, etc..
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., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
24  */
25
26 #ifdef HAVE_CONFIG_H
27 # include "config.h"
28 #endif
29
30 #include <stdio.h>
31 #include <string.h>
32
33 #include <glib.h>
34 #include <epan/packet.h>
35 #include <epan/xdlc.h>
36 #include <epan/emem.h>
37
38 const value_string ftype_vals[] = {
39     { XDLC_I, "Information frame" },
40     { XDLC_S, "Supervisory frame" },
41     { XDLC_U, "Unnumbered frame" },
42     { 0,      NULL }
43 };
44
45 const value_string stype_vals[] = {
46     { XDLC_RR>>2,   "Receiver ready" },
47     { XDLC_RNR>>2,  "Receiver not ready" },
48     { XDLC_REJ>>2,  "Reject" },
49     { XDLC_SREJ>>2, "Selective reject" },
50     { 0,            NULL }
51 };
52
53 static const value_string modifier_short_vals_cmd[] = {
54     { XDLC_UI,    "UI" },
55     { XDLC_UP,    "UP" },
56     { XDLC_DISC,  "DISC" },
57     { XDLC_UA,    "UA" },
58     { XDLC_SNRM,  "SNRM" },
59     { XDLC_SNRME, "SNRME" },
60     { XDLC_TEST,  "TEST" },
61     { XDLC_SIM,   "SIM" },
62     { XDLC_FRMR,  "FRMR" },
63     { XDLC_CFGR,  "CFGR" },
64     { XDLC_SARM,  "SARM" },
65     { XDLC_SABM,  "SABM" },
66     { XDLC_SARME, "SARME" },
67     { XDLC_SABME, "SABME" },
68     { XDLC_RESET, "RESET" },
69     { XDLC_XID,   "XID" },
70     { XDLC_SNRME, "SNRME" },
71     { XDLC_BCN,   "BCN" },
72     { 0,          NULL }
73 };
74
75 const value_string modifier_vals_cmd[] = {
76     { XDLC_UI>>2,    "Unnumbered Information" },
77     { XDLC_UP>>2,    "Unnumbered Poll" },
78     { XDLC_DISC>>2,  "Disconnect" },
79     { XDLC_UA>>2,    "Unnumbered Acknowledge" },
80     { XDLC_SNRM>>2,  "Set Normal Response Mode" },
81     { XDLC_TEST>>2,  "Test" },
82     { XDLC_SIM>>2,   "Set Initialization Mode" },
83     { XDLC_FRMR>>2,  "Frame reject" },
84     { XDLC_CFGR>>2,  "Configure" },
85     { XDLC_SARM>>2,  "Set Asynchronous Response Mode" },
86     { XDLC_SABM>>2,  "Set Asynchronous Balanced Mode" },
87     { XDLC_SARME>>2, "Set Asynchronous Response Mode Extended" },
88     { XDLC_SABME>>2, "Set Asynchronous Balanced Mode Extended" },
89     { XDLC_RESET>>2, "Reset" },
90     { XDLC_XID>>2,   "Exchange identification" },
91     { XDLC_SNRME>>2, "Set Normal Response Mode Extended" },
92     { XDLC_BCN>>2,   "Beacon" },
93     { 0,             NULL }
94 };
95
96 static const value_string modifier_short_vals_resp[] = {
97     { XDLC_UI,    "UI" },
98     { XDLC_UP,    "UP" },
99     { XDLC_RD,    "RD" },
100     { XDLC_UA,    "UA" },
101     { XDLC_SNRM,  "SNRM" },
102     { XDLC_TEST,  "TEST" },
103     { XDLC_RIM,   "RIM" },
104     { XDLC_FRMR,  "FRMR" },
105     { XDLC_CFGR,  "CFGR" },
106     { XDLC_DM,    "DM" },
107     { XDLC_SABM,  "SABM" },
108     { XDLC_SARME, "SARME" },
109     { XDLC_SABME, "SABME" },
110     { XDLC_RESET, "RESET" },
111     { XDLC_XID,   "XID" },
112     { XDLC_SNRME, "SNRME" },
113     { XDLC_BCN,   "BCN" },
114     { 0,          NULL }
115 };
116
117 const value_string modifier_vals_resp[] = {
118     { XDLC_UI>>2,    "Unnumbered Information" },
119     { XDLC_UP>>2,    "Unnumbered Poll" },
120     { XDLC_RD>>2,    "Request Disconnect" },
121     { XDLC_UA>>2,    "Unnumbered Acknowledge" },
122     { XDLC_SNRM>>2,  "Set Normal Response Mode" },
123     { XDLC_TEST>>2,  "Test" },
124     { XDLC_RIM>>2,   "Request Initialization Mode" },
125     { XDLC_FRMR>>2,  "Frame reject" },
126     { XDLC_CFGR>>2,  "Configure" },
127     { XDLC_DM>>2,    "Disconnected mode" },
128     { XDLC_SABM>>2,  "Set Asynchronous Balanced Mode" },
129     { XDLC_SARME>>2, "Set Asynchronous Response Mode Extended" },
130     { XDLC_SABME>>2, "Set Asynchronous Balanced Mode Extended" },
131     { XDLC_RESET>>2, "Reset" },
132     { XDLC_XID>>2,   "Exchange identification" },
133     { XDLC_SNRME>>2, "Set Normal Response Mode Extended" },
134     { XDLC_BCN>>2,   "Beacon" },
135     { 0,             NULL }
136 };
137
138 int
139 get_xdlc_control(const guchar *pd, int offset, int is_extended)
140 {
141     guint16 control;
142
143     switch (pd[offset] & 0x03) {
144
145     case XDLC_S:
146     default:
147         /*
148          * Supervisory or Information frame.
149          */
150         if (is_extended)
151                 control = pletohs(&pd[offset]);
152         else
153                 control = pd[offset];
154         break;
155
156     case XDLC_U:
157         /*
158          * Unnumbered frame.
159          *
160          * XXX - is this two octets, with a P/F bit, in HDLC extended
161          * operation?  It's one octet in LLC, even though the control
162          * field of I and S frames is a 2-byte extended-operation field
163          * in LLC.  Given that there are no sequence numbers in the
164          * control field of a U frame, there doesn't appear to be any
165          * need for it to be 2 bytes in extended operation.
166          */
167         control = pd[offset];
168         break;
169     }
170     return control;
171 }
172
173 int
174 dissect_xdlc_control(tvbuff_t *tvb, int offset, packet_info *pinfo,
175   proto_tree *xdlc_tree, int hf_xdlc_control, gint ett_xdlc_control,
176   const xdlc_cf_items *cf_items_nonext, const xdlc_cf_items *cf_items_ext,
177   const value_string *u_modifier_short_vals_cmd,
178   const value_string *u_modifier_short_vals_resp, int is_response,
179   int is_extended, int append_info)
180 {
181     guint16 control;
182     int control_len;
183     const xdlc_cf_items *cf_items;
184     const char *control_format;
185     guint16 poll_final;
186     char *info;
187     proto_tree *tc, *control_tree;
188     const gchar *frame_type = NULL;
189     const gchar *modifier;
190
191     info=ep_alloc(80);
192     switch (tvb_get_guint8(tvb, offset) & 0x03) {
193
194     case XDLC_S:
195         if (is_extended) {
196             control = tvb_get_letohs(tvb, offset);
197             control_len = 2;
198             cf_items = cf_items_ext;
199             control_format = "Control field: %s (0x%04X)";
200         } else {
201             control = tvb_get_guint8(tvb, offset);
202             control_len = 1;
203             cf_items = cf_items_nonext;
204             control_format = "Control field: %s (0x%02X)";
205         }
206         /*
207          * Supervisory frame.
208          */
209         switch (control & XDLC_S_FTYPE_MASK) {
210         case XDLC_RR:
211             frame_type = "RR";
212             break;
213
214         case XDLC_RNR:
215             frame_type = "RNR";
216             break;
217
218         case XDLC_REJ:
219             frame_type = "REJ";
220             break;
221
222         case XDLC_SREJ:
223             frame_type = "SREJ";
224             break;
225         }
226         if (is_extended) {
227             poll_final = (control & XDLC_P_F_EXT);
228             g_snprintf(info, 80, "S%s, func=%s, N(R)=%u",
229                         (poll_final ?
230                             (is_response ? " F" : " P") :
231                             ""),
232                         frame_type,
233                         (control & XDLC_N_R_EXT_MASK) >> XDLC_N_R_EXT_SHIFT);
234         } else {
235             poll_final = (control & XDLC_P_F);
236             g_snprintf(info, 80, "S%s, func=%s, N(R)=%u",
237                         (poll_final ?
238                             (is_response ? " F" : " P") :
239                             ""),
240                         frame_type,
241                         (control & XDLC_N_R_MASK) >> XDLC_N_R_SHIFT);
242         }
243         if (check_col(pinfo->cinfo, COL_INFO)) {
244             if (append_info) {
245                 col_append_str(pinfo->cinfo, COL_INFO, ", ");
246                 col_append_str(pinfo->cinfo, COL_INFO, info);
247             } else
248                 col_add_str(pinfo->cinfo, COL_INFO, info);
249         }
250         if (xdlc_tree) {
251             tc = proto_tree_add_uint_format(xdlc_tree, hf_xdlc_control, tvb,
252                 offset, control_len, control, control_format, info, control);
253             control_tree = proto_item_add_subtree(tc, ett_xdlc_control);
254             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_n_r,
255                 tvb, offset, control_len, control);
256             if (poll_final) {
257                 proto_tree_add_boolean(control_tree,
258                         (is_response ? *cf_items->hf_xdlc_f :
259                                        *cf_items->hf_xdlc_p),
260                         tvb, offset, control_len, control);
261             }
262             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_s_ftype,
263                 tvb, offset, control_len, control);
264             /* This will always say it's a supervisory frame */
265             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_ftype_s_u,
266                 tvb, offset, control_len, control);
267         }
268         break;
269
270     case XDLC_U:
271         /*
272          * Unnumbered frame.
273          *
274          * XXX - is this two octets, with a P/F bit, in HDLC extended
275          * operation?  It's one octet in LLC, even though the control
276          * field of I and S frames is a 2-byte extended-operation field
277          * in LLC.  Given that there are no sequence numbers in the
278          * control field of a U frame, there doesn't appear to be any
279          * need for it to be 2 bytes in extended operation.
280          */
281         if (u_modifier_short_vals_cmd == NULL)
282                 u_modifier_short_vals_cmd = modifier_short_vals_cmd;
283         if (u_modifier_short_vals_resp == NULL)
284                 u_modifier_short_vals_resp = modifier_short_vals_resp;
285         control = tvb_get_guint8(tvb, offset);
286         control_len = 1;
287         cf_items = cf_items_nonext;
288         control_format = "Control field: %s (0x%02X)";
289         if (is_response) {
290                 modifier = val_to_str(control & XDLC_U_MODIFIER_MASK,
291                         u_modifier_short_vals_resp, "Unknown");
292         } else {
293                 modifier = val_to_str(control & XDLC_U_MODIFIER_MASK,
294                         u_modifier_short_vals_cmd, "Unknown");
295         }
296         poll_final = (control & XDLC_P_F);
297         g_snprintf(info, 80, "U%s, func=%s",
298                 (poll_final ?
299                     (is_response ? " F" : " P") :
300                     ""),
301                 modifier);
302         if (check_col(pinfo->cinfo, COL_INFO)) {
303             if (append_info) {
304                 col_append_str(pinfo->cinfo, COL_INFO, ", ");
305                 col_append_str(pinfo->cinfo, COL_INFO, info);
306             } else
307                 col_add_str(pinfo->cinfo, COL_INFO, info);
308         }
309         if (xdlc_tree) {
310             tc = proto_tree_add_uint_format(xdlc_tree, hf_xdlc_control, tvb,
311                 offset, control_len, control, control_format, info, control);
312             control_tree = proto_item_add_subtree(tc, ett_xdlc_control);
313             if (poll_final) {
314                 proto_tree_add_boolean(control_tree,
315                         (is_response ? *cf_items->hf_xdlc_f:
316                                        *cf_items->hf_xdlc_p),
317                         tvb, offset, control_len, control);
318             }
319             proto_tree_add_uint(control_tree,
320                 (is_response ? *cf_items->hf_xdlc_u_modifier_resp :
321                                *cf_items->hf_xdlc_u_modifier_cmd),
322                 tvb, offset, control_len, control);
323             /* This will always say it's an unnumbered frame */
324             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_ftype_s_u,
325                 tvb, offset, control_len, control);
326         }
327         break;
328
329     default:
330         /*
331          * Information frame.
332          */
333         if (is_extended) {
334             control = tvb_get_letohs(tvb, offset);
335             control_len = 2;
336             cf_items = cf_items_ext;
337             control_format = "Control field: %s (0x%04X)";
338             poll_final = (control & XDLC_P_F_EXT);
339             g_snprintf(info, 80, "I%s, N(R)=%u, N(S)=%u",
340                         ((control & XDLC_P_F_EXT) ? " P" : ""),
341                         (control & XDLC_N_R_EXT_MASK) >> XDLC_N_R_EXT_SHIFT,
342                         (control & XDLC_N_S_EXT_MASK) >> XDLC_N_S_EXT_SHIFT);
343         } else {
344             control = tvb_get_guint8(tvb, offset);
345             control_len = 1;
346             cf_items = cf_items_nonext;
347             control_format = "Control field: %s (0x%02X)";
348             poll_final = (control & XDLC_P_F);
349             g_snprintf(info, 80, "I%s, N(R)=%u, N(S)=%u",
350                         ((control & XDLC_P_F) ? " P" : ""),
351                         (control & XDLC_N_R_MASK) >> XDLC_N_R_SHIFT,
352                         (control & XDLC_N_S_MASK) >> XDLC_N_S_SHIFT);
353         }
354         if (check_col(pinfo->cinfo, COL_INFO)) {
355             if (append_info) {
356                 col_append_str(pinfo->cinfo, COL_INFO, ", ");
357                 col_append_str(pinfo->cinfo, COL_INFO, info);
358             } else
359                 col_add_str(pinfo->cinfo, COL_INFO, info);
360         }
361         if (xdlc_tree) {
362             tc = proto_tree_add_uint_format(xdlc_tree, hf_xdlc_control, tvb,
363                 offset, control_len, control, control_format, info, control);
364             control_tree = proto_item_add_subtree(tc, ett_xdlc_control);
365             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_n_r,
366                 tvb, offset, control_len, control);
367             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_n_s,
368                 tvb, offset, control_len, control);
369             if (poll_final) {
370                 proto_tree_add_boolean(control_tree, *cf_items->hf_xdlc_p,
371                         tvb, offset, control_len, control);
372             }
373             /* This will always say it's an information frame */
374             proto_tree_add_uint(control_tree, *cf_items->hf_xdlc_ftype_i,
375                 tvb, offset, control_len, control);
376         }
377         break;
378     }
379     return control;
380 }