Lines Matching refs:ci
52 static int reprime_dtd(struct ci_hdrc *ci, struct ci_hw_ep *hwep,
66 static inline int ep_to_bit(struct ci_hdrc *ci, int n) in ep_to_bit() argument
68 int fill = 16 - ci->hw_ep_max / 2; in ep_to_bit()
70 if (n >= ci->hw_ep_max / 2) in ep_to_bit()
83 static int hw_device_state(struct ci_hdrc *ci, u32 dma) in hw_device_state() argument
86 hw_write(ci, OP_ENDPTLISTADDR, ~0, dma); in hw_device_state()
88 hw_write(ci, OP_USBINTR, ~0, in hw_device_state()
91 hw_write(ci, OP_USBINTR, ~0, 0); in hw_device_state()
104 static int hw_ep_flush(struct ci_hdrc *ci, int num, int dir) in hw_ep_flush() argument
110 hw_write(ci, OP_ENDPTFLUSH, ~0, BIT(n)); in hw_ep_flush()
111 while (hw_read(ci, OP_ENDPTFLUSH, BIT(n))) in hw_ep_flush()
113 } while (hw_read(ci, OP_ENDPTSTAT, BIT(n))); in hw_ep_flush()
126 static int hw_ep_disable(struct ci_hdrc *ci, int num, int dir) in hw_ep_disable() argument
128 hw_write(ci, OP_ENDPTCTRL + num, in hw_ep_disable()
142 static int hw_ep_enable(struct ci_hdrc *ci, int num, int dir, int type) in hw_ep_enable() argument
165 hw_write(ci, OP_ENDPTCTRL + num, mask, data); in hw_ep_enable()
177 static int hw_ep_get_halt(struct ci_hdrc *ci, int num, int dir) in hw_ep_get_halt() argument
181 return hw_read(ci, OP_ENDPTCTRL + num, mask) ? 1 : 0; in hw_ep_get_halt()
193 static int hw_ep_prime(struct ci_hdrc *ci, int num, int dir, int is_ctrl) in hw_ep_prime() argument
200 if (is_ctrl && dir == RX && hw_read(ci, OP_ENDPTSETUPSTAT, BIT(num))) in hw_ep_prime()
203 hw_write(ci, OP_ENDPTPRIME, ~0, BIT(n)); in hw_ep_prime()
205 while (hw_read(ci, OP_ENDPTPRIME, BIT(n))) in hw_ep_prime()
207 if (is_ctrl && dir == RX && hw_read(ci, OP_ENDPTSETUPSTAT, BIT(num))) in hw_ep_prime()
224 static int hw_ep_set_halt(struct ci_hdrc *ci, int num, int dir, int value) in hw_ep_set_halt() argument
235 hw_write(ci, reg, mask_xs|mask_xr, in hw_ep_set_halt()
237 } while (value != hw_ep_get_halt(ci, num, dir)); in hw_ep_set_halt()
248 static int hw_port_is_high_speed(struct ci_hdrc *ci) in hw_port_is_high_speed() argument
250 return ci->hw_bank.lpm ? hw_read(ci, OP_DEVLC, DEVLC_PSPD) : in hw_port_is_high_speed()
251 hw_read(ci, OP_PORTSC, PORTSC_HSP); in hw_port_is_high_speed()
262 static int hw_test_and_clear_complete(struct ci_hdrc *ci, int n) in hw_test_and_clear_complete() argument
264 n = ep_to_bit(ci, n); in hw_test_and_clear_complete()
265 return hw_test_and_clear(ci, OP_ENDPTCOMPLETE, BIT(n)); in hw_test_and_clear_complete()
275 static u32 hw_test_and_clear_intr_active(struct ci_hdrc *ci) in hw_test_and_clear_intr_active() argument
277 u32 reg = hw_read_intr_status(ci) & hw_read_intr_enable(ci); in hw_test_and_clear_intr_active()
279 hw_write(ci, OP_USBSTS, ~0, reg); in hw_test_and_clear_intr_active()
290 static int hw_test_and_clear_setup_guard(struct ci_hdrc *ci) in hw_test_and_clear_setup_guard() argument
292 return hw_test_and_write(ci, OP_USBCMD, USBCMD_SUTW, 0); in hw_test_and_clear_setup_guard()
302 static int hw_test_and_set_setup_guard(struct ci_hdrc *ci) in hw_test_and_set_setup_guard() argument
304 return hw_test_and_write(ci, OP_USBCMD, USBCMD_SUTW, USBCMD_SUTW); in hw_test_and_set_setup_guard()
315 static void hw_usb_set_address(struct ci_hdrc *ci, u8 value) in hw_usb_set_address() argument
317 hw_write(ci, OP_DEVICEADDR, DEVICEADDR_USBADR, in hw_usb_set_address()
328 static int hw_usb_reset(struct ci_hdrc *ci) in hw_usb_reset() argument
330 hw_usb_set_address(ci, 0); in hw_usb_reset()
333 hw_write(ci, OP_ENDPTFLUSH, ~0, ~0); in hw_usb_reset()
336 hw_write(ci, OP_ENDPTSETUPSTAT, 0, 0); in hw_usb_reset()
339 hw_write(ci, OP_ENDPTCOMPLETE, 0, 0); in hw_usb_reset()
342 while (hw_read(ci, OP_ENDPTPRIME, ~0)) in hw_usb_reset()
515 dev_err(hwep->ci->dev, "not supported operation for sg\n"); in prepare_td_for_sg()
521 dev_err(hwep->ci->dev, "not page aligned sg buffer\n"); in prepare_td_for_sg()
552 struct ci_hdrc *ci = hwep->ci; in _hardware_enqueue() local
562 ret = usb_gadget_map_request_by_dev(ci->dev->parent, in _hardware_enqueue()
605 if (ci->rev == CI_REVISION_22) { in _hardware_enqueue()
606 if (!hw_read(ci, OP_ENDPTSTAT, BIT(n))) in _hardware_enqueue()
607 reprime_dtd(ci, hwep, prevlastnode); in _hardware_enqueue()
610 if (hw_read(ci, OP_ENDPTPRIME, BIT(n))) in _hardware_enqueue()
613 hw_write(ci, OP_USBCMD, USBCMD_ATDTW, USBCMD_ATDTW); in _hardware_enqueue()
614 tmp_stat = hw_read(ci, OP_ENDPTSTAT, BIT(n)); in _hardware_enqueue()
615 } while (!hw_read(ci, OP_USBCMD, USBCMD_ATDTW)); in _hardware_enqueue()
616 hw_write(ci, OP_USBCMD, USBCMD_ATDTW, 0); in _hardware_enqueue()
635 ret = hw_ep_prime(ci, hwep->num, hwep->dir, in _hardware_enqueue()
654 static int reprime_dtd(struct ci_hdrc *ci, struct ci_hw_ep *hwep, in reprime_dtd() argument
661 return hw_ep_prime(ci, hwep->num, hwep->dir, in reprime_dtd()
678 struct ci_hdrc *ci = hwep->ci; in _hardware_dequeue() local
691 if (ci->rev == CI_REVISION_24) in _hardware_dequeue()
692 if (!hw_read(ci, OP_ENDPTSTAT, BIT(n))) in _hardware_dequeue()
693 reprime_dtd(ci, hwep, node); in _hardware_dequeue()
732 usb_gadget_unmap_request_by_dev(hwep->ci->dev->parent, in _hardware_dequeue()
758 hw_ep_flush(hwep->ci, hwep->num, hwep->dir); in _ep_nuke()
812 retval |= hw_ep_set_halt(hwep->ci, hwep->num, hwep->dir, value); in _ep_set_halt()
836 struct ci_hdrc *ci = container_of(gadget, struct ci_hdrc, gadget); in _gadget_stop_activity() local
843 usb_ep_fifo_flush(&ci->ep0out->ep); in _gadget_stop_activity()
844 usb_ep_fifo_flush(&ci->ep0in->ep); in _gadget_stop_activity()
851 if (ci->status != NULL) { in _gadget_stop_activity()
852 usb_ep_free_request(&ci->ep0in->ep, ci->status); in _gadget_stop_activity()
853 ci->status = NULL; in _gadget_stop_activity()
856 spin_lock_irqsave(&ci->lock, flags); in _gadget_stop_activity()
857 ci->gadget.speed = USB_SPEED_UNKNOWN; in _gadget_stop_activity()
858 ci->remote_wakeup = 0; in _gadget_stop_activity()
859 ci->suspended = 0; in _gadget_stop_activity()
860 spin_unlock_irqrestore(&ci->lock, flags); in _gadget_stop_activity()
874 static void isr_reset_handler(struct ci_hdrc *ci) in isr_reset_handler() argument
875 __releases(ci->lock) in isr_reset_handler()
876 __acquires(ci->lock) in isr_reset_handler()
880 spin_unlock(&ci->lock); in isr_reset_handler()
881 if (ci->gadget.speed != USB_SPEED_UNKNOWN) in isr_reset_handler()
882 usb_gadget_udc_reset(&ci->gadget, ci->driver); in isr_reset_handler()
884 retval = _gadget_stop_activity(&ci->gadget); in isr_reset_handler()
888 retval = hw_usb_reset(ci); in isr_reset_handler()
892 ci->status = usb_ep_alloc_request(&ci->ep0in->ep, GFP_ATOMIC); in isr_reset_handler()
893 if (ci->status == NULL) in isr_reset_handler()
897 spin_lock(&ci->lock); in isr_reset_handler()
900 dev_err(ci->dev, "error: %i\n", retval); in isr_reset_handler()
933 struct ci_hdrc *ci = hwep->ci; in _ep_queue() local
941 hwep = (ci->ep0_dir == RX) ? in _ep_queue()
942 ci->ep0out : ci->ep0in; in _ep_queue()
945 dev_warn(hwep->ci->dev, "endpoint ctrl %X nuked\n", in _ep_queue()
952 dev_err(hwep->ci->dev, "request length too big for isochronous\n"); in _ep_queue()
958 dev_err(hwep->ci->dev, "request already in queue\n"); in _ep_queue()
983 static int isr_get_status_response(struct ci_hdrc *ci, in isr_get_status_response() argument
988 struct ci_hw_ep *hwep = ci->ep0in; in isr_get_status_response()
1011 *(u16 *)req->buf = (ci->remote_wakeup << 1) | in isr_get_status_response()
1012 ci->gadget.is_selfpowered; in isr_get_status_response()
1018 *(u16 *)req->buf = hw_ep_get_halt(ci, num, dir); in isr_get_status_response()
1048 struct ci_hdrc *ci = req->context; in isr_setup_status_complete() local
1054 if (ci->setaddr) { in isr_setup_status_complete()
1055 hw_usb_set_address(ci, ci->address); in isr_setup_status_complete()
1056 ci->setaddr = false; in isr_setup_status_complete()
1057 if (ci->address) in isr_setup_status_complete()
1058 usb_gadget_set_state(&ci->gadget, USB_STATE_ADDRESS); in isr_setup_status_complete()
1061 spin_lock_irqsave(&ci->lock, flags); in isr_setup_status_complete()
1062 if (ci->test_mode) in isr_setup_status_complete()
1063 hw_port_test_set(ci, ci->test_mode); in isr_setup_status_complete()
1064 spin_unlock_irqrestore(&ci->lock, flags); in isr_setup_status_complete()
1073 static int isr_setup_status_phase(struct ci_hdrc *ci) in isr_setup_status_phase() argument
1083 if (WARN_ON_ONCE(!ci->status)) in isr_setup_status_phase()
1086 hwep = (ci->ep0_dir == TX) ? ci->ep0out : ci->ep0in; in isr_setup_status_phase()
1087 ci->status->context = ci; in isr_setup_status_phase()
1088 ci->status->complete = isr_setup_status_complete; in isr_setup_status_phase()
1090 return _ep_queue(&hwep->ep, ci->status, GFP_ATOMIC); in isr_setup_status_phase()
1118 hweptemp = hwep->ci->ep0in; in isr_tr_complete_low()
1130 static int otg_a_alt_hnp_support(struct ci_hdrc *ci) in otg_a_alt_hnp_support() argument
1132 dev_warn(&ci->gadget.dev, in otg_a_alt_hnp_support()
1134 return isr_setup_status_phase(ci); in otg_a_alt_hnp_support()
1143 static void isr_setup_packet_handler(struct ci_hdrc *ci) in isr_setup_packet_handler() argument
1144 __releases(ci->lock) in isr_setup_packet_handler()
1145 __acquires(ci->lock) in isr_setup_packet_handler()
1147 struct ci_hw_ep *hwep = &ci->ci_hw_ep[0]; in isr_setup_packet_handler()
1156 _ep_nuke(ci->ep0out); in isr_setup_packet_handler()
1157 _ep_nuke(ci->ep0in); in isr_setup_packet_handler()
1161 hw_test_and_set_setup_guard(ci); in isr_setup_packet_handler()
1163 } while (!hw_test_and_clear_setup_guard(ci)); in isr_setup_packet_handler()
1167 ci->ep0_dir = (type & USB_DIR_IN) ? TX : RX; in isr_setup_packet_handler()
1180 num += ci->hw_ep_max / 2; in isr_setup_packet_handler()
1181 if (!ci->ci_hw_ep[num].wedge) { in isr_setup_packet_handler()
1182 spin_unlock(&ci->lock); in isr_setup_packet_handler()
1184 &ci->ci_hw_ep[num].ep); in isr_setup_packet_handler()
1185 spin_lock(&ci->lock); in isr_setup_packet_handler()
1189 err = isr_setup_status_phase(ci); in isr_setup_packet_handler()
1195 ci->remote_wakeup = 0; in isr_setup_packet_handler()
1196 err = isr_setup_status_phase(ci); in isr_setup_packet_handler()
1210 err = isr_get_status_response(ci, &req); in isr_setup_packet_handler()
1218 ci->address = (u8)le16_to_cpu(req.wValue); in isr_setup_packet_handler()
1219 ci->setaddr = true; in isr_setup_packet_handler()
1220 err = isr_setup_status_phase(ci); in isr_setup_packet_handler()
1232 num += ci->hw_ep_max / 2; in isr_setup_packet_handler()
1234 spin_unlock(&ci->lock); in isr_setup_packet_handler()
1235 err = _ep_set_halt(&ci->ci_hw_ep[num].ep, 1, false); in isr_setup_packet_handler()
1236 spin_lock(&ci->lock); in isr_setup_packet_handler()
1238 isr_setup_status_phase(ci); in isr_setup_packet_handler()
1244 ci->remote_wakeup = 1; in isr_setup_packet_handler()
1245 err = isr_setup_status_phase(ci); in isr_setup_packet_handler()
1255 ci->test_mode = tmode; in isr_setup_packet_handler()
1257 ci); in isr_setup_packet_handler()
1264 if (ci_otg_is_fsm_mode(ci)) { in isr_setup_packet_handler()
1265 ci->gadget.b_hnp_enable = 1; in isr_setup_packet_handler()
1267 ci); in isr_setup_packet_handler()
1271 if (ci_otg_is_fsm_mode(ci)) in isr_setup_packet_handler()
1272 err = otg_a_alt_hnp_support(ci); in isr_setup_packet_handler()
1275 if (ci_otg_is_fsm_mode(ci)) { in isr_setup_packet_handler()
1276 ci->gadget.a_hnp_support = 1; in isr_setup_packet_handler()
1278 ci); in isr_setup_packet_handler()
1291 ci->ep0_dir = TX; in isr_setup_packet_handler()
1293 spin_unlock(&ci->lock); in isr_setup_packet_handler()
1294 err = ci->driver->setup(&ci->gadget, &req); in isr_setup_packet_handler()
1295 spin_lock(&ci->lock); in isr_setup_packet_handler()
1300 spin_unlock(&ci->lock); in isr_setup_packet_handler()
1302 dev_err(ci->dev, "error: _ep_set_halt\n"); in isr_setup_packet_handler()
1303 spin_lock(&ci->lock); in isr_setup_packet_handler()
1313 static void isr_tr_complete_handler(struct ci_hdrc *ci) in isr_tr_complete_handler() argument
1314 __releases(ci->lock) in isr_tr_complete_handler()
1315 __acquires(ci->lock) in isr_tr_complete_handler()
1320 for (i = 0; i < ci->hw_ep_max; i++) { in isr_tr_complete_handler()
1321 struct ci_hw_ep *hwep = &ci->ci_hw_ep[i]; in isr_tr_complete_handler()
1326 if (hw_test_and_clear_complete(ci, i)) { in isr_tr_complete_handler()
1330 err = isr_setup_status_phase(ci); in isr_tr_complete_handler()
1332 spin_unlock(&ci->lock); in isr_tr_complete_handler()
1334 dev_err(ci->dev, in isr_tr_complete_handler()
1336 spin_lock(&ci->lock); in isr_tr_complete_handler()
1343 hw_test_and_clear(ci, OP_ENDPTSETUPSTAT, BIT(0))) in isr_tr_complete_handler()
1344 isr_setup_packet_handler(ci); in isr_tr_complete_handler()
1372 dev_warn(hwep->ci->dev, "enabling a non-empty endpoint!\n"); in ep_enable()
1403 dev_err(hwep->ci->dev, "Set control xfer at non-ep0\n"); in ep_enable()
1412 retval |= hw_ep_enable(hwep->ci, hwep->num, hwep->dir, in ep_enable()
1436 if (hwep->ci->gadget.speed == USB_SPEED_UNKNOWN) { in ep_disable()
1446 retval |= hw_ep_disable(hwep->ci, hwep->num, hwep->dir); in ep_disable()
1495 dev_err(hwep->ci->dev, "freeing queued request\n"); in ep_free_request()
1529 if (hwep->ci->gadget.speed == USB_SPEED_UNKNOWN) { in ep_queue()
1556 if (hwep->ci->gadget.speed != USB_SPEED_UNKNOWN) in ep_dequeue()
1557 hw_ep_flush(hwep->ci, hwep->num, hwep->dir); in ep_dequeue()
1568 usb_gadget_unmap_request(&hwep->ci->gadget, req, hwep->dir); in ep_dequeue()
1623 dev_err(hwep->ci->dev, "%02X: -EINVAL\n", _usb_addr(hwep)); in ep_fifo_flush()
1628 if (hwep->ci->gadget.speed == USB_SPEED_UNKNOWN) { in ep_fifo_flush()
1633 hw_ep_flush(hwep->ci, hwep->num, hwep->dir); in ep_fifo_flush()
1660 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_udc_get_frame() local
1664 spin_lock_irqsave(&ci->lock, flags); in ci_udc_get_frame()
1665 ret = hw_read(ci, OP_FRINDEX, 0x3fff); in ci_udc_get_frame()
1666 spin_unlock_irqrestore(&ci->lock, flags); in ci_udc_get_frame()
1675 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_hdrc_gadget_connect() local
1678 pm_runtime_get_sync(ci->dev); in ci_hdrc_gadget_connect()
1679 hw_device_reset(ci); in ci_hdrc_gadget_connect()
1680 spin_lock_irq(&ci->lock); in ci_hdrc_gadget_connect()
1681 if (ci->driver) { in ci_hdrc_gadget_connect()
1682 hw_device_state(ci, ci->ep0out->qh.dma); in ci_hdrc_gadget_connect()
1684 spin_unlock_irq(&ci->lock); in ci_hdrc_gadget_connect()
1687 spin_unlock_irq(&ci->lock); in ci_hdrc_gadget_connect()
1691 if (ci->driver) in ci_hdrc_gadget_connect()
1692 ci->driver->disconnect(&ci->gadget); in ci_hdrc_gadget_connect()
1693 hw_device_state(ci, 0); in ci_hdrc_gadget_connect()
1694 if (ci->platdata->notify_event) in ci_hdrc_gadget_connect()
1695 ci->platdata->notify_event(ci, in ci_hdrc_gadget_connect()
1697 _gadget_stop_activity(&ci->gadget); in ci_hdrc_gadget_connect()
1698 pm_runtime_put_sync(ci->dev); in ci_hdrc_gadget_connect()
1705 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_udc_vbus_session() local
1709 spin_lock_irqsave(&ci->lock, flags); in ci_udc_vbus_session()
1710 ci->vbus_active = is_active; in ci_udc_vbus_session()
1711 spin_unlock_irqrestore(&ci->lock, flags); in ci_udc_vbus_session()
1713 if (ci->usb_phy) in ci_udc_vbus_session()
1714 usb_phy_set_charger_state(ci->usb_phy, is_active ? in ci_udc_vbus_session()
1717 if (ci->platdata->notify_event) in ci_udc_vbus_session()
1718 ret = ci->platdata->notify_event(ci, in ci_udc_vbus_session()
1721 if (ci->driver) in ci_udc_vbus_session()
1729 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_udc_wakeup() local
1733 spin_lock_irqsave(&ci->lock, flags); in ci_udc_wakeup()
1734 if (ci->gadget.speed == USB_SPEED_UNKNOWN) { in ci_udc_wakeup()
1735 spin_unlock_irqrestore(&ci->lock, flags); in ci_udc_wakeup()
1738 if (!ci->remote_wakeup) { in ci_udc_wakeup()
1742 if (!hw_read(ci, OP_PORTSC, PORTSC_SUSP)) { in ci_udc_wakeup()
1746 hw_write(ci, OP_PORTSC, PORTSC_FPR, PORTSC_FPR); in ci_udc_wakeup()
1748 spin_unlock_irqrestore(&ci->lock, flags); in ci_udc_wakeup()
1754 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_udc_vbus_draw() local
1756 if (ci->usb_phy) in ci_udc_vbus_draw()
1757 return usb_phy_set_power(ci->usb_phy, ma); in ci_udc_vbus_draw()
1763 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_udc_selfpowered() local
1764 struct ci_hw_ep *hwep = ci->ep0in; in ci_udc_selfpowered()
1779 struct ci_hdrc *ci = container_of(_gadget, struct ci_hdrc, gadget); in ci_udc_pullup() local
1785 if (ci_otg_is_fsm_mode(ci) || ci->role == CI_ROLE_HOST) in ci_udc_pullup()
1788 pm_runtime_get_sync(ci->dev); in ci_udc_pullup()
1790 hw_write(ci, OP_USBCMD, USBCMD_RS, USBCMD_RS); in ci_udc_pullup()
1792 hw_write(ci, OP_USBCMD, USBCMD_RS, 0); in ci_udc_pullup()
1793 pm_runtime_put_sync(ci->dev); in ci_udc_pullup()
1807 struct ci_hdrc *ci = container_of(gadget, struct ci_hdrc, gadget); in ci_udc_match_ep() local
1811 list_for_each_entry_reverse(ep, &ci->gadget.ep_list, ep_list) { in ci_udc_match_ep()
1837 static int init_eps(struct ci_hdrc *ci) in init_eps() argument
1841 for (i = 0; i < ci->hw_ep_max/2; i++) in init_eps()
1843 int k = i + j * ci->hw_ep_max/2; in init_eps()
1844 struct ci_hw_ep *hwep = &ci->ci_hw_ep[k]; in init_eps()
1849 hwep->ci = ci; in init_eps()
1850 hwep->lock = &ci->lock; in init_eps()
1851 hwep->td_pool = ci->td_pool; in init_eps()
1877 hwep->qh.ptr = dma_pool_zalloc(ci->qh_pool, GFP_KERNEL, in init_eps()
1888 ci->ep0out = hwep; in init_eps()
1890 ci->ep0in = hwep; in init_eps()
1896 list_add_tail(&hwep->ep.ep_list, &ci->gadget.ep_list); in init_eps()
1902 static void destroy_eps(struct ci_hdrc *ci) in destroy_eps() argument
1906 for (i = 0; i < ci->hw_ep_max; i++) { in destroy_eps()
1907 struct ci_hw_ep *hwep = &ci->ci_hw_ep[i]; in destroy_eps()
1911 dma_pool_free(ci->qh_pool, hwep->qh.ptr, hwep->qh.dma); in destroy_eps()
1925 struct ci_hdrc *ci = container_of(gadget, struct ci_hdrc, gadget); in ci_udc_start() local
1931 ci->ep0out->ep.desc = &ctrl_endpt_out_desc; in ci_udc_start()
1932 retval = usb_ep_enable(&ci->ep0out->ep); in ci_udc_start()
1936 ci->ep0in->ep.desc = &ctrl_endpt_in_desc; in ci_udc_start()
1937 retval = usb_ep_enable(&ci->ep0in->ep); in ci_udc_start()
1941 ci->driver = driver; in ci_udc_start()
1944 if (ci_otg_is_fsm_mode(ci) && ci->fsm.id) { in ci_udc_start()
1945 ci_hdrc_otg_fsm_start(ci); in ci_udc_start()
1949 if (ci->vbus_active) in ci_udc_start()
1952 usb_udc_vbus_handler(&ci->gadget, false); in ci_udc_start()
1957 static void ci_udc_stop_for_otg_fsm(struct ci_hdrc *ci) in ci_udc_stop_for_otg_fsm() argument
1959 if (!ci_otg_is_fsm_mode(ci)) in ci_udc_stop_for_otg_fsm()
1962 mutex_lock(&ci->fsm.lock); in ci_udc_stop_for_otg_fsm()
1963 if (ci->fsm.otg->state == OTG_STATE_A_PERIPHERAL) { in ci_udc_stop_for_otg_fsm()
1964 ci->fsm.a_bidl_adis_tmout = 1; in ci_udc_stop_for_otg_fsm()
1965 ci_hdrc_otg_fsm_start(ci); in ci_udc_stop_for_otg_fsm()
1966 } else if (ci->fsm.otg->state == OTG_STATE_B_PERIPHERAL) { in ci_udc_stop_for_otg_fsm()
1967 ci->fsm.protocol = PROTO_UNDEF; in ci_udc_stop_for_otg_fsm()
1968 ci->fsm.otg->state = OTG_STATE_UNDEFINED; in ci_udc_stop_for_otg_fsm()
1970 mutex_unlock(&ci->fsm.lock); in ci_udc_stop_for_otg_fsm()
1978 struct ci_hdrc *ci = container_of(gadget, struct ci_hdrc, gadget); in ci_udc_stop() local
1981 spin_lock_irqsave(&ci->lock, flags); in ci_udc_stop()
1982 ci->driver = NULL; in ci_udc_stop()
1984 if (ci->vbus_active) { in ci_udc_stop()
1985 hw_device_state(ci, 0); in ci_udc_stop()
1986 spin_unlock_irqrestore(&ci->lock, flags); in ci_udc_stop()
1987 if (ci->platdata->notify_event) in ci_udc_stop()
1988 ci->platdata->notify_event(ci, in ci_udc_stop()
1990 _gadget_stop_activity(&ci->gadget); in ci_udc_stop()
1991 spin_lock_irqsave(&ci->lock, flags); in ci_udc_stop()
1992 pm_runtime_put(ci->dev); in ci_udc_stop()
1995 spin_unlock_irqrestore(&ci->lock, flags); in ci_udc_stop()
1997 ci_udc_stop_for_otg_fsm(ci); in ci_udc_stop()
2010 static irqreturn_t udc_irq(struct ci_hdrc *ci) in udc_irq() argument
2015 if (ci == NULL) in udc_irq()
2018 spin_lock(&ci->lock); in udc_irq()
2020 if (ci->platdata->flags & CI_HDRC_REGS_SHARED) { in udc_irq()
2021 if (hw_read(ci, OP_USBMODE, USBMODE_CM) != in udc_irq()
2023 spin_unlock(&ci->lock); in udc_irq()
2027 intr = hw_test_and_clear_intr_active(ci); in udc_irq()
2032 isr_reset_handler(ci); in udc_irq()
2035 ci->gadget.speed = hw_port_is_high_speed(ci) ? in udc_irq()
2037 if (ci->suspended) { in udc_irq()
2038 if (ci->driver->resume) { in udc_irq()
2039 spin_unlock(&ci->lock); in udc_irq()
2040 ci->driver->resume(&ci->gadget); in udc_irq()
2041 spin_lock(&ci->lock); in udc_irq()
2043 ci->suspended = 0; in udc_irq()
2044 usb_gadget_set_state(&ci->gadget, in udc_irq()
2045 ci->resume_state); in udc_irq()
2050 isr_tr_complete_handler(ci); in udc_irq()
2052 if ((USBi_SLI & intr) && !(ci->suspended)) { in udc_irq()
2053 ci->suspended = 1; in udc_irq()
2054 ci->resume_state = ci->gadget.state; in udc_irq()
2055 if (ci->gadget.speed != USB_SPEED_UNKNOWN && in udc_irq()
2056 ci->driver->suspend) { in udc_irq()
2057 spin_unlock(&ci->lock); in udc_irq()
2058 ci->driver->suspend(&ci->gadget); in udc_irq()
2059 spin_lock(&ci->lock); in udc_irq()
2061 usb_gadget_set_state(&ci->gadget, in udc_irq()
2068 spin_unlock(&ci->lock); in udc_irq()
2077 static int udc_start(struct ci_hdrc *ci) in udc_start() argument
2079 struct device *dev = ci->dev; in udc_start()
2080 struct usb_otg_caps *otg_caps = &ci->platdata->ci_otg_caps; in udc_start()
2083 ci->gadget.ops = &usb_gadget_ops; in udc_start()
2084 ci->gadget.speed = USB_SPEED_UNKNOWN; in udc_start()
2085 ci->gadget.max_speed = USB_SPEED_HIGH; in udc_start()
2086 ci->gadget.name = ci->platdata->name; in udc_start()
2087 ci->gadget.otg_caps = otg_caps; in udc_start()
2088 ci->gadget.sg_supported = 1; in udc_start()
2089 ci->gadget.irq = ci->irq; in udc_start()
2091 if (ci->platdata->flags & CI_HDRC_REQUIRES_ALIGNED_DMA) in udc_start()
2092 ci->gadget.quirk_avoids_skb_reserve = 1; in udc_start()
2094 if (ci->is_otg && (otg_caps->hnp_support || otg_caps->srp_support || in udc_start()
2096 ci->gadget.is_otg = 1; in udc_start()
2098 INIT_LIST_HEAD(&ci->gadget.ep_list); in udc_start()
2101 ci->qh_pool = dma_pool_create("ci_hw_qh", dev->parent, in udc_start()
2104 if (ci->qh_pool == NULL) in udc_start()
2107 ci->td_pool = dma_pool_create("ci_hw_td", dev->parent, in udc_start()
2110 if (ci->td_pool == NULL) { in udc_start()
2115 retval = init_eps(ci); in udc_start()
2119 ci->gadget.ep0 = &ci->ep0in->ep; in udc_start()
2121 retval = usb_add_gadget_udc(dev, &ci->gadget); in udc_start()
2128 destroy_eps(ci); in udc_start()
2130 dma_pool_destroy(ci->td_pool); in udc_start()
2132 dma_pool_destroy(ci->qh_pool); in udc_start()
2141 void ci_hdrc_gadget_destroy(struct ci_hdrc *ci) in ci_hdrc_gadget_destroy() argument
2143 if (!ci->roles[CI_ROLE_GADGET]) in ci_hdrc_gadget_destroy()
2146 usb_del_gadget_udc(&ci->gadget); in ci_hdrc_gadget_destroy()
2148 destroy_eps(ci); in ci_hdrc_gadget_destroy()
2150 dma_pool_destroy(ci->td_pool); in ci_hdrc_gadget_destroy()
2151 dma_pool_destroy(ci->qh_pool); in ci_hdrc_gadget_destroy()
2154 static int udc_id_switch_for_device(struct ci_hdrc *ci) in udc_id_switch_for_device() argument
2156 if (ci->platdata->pins_device) in udc_id_switch_for_device()
2157 pinctrl_select_state(ci->platdata->pctl, in udc_id_switch_for_device()
2158 ci->platdata->pins_device); in udc_id_switch_for_device()
2160 if (ci->is_otg) in udc_id_switch_for_device()
2162 hw_write_otgsc(ci, OTGSC_BSVIS | OTGSC_BSVIE, in udc_id_switch_for_device()
2168 static void udc_id_switch_for_host(struct ci_hdrc *ci) in udc_id_switch_for_host() argument
2174 if (ci->is_otg) in udc_id_switch_for_host()
2175 hw_write_otgsc(ci, OTGSC_BSVIE | OTGSC_BSVIS, OTGSC_BSVIS); in udc_id_switch_for_host()
2177 ci->vbus_active = 0; in udc_id_switch_for_host()
2179 if (ci->platdata->pins_device && ci->platdata->pins_default) in udc_id_switch_for_host()
2180 pinctrl_select_state(ci->platdata->pctl, in udc_id_switch_for_host()
2181 ci->platdata->pins_default); in udc_id_switch_for_host()
2185 static void udc_suspend(struct ci_hdrc *ci) in udc_suspend() argument
2192 if (hw_read(ci, OP_ENDPTLISTADDR, ~0) == 0) in udc_suspend()
2193 hw_write(ci, OP_ENDPTLISTADDR, ~0, ~0); in udc_suspend()
2196 static void udc_resume(struct ci_hdrc *ci, bool power_lost) in udc_resume() argument
2199 if (ci->is_otg) in udc_resume()
2200 hw_write_otgsc(ci, OTGSC_BSVIS | OTGSC_BSVIE, in udc_resume()
2202 if (ci->vbus_active) in udc_resume()
2203 usb_gadget_vbus_disconnect(&ci->gadget); in udc_resume()
2207 if (hw_read(ci, OP_ENDPTLISTADDR, ~0) == 0xFFFFFFFF) in udc_resume()
2208 hw_write(ci, OP_ENDPTLISTADDR, ~0, 0); in udc_resume()
2218 int ci_hdrc_gadget_init(struct ci_hdrc *ci) in ci_hdrc_gadget_init() argument
2223 if (!hw_read(ci, CAP_DCCPARAMS, DCCPARAMS_DC)) in ci_hdrc_gadget_init()
2226 rdrv = devm_kzalloc(ci->dev, sizeof(*rdrv), GFP_KERNEL); in ci_hdrc_gadget_init()
2239 ret = udc_start(ci); in ci_hdrc_gadget_init()
2241 ci->roles[CI_ROLE_GADGET] = rdrv; in ci_hdrc_gadget_init()