diff options
Diffstat (limited to 'epan/dissectors/packet-acr122.c')
-rw-r--r-- | epan/dissectors/packet-acr122.c | 911 |
1 files changed, 911 insertions, 0 deletions
diff --git a/epan/dissectors/packet-acr122.c b/epan/dissectors/packet-acr122.c new file mode 100644 index 00000000..0e1374d6 --- /dev/null +++ b/epan/dissectors/packet-acr122.c @@ -0,0 +1,911 @@ +/* packet-acr122.c + * Routines for ACR122 USB NFC dongle + * + * Copyright 2013, Michal Labedzki for Tieto Corporation + * + * Wireshark - Network traffic analyzer + * By Gerald Combs <gerald@wireshark.org> + * Copyright 1998 Gerald Combs + * + * SPDX-License-Identifier: GPL-2.0-or-later + */ + +#include "config.h" + +#include <epan/packet.h> +#include <epan/prefs.h> +#include <epan/expert.h> +#include "packet-usb.h" + +static int proto_acr122 = -1; + +static int hf_class = -1; +static int hf_ins = -1; +static int hf_p1 = -1; +static int hf_p2 = -1; +static int hf_length = -1; +static int hf_status_word = -1; +static int hf_status_word_sw1 = -1; +static int hf_status_word_sw2 = -1; +static int hf_status_word_led_reserved = -1; +static int hf_status_word_led_green = -1; +static int hf_status_word_led_red = -1; +static int hf_command = -1; +static int hf_response = -1; +static int hf_response_for = -1; +static int hf_picc_operating_auto_picc_polling = -1; +static int hf_picc_operating_auto_ats_generation = -1; +static int hf_picc_operating_polling_interval = -1; +static int hf_picc_operating_felica_424k = -1; +static int hf_picc_operating_felica_212k = -1; +static int hf_picc_operating_topaz = -1; +static int hf_picc_operating_iso_14443_type_b = -1; +static int hf_picc_operating_iso_14443_type_a = -1; +static int hf_firmware_version = -1; +static int hf_led_green_blinking_state = -1; +static int hf_led_red_blinking_state = -1; +static int hf_led_green_mask = -1; +static int hf_led_red_mask = -1; +static int hf_led_initial_green_blinking_state = -1; +static int hf_led_initial_red_blinking_state = -1; +static int hf_led_final_green_state = -1; +static int hf_led_final_red_state = -1; +static int hf_led_t1_duration = -1; +static int hf_led_t2_duration = -1; +static int hf_led_number_of_repetition = -1; +static int hf_led_link_to_buzzer = -1; +static int hf_timeout = -1; +static int hf_poll_buzzer_status = -1; +static int hf_key = -1; +static int hf_key_structure = -1; +static int hf_key_number = -1; +static int hf_key_type = -1; +static int hf_block_number = -1; +static int hf_source_block_number = -1; +static int hf_target_block_number = -1; +static int hf_vb_op = -1; +static int hf_static_byte = -1; +static int hf_version = -1; +static int hf_value = -1; +static int hf_uid = -1; +static int hf_ats = -1; +static int hf_data = -1; + +static gint ett_acr122 = -1; +static gint ett_p1_item = -1; +static gint ett_p2_item = -1; +static gint ett_status_word = -1; +static gint ett_status_word_sw2 = -1; + +static expert_field ei_unknown_command_or_invalid_parameters = EI_INIT; + +static dissector_handle_t acr122_handle; +static dissector_handle_t pn532_handle; + +static wmem_tree_t *command_info = NULL; + +typedef struct command_data_t { + guint32 bus_id; + guint32 device_address; + guint32 endpoint; + + guint8 command; + guint32 command_frame_number; + guint32 response_frame_number; +} command_data_t; + +/* Not part of protocol, generated values */ +#define CMD_UNKNOWN 0x00 +#define CMD_GET_DATA_UID 0x01 +#define CMD_GET_DATA_ATS 0x02 +#define CMD_LOAD_AUTHENTICATION_KEYS 0x03 +#define CMD_AUTHENTICATION_OBSOLETE 0x04 +#define CMD_AUTHENTICATION 0x05 +#define CMD_READ_BINARY_BLOCKS 0x06 +#define CMD_UPDATE_BINARY_BLOCKS 0x07 +#define CMD_VALUE_BLOCK_OPERATION 0x08 +#define CMD_READ_VALUE_BLOCK 0x09 +#define CMD_RESTORE_VALUE_BLOCK 0x0A +#define CMD_DIRECT_TRANSMIT 0x0B +#define CMD_BI_COLOR_AND_BUZZER_LED_CONTROL 0x0C +#define CMD_GET_FIRMWARE_VERSION 0x0D +#define CMD_GET_PICC_OPERATING_PARAMETER 0x0E +#define CMD_SET_PICC_OPERATING_PARAMETER 0x0F +#define CMD_SET_TIMEOUT_PARAMETER 0x10 +#define CMD_SET_BUZZER_OUTPUT_FOR_CARD_DETECTION 0x11 + +static const value_string command_vals[] = { + { CMD_GET_DATA_UID, "Get Data - UID" }, + { CMD_GET_DATA_ATS, "Get Data - ATS" }, + { CMD_LOAD_AUTHENTICATION_KEYS, "Load Authentication Keys" }, + { CMD_AUTHENTICATION_OBSOLETE, "Authentication (Obsolete)" }, + { CMD_AUTHENTICATION, "Authentication" }, + { CMD_READ_BINARY_BLOCKS, "Read Binary Blocks" }, + { CMD_UPDATE_BINARY_BLOCKS, "Update Binary Blocks" }, + { CMD_VALUE_BLOCK_OPERATION, "Value Block Operation" }, + { CMD_READ_VALUE_BLOCK, "Read Value Block" }, + { CMD_RESTORE_VALUE_BLOCK, "Restore Value Block" }, + { CMD_DIRECT_TRANSMIT, "Direct Transmit" }, + { CMD_BI_COLOR_AND_BUZZER_LED_CONTROL, "Bi-Color and Buzzer LED Control" }, + { CMD_GET_FIRMWARE_VERSION, "Get Firmware Version" }, + { CMD_GET_PICC_OPERATING_PARAMETER, "Get PICC Operating Parameter" }, + { CMD_SET_PICC_OPERATING_PARAMETER, "Set PICC Operating Parameter" }, + { CMD_SET_TIMEOUT_PARAMETER, "Set Timeout Parameter" }, + { CMD_SET_BUZZER_OUTPUT_FOR_CARD_DETECTION, "Set Buzzer Output for Card Detection" }, + { 0, NULL } +}; +static value_string_ext command_vals_ext = VALUE_STRING_EXT_INIT(command_vals); + +static const range_string status_word_rvals[] = { + { 0x6300, 0x6300, "Operation Fail" }, + { 0x6a81, 0x6a81, "Function not Supported" }, + { 0x9000, 0x90FF, "Success" }, + { 0, 0, NULL } +}; + +static const value_string link_to_buzzer_vals[] = { + { 0x00, "The buzzer will not turn on" }, + { 0x01, "The buzzer will turn on during the T1 Duration" }, + { 0x02, "The buzzer will turn on during the T2 Duration" }, + { 0x03, "The buzzer will turn on during the T1 and T2 Duration" }, + { 0, NULL } +}; + +static const value_string key_structure_vals[] = { + { 0x00, "Key is loaded into the reader volatile memory" }, + { 0, NULL } +}; + +static const value_string poll_buzzer_status_vals[] = { + { 0x00, "Buzzer disabled on card detected" }, + { 0xFF, "Buzzer enabled on card detected" }, + { 0, NULL } +}; + +static const value_string key_type_vals[] = { + { 0x60, "Type A" }, + { 0x61, "Type B" }, + { 0, NULL } +}; + +static const value_string vb_op_vals[] = { + { 0x00, "Store the \"Value\" into the block. The block will then be converted to a value block." }, + { 0x01, "Increment the value of the value block by the \"Value\". This command is only valid for value block." }, + { 0x02, "Decrement the value of the value block by the \"Value\". This command is only valid for value block." }, + { 0, NULL } +}; + +void proto_register_acr122(void); +void proto_reg_handoff_acr122(void); + +static void +duration_base(gchar *buf, guint32 value) { + snprintf(buf, ITEM_LABEL_LENGTH, "%u.%03u s", value * 100 / 1000, value * 100 % 1000); +} + +static void +timeout_base(gchar *buf, guint32 value) { + if (value == 0x00) + snprintf(buf, ITEM_LABEL_LENGTH, "No timeout check"); + else if (value == 0xFF) + snprintf(buf, ITEM_LABEL_LENGTH, "Wait until the contactless chip responds"); + else if (value < 12) + snprintf(buf, ITEM_LABEL_LENGTH, "%u [s]", value * 5); + else + snprintf(buf, ITEM_LABEL_LENGTH, "%u:%02u [mm:ss]", value * 5 / 60, value * 5 % 60); +} + + +static gint +dissect_acr122(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) +{ + proto_item *main_item; + proto_tree *main_tree; + proto_item *p1_item; + proto_tree *p1_tree; + proto_item *p2_item; + proto_tree *p2_tree; + proto_item *sub_item; + proto_item *sub_tree; + proto_item *sw2_item; + proto_item *sw2_tree; + gint offset = 0; + guint32 value; + tvbuff_t *next_tvb; + guint8 acr_class; + guint8 ins; + guint8 p1; + guint8 p2; + guint8 length; + guint8 command = CMD_UNKNOWN; + command_data_t *command_data; + usb_conv_info_t *usb_conv_info; + wmem_tree_key_t key[5]; + guint32 bus_id; + guint32 device_address; + guint32 endpoint; + guint32 k_bus_id; + guint32 k_device_address; + guint32 k_endpoint; + guint32 k_frame_number; + + col_set_str(pinfo->cinfo, COL_PROTOCOL, "ACR 122"); + col_clear(pinfo->cinfo, COL_INFO); + + main_item = proto_tree_add_item(tree, proto_acr122, tvb, offset, -1, ENC_NA); + main_tree = proto_item_add_subtree(main_item, ett_acr122); + + if (!data) return offset; + usb_conv_info = (usb_conv_info_t *) data; + + bus_id = usb_conv_info->bus_id; + device_address = usb_conv_info->device_address; + endpoint = usb_conv_info->endpoint; + + k_bus_id = bus_id; + k_device_address = device_address; + k_endpoint = endpoint; + k_frame_number = pinfo->num; + + key[0].length = 1; + key[0].key = &k_bus_id; + key[1].length = 1; + key[1].key = &k_device_address; + key[2].length = 1; + key[2].key = &k_endpoint; + key[3].length = 1; + key[3].key = &k_frame_number; + key[4].length = 0; + key[4].key = NULL; + + + if (pinfo->p2p_dir == P2P_DIR_SENT) { /* Request */ + acr_class = tvb_get_guint8(tvb, offset); + ins = tvb_get_guint8(tvb, offset + 1); + p1 = tvb_get_guint8(tvb, offset + 2); + p2 = tvb_get_guint8(tvb, offset + 3); + length = tvb_get_guint8(tvb, offset + 4); + + /* Recognize command by simple heuristic */ + if (acr_class == 0xFF) { + if (ins == 0xCA && p1 == 0x00 && p2 == 0x00 && length == 0) + command = CMD_GET_DATA_UID; + if (ins == 0xCA && p1 == 0x01 && p2 == 0x00 && length == 0) + command = CMD_GET_DATA_ATS; + else if (ins == 0x82 && length == 6) + command = CMD_LOAD_AUTHENTICATION_KEYS; + else if (ins == 0x88 && p1 == 0x00) + command = CMD_AUTHENTICATION_OBSOLETE; + else if (ins == 0x86 && p1 == 0x00 && p2 == 0x00 && length == 5) + command = CMD_AUTHENTICATION; + else if (ins == 0xB0 && p1 == 0x00) + command = CMD_READ_BINARY_BLOCKS; + else if (ins == 0xD6 && p1 == 0x00) + command = CMD_UPDATE_BINARY_BLOCKS; + else if (ins == 0xD7 && p1 == 0x00 && length == 5) + command = CMD_VALUE_BLOCK_OPERATION; + else if (ins == 0xB1 && p1 == 0x00 && length == 4) + command = CMD_READ_VALUE_BLOCK; + else if (ins == 0xD7 && p1 == 0x00 && length == 2) + command = CMD_RESTORE_VALUE_BLOCK; + else if (ins == 0x00 && p1 == 0x00 && p2 == 0x00) + command = CMD_DIRECT_TRANSMIT; + else if (ins == 0x00 && p1 == 0x40 && length == 4) + command = CMD_BI_COLOR_AND_BUZZER_LED_CONTROL; + else if (ins == 0x00 && p1 == 0x48 && p2 == 0x00) + command = CMD_GET_FIRMWARE_VERSION; + else if (ins == 0x00 && p1 == 0x50 && p2 == 0x00) + command = CMD_GET_PICC_OPERATING_PARAMETER; + else if (ins == 0x00 && p1 == 0x51 && length == 0) + command = CMD_SET_PICC_OPERATING_PARAMETER; + else if (ins == 0x00 && p1 == 0x41 && length == 0) + command = CMD_SET_TIMEOUT_PARAMETER; + else if (ins == 0x00 && p1 == 0x52 && length == 0) + command = CMD_SET_BUZZER_OUTPUT_FOR_CARD_DETECTION; + } + + sub_item = proto_tree_add_uint(main_tree, hf_command, tvb, offset, 4 + length, command); + proto_item_set_generated(sub_item); + if (command == CMD_UNKNOWN) + expert_add_info(pinfo, sub_item, &ei_unknown_command_or_invalid_parameters); + + col_add_fstr(pinfo->cinfo, COL_INFO, "Command: %s", val_to_str_ext_const(command, &command_vals_ext, "Unknown")); + + proto_tree_add_item(main_tree, hf_class, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_ins, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + p1_item = proto_tree_add_item(main_tree, hf_p1, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + p2_item = proto_tree_add_item(main_tree, hf_p2, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_length, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + switch (command) { + case CMD_DIRECT_TRANSMIT: + if (length > 0) { + next_tvb = tvb_new_subset_length(tvb, offset, length); + call_dissector_with_data(pn532_handle, next_tvb, pinfo, tree, usb_conv_info); + offset += length; + } + break; + case CMD_BI_COLOR_AND_BUZZER_LED_CONTROL: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_led_green_blinking_state, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_red_blinking_state, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_green_mask, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_red_mask, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_initial_green_blinking_state, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_initial_red_blinking_state, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_final_green_state, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_led_final_red_state, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + proto_tree_add_item(main_tree, hf_led_t1_duration, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_led_t2_duration, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_led_number_of_repetition, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_led_link_to_buzzer, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + break; + case CMD_GET_DATA_UID: + case CMD_GET_DATA_ATS: + /* Nothing to decode */ + break; + case CMD_LOAD_AUTHENTICATION_KEYS: + p1_tree = proto_item_add_subtree(p1_item, ett_p1_item); + proto_tree_add_item(p1_tree, hf_key_structure, tvb, offset - 3, 1, ENC_BIG_ENDIAN); + + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_key_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + proto_tree_add_item(main_tree, hf_key, tvb, offset, 6, ENC_NA); + offset += 6; + break; + case CMD_AUTHENTICATION_OBSOLETE: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_block_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + proto_tree_add_item(main_tree, hf_key_type, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_key_number, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + break; + case CMD_AUTHENTICATION: + proto_tree_add_item(main_tree, hf_version, tvb, offset, 2, ENC_BIG_ENDIAN); + offset += 2; + + proto_tree_add_item(main_tree, hf_block_number, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_key_type, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_key_number, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + break; + case CMD_READ_BINARY_BLOCKS: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_block_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + break; + case CMD_UPDATE_BINARY_BLOCKS: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_block_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + proto_tree_add_item(main_tree, hf_data, tvb, offset, length, ENC_NA); + offset += length; + break; + case CMD_VALUE_BLOCK_OPERATION: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_block_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + proto_tree_add_item(main_tree, hf_vb_op, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_value, tvb, offset, 4, ENC_BIG_ENDIAN); + offset += 4; + break; + case CMD_READ_VALUE_BLOCK: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_block_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + break; + case CMD_RESTORE_VALUE_BLOCK: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_source_block_number, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + + proto_tree_add_item(main_tree, hf_static_byte, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + + proto_tree_add_item(main_tree, hf_target_block_number, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + break; + case CMD_SET_PICC_OPERATING_PARAMETER: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_picc_operating_auto_picc_polling, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_auto_ats_generation, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_polling_interval, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_felica_424k, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_felica_212k, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_topaz, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_iso_14443_type_b, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(p2_tree, hf_picc_operating_iso_14443_type_a, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + break; + case CMD_SET_TIMEOUT_PARAMETER: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_timeout, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + break; + case CMD_SET_BUZZER_OUTPUT_FOR_CARD_DETECTION: + p2_tree = proto_item_add_subtree(p2_item, ett_p2_item); + proto_tree_add_item(p2_tree, hf_poll_buzzer_status, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + break; + case CMD_GET_PICC_OPERATING_PARAMETER: + /* No parameters */ + break; + } + + if (!pinfo->fd->visited) { + command_data = wmem_new(wmem_file_scope(), command_data_t); + command_data->bus_id = bus_id; + command_data->device_address = device_address; + command_data->endpoint = endpoint; + + command_data->command = command; + command_data->command_frame_number = pinfo->num; + command_data->response_frame_number = 0; + + wmem_tree_insert32_array(command_info, key, command_data); + } + + } else { /* Response */ + guint32 command_frame_number = 0; + gboolean use_status_word = FALSE; + wmem_tree_t *wmem_tree; + + key[3].length = 0; + key[3].key = NULL; + + wmem_tree = (wmem_tree_t *) wmem_tree_lookup32_array(command_info, key); + if (wmem_tree) { + command_data = (command_data_t *) wmem_tree_lookup32_le(wmem_tree, pinfo->num); + + if (command_data && (command_data->response_frame_number == 0 || + command_data->response_frame_number == pinfo->num)) { + + command = command_data->command; + command_frame_number = command_data->command_frame_number; + if (!pinfo->fd->visited && command_data->response_frame_number == 0) { + command_data->response_frame_number = pinfo->num; + } + } + } + + sub_item = proto_tree_add_uint(main_tree, hf_response, tvb, offset, tvb_captured_length_remaining(tvb, offset), command); + proto_item_set_generated(sub_item); + + col_add_fstr(pinfo->cinfo, COL_INFO, "Response: %s", val_to_str_ext_const(command, &command_vals_ext, "Unknown")); + + if (command != CMD_UNKNOWN) { + sub_item = proto_tree_add_uint(main_tree, hf_response_for, tvb, offset, tvb_captured_length_remaining(tvb, offset), command_frame_number); + proto_item_set_generated(sub_item); + } + + switch (command) { + case CMD_GET_FIRMWARE_VERSION: + proto_tree_add_item(main_tree, hf_firmware_version, tvb, offset, -1, ENC_NA | ENC_ASCII); + offset += tvb_captured_length_remaining(tvb, offset); + break; + + case CMD_DIRECT_TRANSMIT: + use_status_word = TRUE; + + if (tvb_captured_length_remaining(tvb, offset) > 2) { + next_tvb = tvb_new_subset_length(tvb, offset, tvb_captured_length_remaining(tvb, offset) - 2); + call_dissector_with_data(pn532_handle, next_tvb, pinfo, tree, usb_conv_info); + offset += tvb_captured_length_remaining(tvb, offset) - 2; + } + break; + + + case CMD_READ_BINARY_BLOCKS: + use_status_word = TRUE; + proto_tree_add_item(main_tree, hf_data, tvb, offset, tvb_captured_length_remaining(tvb, offset) - 2, ENC_NA); + offset += tvb_captured_length_remaining(tvb, offset) - 2; + break; + + case CMD_READ_VALUE_BLOCK: + use_status_word = TRUE; + proto_tree_add_item(main_tree, hf_value, tvb, offset, 4, ENC_BIG_ENDIAN); + break; + + case CMD_GET_DATA_UID: + use_status_word = TRUE; + proto_tree_add_item(main_tree, hf_uid, tvb, offset, tvb_captured_length_remaining(tvb, offset) - 2, ENC_NA); + offset += tvb_captured_length_remaining(tvb, offset) - 2; + break; + + case CMD_GET_DATA_ATS: + use_status_word = TRUE; + proto_tree_add_item(main_tree, hf_ats, tvb, offset, tvb_captured_length_remaining(tvb, offset) - 2, ENC_NA); + offset += tvb_captured_length_remaining(tvb, offset) - 2; + break; + + case CMD_BI_COLOR_AND_BUZZER_LED_CONTROL: + case CMD_LOAD_AUTHENTICATION_KEYS: + case CMD_AUTHENTICATION: + case CMD_AUTHENTICATION_OBSOLETE: + case CMD_UPDATE_BINARY_BLOCKS: + case CMD_VALUE_BLOCK_OPERATION: + case CMD_RESTORE_VALUE_BLOCK: + case CMD_SET_TIMEOUT_PARAMETER: + case CMD_SET_BUZZER_OUTPUT_FOR_CARD_DETECTION: + case CMD_SET_PICC_OPERATING_PARAMETER: + case CMD_GET_PICC_OPERATING_PARAMETER: + default: + use_status_word = TRUE; + break; + } + + if (use_status_word) { + value = tvb_get_ntohs(tvb, offset); + col_append_fstr(pinfo->cinfo, COL_INFO, " - %s%s", + (((value & 0xFF00) != 0x9000) && (value & 0xFF00) != 0x6100) ? + "Error: " : "", + rval_to_str_const(value, status_word_rvals, "Unknown error")); + + if ((value & 0xFF00) == 0x6100) + col_append_fstr(pinfo->cinfo, COL_INFO, " - Length %u", value & 0x00FF); + + sub_item = proto_tree_add_item(main_tree, hf_status_word, tvb, offset, 2, ENC_BIG_ENDIAN); + sub_tree = proto_item_add_subtree(sub_item, ett_status_word); + proto_tree_add_item(sub_tree, hf_status_word_sw1, tvb, offset, 1, ENC_BIG_ENDIAN); + offset += 1; + sw2_item = proto_tree_add_item(sub_tree, hf_status_word_sw2, tvb, offset, 1, ENC_BIG_ENDIAN); + + if (command == CMD_BI_COLOR_AND_BUZZER_LED_CONTROL) { + sw2_tree = proto_item_add_subtree(sw2_item, ett_status_word_sw2); + + col_append_fstr(pinfo->cinfo, COL_INFO, " - Red LED: %s, Green LED: %s", (value & 0x02) ? "On" : "Off", (value & 0x01) ? "On" : "Off"); + + proto_tree_add_item(sw2_tree, hf_status_word_led_reserved, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_status_word_led_green, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_status_word_led_red, tvb, offset, 1, ENC_BIG_ENDIAN); + } else if (command == CMD_SET_PICC_OPERATING_PARAMETER || command == CMD_GET_PICC_OPERATING_PARAMETER) { + sw2_tree = proto_item_add_subtree(sw2_item, ett_status_word_sw2); + proto_tree_add_item(sw2_tree, hf_picc_operating_auto_picc_polling, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_auto_ats_generation, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_polling_interval, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_felica_424k, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_felica_212k, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_topaz, tvb, offset, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_iso_14443_type_b, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + proto_tree_add_item(sw2_tree, hf_picc_operating_iso_14443_type_a, tvb, offset - 2, 1, ENC_BIG_ENDIAN); + } + offset += 1; + } + } + + return offset; +} + +void +proto_register_acr122(void) +{ + module_t *module; + expert_module_t *expert_module; + + static hf_register_info hf[] = { + { &hf_class, + { "Class", "acr122.class", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_ins, + { "Ins", "acr122.ins", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_p1, + { "P1", "acr122.p1", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_p2, + { "P2", "acr122.p2", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_length, + { "Length", "acr122.length", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_status_word, + { "Status Word", "acr122.status_word", + FT_UINT16, BASE_HEX | BASE_RANGE_STRING, RVALS(status_word_rvals), 0x00, + NULL, HFILL } + }, + { &hf_status_word_sw1, + { "SW1", "acr122.status_word.sw1", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_status_word_sw2, + { "SW2", "acr122.status_word.sw2", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_command, + { "Command", "acr122.command", + FT_UINT8, BASE_HEX | BASE_EXT_STRING, &command_vals_ext, 0x00, + NULL, HFILL } + }, + { &hf_response, + { "Response", "acr122.response", + FT_UINT8, BASE_HEX | BASE_EXT_STRING, &command_vals_ext, 0x00, + NULL, HFILL } + }, + { &hf_response_for, + { "Response for", "acr122.response_for", + FT_FRAMENUM, BASE_NONE, NULL, 0x00, + NULL, HFILL } + }, + { &hf_picc_operating_auto_picc_polling, + { "Auto PICC Polling", "acr122.picc_operating.auto_picc_polling", + FT_BOOLEAN, 8, NULL, 0x80, + NULL, HFILL } + }, + { &hf_picc_operating_auto_ats_generation, + { "ATS Generation", "acr122.picc_operating.ats_generation", + FT_BOOLEAN, 8, NULL, 0x40, + NULL, HFILL } + }, + { &hf_picc_operating_polling_interval, + { "Polling Interval", "acr122.picc_operating.polling_interval", + FT_BOOLEAN, 8, NULL, 0x20, + NULL, HFILL } + }, + { &hf_picc_operating_felica_424k, + { "FeliCa 424k", "acr122.picc_operating.felica_424k", + FT_BOOLEAN, 8, NULL, 0x10, + NULL, HFILL } + }, + { &hf_picc_operating_felica_212k, + { "FeliCa 212k", "acr122.picc_operating.felica_212k", + FT_BOOLEAN, 8, NULL, 0x08, + NULL, HFILL } + }, + { &hf_picc_operating_topaz, + { "Topaz", "acr122.picc_operating.topaz", + FT_BOOLEAN, 8, NULL, 0x04, + NULL, HFILL } + }, + { &hf_picc_operating_iso_14443_type_b, + { "ISO 14443 Type B", "acr122.picc_operating.iso_14443_type_b", + FT_BOOLEAN, 8, NULL, 0x02, + NULL, HFILL } + }, + { &hf_picc_operating_iso_14443_type_a, + { "ISO 14443 Type A", "acr122.picc_operating.iso_14443_type_a", + FT_BOOLEAN, 8, NULL, 0x01, + NULL, HFILL } + }, + { &hf_firmware_version, + { "Firmware Version", "acr122.firmware_version", + FT_STRING, BASE_NONE, NULL, 0x00, + NULL, HFILL } + }, + { &hf_led_green_blinking_state, + { "Green LED Blinking", "acr122.led.green.blinking", + FT_BOOLEAN, 8, NULL, 0x80, + NULL, HFILL } + }, + { &hf_led_red_blinking_state, + { "Red LED Blinking", "acr122.led.red.blinking", + FT_BOOLEAN, 8, NULL, 0x40, + NULL, HFILL } + }, + { &hf_led_green_mask, + { "Green LED Mask", "acr122.led.green.mask", + FT_BOOLEAN, 8, NULL, 0x20, + NULL, HFILL } + }, + { &hf_led_red_mask, + { "Red LED Mask", "acr122.led.red.mask", + FT_BOOLEAN, 8, NULL, 0x10, + NULL, HFILL } + }, + { &hf_led_initial_green_blinking_state, + { "Initial Green LED Blinking", "acr122.led.green.initial", + FT_BOOLEAN, 8, NULL, 0x08, + NULL, HFILL } + }, + { &hf_led_initial_red_blinking_state, + { "Initial Red LED Blinking", "acr122.led.red.initial", + FT_BOOLEAN, 8, NULL, 0x04, + NULL, HFILL } + }, + { &hf_led_final_green_state, + { "Final Green LED", "acr122.led.green.final", + FT_BOOLEAN, 8, NULL, 0x02, + NULL, HFILL } + }, + { &hf_led_final_red_state, + { "Final Red LED", "acr122.led.red.final", + FT_BOOLEAN, 8, NULL, 0x01, + NULL, HFILL } + }, + { &hf_led_t1_duration, + { "T1 Duration", "acr122.led.t1_duration", + FT_UINT8, BASE_CUSTOM, CF_FUNC(duration_base), 0x00, + "Initial Blinking State", HFILL } + }, + { &hf_led_t2_duration, + { "T2 Duration", "acr122.led.t2_duration", + FT_UINT8, BASE_CUSTOM, CF_FUNC(duration_base), 0x00, + "Toggle Blinking State", HFILL } + }, + { &hf_led_number_of_repetition, + { "Number of Repetition", "acr122.led.number_of_repetition", + FT_UINT8, BASE_DEC, NULL, 0x00, + NULL, HFILL } + }, + { &hf_led_link_to_buzzer, + { "Link to Buzzer", "acr122.led.link_to_buzzer", + FT_UINT8, BASE_HEX, VALS(link_to_buzzer_vals), 0x00, + NULL, HFILL } + }, + { &hf_poll_buzzer_status, + { "Poll Buzzer Status", "acr122.poll_buzzer_status", + FT_UINT8, BASE_HEX, VALS(poll_buzzer_status_vals), 0x00, + NULL, HFILL } + }, + { &hf_timeout, + { "Timeout", "acr122.timeout", + FT_UINT8, BASE_CUSTOM, CF_FUNC(timeout_base), 0x00, + NULL, HFILL } + }, + { &hf_status_word_led_reserved, + { "Reserved", "acr122.status_word.sw2.reserved", + FT_UINT8, BASE_HEX, NULL, 0xFC, + NULL, HFILL } + }, + { &hf_status_word_led_green, + { "Current Green LED", "acr122.status_word.sw2.led.green", + FT_BOOLEAN, 8, NULL, 0x02, + NULL, HFILL } + }, + { &hf_status_word_led_red, + { "Current Red LED", "acr122.status_word.sw2.led.red", + FT_BOOLEAN, 8, NULL, 0x01, + NULL, HFILL } + }, + { &hf_key, + { "Key", "acr122.key", + FT_BYTES, BASE_NONE, NULL, 0x00, + NULL, HFILL } + }, + { &hf_key_structure, + { "Key Structure", "acr122.key_structure", + FT_UINT8, BASE_HEX, VALS(key_structure_vals), 0x00, + NULL, HFILL } + }, + { &hf_key_number, + { "Key Number", "acr122.key_number", + FT_UINT8, BASE_DEC, NULL, 0x00, + NULL, HFILL } + }, + { &hf_key_type, + { "Key Type", "acr122.key_type", + FT_UINT8, BASE_HEX, VALS(key_type_vals), 0x00, + NULL, HFILL } + }, + { &hf_block_number, + { "Block Number", "acr122.block_number", + FT_UINT8, BASE_DEC_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_source_block_number, + { "Source Block Number", "acr122.source_block_number", + FT_UINT8, BASE_DEC_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_target_block_number, + { "Target Block Number", "acr122.target_block_number", + FT_UINT8, BASE_DEC_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_static_byte, + { "Static Byte", "acr122.static_byte", + FT_UINT8, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_vb_op, + { "VB Op", "acr122.vb_op", + FT_UINT8, BASE_HEX, VALS(vb_op_vals), 0x00, + NULL, HFILL } + }, + { &hf_version, + { "Version", "acr122.version", + FT_UINT16, BASE_HEX, NULL, 0x00, + NULL, HFILL } + }, + { &hf_value, + { "Value", "acr122.value", + FT_INT32, BASE_DEC, NULL, 0x00, + NULL, HFILL } + }, + { &hf_uid, + { "UID", "acr122.uid", + FT_BYTES, BASE_NONE, NULL, 0x00, + NULL, HFILL } + }, + { &hf_ats, + { "ATS", "acr122.ats", + FT_BYTES, BASE_NONE, NULL, 0x00, + NULL, HFILL } + }, + { &hf_data, + { "Data", "acr122.data", + FT_BYTES, BASE_NONE, NULL, 0x00, + NULL, HFILL } + }, + }; + + static gint *ett[] = { + &ett_acr122, + &ett_p1_item, + &ett_p2_item, + &ett_status_word, + &ett_status_word_sw2 + }; + + static ei_register_info ei[] = { + { &ei_unknown_command_or_invalid_parameters, { "acr122.expert.unknown_command", PI_PROTOCOL, PI_NOTE, "Unknown command or invalid parameters", EXPFILL }}, + }; + + command_info = wmem_tree_new_autoreset(wmem_epan_scope(), wmem_file_scope()); + + proto_acr122 = proto_register_protocol("Advanced Card Systems ACR122", "ACR 122", "acr122"); + acr122_handle = register_dissector("acr122", dissect_acr122, proto_acr122); + + proto_register_field_array(proto_acr122, hf, array_length(hf)); + proto_register_subtree_array(ett, array_length(ett)); + expert_module = expert_register_protocol(proto_acr122); + expert_register_field_array(expert_module, ei, array_length(ei)); + + module = prefs_register_protocol(proto_acr122, NULL); + prefs_register_static_text_preference(module, "version", + "ACR122U USB NFC Reader - Application Programming Interface V2.02", + "Version of protocol supported by this dissector."); +} + +void +proto_reg_handoff_acr122(void) +{ + pn532_handle = find_dissector_add_dependency("pn532", proto_acr122); + dissector_add_for_decode_as("usbccid.subdissector", acr122_handle); +} + +/* + * Editor modelines - https://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: + */ |