aboutsummaryrefslogtreecommitdiffstats
path: root/epan
diff options
context:
space:
mode:
authorAidan MacDonald <amachronic@protonmail.com>2021-10-23 20:58:29 +0100
committerTomasz Moń <desowin@gmail.com>2021-11-17 13:27:56 +0100
commit660dded3830afcb9eab0498aaaf72db69e40b816 (patch)
tree4cc00bbbf98d184dc97737a97fda4aace2a92d99 /epan
parentf748c91bb2ad08b746216842f171c33245424394 (diff)
Refactor USB mass storage class dissector
The existing dissector only handles the Bulk-Only Transport protocol but occupies the USB dissector hooks for all mass storage class traffic. To facilitate alternative protocols like UASP, direct all mass storage class traffic to a stub dissector which will dispatch to the real dissector based on other information, such as the USB interface protocol. Heuristic dissectors are still attached directly to the core USB hooks.
Diffstat (limited to 'epan')
-rw-r--r--epan/dissectors/CMakeLists.txt1
-rw-r--r--epan/dissectors/packet-usb-masstorage.c453
-rw-r--r--epan/dissectors/packet-usbms-bot.c478
3 files changed, 524 insertions, 408 deletions
diff --git a/epan/dissectors/CMakeLists.txt b/epan/dissectors/CMakeLists.txt
index 36fcd04e9a..5f45946800 100644
--- a/epan/dissectors/CMakeLists.txt
+++ b/epan/dissectors/CMakeLists.txt
@@ -1923,6 +1923,7 @@ set(DISSECTOR_SRC
${CMAKE_CURRENT_SOURCE_DIR}/packet-usb.c
${CMAKE_CURRENT_SOURCE_DIR}/packet-usbip.c
${CMAKE_CURRENT_SOURCE_DIR}/packet-usbll.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/packet-usbms-bot.c
${CMAKE_CURRENT_SOURCE_DIR}/packet-user_encap.c
${CMAKE_CURRENT_SOURCE_DIR}/packet-userlog.c
${CMAKE_CURRENT_SOURCE_DIR}/packet-uts.c
diff --git a/epan/dissectors/packet-usb-masstorage.c b/epan/dissectors/packet-usb-masstorage.c
index ceef788246..6a4e69080d 100644
--- a/epan/dissectors/packet-usb-masstorage.c
+++ b/epan/dissectors/packet-usb-masstorage.c
@@ -1,56 +1,28 @@
/* packet-usb-masstorage.c
+ * USB Mass Storage class stub dissector
+ * Copyright 2021, Aidan MacDonald <amachronic@protonmail.com>
*
- * usb mass storage dissector
- * Ronnie Sahlberg 2006
+ * 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 "packet-usb.h"
-#include "packet-scsi.h"
-
-void proto_register_usb_ms(void);
-void proto_reg_handoff_usb_ms(void);
-/* protocols and header fields */
static int proto_usb_ms = -1;
-static int hf_usb_ms_dCBWSignature = -1;
-static int hf_usb_ms_dCBWTag = -1;
-static int hf_usb_ms_dCBWDataTransferLength = -1;
-static int hf_usb_ms_dCBWFlags = -1;
-static int hf_usb_ms_dCBWTarget = -1;
-static int hf_usb_ms_dCBWLUN = -1;
-static int hf_usb_ms_dCBWCBLength = -1;
-static int hf_usb_ms_dCSWSignature = -1;
-static int hf_usb_ms_dCSWDataResidue = -1;
-static int hf_usb_ms_dCSWStatus = -1;
-static int hf_usb_ms_request = -1;
-static int hf_usb_ms_value = -1;
-static int hf_usb_ms_index = -1;
-static int hf_usb_ms_length = -1;
-static int hf_usb_ms_maxlun = -1;
-
-static gint ett_usb_ms = -1;
-
-static dissector_handle_t usb_ms_bulk_handle;
-/* there is one such structure for each masstorage conversation */
-typedef struct _usb_ms_conv_info_t {
- wmem_tree_t *itl; /* indexed by LUN */
- wmem_tree_t *itlq; /* pinfo->num */
-} usb_ms_conv_info_t;
+static dissector_table_t usb_ms_bulk_dissector_table;
+static dissector_table_t usb_ms_control_dissector_table;
+static dissector_table_t usb_ms_interrupt_dissector_table;
+static dissector_table_t usb_ms_descriptor_dissector_table;
-
-static const value_string status_vals[] = {
- {0x00, "Command Passed"},
- {0x01, "Command Failed"},
- {0x02, "Phase Error"},
- {0, NULL}
-};
+void proto_register_usb_ms(void);
+void proto_reg_handoff_usb_ms(void);
#define MSC_SUBCLASS_SCSI_COMMAND_SET_NOT_REPORTED 0x00
#define MSC_SUBCLASS_RBC 0x01
@@ -96,413 +68,78 @@ static const value_string usb_massstorage_protocol_vals[] = {
};
value_string_ext usb_massstorage_protocol_vals_ext = VALUE_STRING_EXT_INIT(usb_massstorage_protocol_vals);
-
-static void
-dissect_usb_ms_reset(packet_info *pinfo _U_, proto_tree *tree, tvbuff_t *tvb, int offset, gboolean is_request, usb_trans_info_t *usb_trans_info _U_, usb_conv_info_t *usb_conv_info _U_)
-{
- if(is_request){
- proto_tree_add_item(tree, hf_usb_ms_value, tvb, offset, 2, ENC_LITTLE_ENDIAN);
- offset += 2;
-
- proto_tree_add_item(tree, hf_usb_ms_index, tvb, offset, 2, ENC_LITTLE_ENDIAN);
- offset += 2;
-
- proto_tree_add_item(tree, hf_usb_ms_length, tvb, offset, 2, ENC_LITTLE_ENDIAN);
- /*offset += 2;*/
- } else {
- /* no data in reset response */
- }
-}
-
-static void
-dissect_usb_ms_get_max_lun(packet_info *pinfo _U_, proto_tree *tree, tvbuff_t *tvb, int offset, gboolean is_request, usb_trans_info_t *usb_trans_info _U_, usb_conv_info_t *usb_conv_info _U_)
+static int
+dissect_usb_ms_bulk(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void *data)
{
- if(is_request){
- proto_tree_add_item(tree, hf_usb_ms_value, tvb, offset, 2, ENC_LITTLE_ENDIAN);
- offset += 2;
+ usb_conv_info_t *usb_conv_info;
- proto_tree_add_item(tree, hf_usb_ms_index, tvb, offset, 2, ENC_LITTLE_ENDIAN);
- offset += 2;
+ usb_conv_info = (usb_conv_info_t *)data;
- proto_tree_add_item(tree, hf_usb_ms_length, tvb, offset, 2, ENC_LITTLE_ENDIAN);
- /*offset += 2;*/
- } else {
- proto_tree_add_item(tree, hf_usb_ms_maxlun, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- /*offset++;*/
- }
+ return dissector_try_uint_new(usb_ms_bulk_dissector_table, usb_conv_info->interfaceProtocol, tvb, pinfo, parent_tree, TRUE, usb_conv_info);
}
-
-typedef void (*usb_setup_dissector)(packet_info *pinfo, proto_tree *tree, tvbuff_t *tvb, int offset, gboolean is_request, usb_trans_info_t *usb_trans_info, usb_conv_info_t *usb_conv_info);
-
-typedef struct _usb_setup_dissector_table_t {
- guint8 request;
- usb_setup_dissector dissector;
-} usb_setup_dissector_table_t;
-#define USB_SETUP_RESET 0xff
-#define USB_SETUP_GET_MAX_LUN 0xfe
-static const usb_setup_dissector_table_t setup_dissectors[] = {
- {USB_SETUP_RESET, dissect_usb_ms_reset},
- {USB_SETUP_GET_MAX_LUN, dissect_usb_ms_get_max_lun},
- {0, NULL}
-};
-static const value_string setup_request_names_vals[] = {
- {USB_SETUP_RESET, "RESET"},
- {USB_SETUP_GET_MAX_LUN, "GET MAX LUN"},
- {0, NULL}
-};
-
-/* Dissector for mass storage control .
- * Returns tvb_captured_length(tvb) if a class specific dissector was found
- * and 0 othervise.
- */
-static gint
+static int
dissect_usb_ms_control(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void *data)
{
- gboolean is_request;
usb_conv_info_t *usb_conv_info;
- usb_trans_info_t *usb_trans_info;
- int offset=0;
- usb_setup_dissector dissector = NULL;
- const usb_setup_dissector_table_t *tmp;
- proto_tree *tree;
- proto_item *ti;
- /* Reject the packet if data or usb_trans_info are NULL */
- if (data == NULL || ((usb_conv_info_t *)data)->usb_trans_info == NULL)
- return 0;
usb_conv_info = (usb_conv_info_t *)data;
- usb_trans_info = usb_conv_info->usb_trans_info;
- is_request=(pinfo->srcport==NO_ENDPOINT);
-
- /* See if we can find a class specific dissector for this request */
- for(tmp=setup_dissectors;tmp->dissector;tmp++){
- if (tmp->request == usb_trans_info->setup.request){
- dissector=tmp->dissector;
- break;
- }
- }
- /* No we could not find any class specific dissector for this request
- * return 0 and let USB try any of the standard requests.
- */
- if(!dissector){
- return 0;
- }
-
- col_set_str(pinfo->cinfo, COL_PROTOCOL, "USBMS");
- ti = proto_tree_add_protocol_format(parent_tree, proto_usb_ms, tvb, 0, -1, "USB Mass Storage");
- tree = proto_item_add_subtree(ti, ett_usb_ms);
-
- col_add_fstr(pinfo->cinfo, COL_INFO, "%s %s",
- val_to_str(usb_trans_info->setup.request, setup_request_names_vals, "Unknown type %x"),
- is_request?"Request":"Response");
-
- if(is_request){
- proto_tree_add_item(tree, hf_usb_ms_request, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- offset += 1;
- }
-
- dissector(pinfo, tree, tvb, offset, is_request, usb_trans_info, usb_conv_info);
- return tvb_captured_length(tvb);
+ return dissector_try_uint_new(usb_ms_control_dissector_table, usb_conv_info->interfaceProtocol, tvb, pinfo, parent_tree, TRUE, usb_conv_info);
}
-
-/* dissector for mass storage bulk data */
static int
-dissect_usb_ms_bulk(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void* data)
+dissect_usb_ms_interrupt(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void *data)
{
usb_conv_info_t *usb_conv_info;
- usb_ms_conv_info_t *usb_ms_conv_info;
- proto_tree *tree;
- proto_item *ti;
- guint32 signature=0;
- int offset=0;
- gboolean is_request;
- itl_nexus_t *itl;
- itlq_nexus_t *itlq;
- /* Reject the packet if data is NULL */
- if (data == NULL)
- return 0;
usb_conv_info = (usb_conv_info_t *)data;
- /* verify that we do have a usb_ms_conv_info */
- usb_ms_conv_info=(usb_ms_conv_info_t *)usb_conv_info->class_data;
- if(!usb_ms_conv_info){
- usb_ms_conv_info=wmem_new(wmem_file_scope(), usb_ms_conv_info_t);
- usb_ms_conv_info->itl=wmem_tree_new(wmem_file_scope());
- usb_ms_conv_info->itlq=wmem_tree_new(wmem_file_scope());
- usb_conv_info->class_data=usb_ms_conv_info;
- usb_conv_info->class_data_type = USB_CONV_MASS_STORAGE;
- } else if (usb_conv_info->class_data_type != USB_CONV_MASS_STORAGE) {
- /* Don't dissect if another USB type is in the conversation */
- return 0;
- }
-
- is_request=(pinfo->srcport==NO_ENDPOINT);
-
- col_set_str(pinfo->cinfo, COL_PROTOCOL, "USBMS");
-
- col_clear(pinfo->cinfo, COL_INFO);
-
-
- ti = proto_tree_add_protocol_format(parent_tree, proto_usb_ms, tvb, 0, -1, "USB Mass Storage");
- tree = proto_item_add_subtree(ti, ett_usb_ms);
-
- signature=tvb_get_letohl(tvb, offset);
-
-
- /*
- * SCSI CDB inside CBW
- */
- if(is_request&&(signature==0x43425355)&&(tvb_reported_length(tvb)==31)){
- tvbuff_t *cdb_tvb;
- int cdbrlen, cdblen;
- guint8 lun, flags;
- guint32 datalen;
-
- /* dCBWSignature */
- proto_tree_add_item(tree, hf_usb_ms_dCBWSignature, tvb, offset, 4, ENC_LITTLE_ENDIAN);
- offset+=4;
-
- /* dCBWTag */
- proto_tree_add_item(tree, hf_usb_ms_dCBWTag, tvb, offset, 4, ENC_LITTLE_ENDIAN);
- offset+=4;
-
- /* dCBWDataTransferLength */
- proto_tree_add_item(tree, hf_usb_ms_dCBWDataTransferLength, tvb, offset, 4, ENC_LITTLE_ENDIAN);
- datalen=tvb_get_letohl(tvb, offset);
- offset+=4;
-
- /* dCBWFlags */
- proto_tree_add_item(tree, hf_usb_ms_dCBWFlags, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- flags=tvb_get_guint8(tvb, offset);
- offset+=1;
-
- /* dCBWLUN */
- proto_tree_add_item(tree, hf_usb_ms_dCBWTarget, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- proto_tree_add_item(tree, hf_usb_ms_dCBWLUN, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- lun=tvb_get_guint8(tvb, offset)&0x0f;
- offset+=1;
-
- /* make sure we have a ITL structure for this LUN */
- itl=(itl_nexus_t *)wmem_tree_lookup32(usb_ms_conv_info->itl, lun);
- if(!itl){
- itl=wmem_new(wmem_file_scope(), itl_nexus_t);
- itl->cmdset=0xff;
- itl->conversation=NULL;
- wmem_tree_insert32(usb_ms_conv_info->itl, lun, itl);
- }
-
- /* make sure we have an ITLQ structure for this LUN/transaction */
- itlq=(itlq_nexus_t *)wmem_tree_lookup32(usb_ms_conv_info->itlq, pinfo->num);
- if(!itlq){
- itlq=wmem_new(wmem_file_scope(), itlq_nexus_t);
- itlq->lun=lun;
- itlq->scsi_opcode=0xffff;
- itlq->task_flags=0;
- if(datalen){
- if(flags&0x80){
- itlq->task_flags|=SCSI_DATA_READ;
- } else {
- itlq->task_flags|=SCSI_DATA_WRITE;
- }
- }
- itlq->data_length=datalen;
- itlq->bidir_data_length=0;
- itlq->fc_time=pinfo->abs_ts;
- itlq->first_exchange_frame=pinfo->num;
- itlq->last_exchange_frame=0;
- itlq->flags=0;
- itlq->alloc_len=0;
- itlq->extra_data=NULL;
- wmem_tree_insert32(usb_ms_conv_info->itlq, pinfo->num, itlq);
- }
-
- /* dCBWCBLength */
- proto_tree_add_item(tree, hf_usb_ms_dCBWCBLength, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- cdbrlen=tvb_get_guint8(tvb, offset)&0x1f;
- offset+=1;
-
- cdblen=cdbrlen;
- if(cdblen>tvb_captured_length_remaining(tvb, offset)){
- cdblen=tvb_captured_length_remaining(tvb, offset);
- }
- if(cdblen){
- cdb_tvb=tvb_new_subset_length_caplen(tvb, offset, cdblen, cdbrlen);
- dissect_scsi_cdb(cdb_tvb, pinfo, parent_tree, SCSI_DEV_UNKNOWN, itlq, itl);
- }
- return tvb_captured_length(tvb);
- }
-
-
- /*
- * SCSI RESPONSE inside CSW
- */
- if((!is_request)&&(signature==0x53425355)&&(tvb_reported_length(tvb)==13)){
- guint8 status;
-
- /* dCSWSignature */
- proto_tree_add_item(tree, hf_usb_ms_dCSWSignature, tvb, offset, 4, ENC_LITTLE_ENDIAN);
- offset+=4;
-
- /* dCSWTag */
- proto_tree_add_item(tree, hf_usb_ms_dCBWTag, tvb, offset, 4, ENC_LITTLE_ENDIAN);
- offset+=4;
-
- /* dCSWDataResidue */
- proto_tree_add_item(tree, hf_usb_ms_dCSWDataResidue, tvb, offset, 4, ENC_LITTLE_ENDIAN);
- offset+=4;
-
- /* dCSWStatus */
- proto_tree_add_item(tree, hf_usb_ms_dCSWStatus, tvb, offset, 1, ENC_LITTLE_ENDIAN);
- status=tvb_get_guint8(tvb, offset);
- /*offset+=1;*/
-
- itlq=(itlq_nexus_t *)wmem_tree_lookup32_le(usb_ms_conv_info->itlq, pinfo->num);
- if(!itlq){
- return tvb_captured_length(tvb);
- }
- itlq->last_exchange_frame=pinfo->num;
-
- itl=(itl_nexus_t *)wmem_tree_lookup32(usb_ms_conv_info->itl, itlq->lun);
- if(!itl){
- return tvb_captured_length(tvb);
- }
-
- if(!status){
- dissect_scsi_rsp(tvb, pinfo, parent_tree, itlq, itl, 0);
- } else {
- /* just send "check condition" */
- dissect_scsi_rsp(tvb, pinfo, parent_tree, itlq, itl, 0x02);
- }
- return tvb_captured_length(tvb);
- }
-
- /*
- * Ok it was neither CDB not STATUS so just assume it is either data in/out
- */
- itlq=(itlq_nexus_t *)wmem_tree_lookup32_le(usb_ms_conv_info->itlq, pinfo->num);
- if(!itlq){
- return tvb_captured_length(tvb);
- }
-
- itl=(itl_nexus_t *)wmem_tree_lookup32(usb_ms_conv_info->itl, itlq->lun);
- if(!itl){
- return tvb_captured_length(tvb);
- }
-
- dissect_scsi_payload(tvb, pinfo, parent_tree, is_request, itlq, itl, 0);
- return tvb_captured_length(tvb);
+ return dissector_try_uint_new(usb_ms_interrupt_dissector_table, usb_conv_info->interfaceProtocol, tvb, pinfo, parent_tree, TRUE, usb_conv_info);
}
-static gboolean
-dissect_usb_ms_bulk_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data)
+static int
+dissect_usb_ms_descriptor(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void *data)
{
- const gchar usbc[] = {0x55, 0x53, 0x42, 0x43};
- const gchar usbs[] = {0x55, 0x53, 0x42, 0x53};
- if (tvb_reported_length(tvb) < 4)
- return FALSE;
+ usb_conv_info_t *usb_conv_info;
- if (tvb_memeql(tvb, 0, usbc, sizeof(usbc)) == 0 ||
- tvb_memeql(tvb, 0, usbs, sizeof(usbs)) == 0) {
- dissect_usb_ms_bulk(tvb, pinfo, tree, data);
- return TRUE;
- }
+ usb_conv_info = (usb_conv_info_t *)data;
- return FALSE;
+ return dissector_try_uint_new(usb_ms_descriptor_dissector_table, usb_conv_info->interfaceProtocol, tvb, pinfo, parent_tree, TRUE, usb_conv_info);
}
void
proto_register_usb_ms(void)
{
- static hf_register_info hf[] = {
- { &hf_usb_ms_dCBWSignature,
- { "Signature", "usbms.dCBWSignature", FT_UINT32, BASE_HEX,
- NULL, 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_dCBWTag,
- { "Tag", "usbms.dCBWTag", FT_UINT32, BASE_HEX,
- NULL, 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_dCBWDataTransferLength,
- { "DataTransferLength", "usbms.dCBWDataTransferLength", FT_UINT32, BASE_DEC,
- NULL, 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_dCBWFlags,
- { "Flags", "usbms.dCBWFlags", FT_UINT8, BASE_HEX,
- NULL, 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_dCBWTarget,
- { "Target", "usbms.dCBWTarget", FT_UINT8, BASE_HEX_DEC,
- NULL, 0x70, "Target Number when enabling multi-target mode", HFILL }},
-
- { &hf_usb_ms_dCBWLUN,
- { "LUN", "usbms.dCBWLUN", FT_UINT8, BASE_HEX,
- NULL, 0x0f, NULL, HFILL }},
-
- { &hf_usb_ms_dCBWCBLength,
- { "CDB Length", "usbms.dCBWCBLength", FT_UINT8, BASE_HEX,
- NULL, 0x1f, NULL, HFILL }},
-
- { &hf_usb_ms_dCSWSignature,
- { "Signature", "usbms.dCSWSignature", FT_UINT32, BASE_HEX,
- NULL, 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_dCSWDataResidue,
- { "DataResidue", "usbms.dCSWDataResidue", FT_UINT32, BASE_DEC,
- NULL, 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_dCSWStatus,
- { "Status", "usbms.dCSWStatus", FT_UINT8, BASE_HEX,
- VALS(status_vals), 0x0, NULL, HFILL }},
-
- { &hf_usb_ms_request,
- { "bRequest", "usbms.setup.bRequest", FT_UINT8, BASE_HEX, VALS(setup_request_names_vals), 0x0,
- NULL, HFILL }},
-
- { &hf_usb_ms_value,
- { "wValue", "usbms.setup.wValue", FT_UINT16, BASE_HEX, NULL, 0x0,
- NULL, HFILL }},
-
- { &hf_usb_ms_index,
- { "wIndex", "usbms.setup.wIndex", FT_UINT16, BASE_DEC, NULL, 0x0,
- NULL, HFILL }},
-
- { &hf_usb_ms_length,
- { "wLength", "usbms.setup.wLength", FT_UINT16, BASE_DEC, NULL, 0x0,
- NULL, HFILL }},
-
- { &hf_usb_ms_maxlun,
- { "Max LUN", "usbms.setup.maxlun", FT_UINT8, BASE_DEC, NULL, 0x0,
- NULL, HFILL }},
-
- };
-
- static gint *usb_ms_subtrees[] = {
- &ett_usb_ms,
- };
-
-
- proto_usb_ms = proto_register_protocol("USB Mass Storage", "USBMS", "usbms");
- proto_register_field_array(proto_usb_ms, hf, array_length(hf));
- proto_register_subtree_array(usb_ms_subtrees, array_length(usb_ms_subtrees));
-
- usb_ms_bulk_handle = register_dissector("usbms", dissect_usb_ms_bulk, proto_usb_ms);
+ proto_usb_ms = proto_register_protocol("USB Mass Storage Class", "USBMSClass", "usbmsclass");
+
+ usb_ms_bulk_dissector_table = register_dissector_table("usbms.bulk",
+ "USBMS bulk endpoint", proto_usb_ms, FT_UINT8, BASE_HEX);
+ usb_ms_control_dissector_table = register_dissector_table("usbms.control",
+ "USBMS control endpoint", proto_usb_ms, FT_UINT8, BASE_HEX);
+ usb_ms_interrupt_dissector_table = register_dissector_table("usbms.interrupt",
+ "USBMS interrupt endpoint", proto_usb_ms, FT_UINT8, BASE_HEX);
+ usb_ms_descriptor_dissector_table = register_dissector_table("usbms.descriptor",
+ "USBMS descriptor", proto_usb_ms, FT_UINT8, BASE_HEX);
}
void
proto_reg_handoff_usb_ms(void)
{
+ dissector_handle_t usb_ms_bulk_handle;
dissector_handle_t usb_ms_control_handle;
+ dissector_handle_t usb_ms_interrupt_handle;
+ dissector_handle_t usb_ms_descriptor_handle;
- dissector_add_uint("usb.bulk", IF_CLASS_MASS_STORAGE, usb_ms_bulk_handle);
-
+ usb_ms_bulk_handle = create_dissector_handle(dissect_usb_ms_bulk, proto_usb_ms);
usb_ms_control_handle = create_dissector_handle(dissect_usb_ms_control, proto_usb_ms);
- dissector_add_uint("usb.control", IF_CLASS_MASS_STORAGE, usb_ms_control_handle);
+ usb_ms_interrupt_handle = create_dissector_handle(dissect_usb_ms_interrupt, proto_usb_ms);
+ usb_ms_descriptor_handle = create_dissector_handle(dissect_usb_ms_descriptor, proto_usb_ms);
- heur_dissector_add("usb.bulk", dissect_usb_ms_bulk_heur, "Mass Storage USB bulk endpoint", "ms_usb_bulk", proto_usb_ms, HEURISTIC_ENABLE);
+ dissector_add_uint("usb.bulk", IF_CLASS_MASS_STORAGE, usb_ms_bulk_handle);
+ dissector_add_uint("usb.control", IF_CLASS_MASS_STORAGE, usb_ms_control_handle);
+ dissector_add_uint("usb.interrupt", IF_CLASS_MASS_STORAGE, usb_ms_interrupt_handle);
+ dissector_add_uint("usb.descriptor", IF_CLASS_MASS_STORAGE, usb_ms_descriptor_handle);
}
/*
diff --git a/epan/dissectors/packet-usbms-bot.c b/epan/dissectors/packet-usbms-bot.c
new file mode 100644
index 0000000000..b1c43c5c2f
--- /dev/null
+++ b/epan/dissectors/packet-usbms-bot.c
@@ -0,0 +1,478 @@
+/* packet-usbms-bot.c
+ *
+ * usb mass storage (bulk-only transport) dissector
+ * Ronnie Sahlberg 2006
+ *
+ * SPDX-License-Identifier: GPL-2.0-or-later
+ */
+
+
+#include "config.h"
+
+#include <epan/packet.h>
+#include "packet-usb.h"
+#include "packet-scsi.h"
+
+void proto_register_usbms_bot(void);
+void proto_reg_handoff_usbms_bot(void);
+
+#define IF_PROTOCOL_BULK_ONLY 0x50
+
+/* protocols and header fields */
+static int proto_usbms_bot = -1;
+static int hf_usbms_bot_dCBWSignature = -1;
+static int hf_usbms_bot_dCBWTag = -1;
+static int hf_usbms_bot_dCBWDataTransferLength = -1;
+static int hf_usbms_bot_dCBWFlags = -1;
+static int hf_usbms_bot_dCBWTarget = -1;
+static int hf_usbms_bot_dCBWLUN = -1;
+static int hf_usbms_bot_dCBWCBLength = -1;
+static int hf_usbms_bot_dCSWSignature = -1;
+static int hf_usbms_bot_dCSWDataResidue = -1;
+static int hf_usbms_bot_dCSWStatus = -1;
+static int hf_usbms_bot_request = -1;
+static int hf_usbms_bot_value = -1;
+static int hf_usbms_bot_index = -1;
+static int hf_usbms_bot_length = -1;
+static int hf_usbms_bot_maxlun = -1;
+
+static gint ett_usbms_bot = -1;
+
+static dissector_handle_t usbms_bot_bulk_handle;
+
+/* there is one such structure for each masstorage conversation */
+typedef struct _usbms_bot_conv_info_t {
+ wmem_tree_t *itl; /* indexed by LUN */
+ wmem_tree_t *itlq; /* pinfo->num */
+} usbms_bot_conv_info_t;
+
+
+static const value_string status_vals[] = {
+ {0x00, "Command Passed"},
+ {0x01, "Command Failed"},
+ {0x02, "Phase Error"},
+ {0, NULL}
+};
+
+static void
+dissect_usbms_bot_reset(packet_info *pinfo _U_, proto_tree *tree, tvbuff_t *tvb, int offset, gboolean is_request, usb_trans_info_t *usb_trans_info _U_, usb_conv_info_t *usb_conv_info _U_)
+{
+ if(is_request){
+ proto_tree_add_item(tree, hf_usbms_bot_value, tvb, offset, 2, ENC_LITTLE_ENDIAN);
+ offset += 2;
+
+ proto_tree_add_item(tree, hf_usbms_bot_index, tvb, offset, 2, ENC_LITTLE_ENDIAN);
+ offset += 2;
+
+ proto_tree_add_item(tree, hf_usbms_bot_length, tvb, offset, 2, ENC_LITTLE_ENDIAN);
+ /*offset += 2;*/
+ } else {
+ /* no data in reset response */
+ }
+}
+
+static void
+dissect_usbms_bot_get_max_lun(packet_info *pinfo _U_, proto_tree *tree, tvbuff_t *tvb, int offset, gboolean is_request, usb_trans_info_t *usb_trans_info _U_, usb_conv_info_t *usb_conv_info _U_)
+{
+ if(is_request){
+ proto_tree_add_item(tree, hf_usbms_bot_value, tvb, offset, 2, ENC_LITTLE_ENDIAN);
+ offset += 2;
+
+ proto_tree_add_item(tree, hf_usbms_bot_index, tvb, offset, 2, ENC_LITTLE_ENDIAN);
+ offset += 2;
+
+ proto_tree_add_item(tree, hf_usbms_bot_length, tvb, offset, 2, ENC_LITTLE_ENDIAN);
+ /*offset += 2;*/
+ } else {
+ proto_tree_add_item(tree, hf_usbms_bot_maxlun, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ /*offset++;*/
+ }
+}
+
+
+typedef void (*usb_setup_dissector)(packet_info *pinfo, proto_tree *tree, tvbuff_t *tvb, int offset, gboolean is_request, usb_trans_info_t *usb_trans_info, usb_conv_info_t *usb_conv_info);
+
+typedef struct _usb_setup_dissector_table_t {
+ guint8 request;
+ usb_setup_dissector dissector;
+} usb_setup_dissector_table_t;
+#define USB_SETUP_RESET 0xff
+#define USB_SETUP_GET_MAX_LUN 0xfe
+static const usb_setup_dissector_table_t setup_dissectors[] = {
+ {USB_SETUP_RESET, dissect_usbms_bot_reset},
+ {USB_SETUP_GET_MAX_LUN, dissect_usbms_bot_get_max_lun},
+ {0, NULL}
+};
+static const value_string setup_request_names_vals[] = {
+ {USB_SETUP_RESET, "RESET"},
+ {USB_SETUP_GET_MAX_LUN, "GET MAX LUN"},
+ {0, NULL}
+};
+
+/* Dissector for mass storage control .
+ * Returns tvb_captured_length(tvb) if a class specific dissector was found
+ * and 0 othervise.
+ */
+static gint
+dissect_usbms_bot_control(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void *data)
+{
+ gboolean is_request;
+ usb_conv_info_t *usb_conv_info;
+ usb_trans_info_t *usb_trans_info;
+ int offset=0;
+ usb_setup_dissector dissector = NULL;
+ const usb_setup_dissector_table_t *tmp;
+ proto_tree *tree;
+ proto_item *ti;
+
+ /* Reject the packet if data or usb_trans_info are NULL */
+ if (data == NULL || ((usb_conv_info_t *)data)->usb_trans_info == NULL)
+ return 0;
+ usb_conv_info = (usb_conv_info_t *)data;
+ usb_trans_info = usb_conv_info->usb_trans_info;
+
+ is_request=(pinfo->srcport==NO_ENDPOINT);
+
+ /* See if we can find a class specific dissector for this request */
+ for(tmp=setup_dissectors;tmp->dissector;tmp++){
+ if (tmp->request == usb_trans_info->setup.request){
+ dissector=tmp->dissector;
+ break;
+ }
+ }
+ /* No we could not find any class specific dissector for this request
+ * return 0 and let USB try any of the standard requests.
+ */
+ if(!dissector){
+ return 0;
+ }
+
+ col_set_str(pinfo->cinfo, COL_PROTOCOL, "USBMS");
+ ti = proto_tree_add_protocol_format(parent_tree, proto_usbms_bot, tvb, 0, -1, "USB Mass Storage");
+ tree = proto_item_add_subtree(ti, ett_usbms_bot);
+
+ col_add_fstr(pinfo->cinfo, COL_INFO, "%s %s",
+ val_to_str(usb_trans_info->setup.request, setup_request_names_vals, "Unknown type %x"),
+ is_request?"Request":"Response");
+
+ if(is_request){
+ proto_tree_add_item(tree, hf_usbms_bot_request, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ offset += 1;
+ }
+
+ dissector(pinfo, tree, tvb, offset, is_request, usb_trans_info, usb_conv_info);
+ return tvb_captured_length(tvb);
+}
+
+
+/* dissector for mass storage bulk data */
+static int
+dissect_usbms_bot_bulk(tvbuff_t *tvb, packet_info *pinfo, proto_tree *parent_tree, void* data)
+{
+ usb_conv_info_t *usb_conv_info;
+ usbms_bot_conv_info_t *usbms_bot_conv_info;
+ proto_tree *tree;
+ proto_item *ti;
+ guint32 signature=0;
+ int offset=0;
+ gboolean is_request;
+ itl_nexus_t *itl;
+ itlq_nexus_t *itlq;
+
+ /* Reject the packet if data is NULL */
+ if (data == NULL)
+ return 0;
+ usb_conv_info = (usb_conv_info_t *)data;
+
+ /* verify that we do have a usbms_bot_conv_info */
+ usbms_bot_conv_info=(usbms_bot_conv_info_t *)usb_conv_info->class_data;
+ if(!usbms_bot_conv_info){
+ usbms_bot_conv_info=wmem_new(wmem_file_scope(), usbms_bot_conv_info_t);
+ usbms_bot_conv_info->itl=wmem_tree_new(wmem_file_scope());
+ usbms_bot_conv_info->itlq=wmem_tree_new(wmem_file_scope());
+ usb_conv_info->class_data=usbms_bot_conv_info;
+ usb_conv_info->class_data_type = USB_CONV_MASS_STORAGE;
+ } else if (usb_conv_info->class_data_type != USB_CONV_MASS_STORAGE) {
+ /* Don't dissect if another USB type is in the conversation */
+ return 0;
+ }
+
+ is_request=(pinfo->srcport==NO_ENDPOINT);
+
+ col_set_str(pinfo->cinfo, COL_PROTOCOL, "USBMS");
+
+ col_clear(pinfo->cinfo, COL_INFO);
+
+
+ ti = proto_tree_add_protocol_format(parent_tree, proto_usbms_bot, tvb, 0, -1, "USB Mass Storage");
+ tree = proto_item_add_subtree(ti, ett_usbms_bot);
+
+ signature=tvb_get_letohl(tvb, offset);
+
+
+ /*
+ * SCSI CDB inside CBW
+ */
+ if(is_request&&(signature==0x43425355)&&(tvb_reported_length(tvb)==31)){
+ tvbuff_t *cdb_tvb;
+ int cdbrlen, cdblen;
+ guint8 lun, flags;
+ guint32 datalen;
+
+ /* dCBWSignature */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWSignature, tvb, offset, 4, ENC_LITTLE_ENDIAN);
+ offset+=4;
+
+ /* dCBWTag */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWTag, tvb, offset, 4, ENC_LITTLE_ENDIAN);
+ offset+=4;
+
+ /* dCBWDataTransferLength */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWDataTransferLength, tvb, offset, 4, ENC_LITTLE_ENDIAN);
+ datalen=tvb_get_letohl(tvb, offset);
+ offset+=4;
+
+ /* dCBWFlags */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWFlags, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ flags=tvb_get_guint8(tvb, offset);
+ offset+=1;
+
+ /* dCBWLUN */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWTarget, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWLUN, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ lun=tvb_get_guint8(tvb, offset)&0x0f;
+ offset+=1;
+
+ /* make sure we have a ITL structure for this LUN */
+ itl=(itl_nexus_t *)wmem_tree_lookup32(usbms_bot_conv_info->itl, lun);
+ if(!itl){
+ itl=wmem_new(wmem_file_scope(), itl_nexus_t);
+ itl->cmdset=0xff;
+ itl->conversation=NULL;
+ wmem_tree_insert32(usbms_bot_conv_info->itl, lun, itl);
+ }
+
+ /* make sure we have an ITLQ structure for this LUN/transaction */
+ itlq=(itlq_nexus_t *)wmem_tree_lookup32(usbms_bot_conv_info->itlq, pinfo->num);
+ if(!itlq){
+ itlq=wmem_new(wmem_file_scope(), itlq_nexus_t);
+ itlq->lun=lun;
+ itlq->scsi_opcode=0xffff;
+ itlq->task_flags=0;
+ if(datalen){
+ if(flags&0x80){
+ itlq->task_flags|=SCSI_DATA_READ;
+ } else {
+ itlq->task_flags|=SCSI_DATA_WRITE;
+ }
+ }
+ itlq->data_length=datalen;
+ itlq->bidir_data_length=0;
+ itlq->fc_time=pinfo->abs_ts;
+ itlq->first_exchange_frame=pinfo->num;
+ itlq->last_exchange_frame=0;
+ itlq->flags=0;
+ itlq->alloc_len=0;
+ itlq->extra_data=NULL;
+ wmem_tree_insert32(usbms_bot_conv_info->itlq, pinfo->num, itlq);
+ }
+
+ /* dCBWCBLength */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWCBLength, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ cdbrlen=tvb_get_guint8(tvb, offset)&0x1f;
+ offset+=1;
+
+ cdblen=cdbrlen;
+ if(cdblen>tvb_captured_length_remaining(tvb, offset)){
+ cdblen=tvb_captured_length_remaining(tvb, offset);
+ }
+ if(cdblen){
+ cdb_tvb=tvb_new_subset_length_caplen(tvb, offset, cdblen, cdbrlen);
+ dissect_scsi_cdb(cdb_tvb, pinfo, parent_tree, SCSI_DEV_UNKNOWN, itlq, itl);
+ }
+ return tvb_captured_length(tvb);
+ }
+
+
+ /*
+ * SCSI RESPONSE inside CSW
+ */
+ if((!is_request)&&(signature==0x53425355)&&(tvb_reported_length(tvb)==13)){
+ guint8 status;
+
+ /* dCSWSignature */
+ proto_tree_add_item(tree, hf_usbms_bot_dCSWSignature, tvb, offset, 4, ENC_LITTLE_ENDIAN);
+ offset+=4;
+
+ /* dCSWTag */
+ proto_tree_add_item(tree, hf_usbms_bot_dCBWTag, tvb, offset, 4, ENC_LITTLE_ENDIAN);
+ offset+=4;
+
+ /* dCSWDataResidue */
+ proto_tree_add_item(tree, hf_usbms_bot_dCSWDataResidue, tvb, offset, 4, ENC_LITTLE_ENDIAN);
+ offset+=4;
+
+ /* dCSWStatus */
+ proto_tree_add_item(tree, hf_usbms_bot_dCSWStatus, tvb, offset, 1, ENC_LITTLE_ENDIAN);
+ status=tvb_get_guint8(tvb, offset);
+ /*offset+=1;*/
+
+ itlq=(itlq_nexus_t *)wmem_tree_lookup32_le(usbms_bot_conv_info->itlq, pinfo->num);
+ if(!itlq){
+ return tvb_captured_length(tvb);
+ }
+ itlq->last_exchange_frame=pinfo->num;
+
+ itl=(itl_nexus_t *)wmem_tree_lookup32(usbms_bot_conv_info->itl, itlq->lun);
+ if(!itl){
+ return tvb_captured_length(tvb);
+ }
+
+ if(!status){
+ dissect_scsi_rsp(tvb, pinfo, parent_tree, itlq, itl, 0);
+ } else {
+ /* just send "check condition" */
+ dissect_scsi_rsp(tvb, pinfo, parent_tree, itlq, itl, 0x02);
+ }
+ return tvb_captured_length(tvb);
+ }
+
+ /*
+ * Ok it was neither CDB not STATUS so just assume it is either data in/out
+ */
+ itlq=(itlq_nexus_t *)wmem_tree_lookup32_le(usbms_bot_conv_info->itlq, pinfo->num);
+ if(!itlq){
+ return tvb_captured_length(tvb);
+ }
+
+ itl=(itl_nexus_t *)wmem_tree_lookup32(usbms_bot_conv_info->itl, itlq->lun);
+ if(!itl){
+ return tvb_captured_length(tvb);
+ }
+
+ dissect_scsi_payload(tvb, pinfo, parent_tree, is_request, itlq, itl, 0);
+ return tvb_captured_length(tvb);
+}
+
+static gboolean
+dissect_usbms_bot_bulk_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void* data)
+{
+ const gchar usbc[] = {0x55, 0x53, 0x42, 0x43};
+ const gchar usbs[] = {0x55, 0x53, 0x42, 0x53};
+ if (tvb_reported_length(tvb) < 4)
+ return FALSE;
+
+ if (tvb_memeql(tvb, 0, usbc, sizeof(usbc)) == 0 ||
+ tvb_memeql(tvb, 0, usbs, sizeof(usbs)) == 0) {
+ dissect_usbms_bot_bulk(tvb, pinfo, tree, data);
+ return TRUE;
+ }
+
+ return FALSE;
+}
+
+void
+proto_register_usbms_bot(void)
+{
+ static hf_register_info hf[] = {
+ { &hf_usbms_bot_dCBWSignature,
+ { "Signature", "usbms.dCBWSignature", FT_UINT32, BASE_HEX,
+ NULL, 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCBWTag,
+ { "Tag", "usbms.dCBWTag", FT_UINT32, BASE_HEX,
+ NULL, 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCBWDataTransferLength,
+ { "DataTransferLength", "usbms.dCBWDataTransferLength", FT_UINT32, BASE_DEC,
+ NULL, 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCBWFlags,
+ { "Flags", "usbms.dCBWFlags", FT_UINT8, BASE_HEX,
+ NULL, 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCBWTarget,
+ { "Target", "usbms.dCBWTarget", FT_UINT8, BASE_HEX_DEC,
+ NULL, 0x70, "Target Number when enabling multi-target mode", HFILL }},
+
+ { &hf_usbms_bot_dCBWLUN,
+ { "LUN", "usbms.dCBWLUN", FT_UINT8, BASE_HEX,
+ NULL, 0x0f, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCBWCBLength,
+ { "CDB Length", "usbms.dCBWCBLength", FT_UINT8, BASE_HEX,
+ NULL, 0x1f, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCSWSignature,
+ { "Signature", "usbms.dCSWSignature", FT_UINT32, BASE_HEX,
+ NULL, 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCSWDataResidue,
+ { "DataResidue", "usbms.dCSWDataResidue", FT_UINT32, BASE_DEC,
+ NULL, 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_dCSWStatus,
+ { "Status", "usbms.dCSWStatus", FT_UINT8, BASE_HEX,
+ VALS(status_vals), 0x0, NULL, HFILL }},
+
+ { &hf_usbms_bot_request,
+ { "bRequest", "usbms.setup.bRequest", FT_UINT8, BASE_HEX, VALS(setup_request_names_vals), 0x0,
+ NULL, HFILL }},
+
+ { &hf_usbms_bot_value,
+ { "wValue", "usbms.setup.wValue", FT_UINT16, BASE_HEX, NULL, 0x0,
+ NULL, HFILL }},
+
+ { &hf_usbms_bot_index,
+ { "wIndex", "usbms.setup.wIndex", FT_UINT16, BASE_DEC, NULL, 0x0,
+ NULL, HFILL }},
+
+ { &hf_usbms_bot_length,
+ { "wLength", "usbms.setup.wLength", FT_UINT16, BASE_DEC, NULL, 0x0,
+ NULL, HFILL }},
+
+ { &hf_usbms_bot_maxlun,
+ { "Max LUN", "usbms.setup.maxlun", FT_UINT8, BASE_DEC, NULL, 0x0,
+ NULL, HFILL }},
+
+ };
+
+ static gint *usbms_bot_subtrees[] = {
+ &ett_usbms_bot,
+ };
+
+
+ proto_usbms_bot = proto_register_protocol("USB Mass Storage", "USBMS", "usbms");
+ proto_register_field_array(proto_usbms_bot, hf, array_length(hf));
+ proto_register_subtree_array(usbms_bot_subtrees, array_length(usbms_bot_subtrees));
+
+ usbms_bot_bulk_handle = register_dissector("usbms", dissect_usbms_bot_bulk, proto_usbms_bot);
+}
+
+void
+proto_reg_handoff_usbms_bot(void)
+{
+ dissector_handle_t usbms_bot_control_handle;
+
+ dissector_add_uint("usbms.bulk", IF_PROTOCOL_BULK_ONLY, usbms_bot_bulk_handle);
+
+ usbms_bot_control_handle = create_dissector_handle(dissect_usbms_bot_control, proto_usbms_bot);
+ dissector_add_uint("usbms.control", IF_PROTOCOL_BULK_ONLY, usbms_bot_control_handle);
+
+ heur_dissector_add("usb.bulk", dissect_usbms_bot_bulk_heur,
+ "Mass Storage USB Bulk-Only Transport bulk endpoint",
+ "ms_usb_bulk", proto_usbms_bot, HEURISTIC_ENABLE);
+}
+
+/*
+ * 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:
+ */