diff options
author | Gerald Combs <gerald@wireshark.org> | 2007-05-25 23:40:42 +0000 |
---|---|---|
committer | Gerald Combs <gerald@wireshark.org> | 2007-05-25 23:40:42 +0000 |
commit | a491fec183044f6065b8d92a3775f5130049b636 (patch) | |
tree | 3f899da6a2bb6dead6dbfa2392764a88ac26faa6 /plugins/wimax/wimax_pdu_decoder.c | |
parent | 1e7c1bc0369f0c962ed73e8e34fa5ba7fa1a6c3d (diff) |
From Mike Harvey: Support for WiMAX and the WiMAX M2M encapsulation protocol.
Add support for WiMAX and M2M to various makefiles and installer files. Add
basic support for M2M to randpkt.
svn path=/trunk/; revision=21945
Diffstat (limited to 'plugins/wimax/wimax_pdu_decoder.c')
-rw-r--r-- | plugins/wimax/wimax_pdu_decoder.c | 271 |
1 files changed, 271 insertions, 0 deletions
diff --git a/plugins/wimax/wimax_pdu_decoder.c b/plugins/wimax/wimax_pdu_decoder.c new file mode 100644 index 0000000000..4dc5e9f1b4 --- /dev/null +++ b/plugins/wimax/wimax_pdu_decoder.c @@ -0,0 +1,271 @@ +/* wimax_pdu_decoder.c + * WiMax PDU Burst decoder + * + * Copyright (c) 2007 by Intel Corporation. + * + * Author: Lu Pan <lu.pan@intel.com> + * + * $Id$ + * + * Wireshark - Network traffic analyzer + * By Gerald Combs <gerald@wireshark.org> + * Copyright 1999 Gerald Combs + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + */ + +/* Include files */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include <gmodule.h> +#include <epan/packet.h> +#include <epan/prefs.h> +#include "crc.h" + +extern gint proto_wimax; + +extern void proto_register_mac_header_generic(void); +extern void proto_register_mac_header_type_1(void); +extern void proto_register_mac_header_type_2(void); + + +/* MAC Header dissector prototypes */ +extern void dissect_mac_header_generic_decoder(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree); +extern void dissect_mac_header_type_1_decoder(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree); +extern void dissect_mac_header_type_2_decoder(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree); +extern void dissector_wimax_harq_map_decoder(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree); +extern gboolean is_down_link(address *src_address); +extern gint wimax_decode_dlmap_reduced_aas(tvbuff_t *tvb, packet_info *pinfo, proto_tree *base_tree); +extern gint wimax_decode_dlmapc(tvbuff_t *tvb, packet_info *pinfo, proto_tree *pdu_tree); + +#define WIMAX_PDU_PADDING_MASK 0xFF +#define WIMAX_INVALID_PDU_MASK 0xF0 +#define WIMAX_MAP_TYPE_MASK 0xE0 /* 0b111 */ +#define WIMAX_HARQ_MAP_MSG_IND 0xE0 /* 0b111 */ +#define WIMAX_COMPRESSED_DL_MAP_IND 0xC0 /* 0b110 */ +#define REDUCED_PRIVATE_MAP_MASK 0x0C /* 0b11 */ + +#define WIMAX_MAC_HEADER_SIZE 6 +#define WIMAX_MAC_HEADER_INFO_FIELDS 5 +#define WIMAX_MAC_HEADER_HT_FIELD 0x80 +#define WIMAX_MAC_HEADER_EC_FIELD 0x40 +#define WIMAX_MAC_HEADER_LENGTH_MSB_MASK 0x07 + +#define WIMAX_HARQ_MAP_MSG_LENGTH_MASK1 0x07FC +/* Global Variables. */ +gboolean first_gmh; + +/* forward reference */ +static void dissect_wimax_pdu_decoder(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree); + +static gint proto_wimax_pdu_decoder = -1; +static gint ett_wimax_pdu_decoder = -1; + +static int hf_wimax_value_bytes = -1; + +/* PDU display */ +static hf_register_info hf[] = +{ + { + &hf_wimax_value_bytes, + { + "Values", "wimax.pdu.value", + FT_BYTES, BASE_HEX, NULL, 0x0, + "", HFILL + } + }, +}; + +/* Setup protocol subtree array */ +static gint *ett[] = +{ + &ett_wimax_pdu_decoder, +}; + +/* Register Wimax PDU Burst Protocol */ +void proto_register_wimax_pdu(void) +{ + if (proto_wimax_pdu_decoder == -1) + { + proto_wimax_pdu_decoder = proto_wimax; + + register_dissector("wimax_pdu_burst_handler", dissect_wimax_pdu_decoder, -1); + proto_register_field_array(proto_wimax_pdu_decoder, hf, array_length(hf)); + proto_register_subtree_array(ett, array_length(ett)); + + proto_register_mac_header_generic(); + proto_register_mac_header_type_1(); + proto_register_mac_header_type_2(); + } +} + +static void dissect_wimax_pdu_decoder(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree) +{ + guint offset; + guint mac_ht, mac_ec; + guint first_byte, length; + guint mac_hcs, mac_hcs_calculated; + proto_item *pdu_item = NULL; + proto_tree *pdu_tree = NULL; + +#ifndef STATIC_DATA + /* generate the table of CRC32 remainders for all possible bytes */ + wimax_mac_gen_crc32_table(); + /* generate the table of CRC8 remainders for all possible bytes */ + wimax_mac_gen_crc8_table(); +#endif + + /* parsing the PDU burst */ + for(offset = 0; offset < tvb_length(tvb); ) + { + if (offset == 0) + { + first_gmh = TRUE; + } + else + { + first_gmh = FALSE; + } + /* get the length of the remainder */ + length = tvb_length_remaining(tvb, offset); + /* get the first byte at offset */ + first_byte = tvb_get_guint8(tvb, offset); + /* check for padding */ + if(first_byte == WIMAX_PDU_PADDING_MASK) + { /* Padding */ + /* display message */ + pdu_item = proto_tree_add_protocol_format(tree, proto_wimax_pdu_decoder, tvb, offset, length, "Padding (%u bytes)", length); + /* add subtree */ + pdu_tree = proto_item_add_subtree(pdu_item, ett_wimax_pdu_decoder); + /* display the padding in Hex */ + proto_tree_add_item(pdu_tree, hf_wimax_value_bytes, tvb, offset, length, FALSE); + break; + } + else if((first_byte & WIMAX_MAP_TYPE_MASK) == WIMAX_HARQ_MAP_MSG_IND) + { /* HARQ MAP message (no mac header) */ + /* get the HARQ MAp Message Length */ + length = ((tvb_get_ntohs(tvb, offset) & WIMAX_HARQ_MAP_MSG_LENGTH_MASK1) >> 2); + if (length == 0) + { + length = 3; /* At least 3 bytes. This prevents endless loop */ + } + dissector_wimax_harq_map_decoder(tvb_new_subset(tvb,offset,length,length), pinfo, tree); + offset += length; + continue; + } + else if((first_byte & WIMAX_MAP_TYPE_MASK) == WIMAX_COMPRESSED_DL_MAP_IND) + { + if(is_down_link(&pinfo->src)) + { /* decode compressed dl-map without mac header */ + if ((first_byte & REDUCED_PRIVATE_MAP_MASK) == REDUCED_PRIVATE_MAP_MASK) + { + length = wimax_decode_dlmap_reduced_aas(tvb, pinfo, tree); + } + else + { + length = wimax_decode_dlmapc(tvb, pinfo, tree); + } + offset += length; + continue; + } + } + else if((first_byte & WIMAX_INVALID_PDU_MASK) == WIMAX_INVALID_PDU_MASK) + { /* Invalid PDU */ + /* update the info column */ + if (check_col(pinfo->cinfo, COL_INFO)) + { + col_append_sep_str(pinfo->cinfo, COL_INFO, NULL, "Invalid PDU"); + } + /* display message */ + pdu_item = proto_tree_add_protocol_format(tree, proto_wimax_pdu_decoder, tvb, offset, length, "Invalid PDU (%u bytes)", length); + /* add subtree */ + pdu_tree = proto_item_add_subtree(pdu_item, ett_wimax_pdu_decoder); + /* display the invalid MAC Header in Hex */ + proto_tree_add_item(pdu_tree, hf_wimax_value_bytes, tvb, offset, length, FALSE); + break; + } + /* calculate the MAC header HCS */ + mac_hcs_calculated = wimax_mac_calc_crc8((guint8 *)tvb_get_ptr(tvb, offset, WIMAX_MAC_HEADER_INFO_FIELDS), WIMAX_MAC_HEADER_INFO_FIELDS); + /* get the Header Check Sequence (HCS) in the header */ + mac_hcs = tvb_get_guint8(tvb, offset + WIMAX_MAC_HEADER_SIZE - 1); + /* verify the HCS */ + if(mac_hcs != mac_hcs_calculated) + { + /* update the info column */ + if (check_col(pinfo->cinfo, COL_INFO)) + { + col_append_sep_str(pinfo->cinfo, COL_INFO, NULL, "MAC Header CRC error"); + } + /* display message */ + pdu_item = proto_tree_add_protocol_format(tree, proto_wimax_pdu_decoder, tvb, offset, WIMAX_MAC_HEADER_SIZE, "MAC Header CRC error %X (in header) and %X (calculated)", mac_hcs, mac_hcs_calculated); + /* add subtree */ + pdu_tree = proto_item_add_subtree(pdu_item, ett_wimax_pdu_decoder); + /* display the bad MAC Header in Hex */ + proto_tree_add_item(pdu_tree, hf_wimax_value_bytes, tvb, offset, length, FALSE); + break; + } + /* get the Header Type (HT) */ + mac_ht = ((first_byte & WIMAX_MAC_HEADER_HT_FIELD)?1:0); + /* get the Encryption Control (EC) */ + mac_ec = ((first_byte & WIMAX_MAC_HEADER_EC_FIELD)?1:0); + /* update the MAC length for Generic MAC frame */ + if(!mac_ht) + { /* Generic MAC Header with payload */ + /* get the MAC length */ + length = (tvb_get_guint8(tvb, offset+1) & WIMAX_MAC_HEADER_LENGTH_MSB_MASK); + length = ((length<<8) | tvb_get_guint8(tvb, offset+2)); + } + else /* MAC signaling Headers or Bandwidth Request Headers */ + { /* set the mac length */ + length = WIMAX_MAC_HEADER_SIZE; + } + /* display PDU frame info */ + /* + pdu_item = proto_tree_add_protocol_format(tree, proto_wimax_pdu_decoder, tvb, offset, length, "PDU Frame (%u bytes)", length); + */ + pdu_item = proto_tree_add_protocol_format(tree, proto_wimax_pdu_decoder, tvb, offset, length, "PDU (%u bytes)", length); + /* add PDU subtree */ + pdu_tree = proto_item_add_subtree(pdu_item, ett_wimax_pdu_decoder); + if (length == 0) { + offset += 6; /* Add header size. */ + /* Must skip the code below or tvb_new_subset() + * keeps allocating memory until it runs out. */ + continue; + } + /* process the valid MAC header */ + if(mac_ht) + { /* MAC signaling Headers or Bandwidth Request Headers */ + /* check the header type */ + if(mac_ec) + { /* MAC Signaling Header Type II Header */ + proto_item_append_text(pdu_item, " - Mac Type II Header: "); + dissect_mac_header_type_2_decoder(tvb_new_subset(tvb,offset,length,length), pinfo, pdu_tree); + } + else + { /* MAC Signaling Header Type I Header */ + proto_item_append_text(pdu_item, " - Mac Type I Header: "); + dissect_mac_header_type_1_decoder(tvb_new_subset(tvb,offset,length,length), pinfo, pdu_tree); + } + } + else /* Generic MAC Header with payload */ + { + dissect_mac_header_generic_decoder(tvb_new_subset(tvb,offset,length,length), pinfo, pdu_tree); + } + offset += length; + } +} |