^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Cadence USBSS DRD Driver - gadget side.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2018 Cadence Design Systems.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2017-2018 NXP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Authors: Pawel Jez <pjez@cadence.com>,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Pawel Laszczak <pawell@cadence.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * Peter Chen <peter.chen@nxp.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/usb/composite.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/iopoll.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "gadget.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include "trace.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) static struct usb_endpoint_descriptor cdns3_gadget_ep0_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) .bLength = USB_DT_ENDPOINT_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) .bDescriptorType = USB_DT_ENDPOINT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) .bmAttributes = USB_ENDPOINT_XFER_CONTROL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * cdns3_ep0_run_transfer - Do transfer on default endpoint hardware
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * @dma_addr: physical address where data is/will be stored
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * @length: data length
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * @erdy: set it to 1 when ERDY packet should be sent -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) * exit from flow control state
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) * @zlp: add zero length packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static void cdns3_ep0_run_transfer(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) dma_addr_t dma_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) unsigned int length, int erdy, int zlp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) struct cdns3_usb_regs __iomem *regs = priv_dev->regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) struct cdns3_endpoint *priv_ep = priv_dev->eps[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) priv_ep->trb_pool[0].buffer = cpu_to_le32(TRB_BUFFER(dma_addr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) priv_ep->trb_pool[0].length = cpu_to_le32(TRB_LEN(length));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) if (zlp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) priv_ep->trb_pool[0].control = cpu_to_le32(TRB_CYCLE | TRB_TYPE(TRB_NORMAL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) priv_ep->trb_pool[1].buffer = cpu_to_le32(TRB_BUFFER(dma_addr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) priv_ep->trb_pool[1].length = cpu_to_le32(TRB_LEN(0));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) priv_ep->trb_pool[1].control = cpu_to_le32(TRB_CYCLE | TRB_IOC |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) TRB_TYPE(TRB_NORMAL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) priv_ep->trb_pool[0].control = cpu_to_le32(TRB_CYCLE | TRB_IOC |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) TRB_TYPE(TRB_NORMAL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) priv_ep->trb_pool[1].control = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) trace_cdns3_prepare_trb(priv_ep, priv_ep->trb_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) cdns3_select_ep(priv_dev, priv_dev->ep0_data_dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) writel(EP_STS_TRBERR, ®s->ep_sts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) writel(EP_TRADDR_TRADDR(priv_ep->trb_pool_dma), ®s->ep_traddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) trace_cdns3_doorbell_ep0(priv_dev->ep0_data_dir ? "ep0in" : "ep0out",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) readl(®s->ep_traddr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) /* TRB should be prepared before starting transfer. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) writel(EP_CMD_DRDY, ®s->ep_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) /* Resume controller before arming transfer. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) __cdns3_gadget_wakeup(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) if (erdy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) writel(EP_CMD_ERDY, &priv_dev->regs->ep_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) * cdns3_ep0_delegate_req - Returns status of handling setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) * Setup is handled by gadget driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * @ctrl_req: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) * Returns zero on success or negative value on failure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) static int cdns3_ep0_delegate_req(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) struct usb_ctrlrequest *ctrl_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) spin_unlock(&priv_dev->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) priv_dev->setup_pending = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) ret = priv_dev->gadget_driver->setup(&priv_dev->gadget, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) priv_dev->setup_pending = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) spin_lock(&priv_dev->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) static void cdns3_prepare_setup_packet(struct cdns3_device *priv_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) priv_dev->ep0_data_dir = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) priv_dev->ep0_stage = CDNS3_SETUP_STAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) cdns3_ep0_run_transfer(priv_dev, priv_dev->setup_dma,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) sizeof(struct usb_ctrlrequest), 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static void cdns3_ep0_complete_setup(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) u8 send_stall, u8 send_erdy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) struct cdns3_endpoint *priv_ep = priv_dev->eps[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) struct usb_request *request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) request = cdns3_next_request(&priv_ep->pending_req_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) if (request)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) list_del_init(&request->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) if (send_stall) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) trace_cdns3_halt(priv_ep, send_stall, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) /* set_stall on ep0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) cdns3_select_ep(priv_dev, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) writel(EP_CMD_SSTALL, &priv_dev->regs->ep_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) cdns3_prepare_setup_packet(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) priv_dev->ep0_stage = CDNS3_SETUP_STAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) writel((send_erdy ? EP_CMD_ERDY : 0) | EP_CMD_REQ_CMPL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) &priv_dev->regs->ep_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) * cdns3_req_ep0_set_configuration - Handling of SET_CONFIG standard USB request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) * @ctrl_req: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) * Returns 0 if success, USB_GADGET_DELAYED_STATUS on deferred status stage,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) * error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) static int cdns3_req_ep0_set_configuration(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) struct usb_ctrlrequest *ctrl_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) enum usb_device_state device_state = priv_dev->gadget.state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) u32 config = le16_to_cpu(ctrl_req->wValue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) int result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) switch (device_state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) case USB_STATE_ADDRESS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) result = cdns3_ep0_delegate_req(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) if (result || !config)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) goto reset_config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) case USB_STATE_CONFIGURED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) result = cdns3_ep0_delegate_req(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) if (!config && !result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) goto reset_config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) reset_config:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) if (result != USB_GADGET_DELAYED_STATUS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) cdns3_hw_reset_eps_config(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) usb_gadget_set_state(&priv_dev->gadget,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) USB_STATE_ADDRESS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) * cdns3_req_ep0_set_address - Handling of SET_ADDRESS standard USB request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) * @ctrl_req: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) * Returns 0 if success, error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) static int cdns3_req_ep0_set_address(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) struct usb_ctrlrequest *ctrl_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) enum usb_device_state device_state = priv_dev->gadget.state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) u32 reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) u32 addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) addr = le16_to_cpu(ctrl_req->wValue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) if (addr > USB_DEVICE_MAX_ADDRESS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) dev_err(priv_dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) "Device address (%d) cannot be greater than %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) addr, USB_DEVICE_MAX_ADDRESS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) if (device_state == USB_STATE_CONFIGURED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) dev_err(priv_dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) "can't set_address from configured state\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) reg = readl(&priv_dev->regs->usb_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) writel(reg | USB_CMD_FADDR(addr) | USB_CMD_SET_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) &priv_dev->regs->usb_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) usb_gadget_set_state(&priv_dev->gadget,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) (addr ? USB_STATE_ADDRESS : USB_STATE_DEFAULT));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) * cdns3_req_ep0_get_status - Handling of GET_STATUS standard USB request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) * @ctrl: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) * Returns 0 if success, error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) static int cdns3_req_ep0_get_status(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) struct usb_ctrlrequest *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) struct cdns3_endpoint *priv_ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) __le16 *response_pkt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) u16 usb_status = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) u32 recip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) u8 index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) recip = ctrl->bRequestType & USB_RECIP_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) switch (recip) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) case USB_RECIP_DEVICE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) /* self powered */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) if (priv_dev->is_selfpowered)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) usb_status = BIT(USB_DEVICE_SELF_POWERED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if (priv_dev->wake_up_flag)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) usb_status |= BIT(USB_DEVICE_REMOTE_WAKEUP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) if (priv_dev->gadget.speed != USB_SPEED_SUPER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (priv_dev->u1_allowed)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) usb_status |= BIT(USB_DEV_STAT_U1_ENABLED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) if (priv_dev->u2_allowed)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) usb_status |= BIT(USB_DEV_STAT_U2_ENABLED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) case USB_RECIP_INTERFACE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) return cdns3_ep0_delegate_req(priv_dev, ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) case USB_RECIP_ENDPOINT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) index = cdns3_ep_addr_to_index(le16_to_cpu(ctrl->wIndex));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) priv_ep = priv_dev->eps[index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) /* check if endpoint is stalled or stall is pending */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) cdns3_select_ep(priv_dev, le16_to_cpu(ctrl->wIndex));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (EP_STS_STALL(readl(&priv_dev->regs->ep_sts)) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) (priv_ep->flags & EP_STALL_PENDING))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) usb_status = BIT(USB_ENDPOINT_HALT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) response_pkt = (__le16 *)priv_dev->setup_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) *response_pkt = cpu_to_le16(usb_status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) cdns3_ep0_run_transfer(priv_dev, priv_dev->setup_dma,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) sizeof(*response_pkt), 1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) static int cdns3_ep0_feature_handle_device(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) struct usb_ctrlrequest *ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) int set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) enum usb_device_state state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) enum usb_device_speed speed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) u32 wValue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) u16 tmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) wValue = le16_to_cpu(ctrl->wValue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) state = priv_dev->gadget.state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) speed = priv_dev->gadget.speed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) switch (wValue) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) case USB_DEVICE_REMOTE_WAKEUP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) priv_dev->wake_up_flag = !!set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) case USB_DEVICE_U1_ENABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) if (state != USB_STATE_CONFIGURED || speed != USB_SPEED_SUPER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) priv_dev->u1_allowed = !!set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) case USB_DEVICE_U2_ENABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) if (state != USB_STATE_CONFIGURED || speed != USB_SPEED_SUPER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) priv_dev->u2_allowed = !!set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) case USB_DEVICE_LTM_ENABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) case USB_DEVICE_TEST_MODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) if (state != USB_STATE_CONFIGURED || speed > USB_SPEED_HIGH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) tmode = le16_to_cpu(ctrl->wIndex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) if (!set || (tmode & 0xff) != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) tmode >>= 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) switch (tmode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) case USB_TEST_J:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) case USB_TEST_K:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) case USB_TEST_SE0_NAK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) case USB_TEST_PACKET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) cdns3_set_register_bit(&priv_dev->regs->usb_cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) USB_CMD_STMODE |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) USB_STS_TMODE_SEL(tmode - 1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) static int cdns3_ep0_feature_handle_intf(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) struct usb_ctrlrequest *ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) int set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) u32 wValue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) wValue = le16_to_cpu(ctrl->wValue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) switch (wValue) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) case USB_INTRF_FUNC_SUSPEND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) static int cdns3_ep0_feature_handle_endpoint(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) struct usb_ctrlrequest *ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) int set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) struct cdns3_endpoint *priv_ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) u8 index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) if (le16_to_cpu(ctrl->wValue) != USB_ENDPOINT_HALT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (!(ctrl->wIndex & ~USB_DIR_IN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) index = cdns3_ep_addr_to_index(le16_to_cpu(ctrl->wIndex));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) priv_ep = priv_dev->eps[index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) cdns3_select_ep(priv_dev, le16_to_cpu(ctrl->wIndex));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) if (set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) __cdns3_gadget_ep_set_halt(priv_ep);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) else if (!(priv_ep->flags & EP_WEDGE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) ret = __cdns3_gadget_ep_clear_halt(priv_ep);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) cdns3_select_ep(priv_dev, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) * cdns3_req_ep0_handle_feature -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) * Handling of GET/SET_FEATURE standard USB request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) * @ctrl: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) * @set: must be set to 1 for SET_FEATURE request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) * Returns 0 if success, error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) static int cdns3_req_ep0_handle_feature(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) struct usb_ctrlrequest *ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) int set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) u32 recip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) recip = ctrl->bRequestType & USB_RECIP_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) switch (recip) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) case USB_RECIP_DEVICE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) ret = cdns3_ep0_feature_handle_device(priv_dev, ctrl, set);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) case USB_RECIP_INTERFACE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) ret = cdns3_ep0_feature_handle_intf(priv_dev, ctrl, set);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) case USB_RECIP_ENDPOINT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) ret = cdns3_ep0_feature_handle_endpoint(priv_dev, ctrl, set);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) * cdns3_req_ep0_set_sel - Handling of SET_SEL standard USB request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) * @ctrl_req: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) * Returns 0 if success, error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) static int cdns3_req_ep0_set_sel(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) struct usb_ctrlrequest *ctrl_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) if (priv_dev->gadget.state < USB_STATE_ADDRESS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) if (le16_to_cpu(ctrl_req->wLength) != 6) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) dev_err(priv_dev->dev, "Set SEL should be 6 bytes, got %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) ctrl_req->wLength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) cdns3_ep0_run_transfer(priv_dev, priv_dev->setup_dma, 6, 1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) * cdns3_req_ep0_set_isoch_delay -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) * Handling of GET_ISOCH_DELAY standard USB request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) * @ctrl_req: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) * Returns 0 if success, error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) static int cdns3_req_ep0_set_isoch_delay(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) struct usb_ctrlrequest *ctrl_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) if (ctrl_req->wIndex || ctrl_req->wLength)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) priv_dev->isoch_delay = le16_to_cpu(ctrl_req->wValue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) * cdns3_ep0_standard_request - Handling standard USB requests
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) * @ctrl_req: pointer to received setup packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) * Returns 0 if success, error code on error
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) static int cdns3_ep0_standard_request(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) struct usb_ctrlrequest *ctrl_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) switch (ctrl_req->bRequest) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) case USB_REQ_SET_ADDRESS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) ret = cdns3_req_ep0_set_address(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) case USB_REQ_SET_CONFIGURATION:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) ret = cdns3_req_ep0_set_configuration(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) case USB_REQ_GET_STATUS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) ret = cdns3_req_ep0_get_status(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) case USB_REQ_CLEAR_FEATURE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) ret = cdns3_req_ep0_handle_feature(priv_dev, ctrl_req, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) case USB_REQ_SET_FEATURE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) ret = cdns3_req_ep0_handle_feature(priv_dev, ctrl_req, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) case USB_REQ_SET_SEL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) ret = cdns3_req_ep0_set_sel(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) case USB_REQ_SET_ISOCH_DELAY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) ret = cdns3_req_ep0_set_isoch_delay(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) ret = cdns3_ep0_delegate_req(priv_dev, ctrl_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) static void __pending_setup_status_handler(struct cdns3_device *priv_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) struct usb_request *request = priv_dev->pending_status_request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) if (priv_dev->status_completion_no_call && request &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) request->complete) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) request->complete(&priv_dev->eps[0]->endpoint, request);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) priv_dev->status_completion_no_call = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) void cdns3_pending_setup_status_handler(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) struct cdns3_device *priv_dev = container_of(work, struct cdns3_device,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) pending_status_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) spin_lock_irqsave(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) __pending_setup_status_handler(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) spin_unlock_irqrestore(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) * cdns3_ep0_setup_phase - Handling setup USB requests
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) static void cdns3_ep0_setup_phase(struct cdns3_device *priv_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) struct usb_ctrlrequest *ctrl = priv_dev->setup_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) struct cdns3_endpoint *priv_ep = priv_dev->eps[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) priv_dev->ep0_data_dir = ctrl->bRequestType & USB_DIR_IN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) trace_cdns3_ctrl_req(ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) if (!list_empty(&priv_ep->pending_req_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) struct usb_request *request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) request = cdns3_next_request(&priv_ep->pending_req_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) priv_ep->dir = priv_dev->ep0_data_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) cdns3_gadget_giveback(priv_ep, to_cdns3_request(request),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) -ECONNRESET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) if (le16_to_cpu(ctrl->wLength))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) priv_dev->ep0_stage = CDNS3_DATA_STAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) priv_dev->ep0_stage = CDNS3_STATUS_STAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) result = cdns3_ep0_standard_request(priv_dev, ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) result = cdns3_ep0_delegate_req(priv_dev, ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) if (result == USB_GADGET_DELAYED_STATUS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) if (result < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) cdns3_ep0_complete_setup(priv_dev, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) else if (priv_dev->ep0_stage == CDNS3_STATUS_STAGE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) cdns3_ep0_complete_setup(priv_dev, 0, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) static void cdns3_transfer_completed(struct cdns3_device *priv_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) struct cdns3_endpoint *priv_ep = priv_dev->eps[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) if (!list_empty(&priv_ep->pending_req_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) struct usb_request *request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) trace_cdns3_complete_trb(priv_ep, priv_ep->trb_pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) request = cdns3_next_request(&priv_ep->pending_req_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) request->actual =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) TRB_LEN(le32_to_cpu(priv_ep->trb_pool->length));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) priv_ep->dir = priv_dev->ep0_data_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) cdns3_gadget_giveback(priv_ep, to_cdns3_request(request), 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) cdns3_ep0_complete_setup(priv_dev, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) * cdns3_check_new_setup - Check if controller receive new SETUP packet.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) * The SETUP packet can be kept in on-chip memory or in system memory.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) static bool cdns3_check_new_setup(struct cdns3_device *priv_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) u32 ep_sts_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) cdns3_select_ep(priv_dev, USB_DIR_OUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) ep_sts_reg = readl(&priv_dev->regs->ep_sts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) return !!(ep_sts_reg & (EP_STS_SETUP | EP_STS_STPWAIT));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) * cdns3_check_ep0_interrupt_proceed - Processes interrupt related to endpoint 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) * @dir: USB_DIR_IN for IN direction, USB_DIR_OUT for OUT direction
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) void cdns3_check_ep0_interrupt_proceed(struct cdns3_device *priv_dev, int dir)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) u32 ep_sts_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) cdns3_select_ep(priv_dev, dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) ep_sts_reg = readl(&priv_dev->regs->ep_sts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) writel(ep_sts_reg, &priv_dev->regs->ep_sts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) trace_cdns3_ep0_irq(priv_dev, ep_sts_reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) __pending_setup_status_handler(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) if (ep_sts_reg & EP_STS_SETUP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) priv_dev->wait_for_setup = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) if (priv_dev->wait_for_setup && ep_sts_reg & EP_STS_IOC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) priv_dev->wait_for_setup = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) cdns3_ep0_setup_phase(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) } else if ((ep_sts_reg & EP_STS_IOC) || (ep_sts_reg & EP_STS_ISP)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) priv_dev->ep0_data_dir = dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) cdns3_transfer_completed(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) if (ep_sts_reg & EP_STS_DESCMIS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) if (dir == 0 && !priv_dev->setup_pending)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) cdns3_prepare_setup_packet(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) * cdns3_gadget_ep0_enable
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) * @ep: pointer to endpoint zero object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) * @desc: pointer to usb endpoint descriptor
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) * Function shouldn't be called by gadget driver,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) * endpoint 0 is allways active
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) static int cdns3_gadget_ep0_enable(struct usb_ep *ep,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) const struct usb_endpoint_descriptor *desc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) * cdns3_gadget_ep0_disable
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) * @ep: pointer to endpoint zero object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) * Function shouldn't be called by gadget driver,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) * endpoint 0 is allways active
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) static int cdns3_gadget_ep0_disable(struct usb_ep *ep)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) * cdns3_gadget_ep0_set_halt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) * @ep: pointer to endpoint zero object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) * @value: 1 for set stall, 0 for clear stall
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) * Returns 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) static int cdns3_gadget_ep0_set_halt(struct usb_ep *ep, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) /* TODO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) * cdns3_gadget_ep0_queue Transfer data on endpoint zero
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) * @ep: pointer to endpoint zero object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) * @request: pointer to request object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) * @gfp_flags: gfp flags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) * Returns 0 on success, error code elsewhere
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) static int cdns3_gadget_ep0_queue(struct usb_ep *ep,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) struct usb_request *request,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) gfp_t gfp_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) struct cdns3_endpoint *priv_ep = ep_to_cdns3_ep(ep);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) u8 zlp = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) spin_lock_irqsave(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) trace_cdns3_ep0_queue(priv_dev, request);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) /* cancel the request if controller receive new SETUP packet. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) if (cdns3_check_new_setup(priv_dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) spin_unlock_irqrestore(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) return -ECONNRESET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) /* send STATUS stage. Should be called only for SET_CONFIGURATION */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) if (priv_dev->ep0_stage == CDNS3_STATUS_STAGE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) cdns3_select_ep(priv_dev, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) * Configure all non-control EPs which are not enabled by class driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) for (i = 0; i < CDNS3_ENDPOINTS_MAX_COUNT; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) priv_ep = priv_dev->eps[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) if (priv_ep && priv_ep->flags & EP_CLAIMED &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) !(priv_ep->flags & EP_ENABLED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) cdns3_ep_config(priv_ep, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) cdns3_set_hw_configuration(priv_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) cdns3_ep0_complete_setup(priv_dev, 0, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) /* wait until configuration set */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) ret = readl_poll_timeout_atomic(&priv_dev->regs->usb_sts, val,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) val & USB_STS_CFGSTS_MASK, 1, 100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) if (ret == -ETIMEDOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) dev_warn(priv_dev->dev, "timeout for waiting configuration set\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) request->actual = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) priv_dev->status_completion_no_call = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) priv_dev->pending_status_request = request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) usb_gadget_set_state(&priv_dev->gadget, USB_STATE_CONFIGURED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) spin_unlock_irqrestore(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) * Since there is no completion interrupt for status stage,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) * it needs to call ->completion in software after
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) * ep0_queue is back.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) queue_work(system_freezable_wq, &priv_dev->pending_status_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) if (!list_empty(&priv_ep->pending_req_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) dev_err(priv_dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) "can't handle multiple requests for ep0\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) spin_unlock_irqrestore(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) ret = usb_gadget_map_request_by_dev(priv_dev->sysdev, request,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) priv_dev->ep0_data_dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) spin_unlock_irqrestore(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) dev_err(priv_dev->dev, "failed to map request\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) request->status = -EINPROGRESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) list_add_tail(&request->list, &priv_ep->pending_req_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) if (request->zero && request->length &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) (request->length % ep->maxpacket == 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) zlp = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) cdns3_ep0_run_transfer(priv_dev, request->dma, request->length, 1, zlp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) spin_unlock_irqrestore(&priv_dev->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) * cdns3_gadget_ep_set_wedge Set wedge on selected endpoint
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) * @ep: endpoint object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) * Returns 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) int cdns3_gadget_ep_set_wedge(struct usb_ep *ep)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) struct cdns3_endpoint *priv_ep = ep_to_cdns3_ep(ep);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) dev_dbg(priv_dev->dev, "Wedge for %s\n", ep->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) cdns3_gadget_ep_set_halt(ep, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) priv_ep->flags |= EP_WEDGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) const struct usb_ep_ops cdns3_gadget_ep0_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) .enable = cdns3_gadget_ep0_enable,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) .disable = cdns3_gadget_ep0_disable,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) .alloc_request = cdns3_gadget_ep_alloc_request,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) .free_request = cdns3_gadget_ep_free_request,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) .queue = cdns3_gadget_ep0_queue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) .dequeue = cdns3_gadget_ep_dequeue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) .set_halt = cdns3_gadget_ep0_set_halt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) .set_wedge = cdns3_gadget_ep_set_wedge,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) * cdns3_ep0_config - Configures default endpoint
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) * Functions sets parameters: maximal packet size and enables interrupts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) void cdns3_ep0_config(struct cdns3_device *priv_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) struct cdns3_usb_regs __iomem *regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) struct cdns3_endpoint *priv_ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) u32 max_packet_size = 64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) u32 ep_cfg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) regs = priv_dev->regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) if (priv_dev->gadget.speed == USB_SPEED_SUPER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) max_packet_size = 512;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) priv_ep = priv_dev->eps[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) if (!list_empty(&priv_ep->pending_req_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) struct usb_request *request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) request = cdns3_next_request(&priv_ep->pending_req_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) list_del_init(&request->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) priv_dev->u1_allowed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) priv_dev->u2_allowed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) priv_dev->gadget.ep0->maxpacket = max_packet_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) cdns3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(max_packet_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) /* init ep out */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) cdns3_select_ep(priv_dev, USB_DIR_OUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) if (priv_dev->dev_ver >= DEV_VER_V3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) cdns3_set_register_bit(&priv_dev->regs->dtrans,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) BIT(0) | BIT(16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) cdns3_set_register_bit(&priv_dev->regs->tdl_from_trb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) BIT(0) | BIT(16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) ep_cfg = EP_CFG_ENABLE | EP_CFG_MAXPKTSIZE(max_packet_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) if (!(priv_ep->flags & EP_CONFIGURED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) writel(ep_cfg, ®s->ep_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) writel(EP_STS_EN_SETUPEN | EP_STS_EN_DESCMISEN | EP_STS_EN_TRBERREN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) ®s->ep_sts_en);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) /* init ep in */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) cdns3_select_ep(priv_dev, USB_DIR_IN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) if (!(priv_ep->flags & EP_CONFIGURED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) writel(ep_cfg, ®s->ep_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) priv_ep->flags |= EP_CONFIGURED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) writel(EP_STS_EN_SETUPEN | EP_STS_EN_TRBERREN, ®s->ep_sts_en);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) cdns3_set_register_bit(®s->usb_conf, USB_CONF_U1DS | USB_CONF_U2DS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) * cdns3_init_ep0 Initializes software endpoint 0 of gadget
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) * @priv_dev: extended gadget object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) * @priv_ep: extended endpoint object
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) * Returns 0 on success else error code.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) int cdns3_init_ep0(struct cdns3_device *priv_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) struct cdns3_endpoint *priv_ep)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) sprintf(priv_ep->name, "ep0");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) /* fill linux fields */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) priv_ep->endpoint.ops = &cdns3_gadget_ep0_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) priv_ep->endpoint.maxburst = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) usb_ep_set_maxpacket_limit(&priv_ep->endpoint,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) CDNS3_EP0_MAX_PACKET_LIMIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) priv_ep->endpoint.address = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) priv_ep->endpoint.caps.type_control = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) priv_ep->endpoint.caps.dir_in = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) priv_ep->endpoint.caps.dir_out = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) priv_ep->endpoint.name = priv_ep->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) priv_ep->endpoint.desc = &cdns3_gadget_ep0_desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) priv_dev->gadget.ep0 = &priv_ep->endpoint;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) priv_ep->type = USB_ENDPOINT_XFER_CONTROL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) return cdns3_allocate_trb_pool(priv_ep);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags