Lines Matching refs:priv_dev
113 static int cdns3_get_dma_pos(struct cdns3_device *priv_dev, in cdns3_get_dma_pos() argument
118 dma_index = readl(&priv_dev->regs->ep_traddr) - priv_ep->trb_pool_dma; in cdns3_get_dma_pos()
161 void cdns3_select_ep(struct cdns3_device *priv_dev, u32 ep) in cdns3_select_ep() argument
163 if (priv_dev->selected_ep == ep) in cdns3_select_ep()
166 priv_dev->selected_ep = ep; in cdns3_select_ep()
167 writel(ep, &priv_dev->regs->ep_sel); in cdns3_select_ep()
177 static int cdns3_get_tdl(struct cdns3_device *priv_dev) in cdns3_get_tdl() argument
179 if (priv_dev->dev_ver < DEV_VER_V3) in cdns3_get_tdl()
180 return EP_CMD_TDL_GET(readl(&priv_dev->regs->ep_cmd)); in cdns3_get_tdl()
182 return readl(&priv_dev->regs->ep_tdl); in cdns3_get_tdl()
210 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_free_trb_pool() local
213 dma_free_coherent(priv_dev->sysdev, in cdns3_free_trb_pool()
228 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_allocate_trb_pool() local
237 priv_ep->trb_pool = dma_alloc_coherent(priv_dev->sysdev, in cdns3_allocate_trb_pool()
278 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_ep_stall_flush() local
284 &priv_dev->regs->ep_cmd); in cdns3_ep_stall_flush()
287 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val, in cdns3_ep_stall_flush()
297 void cdns3_hw_reset_eps_config(struct cdns3_device *priv_dev) in cdns3_hw_reset_eps_config() argument
301 writel(USB_CONF_CFGRST, &priv_dev->regs->usb_conf); in cdns3_hw_reset_eps_config()
303 cdns3_allow_enable_l1(priv_dev, 0); in cdns3_hw_reset_eps_config()
304 priv_dev->hw_configured_flag = 0; in cdns3_hw_reset_eps_config()
305 priv_dev->onchip_used_size = 0; in cdns3_hw_reset_eps_config()
306 priv_dev->out_mem_is_allocated = 0; in cdns3_hw_reset_eps_config()
307 priv_dev->wait_for_setup = 0; in cdns3_hw_reset_eps_config()
308 priv_dev->using_streams = 0; in cdns3_hw_reset_eps_config()
311 if (priv_dev->eps[i]) in cdns3_hw_reset_eps_config()
312 priv_dev->eps[i]->flags &= ~EP_CONFIGURED; in cdns3_hw_reset_eps_config()
378 void cdns3_allow_enable_l1(struct cdns3_device *priv_dev, int enable) in cdns3_allow_enable_l1() argument
381 writel(USB_CONF_L1EN, &priv_dev->regs->usb_conf); in cdns3_allow_enable_l1()
383 writel(USB_CONF_L1DS, &priv_dev->regs->usb_conf); in cdns3_allow_enable_l1()
386 enum usb_device_speed cdns3_get_speed(struct cdns3_device *priv_dev) in cdns3_get_speed() argument
390 reg = readl(&priv_dev->regs->usb_sts); in cdns3_get_speed()
411 static int cdns3_start_all_request(struct cdns3_device *priv_dev, in cdns3_start_all_request() argument
431 dev_dbg(priv_dev->dev, "Blocking external request\n"); in cdns3_start_all_request()
465 #define cdns3_wa2_enable_detection(priv_dev, priv_ep, reg) do { \ argument
537 static struct usb_request *cdns3_wa2_gadget_giveback(struct cdns3_device *priv_dev, in cdns3_wa2_gadget_giveback() argument
553 usb_gadget_unmap_request_by_dev(priv_dev->sysdev, req, in cdns3_wa2_gadget_giveback()
561 usb_gadget_map_request_by_dev(priv_dev->sysdev, req, in cdns3_wa2_gadget_giveback()
570 cdns3_start_all_request(priv_dev, priv_ep); in cdns3_wa2_gadget_giveback()
577 static int cdns3_wa2_gadget_ep_queue(struct cdns3_device *priv_dev, in cdns3_wa2_gadget_ep_queue() argument
591 cdns3_select_ep(priv_dev, priv_ep->num | priv_ep->dir); in cdns3_wa2_gadget_ep_queue()
593 reg = readl(&priv_dev->regs->ep_sts_en); in cdns3_wa2_gadget_ep_queue()
596 writel(reg, &priv_dev->regs->ep_sts_en); in cdns3_wa2_gadget_ep_queue()
739 static void cdns3_wa2_reset_tdl(struct cdns3_device *priv_dev) in cdns3_wa2_reset_tdl() argument
741 u16 tdl = EP_CMD_TDL_GET(readl(&priv_dev->regs->ep_cmd)); in cdns3_wa2_reset_tdl()
747 &priv_dev->regs->ep_cmd); in cdns3_wa2_reset_tdl()
751 static void cdns3_wa2_check_outq_status(struct cdns3_device *priv_dev) in cdns3_wa2_check_outq_status() argument
756 cdns3_select_ep(priv_dev, 0); in cdns3_wa2_check_outq_status()
758 ep_sts_reg = readl(&priv_dev->regs->ep_sts); in cdns3_wa2_check_outq_status()
762 struct cdns3_endpoint *outq_ep = priv_dev->eps[outq_ep_num]; in cdns3_wa2_check_outq_status()
775 cdns3_select_ep(priv_dev, outq_ep->num | in cdns3_wa2_check_outq_status()
777 ep_sts_en_reg = readl(&priv_dev->regs->ep_sts_en); in cdns3_wa2_check_outq_status()
778 ep_cmd_reg = readl(&priv_dev->regs->ep_cmd); in cdns3_wa2_check_outq_status()
781 cdns3_set_register_bit(&priv_dev->regs->ep_cfg, in cdns3_wa2_check_outq_status()
784 cdns3_wa2_enable_detection(priv_dev, outq_ep, in cdns3_wa2_check_outq_status()
787 &priv_dev->regs->ep_sts_en); in cdns3_wa2_check_outq_status()
789 cdns3_wa2_reset_tdl(priv_dev); in cdns3_wa2_check_outq_status()
804 &priv_dev->regs->ep_cmd); in cdns3_wa2_check_outq_status()
825 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_gadget_giveback() local
833 usb_gadget_unmap_request_by_dev(priv_dev->sysdev, request, in cdns3_gadget_giveback()
846 if (priv_dev->dev_ver < DEV_VER_V2) { in cdns3_gadget_giveback()
847 request = cdns3_wa2_gadget_giveback(priv_dev, priv_ep, in cdns3_gadget_giveback()
854 spin_unlock(&priv_dev->lock); in cdns3_gadget_giveback()
857 spin_lock(&priv_dev->lock); in cdns3_gadget_giveback()
860 if (request->buf == priv_dev->zlp_buf) in cdns3_gadget_giveback()
884 struct cdns3_device *priv_dev = container_of(work, struct cdns3_device, in cdns3_free_aligned_request_buf() local
889 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_free_aligned_request_buf()
891 list_for_each_entry_safe(buf, tmp, &priv_dev->aligned_buf_list, list) { in cdns3_free_aligned_request_buf()
900 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_free_aligned_request_buf()
901 dma_free_coherent(priv_dev->sysdev, buf->size, in cdns3_free_aligned_request_buf()
904 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_free_aligned_request_buf()
908 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_free_aligned_request_buf()
914 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_prepare_aligned_request_buf() local
930 buf->buf = dma_alloc_coherent(priv_dev->sysdev, in cdns3_prepare_aligned_request_buf()
943 &priv_dev->aligned_buf_wq); in cdns3_prepare_aligned_request_buf()
950 &priv_dev->aligned_buf_list); in cdns3_prepare_aligned_request_buf()
967 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_wa1_update_guard() local
972 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY); in cdns3_wa1_update_guard()
986 static void cdns3_wa1_tray_restore_cycle_bit(struct cdns3_device *priv_dev, in cdns3_wa1_tray_restore_cycle_bit() argument
992 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY); in cdns3_wa1_tray_restore_cycle_bit()
993 dma_index = cdns3_get_dma_pos(priv_dev, priv_ep); in cdns3_wa1_tray_restore_cycle_bit()
1002 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_ep_run_stream_transfer() local
1051 if (priv_dev->dev_ver >= DEV_VER_V2) { in cdns3_ep_run_stream_transfer()
1052 if (priv_dev->gadget.speed == USB_SPEED_SUPER) in cdns3_ep_run_stream_transfer()
1069 &priv_dev->regs->ep_traddr); in cdns3_ep_run_stream_transfer()
1074 writel(EP_STS_TRBERR | EP_STS_DESCMIS, &priv_dev->regs->ep_sts); in cdns3_ep_run_stream_transfer()
1083 if (priv_dev->dev_ver < DEV_VER_V2) in cdns3_ep_run_stream_transfer()
1085 &priv_dev->regs->ep_cmd); in cdns3_ep_run_stream_transfer()
1086 else if (priv_dev->dev_ver > DEV_VER_V2) in cdns3_ep_run_stream_transfer()
1087 writel(tdl, &priv_dev->regs->ep_tdl); in cdns3_ep_run_stream_transfer()
1090 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd); in cdns3_ep_run_stream_transfer()
1092 EP_CMD_ERDY, &priv_dev->regs->ep_cmd); in cdns3_ep_run_stream_transfer()
1095 readl(&priv_dev->regs->ep_traddr)); in cdns3_ep_run_stream_transfer()
1099 __cdns3_gadget_wakeup(priv_dev); in cdns3_ep_run_stream_transfer()
1114 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_ep_run_transfer() local
1161 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY); in cdns3_ep_run_transfer()
1162 dma_index = cdns3_get_dma_pos(priv_dev, priv_ep); in cdns3_ep_run_transfer()
1188 if (priv_dev->dev_ver <= DEV_VER_V2) in cdns3_ep_run_transfer()
1197 if (priv_dev->dev_ver >= DEV_VER_V2) { in cdns3_ep_run_transfer()
1202 if (priv_dev->gadget.speed == USB_SPEED_SUPER) in cdns3_ep_run_transfer()
1274 if (priv_dev->dev_ver < DEV_VER_V2 && in cdns3_ep_run_transfer()
1277 u16 old_tdl = EP_CMD_TDL_GET(readl(&priv_dev->regs->ep_cmd)); in cdns3_ep_run_transfer()
1287 &priv_dev->regs->ep_cmd); in cdns3_ep_run_transfer()
1300 if (priv_dev->dev_ver <= DEV_VER_V2) in cdns3_ep_run_transfer()
1301 cdns3_wa1_tray_restore_cycle_bit(priv_dev, priv_ep); in cdns3_ep_run_transfer()
1339 cdns3_set_register_bit(&priv_dev->regs->ep_cfg, in cdns3_ep_run_transfer()
1345 &priv_dev->regs->ep_traddr); in cdns3_ep_run_transfer()
1353 writel(EP_STS_TRBERR | EP_STS_DESCMIS, &priv_dev->regs->ep_sts); in cdns3_ep_run_transfer()
1354 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd); in cdns3_ep_run_transfer()
1356 readl(&priv_dev->regs->ep_traddr)); in cdns3_ep_run_transfer()
1360 __cdns3_gadget_wakeup(priv_dev); in cdns3_ep_run_transfer()
1365 void cdns3_set_hw_configuration(struct cdns3_device *priv_dev) in cdns3_set_hw_configuration() argument
1370 if (priv_dev->hw_configured_flag) in cdns3_set_hw_configuration()
1373 writel(USB_CONF_CFGSET, &priv_dev->regs->usb_conf); in cdns3_set_hw_configuration()
1375 cdns3_set_register_bit(&priv_dev->regs->usb_conf, in cdns3_set_hw_configuration()
1378 priv_dev->hw_configured_flag = 1; in cdns3_set_hw_configuration()
1380 list_for_each_entry(ep, &priv_dev->gadget.ep_list, ep_list) { in cdns3_set_hw_configuration()
1383 cdns3_start_all_request(priv_dev, priv_ep); in cdns3_set_hw_configuration()
1387 cdns3_allow_enable_l1(priv_dev, 1); in cdns3_set_hw_configuration()
1432 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_trb_handled() local
1438 current_index = cdns3_get_dma_pos(priv_dev, priv_ep); in cdns3_trb_handled()
1439 doorbell = !!(readl(&priv_dev->regs->ep_cmd) & EP_CMD_DRDY); in cdns3_trb_handled()
1492 static void cdns3_transfer_completed(struct cdns3_device *priv_dev, in cdns3_transfer_completed() argument
1517 cdns3_select_ep(priv_dev, priv_ep->endpoint.address); in cdns3_transfer_completed()
1553 cdns3_select_ep(priv_dev, priv_ep->endpoint.address); in cdns3_transfer_completed()
1559 dev_warn(priv_dev->dev, in cdns3_transfer_completed()
1581 cdns3_start_all_request(priv_dev, priv_ep); in cdns3_transfer_completed()
1586 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_rearm_transfer() local
1595 writel(EP_CMD_DRDY, &priv_dev->regs->ep_cmd); in cdns3_rearm_transfer()
1597 __cdns3_gadget_wakeup(priv_dev); in cdns3_rearm_transfer()
1600 readl(&priv_dev->regs->ep_traddr)); in cdns3_rearm_transfer()
1607 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_reprogram_tdl() local
1616 writel(EP_CMD_TDL_SET(tdl) | EP_CMD_STDL, &priv_dev->regs->ep_cmd); in cdns3_reprogram_tdl()
1627 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_check_ep_interrupt_proceed() local
1633 cdns3_select_ep(priv_dev, priv_ep->endpoint.address); in cdns3_check_ep_interrupt_proceed()
1635 trace_cdns3_epx_irq(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1637 ep_sts_reg = readl(&priv_dev->regs->ep_sts); in cdns3_check_ep_interrupt_proceed()
1638 writel(ep_sts_reg, &priv_dev->regs->ep_sts); in cdns3_check_ep_interrupt_proceed()
1643 tdl = cdns3_get_tdl(priv_dev); in cdns3_check_ep_interrupt_proceed()
1656 &priv_dev->regs->ep_cmd); in cdns3_check_ep_interrupt_proceed()
1665 cdns3_start_all_request(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1673 priv_dev->dev_ver < DEV_VER_V2)) { in cdns3_check_ep_interrupt_proceed()
1687 u32 ep_cfg = readl(&priv_dev->regs->ep_cfg); in cdns3_check_ep_interrupt_proceed()
1690 writel(ep_cfg, &priv_dev->regs->ep_cfg); in cdns3_check_ep_interrupt_proceed()
1693 cdns3_transfer_completed(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1698 cdns3_start_all_request(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1718 cdns3_transfer_completed(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1727 cdns3_transfer_completed(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1738 cdns3_transfer_completed(priv_dev, priv_ep); in cdns3_check_ep_interrupt_proceed()
1747 if (ep_sts_reg & EP_STS_DESCMIS && priv_dev->dev_ver < DEV_VER_V2 && in cdns3_check_ep_interrupt_proceed()
1754 static void cdns3_disconnect_gadget(struct cdns3_device *priv_dev) in cdns3_disconnect_gadget() argument
1756 if (priv_dev->gadget_driver && priv_dev->gadget_driver->disconnect) in cdns3_disconnect_gadget()
1757 priv_dev->gadget_driver->disconnect(&priv_dev->gadget); in cdns3_disconnect_gadget()
1766 static void cdns3_check_usb_interrupt_proceed(struct cdns3_device *priv_dev, in cdns3_check_usb_interrupt_proceed() argument
1768 __must_hold(&priv_dev->lock) in cdns3_check_usb_interrupt_proceed()
1772 trace_cdns3_usb_irq(priv_dev, usb_ists); in cdns3_check_usb_interrupt_proceed()
1779 if (readl(&priv_dev->regs->drbl)) in cdns3_check_usb_interrupt_proceed()
1780 __cdns3_gadget_wakeup(priv_dev); in cdns3_check_usb_interrupt_proceed()
1785 speed = cdns3_get_speed(priv_dev); in cdns3_check_usb_interrupt_proceed()
1786 priv_dev->gadget.speed = speed; in cdns3_check_usb_interrupt_proceed()
1787 usb_gadget_set_state(&priv_dev->gadget, USB_STATE_POWERED); in cdns3_check_usb_interrupt_proceed()
1788 cdns3_ep0_config(priv_dev); in cdns3_check_usb_interrupt_proceed()
1793 spin_unlock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1794 cdns3_disconnect_gadget(priv_dev); in cdns3_check_usb_interrupt_proceed()
1795 spin_lock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1796 priv_dev->gadget.speed = USB_SPEED_UNKNOWN; in cdns3_check_usb_interrupt_proceed()
1797 usb_gadget_set_state(&priv_dev->gadget, USB_STATE_NOTATTACHED); in cdns3_check_usb_interrupt_proceed()
1798 cdns3_hw_reset_eps_config(priv_dev); in cdns3_check_usb_interrupt_proceed()
1802 if (priv_dev->gadget_driver && in cdns3_check_usb_interrupt_proceed()
1803 priv_dev->gadget_driver->suspend) { in cdns3_check_usb_interrupt_proceed()
1804 spin_unlock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1805 priv_dev->gadget_driver->suspend(&priv_dev->gadget); in cdns3_check_usb_interrupt_proceed()
1806 spin_lock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1811 if (priv_dev->gadget_driver && in cdns3_check_usb_interrupt_proceed()
1812 priv_dev->gadget_driver->resume) { in cdns3_check_usb_interrupt_proceed()
1813 spin_unlock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1814 priv_dev->gadget_driver->resume(&priv_dev->gadget); in cdns3_check_usb_interrupt_proceed()
1815 spin_lock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1821 if (priv_dev->gadget_driver) { in cdns3_check_usb_interrupt_proceed()
1822 spin_unlock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1823 usb_gadget_udc_reset(&priv_dev->gadget, in cdns3_check_usb_interrupt_proceed()
1824 priv_dev->gadget_driver); in cdns3_check_usb_interrupt_proceed()
1825 spin_lock(&priv_dev->lock); in cdns3_check_usb_interrupt_proceed()
1828 speed = cdns3_get_speed(priv_dev); in cdns3_check_usb_interrupt_proceed()
1829 priv_dev->gadget.speed = speed; in cdns3_check_usb_interrupt_proceed()
1830 cdns3_hw_reset_eps_config(priv_dev); in cdns3_check_usb_interrupt_proceed()
1831 cdns3_ep0_config(priv_dev); in cdns3_check_usb_interrupt_proceed()
1846 struct cdns3_device *priv_dev = data; in cdns3_device_irq_handler() local
1847 struct cdns3 *cdns = dev_get_drvdata(priv_dev->dev); in cdns3_device_irq_handler()
1855 reg = readl(&priv_dev->regs->usb_ists); in cdns3_device_irq_handler()
1864 reg = ~reg & readl(&priv_dev->regs->usb_ien); in cdns3_device_irq_handler()
1866 writel(reg, &priv_dev->regs->usb_ien); in cdns3_device_irq_handler()
1871 reg = readl(&priv_dev->regs->ep_ists); in cdns3_device_irq_handler()
1873 writel(0, &priv_dev->regs->ep_ien); in cdns3_device_irq_handler()
1891 struct cdns3_device *priv_dev = data; in cdns3_device_thread_irq_handler() local
1897 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_device_thread_irq_handler()
1899 reg = readl(&priv_dev->regs->usb_ists); in cdns3_device_thread_irq_handler()
1901 writel(reg, &priv_dev->regs->usb_ists); in cdns3_device_thread_irq_handler()
1902 writel(USB_IEN_INIT, &priv_dev->regs->usb_ien); in cdns3_device_thread_irq_handler()
1903 cdns3_check_usb_interrupt_proceed(priv_dev, reg); in cdns3_device_thread_irq_handler()
1907 reg = readl(&priv_dev->regs->ep_ists); in cdns3_device_thread_irq_handler()
1911 cdns3_check_ep0_interrupt_proceed(priv_dev, USB_DIR_OUT); in cdns3_device_thread_irq_handler()
1917 cdns3_check_ep0_interrupt_proceed(priv_dev, USB_DIR_IN); in cdns3_device_thread_irq_handler()
1928 cdns3_check_ep_interrupt_proceed(priv_dev->eps[bit]); in cdns3_device_thread_irq_handler()
1932 if (priv_dev->dev_ver < DEV_VER_V2 && priv_dev->using_streams) in cdns3_device_thread_irq_handler()
1933 cdns3_wa2_check_outq_status(priv_dev); in cdns3_device_thread_irq_handler()
1936 writel(~0, &priv_dev->regs->ep_ien); in cdns3_device_thread_irq_handler()
1937 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_device_thread_irq_handler()
1954 static int cdns3_ep_onchip_buffer_reserve(struct cdns3_device *priv_dev, in cdns3_ep_onchip_buffer_reserve() argument
1960 remained = priv_dev->onchip_buffers - priv_dev->onchip_used_size - 2; in cdns3_ep_onchip_buffer_reserve()
1966 priv_dev->onchip_used_size += size; in cdns3_ep_onchip_buffer_reserve()
1974 if (priv_dev->out_mem_is_allocated >= size) in cdns3_ep_onchip_buffer_reserve()
1977 required = size - priv_dev->out_mem_is_allocated; in cdns3_ep_onchip_buffer_reserve()
1982 priv_dev->out_mem_is_allocated += required; in cdns3_ep_onchip_buffer_reserve()
1983 priv_dev->onchip_used_size += required; in cdns3_ep_onchip_buffer_reserve()
1989 static void cdns3_configure_dmult(struct cdns3_device *priv_dev, in cdns3_configure_dmult() argument
1992 struct cdns3_usb_regs __iomem *regs = priv_dev->regs; in cdns3_configure_dmult()
1995 if (priv_dev->dev_ver <= DEV_VER_V2) in cdns3_configure_dmult()
1998 if (priv_dev->dev_ver == DEV_VER_V2) in cdns3_configure_dmult()
2001 if (priv_dev->dev_ver >= DEV_VER_V3 && priv_ep) { in cdns3_configure_dmult()
2031 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_ep_config() local
2042 cdns3_configure_dmult(priv_dev, priv_ep); in cdns3_ep_config()
2048 if ((priv_dev->dev_ver == DEV_VER_V2 && !priv_ep->dir) || in cdns3_ep_config()
2049 priv_dev->dev_ver > DEV_VER_V2) in cdns3_ep_config()
2055 if ((priv_dev->dev_ver == DEV_VER_V2 && !priv_ep->dir) || in cdns3_ep_config()
2056 priv_dev->dev_ver > DEV_VER_V2) in cdns3_ep_config()
2065 switch (priv_dev->gadget.speed) { in cdns3_ep_config()
2100 if (!priv_dev->hw_configured_flag) { in cdns3_ep_config()
2101 ret = cdns3_ep_onchip_buffer_reserve(priv_dev, buffering + 1, in cdns3_ep_config()
2104 dev_err(priv_dev->dev, "onchip mem is full, ep is invalid\n"); in cdns3_ep_config()
2112 if (priv_ep->use_streams && priv_dev->gadget.speed >= USB_SPEED_SUPER) { in cdns3_ep_config()
2113 if (priv_dev->dev_ver >= DEV_VER_V3) { in cdns3_ep_config()
2120 cdns3_clear_register_bit(&priv_dev->regs->tdl_from_trb, in cdns3_ep_config()
2133 cdns3_select_ep(priv_dev, bEndpointAddress); in cdns3_ep_config()
2134 writel(ep_cfg, &priv_dev->regs->ep_cfg); in cdns3_ep_config()
2137 dev_dbg(priv_dev->dev, "Configure %s: with val %08x\n", in cdns3_ep_config()
2152 cdns3_endpoint *cdns3_find_available_ep(struct cdns3_device *priv_dev, in cdns3_find_available_ep() argument
2158 list_for_each_entry(ep, &priv_dev->gadget.ep_list, ep_list) { in cdns3_find_available_ep()
2201 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_match_ep() local
2205 priv_ep = cdns3_find_available_ep(priv_dev, desc); in cdns3_gadget_match_ep()
2207 dev_err(priv_dev->dev, "no available ep\n"); in cdns3_gadget_match_ep()
2211 dev_dbg(priv_dev->dev, "match endpoint: %s\n", priv_ep->name); in cdns3_gadget_match_ep()
2213 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_match_ep()
2220 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_match_ep()
2275 struct cdns3_device *priv_dev; in cdns3_gadget_ep_enable() local
2285 priv_dev = priv_ep->cdns3_dev; in cdns3_gadget_ep_enable()
2289 dev_dbg(priv_dev->dev, "usbss: invalid parameters\n"); in cdns3_gadget_ep_enable()
2294 dev_err(priv_dev->dev, "usbss: missing wMaxPacketSize\n"); in cdns3_gadget_ep_enable()
2298 if (dev_WARN_ONCE(priv_dev->dev, priv_ep->flags & EP_ENABLED, in cdns3_gadget_ep_enable()
2302 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_ep_enable()
2310 dev_err(priv_dev->dev, "Driver is limited to %d period\n", in cdns3_gadget_ep_enable()
2318 cdns3_select_ep(priv_dev, bEndpointAddress); in cdns3_gadget_ep_enable()
2336 if (priv_dev->gadget.speed >= USB_SPEED_SUPER) { in cdns3_gadget_ep_enable()
2342 priv_dev->using_streams |= true; in cdns3_gadget_ep_enable()
2356 cdns3_select_ep(priv_dev, bEndpointAddress); in cdns3_gadget_ep_enable()
2360 writel(EP_CMD_EPRST, &priv_dev->regs->ep_cmd); in cdns3_gadget_ep_enable()
2362 ret = readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val, in cdns3_gadget_ep_enable()
2373 cdns3_set_register_bit(&priv_dev->regs->ep_ien, in cdns3_gadget_ep_enable()
2376 if (priv_dev->dev_ver < DEV_VER_V2) in cdns3_gadget_ep_enable()
2377 cdns3_wa2_enable_detection(priv_dev, priv_ep, reg); in cdns3_gadget_ep_enable()
2379 writel(reg, &priv_dev->regs->ep_sts_en); in cdns3_gadget_ep_enable()
2388 reg = readl(&priv_dev->regs->ep_sts); in cdns3_gadget_ep_enable()
2394 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_ep_enable()
2409 struct cdns3_device *priv_dev; in cdns3_gadget_ep_disable() local
2422 priv_dev = priv_ep->cdns3_dev; in cdns3_gadget_ep_disable()
2424 if (dev_WARN_ONCE(priv_dev->dev, !(priv_ep->flags & EP_ENABLED), in cdns3_gadget_ep_disable()
2428 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_ep_disable()
2432 cdns3_select_ep(priv_dev, ep->desc->bEndpointAddress); in cdns3_gadget_ep_disable()
2434 ep_cfg = readl(&priv_dev->regs->ep_cfg); in cdns3_gadget_ep_disable()
2436 writel(ep_cfg, &priv_dev->regs->ep_cfg); in cdns3_gadget_ep_disable()
2443 readl_poll_timeout_atomic(&priv_dev->regs->ep_sts, val, in cdns3_gadget_ep_disable()
2445 writel(EP_CMD_EPRST, &priv_dev->regs->ep_cmd); in cdns3_gadget_ep_disable()
2447 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val, in cdns3_gadget_ep_disable()
2451 dev_err(priv_dev->dev, "Timeout: %s resetting failed.\n", in cdns3_gadget_ep_disable()
2484 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_ep_disable()
2502 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in __cdns3_gadget_ep_queue() local
2511 if (priv_dev->dev_ver < DEV_VER_V2) { in __cdns3_gadget_ep_queue()
2512 ret = cdns3_wa2_gadget_ep_queue(priv_dev, priv_ep, in __cdns3_gadget_ep_queue()
2523 ret = usb_gadget_map_request_by_dev(priv_dev->sysdev, request, in __cdns3_gadget_ep_queue()
2538 if (priv_dev->hw_configured_flag && in __cdns3_gadget_ep_queue()
2541 cdns3_start_all_request(priv_dev, priv_ep); in __cdns3_gadget_ep_queue()
2543 if (priv_dev->hw_configured_flag && priv_ep->prime_flag) in __cdns3_gadget_ep_queue()
2544 cdns3_start_all_request(priv_dev, priv_ep); in __cdns3_gadget_ep_queue()
2555 struct cdns3_device *priv_dev; in cdns3_gadget_ep_queue() local
2563 priv_dev = priv_ep->cdns3_dev; in cdns3_gadget_ep_queue()
2565 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_ep_queue()
2574 zlp_request->buf = priv_dev->zlp_buf; in cdns3_gadget_ep_queue()
2580 dev_dbg(priv_dev->dev, "Queuing ZLP for endpoint: %s\n", in cdns3_gadget_ep_queue()
2585 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_ep_queue()
2600 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_gadget_ep_dequeue() local
2611 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_ep_dequeue()
2617 cdns3_select_ep(priv_dev, ep->desc->bEndpointAddress); in cdns3_gadget_ep_dequeue()
2652 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_ep_dequeue()
2663 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in __cdns3_gadget_ep_set_halt() local
2668 u32 ep_sts_reg = readl(&priv_dev->regs->ep_sts); in __cdns3_gadget_ep_set_halt()
2684 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in __cdns3_gadget_ep_clear_halt() local
2701 writel(EP_CMD_CSTALL | EP_CMD_EPRST, &priv_dev->regs->ep_cmd); in __cdns3_gadget_ep_clear_halt()
2704 ret = readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val, in __cdns3_gadget_ep_clear_halt()
2718 cdns3_start_all_request(priv_dev, priv_ep); in __cdns3_gadget_ep_clear_halt()
2732 struct cdns3_device *priv_dev = priv_ep->cdns3_dev; in cdns3_gadget_ep_set_halt() local
2739 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_ep_set_halt()
2741 cdns3_select_ep(priv_dev, ep->desc->bEndpointAddress); in cdns3_gadget_ep_set_halt()
2750 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_ep_set_halt()
2776 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_get_frame() local
2778 return readl(&priv_dev->regs->usb_itpn); in cdns3_gadget_get_frame()
2781 int __cdns3_gadget_wakeup(struct cdns3_device *priv_dev) in __cdns3_gadget_wakeup() argument
2785 speed = cdns3_get_speed(priv_dev); in __cdns3_gadget_wakeup()
2791 writel(USB_CONF_LGO_L0, &priv_dev->regs->usb_conf); in __cdns3_gadget_wakeup()
2798 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_wakeup() local
2802 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_wakeup()
2803 ret = __cdns3_gadget_wakeup(priv_dev); in cdns3_gadget_wakeup()
2804 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_wakeup()
2811 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_set_selfpowered() local
2814 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_set_selfpowered()
2815 priv_dev->is_selfpowered = !!is_selfpowered; in cdns3_gadget_set_selfpowered()
2816 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_set_selfpowered()
2822 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_pullup() local
2825 writel(USB_CONF_DEVEN, &priv_dev->regs->usb_conf); in cdns3_gadget_pullup()
2827 writel(~0, &priv_dev->regs->ep_ists); in cdns3_gadget_pullup()
2828 writel(~0, &priv_dev->regs->usb_ists); in cdns3_gadget_pullup()
2829 writel(USB_CONF_DEVDS, &priv_dev->regs->usb_conf); in cdns3_gadget_pullup()
2835 static void cdns3_gadget_config(struct cdns3_device *priv_dev) in cdns3_gadget_config() argument
2837 struct cdns3_usb_regs __iomem *regs = priv_dev->regs; in cdns3_gadget_config()
2840 cdns3_ep0_config(priv_dev); in cdns3_gadget_config()
2849 if (priv_dev->dev_ver == DEV_VER_TI_V1) { in cdns3_gadget_config()
2872 writel(PUSB_PWR_FST_REG_ACCESS, &priv_dev->regs->usb_pwr); in cdns3_gadget_config()
2874 cdns3_configure_dmult(priv_dev, NULL); in cdns3_gadget_config()
2887 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_udc_start() local
2891 spin_lock_irqsave(&priv_dev->lock, flags); in cdns3_gadget_udc_start()
2892 priv_dev->gadget_driver = driver; in cdns3_gadget_udc_start()
2899 writel(USB_CONF_SFORCE_FS, &priv_dev->regs->usb_conf); in cdns3_gadget_udc_start()
2900 writel(USB_CONF_USB3DIS, &priv_dev->regs->usb_conf); in cdns3_gadget_udc_start()
2903 writel(USB_CONF_USB3DIS, &priv_dev->regs->usb_conf); in cdns3_gadget_udc_start()
2908 dev_err(priv_dev->dev, in cdns3_gadget_udc_start()
2918 cdns3_gadget_config(priv_dev); in cdns3_gadget_udc_start()
2919 spin_unlock_irqrestore(&priv_dev->lock, flags); in cdns3_gadget_udc_start()
2931 struct cdns3_device *priv_dev = gadget_to_cdns3_device(gadget); in cdns3_gadget_udc_stop() local
2937 priv_dev->gadget_driver = NULL; in cdns3_gadget_udc_stop()
2939 priv_dev->onchip_used_size = 0; in cdns3_gadget_udc_stop()
2940 priv_dev->out_mem_is_allocated = 0; in cdns3_gadget_udc_stop()
2941 priv_dev->gadget.speed = USB_SPEED_UNKNOWN; in cdns3_gadget_udc_stop()
2943 list_for_each_entry(ep, &priv_dev->gadget.ep_list, ep_list) { in cdns3_gadget_udc_stop()
2946 cdns3_select_ep(priv_dev, bEndpointAddress); in cdns3_gadget_udc_stop()
2947 writel(EP_CMD_EPRST, &priv_dev->regs->ep_cmd); in cdns3_gadget_udc_stop()
2948 readl_poll_timeout_atomic(&priv_dev->regs->ep_cmd, val, in cdns3_gadget_udc_stop()
2955 writel(0, &priv_dev->regs->usb_ien); in cdns3_gadget_udc_stop()
2956 writel(0, &priv_dev->regs->usb_pwr); in cdns3_gadget_udc_stop()
2957 writel(USB_CONF_DEVDS, &priv_dev->regs->usb_conf); in cdns3_gadget_udc_stop()
2972 static void cdns3_free_all_eps(struct cdns3_device *priv_dev) in cdns3_free_all_eps() argument
2977 priv_dev->eps[16] = NULL; in cdns3_free_all_eps()
2980 if (priv_dev->eps[i]) { in cdns3_free_all_eps()
2981 cdns3_free_trb_pool(priv_dev->eps[i]); in cdns3_free_all_eps()
2982 devm_kfree(priv_dev->dev, priv_dev->eps[i]); in cdns3_free_all_eps()
2992 static int cdns3_init_eps(struct cdns3_device *priv_dev) in cdns3_init_eps() argument
3002 ep_enabled_reg = readl(&priv_dev->regs->usb_cap3); in cdns3_init_eps()
3003 iso_ep_reg = readl(&priv_dev->regs->usb_cap4); in cdns3_init_eps()
3005 dev_dbg(priv_dev->dev, "Initializing non-zero endpoints\n"); in cdns3_init_eps()
3016 priv_dev->eps[i] = priv_dev->eps[0]; in cdns3_init_eps()
3020 priv_ep = devm_kzalloc(priv_dev->dev, sizeof(*priv_ep), in cdns3_init_eps()
3026 priv_ep->cdns3_dev = priv_dev; in cdns3_init_eps()
3027 priv_dev->eps[i] = priv_ep; in cdns3_init_eps()
3032 ret = cdns3_init_ep0(priv_dev, priv_ep); in cdns3_init_eps()
3034 dev_err(priv_dev->dev, "Failed to init ep0\n"); in cdns3_init_eps()
3058 &priv_dev->gadget.ep_list); in cdns3_init_eps()
3063 dev_dbg(priv_dev->dev, "Initialized %s support: %s %s\n", in cdns3_init_eps()
3075 cdns3_free_all_eps(priv_dev); in cdns3_init_eps()
3081 struct cdns3_device *priv_dev = container_of(dev, in cdns3_gadget_release() local
3084 kfree(priv_dev); in cdns3_gadget_release()
3089 struct cdns3_device *priv_dev; in cdns3_gadget_exit() local
3091 priv_dev = cdns->gadget_dev; in cdns3_gadget_exit()
3097 usb_del_gadget(&priv_dev->gadget); in cdns3_gadget_exit()
3098 devm_free_irq(cdns->dev, cdns->dev_irq, priv_dev); in cdns3_gadget_exit()
3100 cdns3_free_all_eps(priv_dev); in cdns3_gadget_exit()
3102 while (!list_empty(&priv_dev->aligned_buf_list)) { in cdns3_gadget_exit()
3105 buf = cdns3_next_align_buf(&priv_dev->aligned_buf_list); in cdns3_gadget_exit()
3106 dma_free_coherent(priv_dev->sysdev, buf->size, in cdns3_gadget_exit()
3114 dma_free_coherent(priv_dev->sysdev, 8, priv_dev->setup_buf, in cdns3_gadget_exit()
3115 priv_dev->setup_dma); in cdns3_gadget_exit()
3117 kfree(priv_dev->zlp_buf); in cdns3_gadget_exit()
3118 usb_put_gadget(&priv_dev->gadget); in cdns3_gadget_exit()
3125 struct cdns3_device *priv_dev; in cdns3_gadget_start() local
3129 priv_dev = kzalloc(sizeof(*priv_dev), GFP_KERNEL); in cdns3_gadget_start()
3130 if (!priv_dev) in cdns3_gadget_start()
3133 usb_initialize_gadget(cdns->dev, &priv_dev->gadget, in cdns3_gadget_start()
3135 cdns->gadget_dev = priv_dev; in cdns3_gadget_start()
3136 priv_dev->sysdev = cdns->dev; in cdns3_gadget_start()
3137 priv_dev->dev = cdns->dev; in cdns3_gadget_start()
3138 priv_dev->regs = cdns->dev_regs; in cdns3_gadget_start()
3140 device_property_read_u16(priv_dev->dev, "cdns,on-chip-buff-size", in cdns3_gadget_start()
3141 &priv_dev->onchip_buffers); in cdns3_gadget_start()
3143 if (priv_dev->onchip_buffers <= 0) { in cdns3_gadget_start()
3144 u32 reg = readl(&priv_dev->regs->usb_cap2); in cdns3_gadget_start()
3146 priv_dev->onchip_buffers = USB_CAP2_ACTUAL_MEM_SIZE(reg); in cdns3_gadget_start()
3149 if (!priv_dev->onchip_buffers) in cdns3_gadget_start()
3150 priv_dev->onchip_buffers = 256; in cdns3_gadget_start()
3171 priv_dev->gadget.max_speed = max_speed; in cdns3_gadget_start()
3172 priv_dev->gadget.speed = USB_SPEED_UNKNOWN; in cdns3_gadget_start()
3173 priv_dev->gadget.ops = &cdns3_gadget_ops; in cdns3_gadget_start()
3174 priv_dev->gadget.name = "usb-ss-gadget"; in cdns3_gadget_start()
3175 priv_dev->gadget.quirk_avoids_skb_reserve = 1; in cdns3_gadget_start()
3176 priv_dev->gadget.irq = cdns->dev_irq; in cdns3_gadget_start()
3178 spin_lock_init(&priv_dev->lock); in cdns3_gadget_start()
3179 INIT_WORK(&priv_dev->pending_status_wq, in cdns3_gadget_start()
3182 INIT_WORK(&priv_dev->aligned_buf_wq, in cdns3_gadget_start()
3186 INIT_LIST_HEAD(&priv_dev->gadget.ep_list); in cdns3_gadget_start()
3187 INIT_LIST_HEAD(&priv_dev->aligned_buf_list); in cdns3_gadget_start()
3189 ret = cdns3_init_eps(priv_dev); in cdns3_gadget_start()
3191 dev_err(priv_dev->dev, "Failed to create endpoints\n"); in cdns3_gadget_start()
3196 priv_dev->setup_buf = dma_alloc_coherent(priv_dev->sysdev, 8, in cdns3_gadget_start()
3197 &priv_dev->setup_dma, GFP_DMA); in cdns3_gadget_start()
3198 if (!priv_dev->setup_buf) { in cdns3_gadget_start()
3203 priv_dev->dev_ver = readl(&priv_dev->regs->usb_cap6); in cdns3_gadget_start()
3205 dev_dbg(priv_dev->dev, "Device Controller version: %08x\n", in cdns3_gadget_start()
3206 readl(&priv_dev->regs->usb_cap6)); in cdns3_gadget_start()
3207 dev_dbg(priv_dev->dev, "USB Capabilities:: %08x\n", in cdns3_gadget_start()
3208 readl(&priv_dev->regs->usb_cap1)); in cdns3_gadget_start()
3209 dev_dbg(priv_dev->dev, "On-Chip memory configuration: %08x\n", in cdns3_gadget_start()
3210 readl(&priv_dev->regs->usb_cap2)); in cdns3_gadget_start()
3212 priv_dev->dev_ver = GET_DEV_BASE_VERSION(priv_dev->dev_ver); in cdns3_gadget_start()
3213 if (priv_dev->dev_ver >= DEV_VER_V2) in cdns3_gadget_start()
3214 priv_dev->gadget.sg_supported = 1; in cdns3_gadget_start()
3216 priv_dev->zlp_buf = kzalloc(CDNS3_EP_ZLP_BUF_SIZE, GFP_KERNEL); in cdns3_gadget_start()
3217 if (!priv_dev->zlp_buf) { in cdns3_gadget_start()
3223 ret = usb_add_gadget(&priv_dev->gadget); in cdns3_gadget_start()
3225 dev_err(priv_dev->dev, "Failed to add gadget\n"); in cdns3_gadget_start()
3231 kfree(priv_dev->zlp_buf); in cdns3_gadget_start()
3233 dma_free_coherent(priv_dev->sysdev, 8, priv_dev->setup_buf, in cdns3_gadget_start()
3234 priv_dev->setup_dma); in cdns3_gadget_start()
3236 cdns3_free_all_eps(priv_dev); in cdns3_gadget_start()
3238 usb_put_gadget(&priv_dev->gadget); in cdns3_gadget_start()
3283 struct cdns3_device *priv_dev = cdns->gadget_dev; in cdns3_gadget_suspend() local
3286 cdns3_disconnect_gadget(priv_dev); in cdns3_gadget_suspend()
3289 priv_dev->gadget.speed = USB_SPEED_UNKNOWN; in cdns3_gadget_suspend()
3290 usb_gadget_set_state(&priv_dev->gadget, USB_STATE_NOTATTACHED); in cdns3_gadget_suspend()
3291 cdns3_hw_reset_eps_config(priv_dev); in cdns3_gadget_suspend()
3294 writel(0, &priv_dev->regs->usb_ien); in cdns3_gadget_suspend()
3301 struct cdns3_device *priv_dev = cdns->gadget_dev; in cdns3_gadget_resume() local
3303 if (!priv_dev->gadget_driver) in cdns3_gadget_resume()
3306 cdns3_gadget_config(priv_dev); in cdns3_gadget_resume()