On 20-11-06 12:42:58, Pawel Laszczak wrote:
> Patch adds the series of tracepoints that can be used for
> debugging issues detected in driver.
>
> Signed-off-by: Pawel Laszczak <pawell@xxxxxxxxxxx>
Reviewed-by: Peter Chen <peter.chen@xxxxxxx>
> ---
> drivers/usb/cdns3/Makefile | 5 +
> drivers/usb/cdns3/cdnsp-debug.h | 583 +++++++++++++++++++++
> drivers/usb/cdns3/cdnsp-ep0.c | 22 +-
> drivers/usb/cdns3/cdnsp-gadget.c | 75 ++-
> drivers/usb/cdns3/cdnsp-mem.c | 18 +-
> drivers/usb/cdns3/cdnsp-ring.c | 75 ++-
> drivers/usb/cdns3/cdnsp-trace.c | 12 +
> drivers/usb/cdns3/cdnsp-trace.h | 840 +++++++++++++++++++++++++++++++
> 8 files changed, 1614 insertions(+), 16 deletions(-)
> create mode 100644 drivers/usb/cdns3/cdnsp-debug.h
> create mode 100644 drivers/usb/cdns3/cdnsp-trace.c
> create mode 100644 drivers/usb/cdns3/cdnsp-trace.h
>
> diff --git a/drivers/usb/cdns3/Makefile b/drivers/usb/cdns3/Makefile
> index a84b129f14b8..a4fdaabdbe18 100644
> --- a/drivers/usb/cdns3/Makefile
> +++ b/drivers/usb/cdns3/Makefile
> @@ -1,6 +1,7 @@
> # SPDX-License-Identifier: GPL-2.0
> # define_trace.h needs to know how to find our header
> CFLAGS_trace.o := -I$(src)
> +CFLAGS_cdnsp-trace.o := -I$(src)
>
> cdns-usb-common-y := core.o drd.o
> cdns3-y := cdns3-plat.o
> @@ -23,3 +24,7 @@ cdnsp-udc-pci-y := cdnsp-pci.o
> obj-$(CONFIG_USB_CDNSP_PCI) += cdnsp-udc-pci.o
> cdnsp-udc-pci-$(CONFIG_USB_CDNSP_GADGET) += cdnsp-ring.o cdnsp-gadget.o \
> cdnsp-mem.o cdnsp-ep0.o
> +
> +ifneq ($(CONFIG_USB_CDNSP_GADGET),)
> +cdnsp-udc-pci-$(CONFIG_TRACING) += cdnsp-trace.o
> +endif
> diff --git a/drivers/usb/cdns3/cdnsp-debug.h b/drivers/usb/cdns3/cdnsp-debug.h
> new file mode 100644
> index 000000000000..d6345d4d2911
> --- /dev/null
> +++ b/drivers/usb/cdns3/cdnsp-debug.h
> @@ -0,0 +1,583 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +/*
> + * Cadence CDNSP DRD Driver.
> + *
> + * Copyright (C) 2020 Cadence.
> + *
> + * Author: Pawel Laszczak <pawell@xxxxxxxxxxx>
> + *
> + */
> +#ifndef __LINUX_CDNSP_DEBUG
> +#define __LINUX_CDNSP_DEBUG
> +
> +static inline const char *cdnsp_trb_comp_code_string(u8 status)
> +{
> + switch (status) {
> + case COMP_INVALID:
> + return "Invalid";
> + case COMP_SUCCESS:
> + return "Success";
> + case COMP_DATA_BUFFER_ERROR:
> + return "Data Buffer Error";
> + case COMP_BABBLE_DETECTED_ERROR:
> + return "Babble Detected";
> + case COMP_TRB_ERROR:
> + return "TRB Error";
> + case COMP_RESOURCE_ERROR:
> + return "Resource Error";
> + case COMP_NO_SLOTS_AVAILABLE_ERROR:
> + return "No Slots Available Error";
> + case COMP_INVALID_STREAM_TYPE_ERROR:
> + return "Invalid Stream Type Error";
> + case COMP_SLOT_NOT_ENABLED_ERROR:
> + return "Slot Not Enabled Error";
> + case COMP_ENDPOINT_NOT_ENABLED_ERROR:
> + return "Endpoint Not Enabled Error";
> + case COMP_SHORT_PACKET:
> + return "Short Packet";
> + case COMP_RING_UNDERRUN:
> + return "Ring Underrun";
> + case COMP_RING_OVERRUN:
> + return "Ring Overrun";
> + case COMP_VF_EVENT_RING_FULL_ERROR:
> + return "VF Event Ring Full Error";
> + case COMP_PARAMETER_ERROR:
> + return "Parameter Error";
> + case COMP_CONTEXT_STATE_ERROR:
> + return "Context State Error";
> + case COMP_EVENT_RING_FULL_ERROR:
> + return "Event Ring Full Error";
> + case COMP_INCOMPATIBLE_DEVICE_ERROR:
> + return "Incompatible Device Error";
> + case COMP_MISSED_SERVICE_ERROR:
> + return "Missed Service Error";
> + case COMP_COMMAND_RING_STOPPED:
> + return "Command Ring Stopped";
> + case COMP_COMMAND_ABORTED:
> + return "Command Aborted";
> + case COMP_STOPPED:
> + return "Stopped";
> + case COMP_STOPPED_LENGTH_INVALID:
> + return "Stopped - Length Invalid";
> + case COMP_STOPPED_SHORT_PACKET:
> + return "Stopped - Short Packet";
> + case COMP_MAX_EXIT_LATENCY_TOO_LARGE_ERROR:
> + return "Max Exit Latency Too Large Error";
> + case COMP_ISOCH_BUFFER_OVERRUN:
> + return "Isoch Buffer Overrun";
> + case COMP_EVENT_LOST_ERROR:
> + return "Event Lost Error";
> + case COMP_UNDEFINED_ERROR:
> + return "Undefined Error";
> + case COMP_INVALID_STREAM_ID_ERROR:
> + return "Invalid Stream ID Error";
> + default:
> + return "Unknown!!";
> + }
> +}
> +
> +static inline const char *cdnsp_trb_type_string(u8 type)
> +{
> + switch (type) {
> + case TRB_NORMAL:
> + return "Normal";
> + case TRB_SETUP:
> + return "Setup Stage";
> + case TRB_DATA:
> + return "Data Stage";
> + case TRB_STATUS:
> + return "Status Stage";
> + case TRB_ISOC:
> + return "Isoch";
> + case TRB_LINK:
> + return "Link";
> + case TRB_EVENT_DATA:
> + return "Event Data";
> + case TRB_TR_NOOP:
> + return "No-Op";
> + case TRB_ENABLE_SLOT:
> + return "Enable Slot Command";
> + case TRB_DISABLE_SLOT:
> + return "Disable Slot Command";
> + case TRB_ADDR_DEV:
> + return "Address Device Command";
> + case TRB_CONFIG_EP:
> + return "Configure Endpoint Command";
> + case TRB_EVAL_CONTEXT:
> + return "Evaluate Context Command";
> + case TRB_RESET_EP:
> + return "Reset Endpoint Command";
> + case TRB_STOP_RING:
> + return "Stop Ring Command";
> + case TRB_SET_DEQ:
> + return "Set TR Dequeue Pointer Command";
> + case TRB_RESET_DEV:
> + return "Reset Device Command";
> + case TRB_FORCE_HEADER:
> + return "Force Header Command";
> + case TRB_CMD_NOOP:
> + return "No-Op Command";
> + case TRB_TRANSFER:
> + return "Transfer Event";
> + case TRB_COMPLETION:
> + return "Command Completion Event";
> + case TRB_PORT_STATUS:
> + return "Port Status Change Event";
> + case TRB_HC_EVENT:
> + return "Device Controller Event";
> + case TRB_MFINDEX_WRAP:
> + return "MFINDEX Wrap Event";
> + case TRB_ENDPOINT_NRDY:
> + return "Endpoint Not ready";
> + case TRB_HALT_ENDPOINT:
> + return "Halt Endpoint";
> + case TRB_FLUSH_ENDPOINT:
> + return "FLush Endpoint";
> + default:
> + return "UNKNOWN";
> + }
> +}
> +
> +static inline const char *cdnsp_ring_type_string(enum cdnsp_ring_type type)
> +{
> + switch (type) {
> + case TYPE_CTRL:
> + return "CTRL";
> + case TYPE_ISOC:
> + return "ISOC";
> + case TYPE_BULK:
> + return "BULK";
> + case TYPE_INTR:
> + return "INTR";
> + case TYPE_STREAM:
> + return "STREAM";
> + case TYPE_COMMAND:
> + return "CMD";
> + case TYPE_EVENT:
> + return "EVENT";
> + }
> +
> + return "UNKNOWN";
> +}
> +
> +static inline char *cdnsp_slot_state_string(u32 state)
> +{
> + switch (state) {
> + case SLOT_STATE_ENABLED:
> + return "enabled/disabled";
> + case SLOT_STATE_DEFAULT:
> + return "default";
> + case SLOT_STATE_ADDRESSED:
> + return "addressed";
> + case SLOT_STATE_CONFIGURED:
> + return "configured";
> + default:
> + return "reserved";
> + }
> +}
> +
> +static inline const char *cdnsp_decode_trb(char *str, size_t size, u32 field0,
> + u32 field1, u32 field2, u32 field3)
> +{
> + int ep_id = TRB_TO_EP_INDEX(field3) - 1;
> + int type = TRB_FIELD_TO_TYPE(field3);
> + unsigned int ep_num;
> + int ret = 0;
> + u32 temp;
> +
> + ep_num = DIV_ROUND_UP(ep_id, 2);
> +
> + switch (type) {
> + case TRB_LINK:
> + ret += snprintf(str, size,
> + "LINK %08x%08x intr %ld type '%s' flags %c:%c:%c:%c",
> + field1, field0, GET_INTR_TARGET(field2),
> + cdnsp_trb_type_string(type),
> + field3 & TRB_IOC ? 'I' : 'i',
> + field3 & TRB_CHAIN ? 'C' : 'c',
> + field3 & TRB_TC ? 'T' : 't',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_TRANSFER:
> + case TRB_COMPLETION:
> + case TRB_PORT_STATUS:
> + case TRB_HC_EVENT:
> + ret += snprintf(str, size,
> + "ep%d%s(%d) type '%s' TRB %08x%08x status '%s'"
> + " len %ld slot %ld flags %c:%c",
> + ep_num, ep_id % 2 ? "out" : "in",
> + TRB_TO_EP_INDEX(field3),
> + cdnsp_trb_type_string(type), field1, field0,
> + cdnsp_trb_comp_code_string(GET_COMP_CODE(field2)),
> + EVENT_TRB_LEN(field2), TRB_TO_SLOT_ID(field3),
> + field3 & EVENT_DATA ? 'E' : 'e',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_MFINDEX_WRAP:
> + ret += snprintf(str, size, "%s: flags %c",
> + cdnsp_trb_type_string(type),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_SETUP:
> + ret += snprintf(str, size,
> + "type '%s' bRequestType %02x bRequest %02x "
> + "wValue %02x%02x wIndex %02x%02x wLength %d "
> + "length %ld TD size %ld intr %ld Setup ID %ld "
> + "flags %c:%c:%c",
> + cdnsp_trb_type_string(type),
> + field0 & 0xff,
> + (field0 & 0xff00) >> 8,
> + (field0 & 0xff000000) >> 24,
> + (field0 & 0xff0000) >> 16,
> + (field1 & 0xff00) >> 8,
> + field1 & 0xff,
> + (field1 & 0xff000000) >> 16 |
> + (field1 & 0xff0000) >> 16,
> + TRB_LEN(field2), GET_TD_SIZE(field2),
> + GET_INTR_TARGET(field2),
> + TRB_SETUPID_TO_TYPE(field3),
> + field3 & TRB_IDT ? 'D' : 'd',
> + field3 & TRB_IOC ? 'I' : 'i',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_DATA:
> + ret += snprintf(str, size,
> + "type '%s' Buffer %08x%08x length %ld TD size %ld "
> + "intr %ld flags %c:%c:%c:%c:%c:%c:%c",
> + cdnsp_trb_type_string(type),
> + field1, field0, TRB_LEN(field2),
> + GET_TD_SIZE(field2),
> + GET_INTR_TARGET(field2),
> + field3 & TRB_IDT ? 'D' : 'i',
> + field3 & TRB_IOC ? 'I' : 'i',
> + field3 & TRB_CHAIN ? 'C' : 'c',
> + field3 & TRB_NO_SNOOP ? 'S' : 's',
> + field3 & TRB_ISP ? 'I' : 'i',
> + field3 & TRB_ENT ? 'E' : 'e',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_STATUS:
> + ret += snprintf(str, size,
> + "Buffer %08x%08x length %ld TD size %ld intr"
> + "%ld type '%s' flags %c:%c:%c:%c",
> + field1, field0, TRB_LEN(field2),
> + GET_TD_SIZE(field2),
> + GET_INTR_TARGET(field2),
> + cdnsp_trb_type_string(type),
> + field3 & TRB_IOC ? 'I' : 'i',
> + field3 & TRB_CHAIN ? 'C' : 'c',
> + field3 & TRB_ENT ? 'E' : 'e',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_NORMAL:
> + case TRB_ISOC:
> + case TRB_EVENT_DATA:
> + case TRB_TR_NOOP:
> + ret += snprintf(str, size,
> + "type '%s' Buffer %08x%08x length %ld "
> + "TD size %ld intr %ld "
> + "flags %c:%c:%c:%c:%c:%c:%c:%c:%c",
> + cdnsp_trb_type_string(type),
> + field1, field0, TRB_LEN(field2),
> + GET_TD_SIZE(field2),
> + GET_INTR_TARGET(field2),
> + field3 & TRB_BEI ? 'B' : 'b',
> + field3 & TRB_IDT ? 'T' : 't',
> + field3 & TRB_IOC ? 'I' : 'i',
> + field3 & TRB_CHAIN ? 'C' : 'c',
> + field3 & TRB_NO_SNOOP ? 'S' : 's',
> + field3 & TRB_ISP ? 'I' : 'i',
> + field3 & TRB_ENT ? 'E' : 'e',
> + field3 & TRB_CYCLE ? 'C' : 'c',
> + !(field3 & TRB_EVENT_INVALIDATE) ? 'V' : 'v');
> + break;
> + case TRB_CMD_NOOP:
> + case TRB_ENABLE_SLOT:
> + ret += snprintf(str, size, "%s: flags %c",
> + cdnsp_trb_type_string(type),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_DISABLE_SLOT:
> + ret += snprintf(str, size, "%s: slot %ld flags %c",
> + cdnsp_trb_type_string(type),
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_ADDR_DEV:
> + ret += snprintf(str, size,
> + "%s: ctx %08x%08x slot %ld flags %c:%c",
> + cdnsp_trb_type_string(type), field1, field0,
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_BSR ? 'B' : 'b',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_CONFIG_EP:
> + ret += snprintf(str, size,
> + "%s: ctx %08x%08x slot %ld flags %c:%c",
> + cdnsp_trb_type_string(type), field1, field0,
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_DC ? 'D' : 'd',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_EVAL_CONTEXT:
> + ret += snprintf(str, size,
> + "%s: ctx %08x%08x slot %ld flags %c",
> + cdnsp_trb_type_string(type), field1, field0,
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_RESET_EP:
> + case TRB_HALT_ENDPOINT:
> + case TRB_FLUSH_ENDPOINT:
> + ret += snprintf(str, size,
> + "%s: ep%d%s(%d) ctx %08x%08x slot %ld flags %c",
> + cdnsp_trb_type_string(type),
> + ep_num, ep_id % 2 ? "out" : "in",
> + TRB_TO_EP_INDEX(field3), field1, field0,
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_STOP_RING:
> + ret += snprintf(str, size,
> + "%s: ep%d%s(%d) slot %ld sp %d flags %c",
> + cdnsp_trb_type_string(type),
> + ep_num, ep_id % 2 ? "out" : "in",
> + TRB_TO_EP_INDEX(field3),
> + TRB_TO_SLOT_ID(field3),
> + TRB_TO_SUSPEND_PORT(field3),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_SET_DEQ:
> + ret += snprintf(str, size,
> + "%s: ep%d%s(%d) deq %08x%08x stream %ld slot %ld flags %c",
> + cdnsp_trb_type_string(type),
> + ep_num, ep_id % 2 ? "out" : "in",
> + TRB_TO_EP_INDEX(field3), field1, field0,
> + TRB_TO_STREAM_ID(field2),
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_RESET_DEV:
> + ret += snprintf(str, size, "%s: slot %ld flags %c",
> + cdnsp_trb_type_string(type),
> + TRB_TO_SLOT_ID(field3),
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + case TRB_ENDPOINT_NRDY:
> + temp = TRB_TO_HOST_STREAM(field2);
> +
> + ret += snprintf(str, size,
> + "%s: ep%d%s(%d) H_SID %x%s%s D_SID %lx flags %c:%c",
> + cdnsp_trb_type_string(type),
> + ep_num, ep_id % 2 ? "out" : "in",
> + TRB_TO_EP_INDEX(field3), temp,
> + temp == STREAM_PRIME_ACK ? "(PRIME)" : "",
> + temp == STREAM_REJECTED ? "(REJECTED)" : "",
> + TRB_TO_DEV_STREAM(field0),
> + field3 & TRB_STAT ? 'S' : 's',
> + field3 & TRB_CYCLE ? 'C' : 'c');
> + break;
> + default:
> + ret += snprintf(str, size,
> + "type '%s' -> raw %08x %08x %08x %08x",
> + cdnsp_trb_type_string(type),
> + field0, field1, field2, field3);
> + }
> +
> + return str;
> +}
> +
> +static inline const char *cdnsp_decode_slot_context(u32 info, u32 info2,
> + u32 int_target, u32 state)
> +{
> + static char str[1024];
> + int ret = 0;
> + u32 speed;
> + char *s;
> +
> + speed = info & DEV_SPEED;
> +
> + switch (speed) {
> + case SLOT_SPEED_FS:
> + s = "full-speed";
> + break;
> + case SLOT_SPEED_HS:
> + s = "high-speed";
> + break;
> + case SLOT_SPEED_SS:
> + s = "super-speed";
> + break;
> + case SLOT_SPEED_SSP:
> + s = "super-speed plus";
> + break;
> + default:
> + s = "UNKNOWN speed";
> + }
> +
> + ret = sprintf(str, "%s Ctx Entries %ld",
> + s, (info & LAST_CTX_MASK) >> 27);
> +
> + ret += sprintf(str + ret, " [Intr %ld] Addr %ld State %s",
> + GET_INTR_TARGET(int_target), state & DEV_ADDR_MASK,
> + cdnsp_slot_state_string(GET_SLOT_STATE(state)));
> +
> + return str;
> +}
> +
> +static inline const char *cdnsp_portsc_link_state_string(u32 portsc)
> +{
> + switch (portsc & PORT_PLS_MASK) {
> + case XDEV_U0:
> + return "U0";
> + case XDEV_U1:
> + return "U1";
> + case XDEV_U2:
> + return "U2";
> + case XDEV_U3:
> + return "U3";
> + case XDEV_DISABLED:
> + return "Disabled";
> + case XDEV_RXDETECT:
> + return "RxDetect";
> + case XDEV_INACTIVE:
> + return "Inactive";
> + case XDEV_POLLING:
> + return "Polling";
> + case XDEV_RECOVERY:
> + return "Recovery";
> + case XDEV_HOT_RESET:
> + return "Hot Reset";
> + case XDEV_COMP_MODE:
> + return "Compliance mode";
> + case XDEV_TEST_MODE:
> + return "Test mode";
> + case XDEV_RESUME:
> + return "Resume";
> + default:
> + break;
> + }
> +
> + return "Unknown";
> +}
> +
> +static inline const char *cdnsp_decode_portsc(char *str, size_t size,
> + u32 portsc)
> +{
> + int ret;
> +
> + ret = snprintf(str, size, "%s %s %s Link:%s PortSpeed:%d ",
> + portsc & PORT_POWER ? "Powered" : "Powered-off",
> + portsc & PORT_CONNECT ? "Connected" : "Not-connected",
> + portsc & PORT_PED ? "Enabled" : "Disabled",
> + cdnsp_portsc_link_state_string(portsc),
> + DEV_PORT_SPEED(portsc));
> +
> + if (portsc & PORT_RESET)
> + ret += snprintf(str + ret, size - ret, "In-Reset ");
> +
> + ret += snprintf(str + ret, size - ret, "Change: ");
> + if (portsc & PORT_CSC)
> + ret += snprintf(str + ret, size - ret, "CSC ");
> + if (portsc & PORT_WRC)
> + ret += snprintf(str + ret, size - ret, "WRC ");
> + if (portsc & PORT_RC)
> + ret += snprintf(str + ret, size - ret, "PRC ");
> + if (portsc & PORT_PLC)
> + ret += snprintf(str + ret, size - ret, "PLC ");
> + if (portsc & PORT_CEC)
> + ret += snprintf(str + ret, size - ret, "CEC ");
> + ret += snprintf(str + ret, size - ret, "Wake: ");
> + if (portsc & PORT_WKCONN_E)
> + ret += snprintf(str + ret, size - ret, "WCE ");
> + if (portsc & PORT_WKDISC_E)
> + ret += snprintf(str + ret, size - ret, "WDE ");
> +
> + return str;
> +}
> +
> +static inline const char *cdnsp_ep_state_string(u8 state)
> +{
> + switch (state) {
> + case EP_STATE_DISABLED:
> + return "disabled";
> + case EP_STATE_RUNNING:
> + return "running";
> + case EP_STATE_HALTED:
> + return "halted";
> + case EP_STATE_STOPPED:
> + return "stopped";
> + case EP_STATE_ERROR:
> + return "error";
> + default:
> + return "INVALID";
> + }
> +}
> +
> +static inline const char *cdnsp_ep_type_string(u8 type)
> +{
> + switch (type) {
> + case ISOC_OUT_EP:
> + return "Isoc OUT";
> + case BULK_OUT_EP:
> + return "Bulk OUT";
> + case INT_OUT_EP:
> + return "Int OUT";
> + case CTRL_EP:
> + return "Ctrl";
> + case ISOC_IN_EP:
> + return "Isoc IN";
> + case BULK_IN_EP:
> + return "Bulk IN";
> + case INT_IN_EP:
> + return "Int IN";
> + default:
> + return "INVALID";
> + }
> +}
> +
> +static inline const char *cdnsp_decode_ep_context(char *str, size_t size,
> + u32 info, u32 info2,
> + u64 deq, u32 tx_info)
> +{
> + u8 max_pstr, ep_state, interval, ep_type, burst, cerr, mult;
> + bool lsa, hid;
> + u16 maxp, avg;
> + u32 esit;
> + int ret;
> +
> + esit = CTX_TO_MAX_ESIT_PAYLOAD_HI(info) << 16 |
> + CTX_TO_MAX_ESIT_PAYLOAD_LO(tx_info);
> +
> + ep_state = info & EP_STATE_MASK;
> + max_pstr = CTX_TO_EP_MAXPSTREAMS(info);
> + interval = CTX_TO_EP_INTERVAL(info);
> + mult = CTX_TO_EP_MULT(info) + 1;
> + lsa = !!(info & EP_HAS_LSA);
> +
> + cerr = (info2 & (3 << 1)) >> 1;
> + ep_type = CTX_TO_EP_TYPE(info2);
> + hid = !!(info2 & (1 << 7));
> + burst = CTX_TO_MAX_BURST(info2);
> + maxp = MAX_PACKET_DECODED(info2);
> +
> + avg = EP_AVG_TRB_LENGTH(tx_info);
> +
> + ret = snprintf(str, size, "State %s mult %d max P. Streams %d %s",
> + cdnsp_ep_state_string(ep_state), mult,
> + max_pstr, lsa ? "LSA " : "");
> +
> + ret += snprintf(str + ret, size - ret,
> + "interval %d us max ESIT payload %d CErr %d ",
> + (1 << interval) * 125, esit, cerr);
> +
> + ret += snprintf(str + ret, size - ret,
> + "Type %s %sburst %d maxp %d deq %016llx ",
> + cdnsp_ep_type_string(ep_type), hid ? "HID" : "",
> + burst, maxp, deq);
> +
> + ret += snprintf(str + ret, size - ret, "avg trb len %d", avg);
> +
> + return str;
> +}
> +
> +#endif /*__LINUX_CDNSP_DEBUG*/
> diff --git a/drivers/usb/cdns3/cdnsp-ep0.c b/drivers/usb/cdns3/cdnsp-ep0.c
> index 6235a7e4e5da..13771a7087ef 100644
> --- a/drivers/usb/cdns3/cdnsp-ep0.c
> +++ b/drivers/usb/cdns3/cdnsp-ep0.c
> @@ -13,6 +13,7 @@
> #include <linux/list.h>
>
> #include "cdnsp-gadget.h"
> +#include "cdnsp-trace.h"
>
> static void cdnsp_ep0_stall(struct cdnsp_device *pdev)
> {
> @@ -23,11 +24,13 @@ static void cdnsp_ep0_stall(struct cdnsp_device *pdev)
> preq = next_request(&pep->pending_list);
>
> if (pdev->three_stage_setup) {
> + trace_cdnsp_ep0_data_stage("send stall");
> cdnsp_halt_endpoint(pdev, pep, true);
>
> if (preq)
> cdnsp_gadget_giveback(pep, preq, -ECONNRESET);
> } else {
> + trace_cdnsp_ep0_status_stage("send stall");
> pep->ep_state |= EP0_HALTED_STATUS;
>
> if (preq)
> @@ -42,6 +45,8 @@ static int cdnsp_ep0_delegate_req(struct cdnsp_device *pdev,
> {
> int ret;
>
> + trace_cdnsp_ep0_request("delagete");
> +
> spin_unlock(&pdev->lock);
> ret = pdev->gadget_driver->setup(&pdev->gadget, ctrl);
> spin_lock(&pdev->lock);
> @@ -60,8 +65,10 @@ static int cdnsp_ep0_set_config(struct cdnsp_device *pdev,
>
> switch (state) {
> case USB_STATE_ADDRESS:
> + trace_cdnsp_ep0_set_config("from Address state");
> break;
> case USB_STATE_CONFIGURED:
> + trace_cdnsp_ep0_set_config("from Configured state");
> break;
> default:
> dev_err(pdev->dev, "Set Configuration - bad device state\n");
> @@ -123,6 +130,7 @@ static int cdnsp_ep0_set_address(struct cdnsp_device *pdev,
>
> int cdnsp_status_stage(struct cdnsp_device *pdev)
> {
> + trace_cdnsp_ep0_status_stage("preparing");
> pdev->ep0_stage = CDNSP_STATUS_STAGE;
> pdev->ep0_preq.request.length = 0;
>
> @@ -212,18 +220,21 @@ static int cdnsp_ep0_handle_feature_device(struct cdnsp_device *pdev,
> switch (le16_to_cpu(ctrl->wValue)) {
> case USB_DEVICE_REMOTE_WAKEUP:
> pdev->may_wakeup = !!set;
> + trace_cdnsp_may_wakeup(set);
> break;
> case USB_DEVICE_U1_ENABLE:
> if (state != USB_STATE_CONFIGURED || speed < USB_SPEED_SUPER)
> return -EINVAL;
>
> pdev->u1_allowed = !!set;
> + trace_cdnsp_u1(set);
> break;
> case USB_DEVICE_U2_ENABLE:
> if (state != USB_STATE_CONFIGURED || speed < USB_SPEED_SUPER)
> return -EINVAL;
>
> pdev->u2_allowed = !!set;
> + trace_cdnsp_u2(set);
> break;
> case USB_DEVICE_LTM_ENABLE:
> return -EINVAL;
> @@ -427,6 +438,8 @@ void cdnsp_setup_analyze(struct cdnsp_device *pdev)
> int ret = 0;
> __le16 len;
>
> + trace_cdnsp_ctrl_req(ctrl);
> +
> if (!pdev->gadget_driver)
> goto out;
>
> @@ -437,8 +450,10 @@ void cdnsp_setup_analyze(struct cdnsp_device *pdev)
> }
>
> /* Restore the ep0 to Stopped/Running state. */
> - if (pdev->eps[0].ep_state & EP_HALTED)
> + if (pdev->eps[0].ep_state & EP_HALTED) {
> + trace_cdnsp_ep0_halted("Restore to normal state");
> cdnsp_halt_endpoint(pdev, &pdev->eps[0], 0);
> + }
>
> /*
> * Finishing previous SETUP transfer by removing request from
> @@ -447,6 +462,7 @@ void cdnsp_setup_analyze(struct cdnsp_device *pdev)
> if (!list_empty(&pdev->eps[0].pending_list)) {
> struct cdnsp_request *req;
>
> + trace_cdnsp_ep0_request("Remove previous");
> req = next_request(&pdev->eps[0].pending_list);
> cdnsp_ep_dequeue(&pdev->eps[0], req);
> }
> @@ -468,8 +484,10 @@ void cdnsp_setup_analyze(struct cdnsp_device *pdev)
> if (!len)
> pdev->ep0_stage = CDNSP_STATUS_STAGE;
>
> - if (ret == USB_GADGET_DELAYED_STATUS)
> + if (ret == USB_GADGET_DELAYED_STATUS) {
> + trace_cdnsp_ep0_status_stage("delayed");
> return;
> + }
> out:
> if (ret < 0)
> cdnsp_ep0_stall(pdev);
> diff --git a/drivers/usb/cdns3/cdnsp-gadget.c b/drivers/usb/cdns3/cdnsp-gadget.c
> index 1366c3686331..10abad16c26d 100644
> --- a/drivers/usb/cdns3/cdnsp-gadget.c
> +++ b/drivers/usb/cdns3/cdnsp-gadget.c
> @@ -23,6 +23,7 @@
> #include "gadget-export.h"
> #include "drd.h"
> #include "cdnsp-gadget.h"
> +#include "cdnsp-trace.h"
>
> unsigned int cdnsp_port_speed(unsigned int port_status)
> {
> @@ -100,6 +101,7 @@ void cdnsp_set_link_state(struct cdnsp_device *pdev,
> __le32 __iomem *port_regs,
> u32 link_state)
> {
> + int port_num = 0xFF;
> u32 temp;
>
> temp = readl(port_regs);
> @@ -110,7 +112,12 @@ void cdnsp_set_link_state(struct cdnsp_device *pdev,
> temp &= ~PORT_PLS_MASK;
> temp |= PORT_LINK_STROBE | link_state;
>
> + if (pdev->active_port)
> + port_num = pdev->active_port->port_num;
> +
> + trace_cdnsp_handle_port_status(port_num, readl(port_regs));
> writel(temp, port_regs);
> + trace_cdnsp_link_state_changed(port_num, readl(port_regs));
> }
>
> static void cdnsp_disable_port(struct cdnsp_device *pdev,
> @@ -230,6 +237,8 @@ static int cdnsp_start(struct cdnsp_device *pdev)
> temp |= (CMD_R_S | CMD_DEVEN);
> writel(temp, &pdev->op_regs->command);
>
> + trace_cdnsp_init("Turn on controller");
> +
> pdev->cdnsp_state = 0;
>
> /*
> @@ -339,8 +348,10 @@ int cdnsp_ep_enqueue(struct cdnsp_ep *pep, struct cdnsp_request *preq)
> struct usb_request *request;
> int ret;
>
> - if (preq->epnum == 0 && !list_empty(&pep->pending_list))
> + if (preq->epnum == 0 && !list_empty(&pep->pending_list)) {
> + trace_cdnsp_request_enqueue_busy(preq);
> return -EBUSY;
> + }
>
> request = &preq->request;
> request->actual = 0;
> @@ -350,11 +361,15 @@ int cdnsp_ep_enqueue(struct cdnsp_ep *pep, struct cdnsp_request *preq)
> preq->td.drbl = 0;
>
> ret = usb_gadget_map_request_by_dev(pdev->dev, request, pep->direction);
> - if (ret)
> + if (ret) {
> + trace_cdnsp_request_enqueue_error(preq);
> return ret;
> + }
>
> list_add_tail(&preq->list, &pep->pending_list);
>
> + trace_cdnsp_request_enqueue(preq);
> +
> switch (usb_endpoint_type(pep->endpoint.desc)) {
> case USB_ENDPOINT_XFER_CONTROL:
> ret = cdnsp_queue_ctrl_tx(pdev, preq);
> @@ -376,6 +391,7 @@ int cdnsp_ep_enqueue(struct cdnsp_ep *pep, struct cdnsp_request *preq)
> usb_gadget_unmap_request_by_dev(pdev->dev, &preq->request,
> pep->direction);
> list_del(&preq->list);
> + trace_cdnsp_request_enqueue_error(preq);
>
> return ret;
> }
> @@ -410,6 +426,8 @@ int cdnsp_ep_dequeue(struct cdnsp_ep *pep, struct cdnsp_request *preq)
> struct cdnsp_device *pdev = pep->pdev;
> int ret;
>
> + trace_cdnsp_request_dequeue(preq);
> +
> if (GET_EP_CTX_STATE(pep->out_ctx) == EP_STATE_RUNNING) {
> ret = cdnsp_cmd_stop_ep(pdev, pep);
> if (ret)
> @@ -516,11 +534,14 @@ int cdnsp_wait_for_cmd_compl(struct cdnsp_device *pdev)
> cmd_trb = pdev->cmd.command_trb;
> pdev->cmd.status = 0;
>
> + trace_cdnsp_cmd_wait_for_compl(pdev->cmd_ring, &cmd_trb->generic);
> +
> ret = readl_poll_timeout_atomic(&pdev->op_regs->cmd_ring, val,
> !CMD_RING_BUSY(val), 1,
> CDNSP_CMD_TIMEOUT);
> if (ret) {
> dev_err(pdev->dev, "ERR: Timeout while waiting for command\n");
> + trace_cdnsp_cmd_timeout(pdev->cmd_ring, &cmd_trb->generic);
> pdev->cdnsp_state = CDNSP_STATE_DYING;
> return -ETIMEDOUT;
> }
> @@ -562,6 +583,8 @@ int cdnsp_wait_for_cmd_compl(struct cdnsp_device *pdev)
> continue;
> }
>
> + trace_cdnsp_handle_command(pdev->cmd_ring, &cmd_trb->generic);
> +
> pdev->cmd.status = GET_COMP_CODE(le32_to_cpu(event->event_cmd.status));
> if (pdev->cmd.status == COMP_SUCCESS)
> return 0;
> @@ -576,6 +599,8 @@ int cdnsp_halt_endpoint(struct cdnsp_device *pdev,
> {
> int ret;
>
> + trace_cdnsp_ep_halt(value ? "Set" : "Clear");
> +
> if (value) {
> ret = cdnsp_cmd_stop_ep(pdev, pep);
> if (ret)
> @@ -596,6 +621,8 @@ int cdnsp_halt_endpoint(struct cdnsp_device *pdev,
> cdnsp_queue_reset_ep(pdev, pep->idx);
> cdnsp_ring_cmd_db(pdev);
> ret = cdnsp_wait_for_cmd_compl(pdev);
> + trace_cdnsp_handle_cmd_reset_ep(pep->out_ctx);
> +
> if (ret)
> return ret;
>
> @@ -649,6 +676,9 @@ static int cdnsp_update_eps_configuration(struct cdnsp_device *pdev,
> (ep_sts != EP_STATE_DISABLED && ctrl_ctx->drop_flags))
> ret = cdnsp_configure_endpoint(pdev);
>
> + trace_cdnsp_configure_endpoint(cdnsp_get_slot_ctx(&pdev->out_ctx));
> + trace_cdnsp_handle_cmd_config_ep(pep->out_ctx);
> +
> cdnsp_zero_in_ctx(pdev);
>
> return ret;
> @@ -673,6 +703,7 @@ int cdnsp_reset_device(struct cdnsp_device *pdev)
> /* If device is not setup, there is no point in resetting it. */
> slot_ctx = cdnsp_get_slot_ctx(&pdev->out_ctx);
> slot_state = GET_SLOT_STATE(le32_to_cpu(slot_ctx->dev_state));
> + trace_cdnsp_reset_device(slot_ctx);
>
> if (slot_state <= SLOT_STATE_DEFAULT &&
> pdev->eps[0].ep_state & EP_HALTED) {
> @@ -700,6 +731,8 @@ int cdnsp_reset_device(struct cdnsp_device *pdev)
> for (i = 1; i < 31; ++i)
> pdev->eps[i].ep_state |= EP_STOPPED;
>
> + trace_cdnsp_handle_cmd_reset_dev(slot_ctx);
> +
> if (ret)
> dev_err(pdev->dev, "Reset device failed with error code %d",
> ret);
> @@ -756,6 +789,8 @@ int cdnsp_alloc_streams(struct cdnsp_device *pdev, struct cdnsp_ep *pep)
> /* The stream context array size must be a power of two */
> num_stream_ctxs = roundup_pow_of_two(num_streams);
>
> + trace_cdnsp_stream_number(pep, num_stream_ctxs, num_streams);
> +
> ret = cdnsp_alloc_stream_info(pdev, pep, num_stream_ctxs, num_streams);
> if (ret)
> return ret;
> @@ -781,6 +816,8 @@ int cdnsp_disable_slot(struct cdnsp_device *pdev)
> pdev->slot_id = 0;
> pdev->active_port = NULL;
>
> + trace_cdnsp_handle_cmd_disable_slot(cdnsp_get_slot_ctx(&pdev->out_ctx));
> +
> memset(pdev->in_ctx.bytes, 0, CDNSP_CTX_SIZE);
> memset(pdev->out_ctx.bytes, 0, CDNSP_CTX_SIZE);
>
> @@ -804,11 +841,14 @@ int cdnsp_enable_slot(struct cdnsp_device *pdev)
> cdnsp_ring_cmd_db(pdev);
> ret = cdnsp_wait_for_cmd_compl(pdev);
> if (ret)
> - return ret;
> + goto show_trace;
>
> pdev->slot_id = 1;
>
> - return 0;
> +show_trace:
> + trace_cdnsp_handle_cmd_enable_slot(cdnsp_get_slot_ctx(&pdev->out_ctx));
> +
> + return ret;
> }
>
> /*
> @@ -822,8 +862,10 @@ int cdnsp_setup_device(struct cdnsp_device *pdev, enum cdnsp_setup_dev setup)
> int dev_state = 0;
> int ret;
>
> - if (!pdev->slot_id)
> + if (!pdev->slot_id) {
> + trace_cdnsp_slot_id("incorrect");
> return -EINVAL;
> + }
>
> if (!pdev->active_port->port_num)
> return -EINVAL;
> @@ -831,8 +873,10 @@ int cdnsp_setup_device(struct cdnsp_device *pdev, enum cdnsp_setup_dev setup)
> slot_ctx = cdnsp_get_slot_ctx(&pdev->out_ctx);
> dev_state = GET_SLOT_STATE(le32_to_cpu(slot_ctx->dev_state));
>
> - if (setup == SETUP_CONTEXT_ONLY && dev_state == SLOT_STATE_DEFAULT)
> + if (setup == SETUP_CONTEXT_ONLY && dev_state == SLOT_STATE_DEFAULT) {
> + trace_cdnsp_slot_already_in_default(slot_ctx);
> return 0;
> + }
>
> slot_ctx = cdnsp_get_slot_ctx(&pdev->in_ctx);
> ctrl_ctx = cdnsp_get_input_control_ctx(&pdev->in_ctx);
> @@ -848,10 +892,14 @@ int cdnsp_setup_device(struct cdnsp_device *pdev, enum cdnsp_setup_dev setup)
> ctrl_ctx->add_flags = cpu_to_le32(SLOT_FLAG | EP0_FLAG);
> ctrl_ctx->drop_flags = 0;
>
> + trace_cdnsp_setup_device_slot(slot_ctx);
> +
> cdnsp_queue_address_device(pdev, pdev->in_ctx.dma, setup);
> cdnsp_ring_cmd_db(pdev);
> ret = cdnsp_wait_for_cmd_compl(pdev);
>
> + trace_cdnsp_handle_cmd_addr_dev(cdnsp_get_slot_ctx(&pdev->out_ctx));
> +
> /* Zero the input context control for later use. */
> ctrl_ctx->add_flags = 0;
> ctrl_ctx->drop_flags = 0;
> @@ -866,6 +914,8 @@ void cdnsp_set_usb2_hardware_lpm(struct cdnsp_device *pdev,
> if (pdev->active_port != &pdev->usb2_port || !pdev->gadget.lpm_capable)
> return;
>
> + trace_cdnsp_lpm(enable);
> +
> if (enable)
> writel(PORT_BESL(CDNSP_DEFAULT_BESL) | PORT_L1S_NYET | PORT_HLE,
> &pdev->active_port->regs->portpmsc);
> @@ -945,6 +995,7 @@ static int cdnsp_gadget_ep_enable(struct usb_ep *ep,
> pep->ep_state &= ~EP_STOPPED;
>
> unlock:
> + trace_cdnsp_ep_enable_end(pep, 0);
> spin_unlock_irqrestore(&pdev->lock, flags);
>
> return ret;
> @@ -1001,6 +1052,7 @@ static int cdnsp_gadget_ep_disable(struct usb_ep *ep)
> pep->ep_state |= EP_STOPPED;
>
> finish:
> + trace_cdnsp_ep_disable_end(pep, 0);
> spin_unlock_irqrestore(&pdev->lock, flags);
>
> return ret;
> @@ -1019,6 +1071,8 @@ static struct usb_request *cdnsp_gadget_ep_alloc_request(struct usb_ep *ep,
> preq->epnum = pep->number;
> preq->pep = pep;
>
> + trace_cdnsp_alloc_request(preq);
> +
> return &preq->request;
> }
>
> @@ -1027,6 +1081,7 @@ static void cdnsp_gadget_ep_free_request(struct usb_ep *ep,
> {
> struct cdnsp_request *preq = to_cdnsp_request(request);
>
> + trace_cdnsp_free_request(preq);
> kfree(preq);
> }
>
> @@ -1095,6 +1150,7 @@ static int cdnsp_gadget_ep_set_halt(struct usb_ep *ep, int value)
> preq = next_request(&pep->pending_list);
> if (value) {
> if (preq) {
> + trace_cdnsp_ep_busy_try_halt_again(pep, 0);
> ret = -EAGAIN;
> goto done;
> }
> @@ -1158,6 +1214,8 @@ void cdnsp_gadget_giveback(struct cdnsp_ep *pep,
> usb_gadget_unmap_request_by_dev(pdev->dev, &preq->request,
> preq->direction);
>
> + trace_cdnsp_request_giveback(preq);
> +
> if (preq != &pdev->ep0_preq) {
> spin_unlock(&pdev->lock);
> usb_gadget_giveback_request(&pep->endpoint, &preq->request);
> @@ -1238,6 +1296,7 @@ static int cdnsp_run(struct cdnsp_device *pdev,
> temp = readl(&pdev->ir_set->irq_pending);
> writel(IMAN_IE_SET(temp), &pdev->ir_set->irq_pending);
>
> + trace_cdnsp_init("Controller ready to work");
> return 0;
> err:
> cdnsp_halt(pdev);
> @@ -1390,6 +1449,8 @@ static void cdnsp_stop(struct cdnsp_device *pdev)
>
> cdnsp_consume_all_events(pdev);
> cdnsp_clear_cmd_ring(pdev);
> +
> + trace_cdnsp_exit("Controller stopped.");
> }
>
> /*
> @@ -1471,6 +1532,8 @@ static int cdnsp_gadget_pullup(struct usb_gadget *gadget, int is_on)
> struct cdnsp_device *pdev = gadget_to_cdnsp(gadget);
> struct cdns *cdns = dev_get_drvdata(pdev->dev);
>
> + trace_cdnsp_pullup(is_on);
> +
> if (!is_on) {
> cdnsp_reset_device(pdev);
> cdns_clear_vbus(cdns);
> diff --git a/drivers/usb/cdns3/cdnsp-mem.c b/drivers/usb/cdns3/cdnsp-mem.c
> index 3487367c1bb4..4b16ae7f775d 100644
> --- a/drivers/usb/cdns3/cdnsp-mem.c
> +++ b/drivers/usb/cdns3/cdnsp-mem.c
> @@ -16,6 +16,7 @@
> #include <linux/usb.h>
>
> #include "cdnsp-gadget.h"
> +#include "cdnsp-trace.h"
>
> static void cdnsp_free_stream_info(struct cdnsp_device *pdev,
> struct cdnsp_ep *pep);
> @@ -281,6 +282,8 @@ static void cdnsp_ring_free(struct cdnsp_device *pdev, struct cdnsp_ring *ring)
> if (!ring)
> return;
>
> + trace_cdnsp_ring_free(ring);
> +
> if (ring->first_seg) {
> if (ring->type == TYPE_STREAM)
> cdnsp_remove_stream_mapping(ring);
> @@ -397,7 +400,7 @@ static struct cdnsp_ring *cdnsp_ring_alloc(struct cdnsp_device *pdev,
> cpu_to_le32(LINK_TOGGLE);
>
> cdnsp_initialize_ring_info(ring);
> -
> + trace_cdnsp_ring_alloc(ring);
> return ring;
> fail:
> kfree(ring);
> @@ -450,6 +453,7 @@ int cdnsp_ring_expansion(struct cdnsp_device *pdev,
> }
>
> cdnsp_link_rings(pdev, ring, first, last, num_segs);
> + trace_cdnsp_ring_expansion(ring);
>
> return 0;
> }
> @@ -610,6 +614,8 @@ int cdnsp_alloc_stream_info(struct cdnsp_device *pdev,
> stream_info->stream_ctx_array[cur_stream].stream_ring =
> cpu_to_le64(addr);
>
> + trace_cdnsp_set_stream_ring(cur_ring);
> +
> ret = cdnsp_update_stream_mapping(cur_ring);
> if (ret)
> goto cleanup_rings;
> @@ -695,6 +701,7 @@ static int cdnsp_alloc_priv_device(struct cdnsp_device *pdev, gfp_t flags)
> pdev->dcbaa->dev_context_ptrs[1] = cpu_to_le64(pdev->out_ctx.dma);
> pdev->cmd.in_ctx = &pdev->in_ctx;
>
> + trace_cdnsp_alloc_priv_device(pdev);
> return 0;
> fail:
> dma_pool_free(pdev->device_pool, pdev->out_ctx.bytes,
> @@ -761,6 +768,8 @@ int cdnsp_setup_addressable_priv_dev(struct cdnsp_device *pdev)
> ep0_ctx->deq = cpu_to_le64(pdev->eps[0].ring->first_seg->dma |
> pdev->eps[0].ring->cycle_state);
>
> + trace_cdnsp_setup_addressable_priv_device(pdev);
> +
> return 0;
> }
>
> @@ -1112,7 +1121,7 @@ static void cdnsp_add_in_port(struct cdnsp_device *pdev,
> struct cdnsp_port *port,
> __le32 __iomem *addr)
> {
> - u32 temp, port_offset;
> + u32 temp, port_offset, port_count;
>
> temp = readl(addr);
> port->maj_rev = CDNSP_EXT_PORT_MAJOR(temp);
> @@ -1121,6 +1130,9 @@ static void cdnsp_add_in_port(struct cdnsp_device *pdev,
> /* Port offset and count in the third dword.*/
> temp = readl(addr + 2);
> port_offset = CDNSP_EXT_PORT_OFF(temp);
> + port_count = CDNSP_EXT_PORT_COUNT(temp);
> +
> + trace_cdnsp_port_info(addr, port_offset, port_count, port->maj_rev);
>
> port->port_num = port_offset;
> port->exist = 1;
> @@ -1171,6 +1183,8 @@ static int cdnsp_setup_port_arrays(struct cdnsp_device *pdev, gfp_t flags)
> return -ENODEV;
> }
>
> + trace_cdnsp_init("Found USB 2.0 ports and USB 3.0 ports.");
> +
> pdev->usb2_port.regs = (struct cdnsp_port_regs *)
> (&pdev->op_regs->port_reg_base + NUM_PORT_REGS *
> (pdev->usb2_port.port_num - 1));
> diff --git a/drivers/usb/cdns3/cdnsp-ring.c b/drivers/usb/cdns3/cdnsp-ring.c
> index a28faca41a8f..874d9ff5406c 100644
> --- a/drivers/usb/cdns3/cdnsp-ring.c
> +++ b/drivers/usb/cdns3/cdnsp-ring.c
> @@ -61,6 +61,7 @@
> #include <linux/slab.h>
> #include <linux/irq.h>
>
> +#include "cdnsp-trace.h"
> #include "cdnsp-gadget.h"
>
> /*
> @@ -148,7 +149,7 @@ void cdnsp_inc_deq(struct cdnsp_device *pdev, struct cdnsp_ring *ring)
> if (ring->type == TYPE_EVENT) {
> if (!cdnsp_last_trb_on_seg(ring->deq_seg, ring->dequeue)) {
> ring->dequeue++;
> - return;
> + goto out;
> }
>
> if (cdnsp_last_trb_on_ring(ring, ring->deq_seg, ring->dequeue))
> @@ -156,7 +157,7 @@ void cdnsp_inc_deq(struct cdnsp_device *pdev, struct cdnsp_ring *ring)
>
> ring->deq_seg = ring->deq_seg->next;
> ring->dequeue = ring->deq_seg->trbs;
> - return;
> + goto out;
> }
>
> /* All other rings have link trbs. */
> @@ -168,6 +169,8 @@ void cdnsp_inc_deq(struct cdnsp_device *pdev, struct cdnsp_ring *ring)
> ring->deq_seg = ring->deq_seg->next;
> ring->dequeue = ring->deq_seg->trbs;
> }
> +out:
> + trace_cdnsp_inc_deq(ring);
> }
>
> /*
> @@ -222,6 +225,8 @@ static void cdnsp_inc_enq(struct cdnsp_device *pdev,
> ring->enqueue = ring->enq_seg->trbs;
> next = ring->enqueue;
> }
> +
> + trace_cdnsp_inc_enq(ring);
> }
>
> /*
> @@ -261,6 +266,7 @@ static void cdnsp_force_l0_go(struct cdnsp_device *pdev)
> /* Ring the doorbell after placing a command on the ring. */
> void cdnsp_ring_cmd_db(struct cdnsp_device *pdev)
> {
> + trace_cdnsp_cmd_drbl("Ding Dong");
> writel(DB_VALUE_CMD, &pdev->dba->cmd_db);
> }
>
> @@ -299,6 +305,8 @@ static bool cdnsp_ring_ep_doorbell(struct cdnsp_device *pdev,
> else
> db_value = DB_VALUE(pep->idx, stream_id);
>
> + trace_cdnsp_tr_drbl(pep, stream_id);
> +
> writel(db_value, reg_addr);
>
> cdnsp_force_l0_go(pdev);
> @@ -484,6 +492,8 @@ static void cdnsp_find_new_dequeue_state(struct cdnsp_device *pdev,
>
> state->new_deq_seg = new_seg;
> state->new_deq_ptr = new_deq;
> +
> + trace_cdnsp_new_deq_state(state);
> }
>
> /*
> @@ -544,6 +554,10 @@ static struct cdnsp_segment *cdnsp_trb_in_td(struct cdnsp_device *pdev,
> /* If the end TRB isn't in this segment, this is set to 0 */
> end_trb_dma = cdnsp_trb_virt_to_dma(cur_seg, end_trb);
>
> + trace_cdnsp_looking_trb_in_td(suspect_dma, start_dma,
> + end_trb_dma, cur_seg->dma,
> + end_seg_dma);
> +
> if (end_trb_dma > 0) {
> /*
> * The end TRB is in this segment, so suspect should
> @@ -594,6 +608,9 @@ static void cdnsp_unmap_td_bounce_buffer(struct cdnsp_device *pdev,
>
> preq = td->preq;
>
> + trace_cdnsp_bounce_unmap(td->preq, seg->bounce_len, seg->bounce_offs,
> + seg->bounce_dma, 0);
> +
> if (!preq->direction) {
> dma_unmap_single(pdev->dev, seg->bounce_dma,
> ring->bounce_buf_len, DMA_TO_DEVICE);
> @@ -631,6 +648,9 @@ static int cdnsp_cmd_set_deq(struct cdnsp_device *pdev,
> cdnsp_ring_cmd_db(pdev);
> ret = cdnsp_wait_for_cmd_compl(pdev);
>
> + trace_cdnsp_handle_cmd_set_deq(cdnsp_get_slot_ctx(&pdev->out_ctx));
> + trace_cdnsp_handle_cmd_set_deq_ep(pep->out_ctx);
> +
> /*
> * Update the ring's dequeue segment and dequeue pointer
> * to reflect the new position.
> @@ -682,6 +702,9 @@ int cdnsp_remove_request(struct cdnsp_device *pdev,
>
> memset(&deq_state, 0, sizeof(deq_state));
>
> + trace_cdnsp_remove_request(pep->out_ctx);
> + trace_cdnsp_remove_request_td(preq);
> +
> cur_td = &preq->td;
> ep_ring = cdnsp_request_to_transfer_ring(pdev, preq);
>
> @@ -789,6 +812,8 @@ static void cdnsp_handle_port_status(struct cdnsp_device *pdev,
> writel(cdnsp_port_state_to_neutral(portsc) |
> (portsc & PORT_CHANGE_BITS), &port_regs->portsc);
>
> + trace_cdnsp_handle_port_status(pdev->active_port->port_num, portsc);
> +
> pdev->gadget.speed = cdnsp_port_speed(portsc);
> link_state = portsc & PORT_PLS_MASK;
>
> @@ -954,8 +979,10 @@ static int cdnsp_giveback_first_trb(struct cdnsp_device *pdev,
> start_trb->field[3] &= cpu_to_le32(~TRB_CYCLE);
>
> if ((pep->ep_state & EP_HAS_STREAMS) &&
> - !pep->stream_info.first_prime_det)
> + !pep->stream_info.first_prime_det) {
> + trace_cdnsp_wait_for_prime(pep, stream_id);
> return 0;
> + }
>
> return cdnsp_ring_ep_doorbell(pdev, pep, stream_id);
> }
> @@ -1226,8 +1253,10 @@ static int cdnsp_handle_tx_event(struct cdnsp_device *pdev,
> if (invalidate || !pdev->gadget.connected)
> goto cleanup;
>
> - if (GET_EP_CTX_STATE(pep->out_ctx) == EP_STATE_DISABLED)
> + if (GET_EP_CTX_STATE(pep->out_ctx) == EP_STATE_DISABLED) {
> + trace_cdnsp_ep_disabled(pep->out_ctx);
> goto err_out;
> + }
>
> /* Some transfer events don't always point to a trb*/
> if (!ep_ring) {
> @@ -1274,8 +1303,23 @@ static int cdnsp_handle_tx_event(struct cdnsp_device *pdev,
> * list.
> */
> if (list_empty(&ep_ring->td_list)) {
> - if (pep->skip)
> + /*
> + * Don't print warnings if it's due to a stopped
> + * endpoint generating an extra completion event, or
> + * a event for the last TRB of a short TD we already
> + * got a short event for.
> + * The short TD is already removed from the TD list.
> + */
> + if (!(trb_comp_code == COMP_STOPPED ||
> + trb_comp_code == COMP_STOPPED_LENGTH_INVALID ||
> + ep_ring->last_td_was_short))
> + trace_cdnsp_trb_without_td(ep_ring,
> + (struct cdnsp_generic_trb *)event);
> +
> + if (pep->skip) {
> pep->skip = false;
> + trace_cdnsp_ep_list_empty_with_skip(pep, 0);
> + }
>
> goto cleanup;
> }
> @@ -1332,6 +1376,9 @@ static int cdnsp_handle_tx_event(struct cdnsp_device *pdev,
> ep_trb = &ep_seg->trbs[(ep_trb_dma - ep_seg->dma)
> / sizeof(*ep_trb)];
>
> + trace_cdnsp_handle_transfer(ep_ring,
> + (struct cdnsp_generic_trb *)ep_trb);
> +
> if (cdnsp_trb_is_noop(ep_trb))
> goto cleanup;
>
> @@ -1397,6 +1444,8 @@ static bool cdnsp_handle_event(struct cdnsp_device *pdev)
> if (cycle_bit != pdev->event_ring->cycle_state)
> return false;
>
> + trace_cdnsp_handle_event(pdev->event_ring, &event->generic);
> +
> /*
> * Barrier between reading the TRB_CYCLE (valid) flag above and any
> * reads of the event's flags/data below.
> @@ -1544,6 +1593,7 @@ static void cdnsp_queue_trb(struct cdnsp_device *pdev, struct cdnsp_ring *ring,
> trb->field[2] = cpu_to_le32(field3);
> trb->field[3] = cpu_to_le32(field4);
>
> + trace_cdnsp_queue_trb(ring, trb);
> cdnsp_inc_enq(pdev, ring, more_trbs_coming);
> }
>
> @@ -1574,6 +1624,8 @@ static int cdnsp_prepare_ring(struct cdnsp_device *pdev,
> if (cdnsp_room_on_ring(pdev, ep_ring, num_trbs))
> break;
>
> + trace_cdnsp_no_room_on_ring("try ring expansion");
> +
> num_trbs_needed = num_trbs - ep_ring->num_trbs_free;
> if (cdnsp_ring_expansion(pdev, ep_ring, num_trbs_needed,
> mem_flags)) {
> @@ -1737,6 +1789,8 @@ static int cdnsp_align_td(struct cdnsp_device *pdev,
> /* Is the last nornal TRB alignable by splitting it. */
> if (*trb_buff_len > unalign) {
> *trb_buff_len -= unalign;
> + trace_cdnsp_bounce_align_td_split(preq, *trb_buff_len,
> + enqd_len, 0, unalign);
> return 0;
> }
>
> @@ -1773,6 +1827,9 @@ static int cdnsp_align_td(struct cdnsp_device *pdev,
> seg->bounce_len = new_buff_len;
> seg->bounce_offs = enqd_len;
>
> + trace_cdnsp_bounce_map(preq, new_buff_len, enqd_len, seg->bounce_dma,
> + unalign);
> +
> /*
> * Bounce buffer successful aligned and seg->bounce_dma will be used
> * in transfer TRB as new transfer buffer address.
> @@ -2009,13 +2066,17 @@ int cdnsp_cmd_stop_ep(struct cdnsp_device *pdev, struct cdnsp_ep *pep)
> u32 ep_state = GET_EP_CTX_STATE(pep->out_ctx);
> int ret = 0;
>
> - if (ep_state == EP_STATE_STOPPED || ep_state == EP_STATE_DISABLED)
> + if (ep_state == EP_STATE_STOPPED || ep_state == EP_STATE_DISABLED) {
> + trace_cdnsp_ep_stopped_or_disabled(pep->out_ctx);
> goto ep_stopped;
> + }
>
> cdnsp_queue_stop_endpoint(pdev, pep->idx);
> cdnsp_ring_cmd_db(pdev);
> ret = cdnsp_wait_for_cmd_compl(pdev);
>
> + trace_cdnsp_handle_cmd_stop_ep(pep->out_ctx);
> +
> ep_stopped:
> pep->ep_state |= EP_STOPPED;
> return ret;
> @@ -2029,6 +2090,8 @@ int cdnsp_cmd_flush_ep(struct cdnsp_device *pdev, struct cdnsp_ep *pep)
> cdnsp_ring_cmd_db(pdev);
> ret = cdnsp_wait_for_cmd_compl(pdev);
>
> + trace_cdnsp_handle_cmd_flush_ep(pep->out_ctx);
> +
> return ret;
> }
>
> diff --git a/drivers/usb/cdns3/cdnsp-trace.c b/drivers/usb/cdns3/cdnsp-trace.c
> new file mode 100644
> index 000000000000..e50ab799ad95
> --- /dev/null
> +++ b/drivers/usb/cdns3/cdnsp-trace.c
> @@ -0,0 +1,12 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Cadence CDNSP DRD Driver.
> + *
> + * Copyright (C) 2020 Cadence.
> + *
> + * Author: Pawel Laszczak <pawell@xxxxxxxxxxx>
> + *
> + */
> +
> +#define CREATE_TRACE_POINTS
> +#include "cdnsp-trace.h"
> diff --git a/drivers/usb/cdns3/cdnsp-trace.h b/drivers/usb/cdns3/cdnsp-trace.h
> new file mode 100644
> index 000000000000..b68e282464d2
> --- /dev/null
> +++ b/drivers/usb/cdns3/cdnsp-trace.h
> @@ -0,0 +1,840 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +/*
> + * Cadence CDNSP DRD Driver.
> + * Trace support header file
> + *
> + * Copyright (C) 2020 Cadence.
> + *
> + * Author: Pawel Laszczak <pawell@xxxxxxxxxxx>
> + *
> + */
> +
> +#undef TRACE_SYSTEM
> +#define TRACE_SYSTEM cdnsp-dev
> +
> +/*
> + * The TRACE_SYSTEM_VAR defaults to TRACE_SYSTEM, but must be a
> + * legitimate C variable. It is not exported to user space.
> + */
> +#undef TRACE_SYSTEM_VAR
> +#define TRACE_SYSTEM_VAR cdnsp_dev
> +
> +#if !defined(__CDNSP_DEV_TRACE_H) || defined(TRACE_HEADER_MULTI_READ)
> +#define __CDNSP_DEV_TRACE_H
> +
> +#include <linux/tracepoint.h>
> +#include "cdnsp-gadget.h"
> +#include "cdnsp-debug.h"
> +
> +/*
> + * There is limitation for single buffer size in TRACEPOINT subsystem.
> + * By default TRACE_BUF_SIZE is 1024, so no all data will be logged.
> + * To show more data this must be increased. In most cases the default
> + * value is sufficient.
> + */
> +#define CDNSP_MSG_MAX 500
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_ep,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id),
> + TP_STRUCT__entry(
> + __string(name, pep->name)
> + __field(unsigned int, state)
> + __field(u32, stream_id)
> + __field(u8, enabled)
> + __field(unsigned int, num_streams)
> + __field(int, td_count)
> + __field(u8, first_prime_det)
> + __field(u8, drbls_count)
> + ),
> + TP_fast_assign(
> + __assign_str(name, pep->name);
> + __entry->state = pep->ep_state;
> + __entry->stream_id = stream_id;
> + __entry->enabled = pep->ep_state & EP_HAS_STREAMS;
> + __entry->num_streams = pep->stream_info.num_streams;
> + __entry->td_count = pep->stream_info.td_count;
> + __entry->first_prime_det = pep->stream_info.first_prime_det;
> + __entry->drbls_count = pep->stream_info.drbls_count;
> + ),
> + TP_printk("%s: SID: %08x ep state: %x stream: enabled: %d num %d "
> + "tds %d, first prime: %d drbls %d",
> + __get_str(name), __entry->state, __entry->stream_id,
> + __entry->enabled, __entry->num_streams, __entry->td_count,
> + __entry->first_prime_det, __entry->drbls_count)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep, cdnsp_tr_drbl,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep, cdnsp_wait_for_prime,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep, cdnsp_ep_list_empty_with_skip,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep, cdnsp_ep_enable_end,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep, cdnsp_ep_disable_end,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep, cdnsp_ep_busy_try_halt_again,
> + TP_PROTO(struct cdnsp_ep *pep, u32 stream_id),
> + TP_ARGS(pep, stream_id)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_enable_disable,
> + TP_PROTO(int set),
> + TP_ARGS(set),
> + TP_STRUCT__entry(
> + __field(int, set)
> + ),
> + TP_fast_assign(
> + __entry->set = set;
> + ),
> + TP_printk("%s", __entry->set ? "enabled" : "disabled")
> +);
> +
> +DEFINE_EVENT(cdnsp_log_enable_disable, cdnsp_pullup,
> + TP_PROTO(int set),
> + TP_ARGS(set)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_enable_disable, cdnsp_u1,
> + TP_PROTO(int set),
> + TP_ARGS(set)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_enable_disable, cdnsp_u2,
> + TP_PROTO(int set),
> + TP_ARGS(set)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_enable_disable, cdnsp_lpm,
> + TP_PROTO(int set),
> + TP_ARGS(set)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_enable_disable, cdnsp_may_wakeup,
> + TP_PROTO(int set),
> + TP_ARGS(set)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_simple,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg),
> + TP_STRUCT__entry(
> + __string(text, msg)
> + ),
> + TP_fast_assign(
> + __assign_str(text, msg)
> + ),
> + TP_printk("%s", __get_str(text))
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_exit,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_init,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_slot_id,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_cmd_drbl,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_no_room_on_ring,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_ep0_status_stage,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_ep0_data_stage,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_ep0_request,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_ep0_set_config,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_ep0_halted,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_simple, cdnsp_ep_halt,
> + TP_PROTO(char *msg),
> + TP_ARGS(msg)
> +);
> +
> +TRACE_EVENT(cdnsp_looking_trb_in_td,
> + TP_PROTO(dma_addr_t suspect, dma_addr_t trb_start, dma_addr_t trb_end,
> + dma_addr_t curr_seg, dma_addr_t end_seg),
> + TP_ARGS(suspect, trb_start, trb_end, curr_seg, end_seg),
> + TP_STRUCT__entry(
> + __field(dma_addr_t, suspect)
> + __field(dma_addr_t, trb_start)
> + __field(dma_addr_t, trb_end)
> + __field(dma_addr_t, curr_seg)
> + __field(dma_addr_t, end_seg)
> + ),
> + TP_fast_assign(
> + __entry->suspect = suspect;
> + __entry->trb_start = trb_start;
> + __entry->trb_end = trb_end;
> + __entry->curr_seg = curr_seg;
> + __entry->end_seg = end_seg;
> + ),
> + TP_printk("DMA: suspect event: %pad, trb-start: %pad, trb-end %pad, "
> + "seg-start %pad, seg-end %pad",
> + &__entry->suspect, &__entry->trb_start, &__entry->trb_end,
> + &__entry->curr_seg, &__entry->end_seg)
> +);
> +
> +TRACE_EVENT(cdnsp_port_info,
> + TP_PROTO(__le32 __iomem *addr, u32 offset, u32 count, u32 rev),
> + TP_ARGS(addr, offset, count, rev),
> + TP_STRUCT__entry(
> + __field(__le32 __iomem *, addr)
> + __field(u32, offset)
> + __field(u32, count)
> + __field(u32, rev)
> + ),
> + TP_fast_assign(
> + __entry->addr = addr;
> + __entry->offset = offset;
> + __entry->count = count;
> + __entry->rev = rev;
> + ),
> + TP_printk("Ext Cap %p, port offset = %u, count = %u, rev = 0x%x",
> + __entry->addr, __entry->offset, __entry->count, __entry->rev)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_deq_state,
> + TP_PROTO(struct cdnsp_dequeue_state *state),
> + TP_ARGS(state),
> + TP_STRUCT__entry(
> + __field(int, new_cycle_state)
> + __field(struct cdnsp_segment *, new_deq_seg)
> + __field(dma_addr_t, deq_seg_dma)
> + __field(union cdnsp_trb *, new_deq_ptr)
> + __field(dma_addr_t, deq_ptr_dma)
> + ),
> + TP_fast_assign(
> + __entry->new_cycle_state = state->new_cycle_state;
> + __entry->new_deq_seg = state->new_deq_seg;
> + __entry->deq_seg_dma = state->new_deq_seg->dma;
> + __entry->new_deq_ptr = state->new_deq_ptr,
> + __entry->deq_ptr_dma = cdnsp_trb_virt_to_dma(state->new_deq_seg,
> + state->new_deq_ptr);
> + ),
> + TP_printk("New cycle state = 0x%x, New dequeue segment = %p (0x%pad dma), "
> + "New dequeue pointer = %p (0x%pad dma)",
> + __entry->new_cycle_state, __entry->new_deq_seg,
> + &__entry->deq_seg_dma, __entry->new_deq_ptr,
> + &__entry->deq_ptr_dma
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_deq_state, cdnsp_new_deq_state,
> + TP_PROTO(struct cdnsp_dequeue_state *state),
> + TP_ARGS(state)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_ctrl,
> + TP_PROTO(struct usb_ctrlrequest *ctrl),
> + TP_ARGS(ctrl),
> + TP_STRUCT__entry(
> + __field(u8, bRequestType)
> + __field(u8, bRequest)
> + __field(u16, wValue)
> + __field(u16, wIndex)
> + __field(u16, wLength)
> + __dynamic_array(char, str, CDNSP_MSG_MAX)
> + ),
> + TP_fast_assign(
> + __entry->bRequestType = ctrl->bRequestType;
> + __entry->bRequest = ctrl->bRequest;
> + __entry->wValue = le16_to_cpu(ctrl->wValue);
> + __entry->wIndex = le16_to_cpu(ctrl->wIndex);
> + __entry->wLength = le16_to_cpu(ctrl->wLength);
> + ),
> + TP_printk("%s", usb_decode_ctrl(__get_str(str), CDNSP_MSG_MAX,
> + __entry->bRequestType,
> + __entry->bRequest, __entry->wValue,
> + __entry->wIndex, __entry->wLength)
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ctrl, cdnsp_ctrl_req,
> + TP_PROTO(struct usb_ctrlrequest *ctrl),
> + TP_ARGS(ctrl)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_bounce,
> + TP_PROTO(struct cdnsp_request *preq, u32 new_buf_len, u32 offset,
> + dma_addr_t dma, unsigned int unalign),
> + TP_ARGS(preq, new_buf_len, offset, dma, unalign),
> + TP_STRUCT__entry(
> + __string(name, preq->pep->name)
> + __field(u32, new_buf_len)
> + __field(u32, offset)
> + __field(dma_addr_t, dma)
> + __field(unsigned int, unalign)
> + ),
> + TP_fast_assign(
> + __assign_str(name, preq->pep->name);
> + __entry->new_buf_len = new_buf_len;
> + __entry->offset = offset;
> + __entry->dma = dma;
> + __entry->unalign = unalign;
> + ),
> + TP_printk("%s buf len %d, offset %d, dma %pad, unalign %d",
> + __get_str(name), __entry->new_buf_len,
> + __entry->offset, &__entry->dma, __entry->unalign
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_bounce, cdnsp_bounce_align_td_split,
> + TP_PROTO(struct cdnsp_request *preq, u32 new_buf_len, u32 offset,
> + dma_addr_t dma, unsigned int unalign),
> + TP_ARGS(preq, new_buf_len, offset, dma, unalign)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_bounce, cdnsp_bounce_map,
> + TP_PROTO(struct cdnsp_request *preq, u32 new_buf_len, u32 offset,
> + dma_addr_t dma, unsigned int unalign),
> + TP_ARGS(preq, new_buf_len, offset, dma, unalign)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_bounce, cdnsp_bounce_unmap,
> + TP_PROTO(struct cdnsp_request *preq, u32 new_buf_len, u32 offset,
> + dma_addr_t dma, unsigned int unalign),
> + TP_ARGS(preq, new_buf_len, offset, dma, unalign)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_trb,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb),
> + TP_STRUCT__entry(
> + __field(u32, type)
> + __field(u32, field0)
> + __field(u32, field1)
> + __field(u32, field2)
> + __field(u32, field3)
> + __field(union cdnsp_trb *, trb)
> + __field(dma_addr_t, trb_dma)
> + __dynamic_array(char, str, CDNSP_MSG_MAX)
> + ),
> + TP_fast_assign(
> + __entry->type = ring->type;
> + __entry->field0 = le32_to_cpu(trb->field[0]);
> + __entry->field1 = le32_to_cpu(trb->field[1]);
> + __entry->field2 = le32_to_cpu(trb->field[2]);
> + __entry->field3 = le32_to_cpu(trb->field[3]);
> + __entry->trb = (union cdnsp_trb *)trb;
> + __entry->trb_dma = cdnsp_trb_virt_to_dma(ring->deq_seg,
> + (union cdnsp_trb *)trb);
> +
> + ),
> + TP_printk("%s: %s trb: %p(%pad)", cdnsp_ring_type_string(__entry->type),
> + cdnsp_decode_trb(__get_str(str), CDNSP_MSG_MAX,
> + __entry->field0, __entry->field1,
> + __entry->field2, __entry->field3),
> + __entry->trb, &__entry->trb_dma
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_handle_event,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_trb_without_td,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_handle_command,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_handle_transfer,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_queue_trb,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_cmd_wait_for_compl,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_cmd_timeout,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_trb, cdnsp_defered_event,
> + TP_PROTO(struct cdnsp_ring *ring, struct cdnsp_generic_trb *trb),
> + TP_ARGS(ring, trb)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_pdev,
> + TP_PROTO(struct cdnsp_device *pdev),
> + TP_ARGS(pdev),
> + TP_STRUCT__entry(
> + __field(struct cdnsp_device *, pdev)
> + __field(struct usb_gadget *, gadget)
> + __field(dma_addr_t, out_ctx)
> + __field(dma_addr_t, in_ctx)
> + __field(u8, port_num)
> + ),
> + TP_fast_assign(
> + __entry->pdev = pdev;
> + __entry->gadget = &pdev->gadget;
> + __entry->in_ctx = pdev->in_ctx.dma;
> + __entry->out_ctx = pdev->out_ctx.dma;
> + __entry->port_num = pdev->active_port ?
> + pdev->active_port->port_num : 0xFF;
> + ),
> + TP_printk("pdev %p gadget %p ctx %pad | %pad, port %d ",
> + __entry->pdev, __entry->gadget, &__entry->in_ctx,
> + &__entry->out_ctx, __entry->port_num
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_pdev, cdnsp_alloc_priv_device,
> + TP_PROTO(struct cdnsp_device *vdev),
> + TP_ARGS(vdev)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_pdev, cdnsp_free_priv_device,
> + TP_PROTO(struct cdnsp_device *vdev),
> + TP_ARGS(vdev)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_pdev, cdnsp_setup_device,
> + TP_PROTO(struct cdnsp_device *vdev),
> + TP_ARGS(vdev)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_pdev, cdnsp_setup_addressable_priv_device,
> + TP_PROTO(struct cdnsp_device *vdev),
> + TP_ARGS(vdev)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_request,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req),
> + TP_STRUCT__entry(
> + __string(name, req->pep->name)
> + __field(struct usb_request *, request)
> + __field(struct cdnsp_request *, preq)
> + __field(void *, buf)
> + __field(unsigned int, actual)
> + __field(unsigned int, length)
> + __field(int, status)
> + __field(dma_addr_t, dma)
> + __field(unsigned int, stream_id)
> + __field(unsigned int, zero)
> + __field(unsigned int, short_not_ok)
> + __field(unsigned int, no_interrupt)
> + __field(struct scatterlist*, sg)
> + __field(unsigned int, num_sgs)
> + __field(unsigned int, num_mapped_sgs)
> +
> + ),
> + TP_fast_assign(
> + __assign_str(name, req->pep->name);
> + __entry->request = &req->request;
> + __entry->preq = req;
> + __entry->buf = req->request.buf;
> + __entry->actual = req->request.actual;
> + __entry->length = req->request.length;
> + __entry->status = req->request.status;
> + __entry->dma = req->request.dma;
> + __entry->stream_id = req->request.stream_id;
> + __entry->zero = req->request.zero;
> + __entry->short_not_ok = req->request.short_not_ok;
> + __entry->no_interrupt = req->request.no_interrupt;
> + __entry->sg = req->request.sg;
> + __entry->num_sgs = req->request.num_sgs;
> + __entry->num_mapped_sgs = req->request.num_mapped_sgs;
> + ),
> + TP_printk("%s; req U:%p/P:%p, req buf %p, length %u/%u, status %d, "
> + "buf dma (%pad), SID %u, %s%s%s, sg %p, num_sg %d,"
> + " num_m_sg %d",
> + __get_str(name), __entry->request, __entry->preq,
> + __entry->buf, __entry->actual, __entry->length,
> + __entry->status, &__entry->dma,
> + __entry->stream_id, __entry->zero ? "Z" : "z",
> + __entry->short_not_ok ? "S" : "s",
> + __entry->no_interrupt ? "I" : "i",
> + __entry->sg, __entry->num_sgs, __entry->num_mapped_sgs
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_request_enqueue,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_request_enqueue_busy,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_request_enqueue_error,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_request_dequeue,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_request_giveback,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_alloc_request,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_request, cdnsp_free_request,
> + TP_PROTO(struct cdnsp_request *req),
> + TP_ARGS(req)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_ep_ctx,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx),
> + TP_STRUCT__entry(
> + __field(u32, info)
> + __field(u32, info2)
> + __field(u64, deq)
> + __field(u32, tx_info)
> + __dynamic_array(char, str, CDNSP_MSG_MAX)
> + ),
> + TP_fast_assign(
> + __entry->info = le32_to_cpu(ctx->ep_info);
> + __entry->info2 = le32_to_cpu(ctx->ep_info2);
> + __entry->deq = le64_to_cpu(ctx->deq);
> + __entry->tx_info = le32_to_cpu(ctx->tx_info);
> + ),
> + TP_printk("%s", cdnsp_decode_ep_context(__get_str(str), CDNSP_MSG_MAX,
> + __entry->info, __entry->info2,
> + __entry->deq, __entry->tx_info)
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_ep_disabled,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_ep_stopped_or_disabled,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_remove_request,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_handle_cmd_stop_ep,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_handle_cmd_flush_ep,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_handle_cmd_set_deq_ep,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_handle_cmd_reset_ep,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ep_ctx, cdnsp_handle_cmd_config_ep,
> + TP_PROTO(struct cdnsp_ep_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_slot_ctx,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx),
> + TP_STRUCT__entry(
> + __field(u32, info)
> + __field(u32, info2)
> + __field(u32, int_target)
> + __field(u32, state)
> + ),
> + TP_fast_assign(
> + __entry->info = le32_to_cpu(ctx->dev_info);
> + __entry->info2 = le32_to_cpu(ctx->dev_port);
> + __entry->int_target = le64_to_cpu(ctx->int_target);
> + __entry->state = le32_to_cpu(ctx->dev_state);
> + ),
> + TP_printk("%s", cdnsp_decode_slot_context(__entry->info,
> + __entry->info2,
> + __entry->int_target,
> + __entry->state)
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_slot_already_in_default,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_handle_cmd_enable_slot,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_handle_cmd_disable_slot,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_reset_device,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_setup_device_slot,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_handle_cmd_addr_dev,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_handle_cmd_reset_dev,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_handle_cmd_set_deq,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_slot_ctx, cdnsp_configure_endpoint,
> + TP_PROTO(struct cdnsp_slot_ctx *ctx),
> + TP_ARGS(ctx)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_td_info,
> + TP_PROTO(struct cdnsp_request *preq),
> + TP_ARGS(preq),
> + TP_STRUCT__entry(
> + __string(name, preq->pep->name)
> + __field(struct usb_request *, request)
> + __field(struct cdnsp_request *, preq)
> + __field(union cdnsp_trb *, first_trb)
> + __field(union cdnsp_trb *, last_trb)
> + __field(dma_addr_t, trb_dma)
> + ),
> + TP_fast_assign(
> + __assign_str(name, preq->pep->name);
> + __entry->request = &preq->request;
> + __entry->preq = preq;
> + __entry->first_trb = preq->td.first_trb;
> + __entry->last_trb = preq->td.last_trb;
> + __entry->trb_dma = cdnsp_trb_virt_to_dma(preq->td.start_seg,
> + preq->td.first_trb)
> + ),
> + TP_printk("%s req/preq: %p/%p, first trb %p[vir]/%pad(dma), last trb %p",
> + __get_str(name), __entry->request, __entry->preq,
> + __entry->first_trb, &__entry->trb_dma,
> + __entry->last_trb
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_td_info, cdnsp_remove_request_td,
> + TP_PROTO(struct cdnsp_request *preq),
> + TP_ARGS(preq)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_ring,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring),
> + TP_STRUCT__entry(
> + __field(u32, type)
> + __field(void *, ring)
> + __field(dma_addr_t, enq)
> + __field(dma_addr_t, deq)
> + __field(dma_addr_t, enq_seg)
> + __field(dma_addr_t, deq_seg)
> + __field(unsigned int, num_segs)
> + __field(unsigned int, stream_id)
> + __field(unsigned int, cycle_state)
> + __field(unsigned int, num_trbs_free)
> + __field(unsigned int, bounce_buf_len)
> + ),
> + TP_fast_assign(
> + __entry->ring = ring;
> + __entry->type = ring->type;
> + __entry->num_segs = ring->num_segs;
> + __entry->stream_id = ring->stream_id;
> + __entry->enq_seg = ring->enq_seg->dma;
> + __entry->deq_seg = ring->deq_seg->dma;
> + __entry->cycle_state = ring->cycle_state;
> + __entry->num_trbs_free = ring->num_trbs_free;
> + __entry->bounce_buf_len = ring->bounce_buf_len;
> + __entry->enq = cdnsp_trb_virt_to_dma(ring->enq_seg,
> + ring->enqueue);
> + __entry->deq = cdnsp_trb_virt_to_dma(ring->deq_seg,
> + ring->dequeue);
> + ),
> + TP_printk("%s %p: enq %pad(%pad) deq %pad(%pad) segs %d stream %d"
> + " free_trbs %d bounce %d cycle %d",
> + cdnsp_ring_type_string(__entry->type), __entry->ring,
> + &__entry->enq, &__entry->enq_seg,
> + &__entry->deq, &__entry->deq_seg,
> + __entry->num_segs,
> + __entry->stream_id,
> + __entry->num_trbs_free,
> + __entry->bounce_buf_len,
> + __entry->cycle_state
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ring, cdnsp_ring_alloc,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ring, cdnsp_ring_free,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ring, cdnsp_set_stream_ring,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ring, cdnsp_ring_expansion,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ring, cdnsp_inc_enq,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_ring, cdnsp_inc_deq,
> + TP_PROTO(struct cdnsp_ring *ring),
> + TP_ARGS(ring)
> +);
> +
> +DECLARE_EVENT_CLASS(cdnsp_log_portsc,
> + TP_PROTO(u32 portnum, u32 portsc),
> + TP_ARGS(portnum, portsc),
> + TP_STRUCT__entry(
> + __field(u32, portnum)
> + __field(u32, portsc)
> + __dynamic_array(char, str, CDNSP_MSG_MAX)
> + ),
> + TP_fast_assign(
> + __entry->portnum = portnum;
> + __entry->portsc = portsc;
> + ),
> + TP_printk("port-%d: %s",
> + __entry->portnum,
> + cdnsp_decode_portsc(__get_str(str), CDNSP_MSG_MAX,
> + __entry->portsc)
> + )
> +);
> +
> +DEFINE_EVENT(cdnsp_log_portsc, cdnsp_handle_port_status,
> + TP_PROTO(u32 portnum, u32 portsc),
> + TP_ARGS(portnum, portsc)
> +);
> +
> +DEFINE_EVENT(cdnsp_log_portsc, cdnsp_link_state_changed,
> + TP_PROTO(u32 portnum, u32 portsc),
> + TP_ARGS(portnum, portsc)
> +);
> +
> +TRACE_EVENT(cdnsp_stream_number,
> + TP_PROTO(struct cdnsp_ep *pep, int num_stream_ctxs, int num_streams),
> + TP_ARGS(pep, num_stream_ctxs, num_streams),
> + TP_STRUCT__entry(
> + __string(name, pep->name)
> + __field(int, num_stream_ctxs)
> + __field(int, num_streams)
> + ),
> + TP_fast_assign(
> + __entry->num_stream_ctxs = num_stream_ctxs;
> + __entry->num_streams = num_streams;
> + ),
> + TP_printk("%s Need %u stream ctx entries for %u stream IDs.",
> + __get_str(name), __entry->num_stream_ctxs,
> + __entry->num_streams)
> +);
> +
> +#endif /* __CDNSP_TRACE_H */
> +
> +/* this part must be outside header guard */
> +
> +#undef TRACE_INCLUDE_PATH
> +#define TRACE_INCLUDE_PATH .
> +
> +#undef TRACE_INCLUDE_FILE
> +#define TRACE_INCLUDE_FILE cdnsp-trace
> +
> +#include <trace/define_trace.h>
> --
> 2.17.1
>
--
Thanks,
Peter Chen
