2013-10-27 22:40:45 +00:00
|
|
|
/* packet-pn532_hci.c
|
2013-12-09 22:23:44 +00:00
|
|
|
* Routines for NXP PN532 HCI Protocol
|
2013-10-27 22:40:45 +00:00
|
|
|
*
|
|
|
|
* http://www.nxp.com/documents/user_manual/141520.pdf
|
|
|
|
*
|
|
|
|
* Copyright 2013, Michal Labedzki for Tieto Corporation
|
|
|
|
*
|
|
|
|
* Wireshark - Network traffic analyzer
|
|
|
|
* By Gerald Combs <gerald@wireshark.org>
|
|
|
|
* Copyright 1998 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 thehf_class
|
|
|
|
* 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "config.h"
|
|
|
|
|
|
|
|
#include <epan/packet.h>
|
|
|
|
#include <epan/prefs.h>
|
|
|
|
#include <epan/expert.h>
|
|
|
|
#include "packet-usb.h"
|
|
|
|
|
|
|
|
static int proto_pn532_hci = -1;
|
|
|
|
static int hf_preamble = -1;
|
|
|
|
static int hf_start_code = -1;
|
|
|
|
static int hf_length = -1;
|
|
|
|
static int hf_length_checksum = -1;
|
|
|
|
static int hf_extended_length = -1;
|
|
|
|
static int hf_packet_code = -1;
|
|
|
|
static int hf_postable = -1;
|
|
|
|
static int hf_specific_application_level_error_code = -1;
|
|
|
|
static int hf_data_checksum = -1;
|
|
|
|
static int hf_ignored = -1;
|
|
|
|
|
|
|
|
static gint ett_pn532_hci = -1;
|
|
|
|
|
|
|
|
static expert_field ei_invalid_length_checksum = EI_INIT;
|
|
|
|
static expert_field ei_invalid_data_checksum = EI_INIT;
|
|
|
|
|
|
|
|
static dissector_handle_t pn532_handle;
|
|
|
|
static dissector_handle_t pn532_hci_handle;
|
|
|
|
|
|
|
|
static const value_string packet_code_vals[] = {
|
|
|
|
{ 0x00FF, "ACK Frame" },
|
|
|
|
{ 0x01FF, "Error Frame" },
|
|
|
|
{ 0xFF00, "NACK Frame" },
|
|
|
|
{ 0xFFFF, "Extended Information Frame" },
|
|
|
|
{ 0, NULL }
|
|
|
|
};
|
|
|
|
|
|
|
|
void proto_register_pn532_hci(void);
|
|
|
|
void proto_reg_handoff_pn532_hci(void);
|
|
|
|
|
|
|
|
static gint
|
|
|
|
dissect_pn532_hci(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data)
|
|
|
|
{
|
|
|
|
proto_item *main_item;
|
|
|
|
proto_tree *main_tree;
|
|
|
|
gint offset = 0;
|
|
|
|
tvbuff_t *next_tvb;
|
|
|
|
guint16 packet_code;
|
|
|
|
guint16 length;
|
|
|
|
guint8 checksum;
|
2013-12-09 22:23:44 +00:00
|
|
|
usb_conv_info_t *usb_conv_info;
|
2013-10-27 22:40:45 +00:00
|
|
|
|
2013-12-09 22:23:44 +00:00
|
|
|
/* Reject the packet if data is NULL */
|
|
|
|
if (data == NULL)
|
|
|
|
return 0;
|
|
|
|
usb_conv_info = (usb_conv_info_t *)data;
|
2013-10-27 22:40:45 +00:00
|
|
|
|
2014-06-19 17:18:16 +00:00
|
|
|
length = tvb_length_remaining(tvb, offset);
|
2013-10-27 22:40:45 +00:00
|
|
|
if (length < 6) return offset;
|
|
|
|
|
|
|
|
col_set_str(pinfo->cinfo, COL_PROTOCOL, "PN532_HCI");
|
|
|
|
col_clear(pinfo->cinfo, COL_INFO);
|
|
|
|
|
|
|
|
main_item = proto_tree_add_item(tree, proto_pn532_hci, tvb, offset, -1, ENC_NA);
|
|
|
|
main_tree = proto_item_add_subtree(main_item, ett_pn532_hci);
|
|
|
|
|
|
|
|
length = 0;
|
2014-06-19 17:18:16 +00:00
|
|
|
while (tvb_length_remaining(tvb, length) >= 2 && tvb_get_ntohs(tvb, length) != 0x00FF) {
|
2013-10-27 22:40:45 +00:00
|
|
|
length += 1;
|
|
|
|
}
|
|
|
|
if (length) {
|
|
|
|
proto_tree_add_item(main_tree, hf_preamble, tvb, offset, length, ENC_NA);
|
|
|
|
offset += length;
|
|
|
|
}
|
|
|
|
|
|
|
|
proto_tree_add_item(main_tree, hf_start_code, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
offset += 2;
|
|
|
|
|
|
|
|
packet_code = tvb_get_ntohs(tvb, offset);
|
|
|
|
if (packet_code == 0x00FF) { /* ACK Frame */
|
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(packet_code, packet_code_vals, "Unknown frame"));
|
|
|
|
|
|
|
|
proto_tree_add_item(main_tree, hf_packet_code, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
offset += 2;
|
|
|
|
} else if (packet_code == 0xFF00) { /* NACK Frame */
|
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(packet_code, packet_code_vals, "Unknown frame"));
|
|
|
|
|
|
|
|
proto_tree_add_item(main_tree, hf_packet_code, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
offset += 2;
|
|
|
|
} else if (packet_code == 0x01FF) { /* Error Frame */
|
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(packet_code, packet_code_vals, "Unknown frame"));
|
|
|
|
|
|
|
|
proto_tree_add_item(main_tree, hf_packet_code, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
offset += 2;
|
|
|
|
|
2014-12-13 17:52:20 +00:00
|
|
|
proto_tree_add_item(main_tree, hf_specific_application_level_error_code, tvb, offset, 1, ENC_BIG_ENDIAN);
|
2013-10-27 22:40:45 +00:00
|
|
|
offset += 1;
|
|
|
|
} else if (packet_code == 0xFFFF) { /* Extended Information Frame */
|
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, "Extended Information Frame");
|
|
|
|
|
|
|
|
proto_tree_add_item(main_tree, hf_extended_length, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
|
|
length = tvb_get_ntohs(tvb, offset);
|
|
|
|
offset += 2;
|
|
|
|
|
2014-12-13 17:52:20 +00:00
|
|
|
proto_tree_add_item(main_tree, hf_length_checksum, tvb, offset, 1, ENC_BIG_ENDIAN);
|
2013-10-27 22:40:45 +00:00
|
|
|
checksum = (length >> 8) + (length & 0xFF) + tvb_get_guint8(tvb, offset);
|
|
|
|
if (checksum != 0) {
|
|
|
|
proto_tree_add_expert(main_tree, pinfo, &ei_invalid_length_checksum, tvb, offset, 1);
|
|
|
|
}
|
|
|
|
offset += 1;
|
|
|
|
|
2014-06-06 14:35:50 +00:00
|
|
|
next_tvb = tvb_new_subset_length(tvb, offset, length);
|
2013-11-12 13:46:51 +00:00
|
|
|
call_dissector_with_data(pn532_handle, next_tvb, pinfo, tree, usb_conv_info);
|
2013-10-27 22:40:45 +00:00
|
|
|
offset += length;
|
|
|
|
|
2014-12-13 17:52:20 +00:00
|
|
|
proto_tree_add_item(main_tree, hf_data_checksum, tvb, offset, 1, ENC_BIG_ENDIAN);
|
2013-10-27 22:40:45 +00:00
|
|
|
checksum = tvb_get_guint8(tvb, offset);
|
|
|
|
while (length) {
|
|
|
|
checksum += tvb_get_guint8(tvb, offset - length);
|
|
|
|
length -= 1;
|
|
|
|
}
|
|
|
|
if (checksum != 0) {
|
|
|
|
proto_tree_add_expert(main_tree, pinfo, &ei_invalid_data_checksum, tvb, offset, 1);
|
|
|
|
}
|
|
|
|
offset += 1;
|
|
|
|
} else { /* Normal Information Frame */
|
|
|
|
col_set_str(pinfo->cinfo, COL_INFO, "Normal Information Frame");
|
|
|
|
|
2014-12-13 17:52:20 +00:00
|
|
|
proto_tree_add_item(main_tree, hf_length, tvb, offset, 1, ENC_BIG_ENDIAN);
|
2013-10-27 22:40:45 +00:00
|
|
|
length = tvb_get_guint8(tvb, offset);
|
|
|
|
offset += 1;
|
|
|
|
|
2014-12-13 17:52:20 +00:00
|
|
|
proto_tree_add_item(main_tree, hf_length_checksum, tvb, offset, 1, ENC_BIG_ENDIAN);
|
2013-10-27 22:40:45 +00:00
|
|
|
checksum = length + tvb_get_guint8(tvb, offset);
|
|
|
|
if (checksum != 0)
|
|
|
|
proto_tree_add_expert(main_tree, pinfo, &ei_invalid_length_checksum, tvb, offset, 1);
|
|
|
|
offset += 1;
|
|
|
|
|
2014-06-06 14:35:50 +00:00
|
|
|
next_tvb = tvb_new_subset_length(tvb, offset, length);
|
2013-11-12 13:46:51 +00:00
|
|
|
call_dissector_with_data(pn532_handle, next_tvb, pinfo, tree, usb_conv_info);
|
2013-10-27 22:40:45 +00:00
|
|
|
offset += length;
|
|
|
|
|
2014-12-13 17:52:20 +00:00
|
|
|
proto_tree_add_item(main_tree, hf_data_checksum, tvb, offset, 1, ENC_BIG_ENDIAN);
|
2013-10-27 22:40:45 +00:00
|
|
|
checksum = tvb_get_guint8(tvb, offset);
|
|
|
|
while (length) {
|
|
|
|
checksum += tvb_get_guint8(tvb, offset - length);
|
|
|
|
length -= 1;
|
|
|
|
}
|
|
|
|
if (checksum != 0) {
|
|
|
|
proto_tree_add_expert(main_tree, pinfo, &ei_invalid_data_checksum, tvb, offset, 1);
|
|
|
|
}
|
|
|
|
offset += 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
length = 0;
|
2014-06-19 17:18:16 +00:00
|
|
|
if (tvb_length_remaining(tvb, offset) == 1) {
|
2013-10-27 22:40:45 +00:00
|
|
|
length = 1;
|
2014-06-19 17:18:16 +00:00
|
|
|
} else while (tvb_length_remaining(tvb, offset + length) >= 2 && tvb_get_ntohs(tvb, offset + length) != 0x00FF) {
|
2013-10-27 22:40:45 +00:00
|
|
|
length += 1;
|
|
|
|
}
|
|
|
|
if (length) {
|
|
|
|
proto_tree_add_item(main_tree, hf_postable, tvb, offset, length, ENC_NA);
|
|
|
|
offset += length;
|
|
|
|
}
|
|
|
|
|
2014-06-19 17:18:16 +00:00
|
|
|
if (tvb_length_remaining(tvb, offset)) {
|
|
|
|
proto_tree_add_item(main_tree, hf_ignored, tvb, offset, tvb_length_remaining(tvb, offset), ENC_NA);
|
|
|
|
offset += tvb_length_remaining(tvb, offset);
|
2013-10-27 22:40:45 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return offset;
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
proto_register_pn532_hci(void)
|
|
|
|
{
|
|
|
|
module_t *module;
|
|
|
|
expert_module_t *expert_module;
|
|
|
|
|
|
|
|
static hf_register_info hf[] = {
|
|
|
|
{ &hf_preamble,
|
|
|
|
{ "Preamble", "pn532_hci.preamble",
|
|
|
|
FT_BYTES, BASE_NONE, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_start_code,
|
|
|
|
{ "Start Code", "pn532_hci.start_code",
|
|
|
|
FT_UINT16, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_packet_code,
|
|
|
|
{ "Packet Code", "pn532_hci.packet_code",
|
|
|
|
FT_UINT16, BASE_HEX, VALS(packet_code_vals), 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_length,
|
|
|
|
{ "Length", "pn532_hci.length",
|
|
|
|
FT_UINT8, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_extended_length,
|
|
|
|
{ "Extended Length", "pn532_hci.extended_length",
|
|
|
|
FT_UINT16, BASE_DEC, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_length_checksum,
|
|
|
|
{ "Length Checksum", "pn532_hci.length_checksum",
|
|
|
|
FT_UINT8, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_data_checksum,
|
|
|
|
{ "Data Checksum", "pn532_hci.data_checksum",
|
|
|
|
FT_UINT8, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_specific_application_level_error_code,
|
|
|
|
{ "Specific Application Level Error Code","pn532_hci.specific_application_level_error_code",
|
|
|
|
FT_UINT8, BASE_HEX, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_postable,
|
|
|
|
{ "Postamble", "pn532_hci.postamble",
|
|
|
|
FT_BYTES, BASE_NONE, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
},
|
|
|
|
{ &hf_ignored,
|
|
|
|
{ "Ignored", "pn532_hci.ignored",
|
|
|
|
FT_BYTES, BASE_NONE, NULL, 0x00,
|
|
|
|
NULL, HFILL }
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
static gint *ett[] = {
|
|
|
|
&ett_pn532_hci
|
|
|
|
};
|
|
|
|
|
|
|
|
static ei_register_info ei[] = {
|
|
|
|
{ &ei_invalid_length_checksum, { "pn532_hci.expert.invalid_length_checksum", PI_PROTOCOL, PI_WARN, "Invalid Length Checksum", EXPFILL }},
|
|
|
|
{ &ei_invalid_data_checksum, { "pn532_hci.expert.invalid_data_checksum", PI_PROTOCOL, PI_WARN, "Invalid Data Checksum", EXPFILL }},
|
|
|
|
};
|
|
|
|
|
|
|
|
proto_pn532_hci = proto_register_protocol("NXP PN532 HCI", "PN532_HCI", "pn532_hci");
|
2013-11-21 01:18:23 +00:00
|
|
|
pn532_hci_handle = new_register_dissector("pn532_hci", dissect_pn532_hci, proto_pn532_hci);
|
2013-10-27 22:40:45 +00:00
|
|
|
|
|
|
|
proto_register_field_array(proto_pn532_hci, hf, array_length(hf));
|
|
|
|
proto_register_subtree_array(ett, array_length(ett));
|
|
|
|
expert_module = expert_register_protocol(proto_pn532_hci);
|
|
|
|
expert_register_field_array(expert_module, ei, array_length(ei));
|
|
|
|
|
|
|
|
module = prefs_register_protocol(proto_pn532_hci, NULL);
|
|
|
|
prefs_register_static_text_preference(module, "version",
|
|
|
|
"PN532 HCI protocol version is based on: \"UM0701-02; PN532 User Manual\"",
|
|
|
|
"Version of protocol supported by this dissector.");
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
proto_reg_handoff_pn532_hci(void)
|
|
|
|
{
|
|
|
|
pn532_handle = find_dissector("pn532");
|
|
|
|
|
|
|
|
dissector_add_uint("usb.product", (0x04e6 << 16) | 0x5591, pn532_hci_handle);
|
|
|
|
|
2014-06-20 16:43:28 +00:00
|
|
|
dissector_add_for_decode_as("usb.device", pn532_hci_handle);
|
|
|
|
dissector_add_for_decode_as("usb.protocol", pn532_hci_handle);
|
2013-10-27 22:40:45 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Editor modelines - http://www.wireshark.org/tools/modelines.html
|
|
|
|
*
|
|
|
|
* Local variables:
|
|
|
|
* c-basic-offset: 4
|
|
|
|
* tab-width: 8
|
|
|
|
* indent-tabs-mode: nil
|
|
|
|
* End:
|
|
|
|
*
|
|
|
|
* vi: set shiftwidth=4 tabstop=8 expandtab:
|
|
|
|
* :indentSize=4:tabSize=8:noTabs=true:
|
|
|
|
*/
|