Lines Matching refs:priv_dev
115 static int cdns3_get_dma_pos(struct cdns3_device *priv_dev,
120 dma_index = readl(&priv_dev->regs->ep_traddr) - priv_ep->trb_pool_dma;
160 * @priv_dev: extended gadget object
163 void cdns3_select_ep(struct cdns3_device *priv_dev, u32 ep)
165 if (priv_dev->selected_ep == ep)
168 priv_dev->selected_ep = ep;
169 writel(ep, &priv_dev->regs->ep_sel);
174 * @priv_dev: extended gadget object
179 static int cdns3_get_tdl(struct cdns3_device *priv_dev)
181 if (priv_dev->dev_ver < DEV_VER_V3)
182 return EP_CMD_TDL_GET(readl(&priv_dev->regs->ep_cmd));
184 return readl(&priv_dev->regs->ep_tdl);
197 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
200 dma_pool_free(priv_dev->eps_dma_pool,
214 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
223 priv_ep->trb_pool = dma_pool_alloc(priv_dev->eps_dma_pool,
264 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
270 &priv_dev->regs->ep_cmd);
273 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val,
281 * @priv_dev: extended gadget object
283 void cdns3_hw_reset_eps_config(struct cdns3_device *priv_dev)
287 writel(USB_CONF_CFGRST, &priv_dev->regs->usb_conf);
289 cdns3_allow_enable_l1(priv_dev, 0);
290 priv_dev->hw_configured_flag = 0;
291 priv_dev->onchip_used_size = 0;
292 priv_dev->out_mem_is_allocated = 0;
293 priv_dev->wait_for_setup = 0;
294 priv_dev->using_streams = 0;
297 if (priv_dev->eps[i])
298 priv_dev->eps[i]->flags &= ~EP_CONFIGURED;
343 * @priv_dev: Extended gadget object
351 void cdns3_allow_enable_l1(struct cdns3_device *priv_dev, int enable)
354 writel(USB_CONF_L1EN, &priv_dev->regs->usb_conf);
356 writel(USB_CONF_L1DS, &priv_dev->regs->usb_conf);
359 enum usb_device_speed cdns3_get_speed(struct cdns3_device *priv_dev)
363 reg = readl(&priv_dev->regs->usb_sts);
378 * @priv_dev: Extended gadget object
384 static int cdns3_start_all_request(struct cdns3_device *priv_dev,
404 dev_dbg(priv_dev->dev, "Blocking external request\n");
436 #define cdns3_wa2_enable_detection(priv_dev, priv_ep, reg) do { \
508 static struct usb_request *cdns3_wa2_gadget_giveback(struct cdns3_device *priv_dev,
524 usb_gadget_unmap_request_by_dev(priv_dev->sysdev, req,
532 usb_gadget_map_request_by_dev(priv_dev->sysdev, req,
541 cdns3_start_all_request(priv_dev, priv_ep);
548 static int cdns3_wa2_gadget_ep_queue(struct cdns3_device *priv_dev,
562 cdns3_select_ep(priv_dev, priv_ep->num | priv_ep->dir);
564 reg = readl(&priv_dev->regs->ep_sts_en);
567 writel(reg, &priv_dev->regs->ep_sts_en);
710 static void cdns3_wa2_reset_tdl(struct cdns3_device *priv_dev)
712 u16 tdl = EP_CMD_TDL_GET(readl(&priv_dev->regs->ep_cmd));
718 &priv_dev->regs->ep_cmd);
722 static void cdns3_wa2_check_outq_status(struct cdns3_device *priv_dev)
727 cdns3_select_ep(priv_dev, 0);
729 ep_sts_reg = readl(&priv_dev->regs->ep_sts);
733 struct cdns3_endpoint *outq_ep = priv_dev->eps[outq_ep_num];
746 cdns3_select_ep(priv_dev, outq_ep->num |
748 ep_sts_en_reg = readl(&priv_dev->regs->ep_sts_en);
749 ep_cmd_reg = readl(&priv_dev->regs->ep_cmd);
752 cdns3_set_register_bit(&priv_dev->regs->ep_cfg,
755 cdns3_wa2_enable_detection(priv_dev, outq_ep,
758 &priv_dev->regs->ep_sts_en);
760 cdns3_wa2_reset_tdl(priv_dev);
775 &priv_dev->regs->ep_cmd);
796 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
805 usb_gadget_unmap_request_by_dev(priv_dev->sysdev, request,
811 dma_sync_single_for_cpu(priv_dev->sysdev,
824 if (priv_dev->dev_ver < DEV_VER_V2) {
825 request = cdns3_wa2_gadget_giveback(priv_dev, priv_ep,
835 if (request->complete && request->buf != priv_dev->zlp_buf) {
836 spin_unlock(&priv_dev->lock);
839 spin_lock(&priv_dev->lock);
842 if (request->buf == priv_dev->zlp_buf)
866 struct cdns3_device *priv_dev = container_of(work, struct cdns3_device,
871 spin_lock_irqsave(&priv_dev->lock, flags);
873 list_for_each_entry_safe(buf, tmp, &priv_dev->aligned_buf_list, list) {
882 spin_unlock_irqrestore(&priv_dev->lock, flags);
883 dma_free_noncoherent(priv_dev->sysdev, buf->size,
886 spin_lock_irqsave(&priv_dev->lock, flags);
890 spin_unlock_irqrestore(&priv_dev->lock, flags);
896 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
914 buf->buf = dma_alloc_noncoherent(priv_dev->sysdev,
928 &priv_dev->aligned_buf_wq);
935 &priv_dev->aligned_buf_list);
940 dma_sync_single_for_cpu(priv_dev->sysdev,
947 dma_sync_single_for_device(priv_dev->sysdev,
959 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
964 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY);
978 static void cdns3_wa1_tray_restore_cycle_bit(struct cdns3_device *priv_dev,
984 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY);
985 dma_index = cdns3_get_dma_pos(priv_dev, priv_ep);
994 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1043 if (priv_dev->dev_ver >= DEV_VER_V2) {
1044 if (priv_dev->gadget.speed == USB_SPEED_SUPER)
1061 &priv_dev->regs->ep_traddr);
1066 writel(EP_STS_TRBERR | EP_STS_DESCMIS, &priv_dev->regs->ep_sts);
1075 if (priv_dev->dev_ver < DEV_VER_V2)
1077 &priv_dev->regs->ep_cmd);
1078 else if (priv_dev->dev_ver > DEV_VER_V2)
1079 writel(tdl, &priv_dev->regs->ep_tdl);
1082 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd);
1084 EP_CMD_ERDY, &priv_dev->regs->ep_cmd);
1087 readl(&priv_dev->regs->ep_traddr));
1091 __cdns3_gadget_wakeup(priv_dev);
1098 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1100 if (priv_dev->dev_ver < DEV_VER_V3)
1103 if (readl(&priv_dev->regs->ep_sts) & EP_STS_TRBERR) {
1104 writel(EP_STS_TRBERR, &priv_dev->regs->ep_sts);
1105 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd);
1119 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1166 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY);
1167 dma_index = cdns3_get_dma_pos(priv_dev, priv_ep);
1213 if (priv_dev->dev_ver <= DEV_VER_V2)
1219 if (priv_dev->dev_ver >= DEV_VER_V2) {
1224 if (priv_dev->gadget.speed == USB_SPEED_SUPER)
1274 if (priv_ep->type == USB_ENDPOINT_XFER_ISOC && priv_dev->dev_ver <= DEV_VER_V2)
1328 if (priv_dev->dev_ver < DEV_VER_V2 &&
1331 u16 old_tdl = EP_CMD_TDL_GET(readl(&priv_dev->regs->ep_cmd));
1341 &priv_dev->regs->ep_cmd);
1354 if (priv_dev->dev_ver <= DEV_VER_V2)
1355 cdns3_wa1_tray_restore_cycle_bit(priv_dev, priv_ep);
1393 cdns3_set_register_bit(&priv_dev->regs->ep_cfg,
1399 &priv_dev->regs->ep_traddr);
1407 writel(EP_STS_TRBERR | EP_STS_DESCMIS, &priv_dev->regs->ep_sts);
1408 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd);
1411 readl(&priv_dev->regs->ep_traddr));
1415 __cdns3_gadget_wakeup(priv_dev);
1420 void cdns3_set_hw_configuration(struct cdns3_device *priv_dev)
1425 if (priv_dev->hw_configured_flag)
1428 writel(USB_CONF_CFGSET, &priv_dev->regs->usb_conf);
1430 cdns3_set_register_bit(&priv_dev->regs->usb_conf,
1433 priv_dev->hw_configured_flag = 1;
1435 list_for_each_entry(ep, &priv_dev->gadget.ep_list, ep_list) {
1438 cdns3_start_all_request(priv_dev, priv_ep);
1442 cdns3_allow_enable_l1(priv_dev, 1);
1487 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1493 current_index = cdns3_get_dma_pos(priv_dev, priv_ep);
1494 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY);
1547 static void cdns3_transfer_completed(struct cdns3_device *priv_dev,
1566 if (priv_ep->dequeue == cdns3_get_dma_pos(priv_dev, priv_ep) &&
1579 cdns3_select_ep(priv_dev, priv_ep->endpoint.address);
1620 cdns3_select_ep(priv_dev, priv_ep->endpoint.address);
1626 dev_warn(priv_dev->dev,
1648 cdns3_start_all_request(priv_dev, priv_ep);
1653 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1662 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd);
1664 __cdns3_gadget_wakeup(priv_dev);
1667 readl(&priv_dev->regs->ep_traddr));
1674 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1683 writel(EP_CMD_TDL_SET(tdl) | EP_CMD_STDL, &priv_dev->regs->ep_cmd);
1694 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
1700 cdns3_select_ep(priv_dev, priv_ep->endpoint.address);
1702 trace_cdns3_epx_irq(priv_dev, priv_ep);
1704 ep_sts_reg = readl(&priv_dev->regs->ep_sts);
1705 writel(ep_sts_reg, &priv_dev->regs->ep_sts);
1710 tdl = cdns3_get_tdl(priv_dev);
1723 &priv_dev->regs->ep_cmd);
1732 cdns3_start_all_request(priv_dev, priv_ep);
1740 priv_dev->dev_ver < DEV_VER_V2)) {
1754 u32 ep_cfg = readl(&priv_dev->regs->ep_cfg);
1757 writel(ep_cfg, &priv_dev->regs->ep_cfg);
1761 cdns3_transfer_completed(priv_dev, priv_ep);
1766 cdns3_start_all_request(priv_dev, priv_ep);
1786 cdns3_transfer_completed(priv_dev, priv_ep);
1795 cdns3_transfer_completed(priv_dev, priv_ep);
1806 cdns3_transfer_completed(priv_dev, priv_ep);
1815 if (ep_sts_reg & EP_STS_DESCMIS && priv_dev->dev_ver < DEV_VER_V2 &&
1822 static void cdns3_disconnect_gadget(struct cdns3_device *priv_dev)
1824 if (priv_dev->gadget_driver && priv_dev->gadget_driver->disconnect)
1825 priv_dev->gadget_driver->disconnect(&priv_dev->gadget);
1830 * @priv_dev: extended gadget object
1834 static void cdns3_check_usb_interrupt_proceed(struct cdns3_device *priv_dev,
1836 __must_hold(&priv_dev->lock)
1840 trace_cdns3_usb_irq(priv_dev, usb_ists);
1847 if (readl(&priv_dev->regs->drbl))
1848 __cdns3_gadget_wakeup(priv_dev);
1853 speed = cdns3_get_speed(priv_dev);
1854 priv_dev->gadget.speed = speed;
1855 usb_gadget_set_state(&priv_dev->gadget, USB_STATE_POWERED);
1856 cdns3_ep0_config(priv_dev);
1861 spin_unlock(&priv_dev->lock);
1862 cdns3_disconnect_gadget(priv_dev);
1863 spin_lock(&priv_dev->lock);
1864 priv_dev->gadget.speed = USB_SPEED_UNKNOWN;
1865 usb_gadget_set_state(&priv_dev->gadget, USB_STATE_NOTATTACHED);
1866 cdns3_hw_reset_eps_config(priv_dev);
1870 if (priv_dev->gadget_driver &&
1871 priv_dev->gadget_driver->suspend) {
1872 spin_unlock(&priv_dev->lock);
1873 priv_dev->gadget_driver->suspend(&priv_dev->gadget);
1874 spin_lock(&priv_dev->lock);
1879 if (priv_dev->gadget_driver &&
1880 priv_dev->gadget_driver->resume) {
1881 spin_unlock(&priv_dev->lock);
1882 priv_dev->gadget_driver->resume(&priv_dev->gadget);
1883 spin_lock(&priv_dev->lock);
1889 if (priv_dev->gadget_driver) {
1890 spin_unlock(&priv_dev->lock);
1891 usb_gadget_udc_reset(&priv_dev->gadget,
1892 priv_dev->gadget_driver);
1893 spin_lock(&priv_dev->lock);
1896 speed = cdns3_get_speed(priv_dev);
1897 priv_dev->gadget.speed = speed;
1898 cdns3_hw_reset_eps_config(priv_dev);
1899 cdns3_ep0_config(priv_dev);
1914 struct cdns3_device *priv_dev = data;
1915 struct cdns *cdns = dev_get_drvdata(priv_dev->dev);
1923 reg = readl(&priv_dev->regs->usb_ists);
1932 reg = ~reg & readl(&priv_dev->regs->usb_ien);
1934 writel(reg, &priv_dev->regs->usb_ien);
1939 reg = readl(&priv_dev->regs->ep_ists);
1941 writel(0, &priv_dev->regs->ep_ien);
1959 struct cdns3_device *priv_dev = data;
1965 spin_lock_irqsave(&priv_dev->lock, flags);
1967 reg = readl(&priv_dev->regs->usb_ists);
1969 writel(reg, &priv_dev->regs->usb_ists);
1970 writel(USB_IEN_INIT, &priv_dev->regs->usb_ien);
1971 cdns3_check_usb_interrupt_proceed(priv_dev, reg);
1975 reg = readl(&priv_dev->regs->ep_ists);
1979 cdns3_check_ep0_interrupt_proceed(priv_dev, USB_DIR_OUT);
1985 cdns3_check_ep0_interrupt_proceed(priv_dev, USB_DIR_IN);
1996 cdns3_check_ep_interrupt_proceed(priv_dev->eps[bit]);
2000 if (priv_dev->dev_ver < DEV_VER_V2 && priv_dev->using_streams)
2001 cdns3_wa2_check_outq_status(priv_dev);
2004 writel(~0, &priv_dev->regs->ep_ien);
2005 spin_unlock_irqrestore(&priv_dev->lock, flags);
2016 * @priv_dev: extended gadget object
2022 static int cdns3_ep_onchip_buffer_reserve(struct cdns3_device *priv_dev,
2028 remained = priv_dev->onchip_buffers - priv_dev->onchip_used_size - 2;
2034 priv_dev->onchip_used_size += size;
2042 if (priv_dev->out_mem_is_allocated >= size)
2045 required = size - priv_dev->out_mem_is_allocated;
2050 priv_dev->out_mem_is_allocated += required;
2051 priv_dev->onchip_used_size += required;
2057 static void cdns3_configure_dmult(struct cdns3_device *priv_dev,
2060 struct cdns3_usb_regs __iomem *regs = priv_dev->regs;
2063 if (priv_dev->dev_ver <= DEV_VER_V2)
2066 if (priv_dev->dev_ver == DEV_VER_V2)
2069 if (priv_dev->dev_ver >= DEV_VER_V3 && priv_ep) {
2099 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
2107 buffering = priv_dev->ep_buf_size - 1;
2109 cdns3_configure_dmult(priv_dev, priv_ep);
2115 if (priv_dev->dev_ver >= DEV_VER_V2 && !priv_ep->dir)
2121 if (priv_dev->dev_ver >= DEV_VER_V2 && !priv_ep->dir)
2129 switch (priv_dev->gadget.speed) {
2139 maxburst = priv_dev->ep_buf_size - 1;
2164 if (priv_dev->dev_ver < DEV_VER_V2)
2171 if (!priv_dev->hw_configured_flag) {
2172 ret = cdns3_ep_onchip_buffer_reserve(priv_dev, buffering + 1,
2175 dev_err(priv_dev->dev, "onchip mem is full, ep is invalid\n");
2183 if (priv_ep->use_streams && priv_dev->gadget.speed >= USB_SPEED_SUPER) {
2184 if (priv_dev->dev_ver >= DEV_VER_V3) {
2191 cdns3_clear_register_bit(&priv_dev->regs->tdl_from_trb,
2204 cdns3_select_ep(priv_dev, bEndpointAddress);
2205 writel(ep_cfg, &priv_dev->regs->ep_cfg);
2208 dev_dbg(priv_dev->dev, "Configure %s: with val %08x\n",
2223 cdns3_endpoint *cdns3_find_available_ep(struct cdns3_device *priv_dev,
2229 list_for_each_entry(ep, &priv_dev->gadget.ep_list, ep_list) {
2272 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
2276 priv_ep = cdns3_find_available_ep(priv_dev, desc);
2278 dev_err(priv_dev->dev, "no available ep\n");
2282 dev_dbg(priv_dev->dev, "match endpoint: %s\n", priv_ep->name);
2284 spin_lock_irqsave(&priv_dev->lock, flags);
2298 spin_unlock_irqrestore(&priv_dev->lock, flags);
2353 struct cdns3_device *priv_dev;
2368 priv_dev = priv_ep->cdns3_dev;
2372 dev_dbg(priv_dev->dev, "usbss: invalid parameters\n");
2377 dev_err(priv_dev->dev, "usbss: missing wMaxPacketSize\n");
2381 if (dev_WARN_ONCE(priv_dev->dev, priv_ep->flags & EP_ENABLED,
2385 spin_lock_irqsave(&priv_dev->lock, flags);
2393 dev_err(priv_dev->dev, "Driver is limited to %d period\n",
2401 cdns3_select_ep(priv_dev, bEndpointAddress);
2419 if (priv_dev->gadget.speed >= USB_SPEED_SUPER) {
2425 priv_dev->using_streams |= true;
2439 cdns3_select_ep(priv_dev, bEndpointAddress);
2443 writel(EP_CMD_EPRST, &priv_dev->regs->ep_cmd);
2445 ret = readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val,
2456 cdns3_set_register_bit(&priv_dev->regs->ep_ien,
2459 if (priv_dev->dev_ver < DEV_VER_V2)
2460 cdns3_wa2_enable_detection(priv_dev, priv_ep, reg);
2462 writel(reg, &priv_dev->regs->ep_sts_en);
2471 reg = readl(&priv_dev->regs->ep_sts);
2477 spin_unlock_irqrestore(&priv_dev->lock, flags);
2492 struct cdns3_device *priv_dev;
2505 priv_dev = priv_ep->cdns3_dev;
2507 if (dev_WARN_ONCE(priv_dev->dev, !(priv_ep->flags & EP_ENABLED),
2511 spin_lock_irqsave(&priv_dev->lock, flags);
2515 cdns3_select_ep(priv_dev, ep->desc->bEndpointAddress);
2517 ep_cfg = readl(&priv_dev->regs->ep_cfg);
2519 writel(ep_cfg, &priv_dev->regs->ep_cfg);
2526 readl_poll_timeout_atomic(&priv_dev->regs->ep_sts, val,
2528 writel(EP_CMD_EPRST, &priv_dev->regs->ep_cmd);
2530 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val,
2534 dev_err(priv_dev->dev, "Timeout: %s resetting failed.\n",
2567 spin_unlock_irqrestore(&priv_dev->lock, flags);
2585 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
2594 if (priv_dev->dev_ver < DEV_VER_V2) {
2595 ret = cdns3_wa2_gadget_ep_queue(priv_dev, priv_ep,
2607 ret = usb_gadget_map_request_by_dev(priv_dev->sysdev, request,
2623 if (priv_dev->hw_configured_flag &&
2626 cdns3_start_all_request(priv_dev, priv_ep);
2628 if (priv_dev->hw_configured_flag && priv_ep->prime_flag)
2629 cdns3_start_all_request(priv_dev, priv_ep);
2640 struct cdns3_device *priv_dev;
2648 priv_dev = priv_ep->cdns3_dev;
2650 spin_lock_irqsave(&priv_dev->lock, flags);
2659 zlp_request->buf = priv_dev->zlp_buf;
2665 dev_dbg(priv_dev->dev, "Queuing ZLP for endpoint: %s\n",
2670 spin_unlock_irqrestore(&priv_dev->lock, flags);
2685 struct cdns3_device *priv_dev;
2697 priv_dev = priv_ep->cdns3_dev;
2699 spin_lock_irqsave(&priv_dev->lock, flags);
2705 cdns3_select_ep(priv_dev, ep->desc->bEndpointAddress);
2729 writel(EP_CMD_DFLUSH, &priv_dev->regs->ep_cmd);
2732 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val,
2751 spin_unlock_irqrestore(&priv_dev->lock, flags);
2762 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
2767 u32 ep_sts_reg = readl(&priv_dev->regs->ep_sts);
2783 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
2803 writel(EP_CMD_CSTALL | EP_CMD_EPRST, &priv_dev->regs->ep_cmd);
2806 ret = readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val,
2820 cdns3_start_all_request(priv_dev, priv_ep);
2834 struct cdns3_device *priv_dev = priv_ep->cdns3_dev;
2841 spin_lock_irqsave(&priv_dev->lock, flags);
2843 cdns3_select_ep(priv_dev, ep->desc->bEndpointAddress);
2852 spin_unlock_irqrestore(&priv_dev->lock, flags);
2878 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
2880 return readl(&priv_dev->regs->usb_itpn);
2883 int __cdns3_gadget_wakeup(struct cdns3_device *priv_dev)
2887 speed = cdns3_get_speed(priv_dev);
2893 writel(USB_CONF_LGO_L0, &priv_dev->regs->usb_conf);
2900 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
2904 spin_lock_irqsave(&priv_dev->lock, flags);
2905 ret = __cdns3_gadget_wakeup(priv_dev);
2906 spin_unlock_irqrestore(&priv_dev->lock, flags);
2913 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
2916 spin_lock_irqsave(&priv_dev->lock, flags);
2917 priv_dev->is_selfpowered = !!is_selfpowered;
2918 spin_unlock_irqrestore(&priv_dev->lock, flags);
2924 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
2927 writel(USB_CONF_DEVEN, &priv_dev->regs->usb_conf);
2929 writel(~0, &priv_dev->regs->ep_ists);
2930 writel(~0, &priv_dev->regs->usb_ists);
2931 writel(USB_CONF_DEVDS, &priv_dev->regs->usb_conf);
2937 static void cdns3_gadget_config(struct cdns3_device *priv_dev)
2939 struct cdns3_usb_regs __iomem *regs = priv_dev->regs;
2942 cdns3_ep0_config(priv_dev);
2951 if (priv_dev->dev_ver == DEV_VER_TI_V1) {
2974 writel(PUSB_PWR_FST_REG_ACCESS, &priv_dev->regs->usb_pwr);
2976 cdns3_configure_dmult(priv_dev, NULL);
2989 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
2993 spin_lock_irqsave(&priv_dev->lock, flags);
2994 priv_dev->gadget_driver = driver;
3001 writel(USB_CONF_SFORCE_FS, &priv_dev->regs->usb_conf);
3002 writel(USB_CONF_USB3DIS, &priv_dev->regs->usb_conf);
3005 writel(USB_CONF_USB3DIS, &priv_dev->regs->usb_conf);
3010 dev_err(priv_dev->dev,
3020 cdns3_gadget_config(priv_dev);
3021 spin_unlock_irqrestore(&priv_dev->lock, flags);
3033 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
3039 priv_dev->gadget_driver = NULL;
3041 priv_dev->onchip_used_size = 0;
3042 priv_dev->out_mem_is_allocated = 0;
3043 priv_dev->gadget.speed = USB_SPEED_UNKNOWN;
3045 list_for_each_entry(ep, &priv_dev->gadget.ep_list, ep_list) {
3048 cdns3_select_ep(priv_dev, bEndpointAddress);
3049 writel(EP_CMD_EPRST, &priv_dev->regs->ep_cmd);
3050 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val,
3057 writel(0, &priv_dev->regs->usb_ien);
3058 writel(0, &priv_dev->regs->usb_pwr);
3059 writel(USB_CONF_DEVDS, &priv_dev->regs->usb_conf);
3076 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget);
3110 if (total > priv_dev->onchip_buffers)
3113 priv_dev->ep_buf_size = (priv_dev->onchip_buffers - 2 - iso) / (n_in + out);
3129 static void cdns3_free_all_eps(struct cdns3_device *priv_dev)
3134 priv_dev->eps[16] = NULL;
3137 if (priv_dev->eps[i]) {
3138 cdns3_free_trb_pool(priv_dev->eps[i]);
3139 devm_kfree(priv_dev->dev, priv_dev->eps[i]);
3145 * @priv_dev: extended gadget object
3149 static int cdns3_init_eps(struct cdns3_device *priv_dev)
3159 ep_enabled_reg = readl(&priv_dev->regs->usb_cap3);
3160 iso_ep_reg = readl(&priv_dev->regs->usb_cap4);
3162 dev_dbg(priv_dev->dev, "Initializing non-zero endpoints\n");
3173 priv_dev->eps[i] = priv_dev->eps[0];
3177 priv_ep = devm_kzalloc(priv_dev->dev, sizeof(*priv_ep),
3183 priv_ep->cdns3_dev = priv_dev;
3184 priv_dev->eps[i] = priv_ep;
3189 ret = cdns3_init_ep0(priv_dev, priv_ep);
3191 dev_err(priv_dev->dev, "Failed to init ep0\n");
3215 &priv_dev->gadget.ep_list);
3220 dev_dbg(priv_dev->dev, "Initialized %s support: %s %s\n",
3232 cdns3_free_all_eps(priv_dev);
3238 struct cdns3_device *priv_dev = container_of(dev,
3241 kfree(priv_dev);
3246 struct cdns3_device *priv_dev;
3248 priv_dev = cdns->gadget_dev;
3254 usb_del_gadget(&priv_dev->gadget);
3255 devm_free_irq(cdns->dev, cdns->dev_irq, priv_dev);
3257 cdns3_free_all_eps(priv_dev);
3259 while (!list_empty(&priv_dev->aligned_buf_list)) {
3262 buf = cdns3_next_align_buf(&priv_dev->aligned_buf_list);
3263 dma_free_noncoherent(priv_dev->sysdev, buf->size,
3272 dma_free_coherent(priv_dev->sysdev, 8, priv_dev->setup_buf,
3273 priv_dev->setup_dma);
3274 dma_pool_destroy(priv_dev->eps_dma_pool);
3276 kfree(priv_dev->zlp_buf);
3277 usb_put_gadget(&priv_dev->gadget);
3284 struct cdns3_device *priv_dev;
3288 priv_dev = kzalloc(sizeof(*priv_dev), GFP_KERNEL);
3289 if (!priv_dev)
3292 usb_initialize_gadget(cdns->dev, &priv_dev->gadget,
3294 cdns->gadget_dev = priv_dev;
3295 priv_dev->sysdev = cdns->dev;
3296 priv_dev->dev = cdns->dev;
3297 priv_dev->regs = cdns->dev_regs;
3299 device_property_read_u16(priv_dev->dev, "cdns,on-chip-buff-size",
3300 &priv_dev->onchip_buffers);
3302 if (priv_dev->onchip_buffers <= 0) {
3303 u32 reg = readl(&priv_dev->regs->usb_cap2);
3305 priv_dev->onchip_buffers = USB_CAP2_ACTUAL_MEM_SIZE(reg);
3308 if (!priv_dev->onchip_buffers)
3309 priv_dev->onchip_buffers = 256;
3330 priv_dev->gadget.max_speed = max_speed;
3331 priv_dev->gadget.speed = USB_SPEED_UNKNOWN;
3332 priv_dev->gadget.ops = &cdns3_gadget_ops;
3333 priv_dev->gadget.name = "usb-ss-gadget";
3334 priv_dev->gadget.quirk_avoids_skb_reserve = 1;
3335 priv_dev->gadget.irq = cdns->dev_irq;
3337 spin_lock_init(&priv_dev->lock);
3338 INIT_WORK(&priv_dev->pending_status_wq,
3341 INIT_WORK(&priv_dev->aligned_buf_wq,
3345 INIT_LIST_HEAD(&priv_dev->gadget.ep_list);
3346 INIT_LIST_HEAD(&priv_dev->aligned_buf_list);
3347 priv_dev->eps_dma_pool = dma_pool_create("cdns3_eps_dma_pool",
3348 priv_dev->sysdev,
3350 if (!priv_dev->eps_dma_pool) {
3351 dev_err(priv_dev->dev, "Failed to create TRB dma pool\n");
3356 ret = cdns3_init_eps(priv_dev);
3358 dev_err(priv_dev->dev, "Failed to create endpoints\n");
3363 priv_dev->setup_buf = dma_alloc_coherent(priv_dev->sysdev, 8,
3364 &priv_dev->setup_dma, GFP_DMA);
3365 if (!priv_dev->setup_buf) {
3370 priv_dev->dev_ver = readl(&priv_dev->regs->usb_cap6);
3372 dev_dbg(priv_dev->dev, "Device Controller version: %08x\n",
3373 readl(&priv_dev->regs->usb_cap6));
3374 dev_dbg(priv_dev->dev, "USB Capabilities:: %08x\n",
3375 readl(&priv_dev->regs->usb_cap1));
3376 dev_dbg(priv_dev->dev, "On-Chip memory configuration: %08x\n",
3377 readl(&priv_dev->regs->usb_cap2));
3379 priv_dev->dev_ver = GET_DEV_BASE_VERSION(priv_dev->dev_ver);
3380 if (priv_dev->dev_ver >= DEV_VER_V2)
3381 priv_dev->gadget.sg_supported = 1;
3383 priv_dev->zlp_buf = kzalloc(CDNS3_EP_ZLP_BUF_SIZE, GFP_KERNEL);
3384 if (!priv_dev->zlp_buf) {
3390 ret = usb_add_gadget(&priv_dev->gadget);
3392 dev_err(priv_dev->dev, "Failed to add gadget\n");
3398 kfree(priv_dev->zlp_buf);
3400 dma_free_coherent(priv_dev->sysdev, 8, priv_dev->setup_buf,
3401 priv_dev->setup_dma);
3403 cdns3_free_all_eps(priv_dev);
3405 dma_pool_destroy(priv_dev->eps_dma_pool);
3407 usb_put_gadget(&priv_dev->gadget);
3454 struct cdns3_device *priv_dev = cdns->gadget_dev;
3457 cdns3_disconnect_gadget(priv_dev);
3460 priv_dev->gadget.speed = USB_SPEED_UNKNOWN;
3461 usb_gadget_set_state(&priv_dev->gadget, USB_STATE_NOTATTACHED);
3462 cdns3_hw_reset_eps_config(priv_dev);
3465 writel(0, &priv_dev->regs->usb_ien);
3472 struct cdns3_device *priv_dev = cdns->gadget_dev;
3474 if (!priv_dev->gadget_driver)
3477 cdns3_gadget_config(priv_dev);
3479 writel(USB_CONF_DEVEN, &priv_dev->regs->usb_conf);