Lines Matching full:udc
78 struct qe_udc *udc = ep->udc; in done() local
94 dma_unmap_single(udc->gadget.dev.parent, in done()
102 dma_sync_single_for_cpu(udc->gadget.dev.parent, in done()
109 dev_vdbg(udc->dev, "complete %s req %p stat %d len %u/%u\n", in done()
115 spin_unlock(&udc->lock); in done()
119 spin_lock(&udc->lock); in done()
146 struct qe_udc *udc = ep->udc; in qe_eprx_stall_change() local
148 tem_usep = in_be16(&udc->usb_regs->usb_usep[epnum]); in qe_eprx_stall_change()
155 out_be16(&udc->usb_regs->usb_usep[epnum], tem_usep); in qe_eprx_stall_change()
163 struct qe_udc *udc = ep->udc; in qe_eptx_stall_change() local
165 tem_usep = in_be16(&udc->usb_regs->usb_usep[epnum]); in qe_eptx_stall_change()
172 out_be16(&udc->usb_regs->usb_usep[epnum], tem_usep); in qe_eptx_stall_change()
177 static int qe_ep0_stall(struct qe_udc *udc) in qe_ep0_stall() argument
179 qe_eptx_stall_change(&udc->eps[0], 1); in qe_ep0_stall()
180 qe_eprx_stall_change(&udc->eps[0], 1); in qe_ep0_stall()
181 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep0_stall()
182 udc->ep0_dir = 0; in qe_ep0_stall()
189 struct qe_udc *udc = ep->udc; in qe_eprx_nack() local
193 clrsetbits_be16(&udc->usb_regs->usb_usep[epnum], in qe_eprx_nack()
197 clrbits16(&udc->usb_regs->usb_usbmr, in qe_eprx_nack()
207 struct qe_udc *udc = ep->udc; in qe_eprx_normal() local
210 clrsetbits_be16(&udc->usb_regs->usb_usep[ep->epnum], in qe_eprx_normal()
214 out_be16(&udc->usb_regs->usb_usber, in qe_eprx_normal()
216 setbits16(&udc->usb_regs->usb_usbmr, in qe_eprx_normal()
228 if (ep->udc->soc_type == PORT_CPM) in qe_ep_cmd_stoptx()
240 if (ep->udc->soc_type == PORT_CPM) in qe_ep_cmd_restarttx()
252 struct qe_udc *udc = ep->udc; in qe_ep_flushtxfifo() local
258 out_8(&udc->usb_regs->usb_uscom, in qe_ep_flushtxfifo()
260 out_be16(&udc->ep_param[i]->tbptr, in_be16(&udc->ep_param[i]->tbase)); in qe_ep_flushtxfifo()
261 out_be32(&udc->ep_param[i]->tstate, 0); in qe_ep_flushtxfifo()
262 out_be16(&udc->ep_param[i]->tbcnt, 0); in qe_ep_flushtxfifo()
272 struct qe_udc *udc = ep->udc; in qe_ep_filltxfifo() local
274 out_8(&udc->usb_regs->usb_uscom, in qe_ep_filltxfifo()
279 static int qe_epbds_reset(struct qe_udc *udc, int pipe_num) in qe_epbds_reset() argument
286 ep = &udc->eps[pipe_num]; in qe_epbds_reset()
311 static int qe_ep_reset(struct qe_udc *udc, int pipe_num) in qe_ep_reset() argument
316 ep = &udc->eps[pipe_num]; in qe_ep_reset()
317 tmpusep = in_be16(&udc->usb_regs->usb_usep[pipe_num]); in qe_ep_reset()
334 out_be16(&udc->usb_regs->usb_usep[pipe_num], tmpusep); in qe_ep_reset()
336 qe_epbds_reset(udc, pipe_num); in qe_ep_reset()
347 static int qe_ep_bd_init(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_bd_init() argument
349 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_bd_init()
361 epparam = udc->ep_param[pipe_num]; in qe_ep_bd_init()
439 ep->rxbuf_d = dma_map_single(ep->udc->gadget.dev.parent, in qe_ep_rxbd_update()
445 dma_sync_single_for_device(ep->udc->gadget.dev.parent, in qe_ep_rxbd_update()
467 static int qe_ep_register_init(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_register_init() argument
469 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_register_init()
475 epparam = udc->ep_param[pipe_num]; in qe_ep_register_init()
506 out_be16(&udc->usb_regs->usb_usep[pipe_num], usep); in qe_ep_register_init()
520 static int qe_ep_init(struct qe_udc *udc, in qe_ep_init() argument
524 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_init()
540 switch (udc->gadget.speed) { in qe_ep_init()
561 switch (udc->gadget.speed) { in qe_ep_init()
578 switch (udc->gadget.speed) { in qe_ep_init()
593 switch (udc->gadget.speed) { in qe_ep_init()
628 spin_lock_irqsave(&udc->lock, flags); in qe_ep_init()
639 udc->ep0_dir = USB_DIR_OUT; in qe_ep_init()
640 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_init()
654 qe_ep_bd_init(udc, pipe_num); in qe_ep_init()
668 qe_ep_register_init(udc, pipe_num); in qe_ep_init()
672 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_init()
679 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_init()
681 dev_err(udc->dev, "failed to initialize %s\n", ep->ep.name); in qe_ep_init()
685 static inline void qe_usb_enable(struct qe_udc *udc) in qe_usb_enable() argument
687 setbits8(&udc->usb_regs->usb_usmod, USB_MODE_EN); in qe_usb_enable()
690 static inline void qe_usb_disable(struct qe_udc *udc) in qe_usb_disable() argument
692 clrbits8(&udc->usb_regs->usb_usmod, USB_MODE_EN); in qe_usb_disable()
701 UDC transmit and receive process
749 struct qe_udc *udc = ep->udc; in ep_recycle_rxbds() local
754 ((in_be16(&udc->ep_param[epnum]->rbptr) - in ep_recycle_rxbds()
755 in_be16(&udc->ep_param[epnum]->rbase)) in ep_recycle_rxbds()
770 if (in_be16(&udc->usb_regs->usb_usber) & USB_E_BSY_MASK) in ep_recycle_rxbds()
771 out_be16(&udc->usb_regs->usb_usber, USB_E_BSY_MASK); in ep_recycle_rxbds()
779 static void setup_received_handle(struct qe_udc *udc,
782 static void ep0_req_complete(struct qe_udc *udc, struct qe_req *req);
784 static int ep0_setup_handle(struct qe_udc *udc) in ep0_setup_handle() argument
786 struct qe_ep *ep = &udc->eps[0]; in ep0_setup_handle()
793 && (udc->ep0_state == WAIT_FOR_SETUP)) { in ep0_setup_handle()
797 cp = (u8 *)&udc->local_setup_buff; in ep0_setup_handle()
802 setup_received_handle(udc, &udc->local_setup_buff); in ep0_setup_handle()
808 static int qe_ep0_rx(struct qe_udc *udc) in qe_ep0_rx() argument
810 struct qe_ep *ep = &udc->eps[0]; in qe_ep0_rx()
819 dev_err(udc->dev, "ep0 not a control endpoint\n"); in qe_ep0_rx()
831 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep0_rx()
832 dev_vdbg(udc->dev, in qe_ep0_rx()
854 ep0_setup_handle(udc); in qe_ep0_rx()
859 dev_err(udc->dev, "The receive frame with error!\n"); in qe_ep0_rx()
895 dev_err(ep->udc->dev, "the data01 error!\n"); in qe_ep_rxframe_handle()
901 dev_err(ep->udc->dev, "the %s have no requeue!\n", ep->name); in qe_ep_rxframe_handle()
912 ep0_req_complete(ep->udc, req); in qe_ep_rxframe_handle()
928 struct qe_udc *udc = from_tasklet(udc, t, rx_tasklet); in ep_rx_tasklet() local
936 spin_lock_irqsave(&udc->lock, flags); in ep_rx_tasklet()
939 ep = &udc->eps[i]; in ep_rx_tasklet()
942 dev_dbg(udc->dev, in ep_rx_tasklet()
955 dev_dbg(udc->dev, in ep_rx_tasklet()
983 dev_err(udc->dev, in ep_rx_tasklet()
1011 spin_unlock_irqrestore(&udc->lock, flags); in ep_rx_tasklet()
1016 struct qe_udc *udc; in qe_ep_rx() local
1021 udc = ep->udc; in qe_ep_rx()
1025 dev_err(udc->dev, "transmit ep in rx function\n"); in qe_ep_rx()
1032 ucoffs = (u16)((in_be16(&udc->ep_param[ep->epnum]->rbptr) - in qe_ep_rx()
1033 in_be16(&udc->ep_param[ep->epnum]->rbase)) >> 3); in qe_ep_rx()
1042 dev_vdbg(udc->dev, "%d empty bds, send NACK\n", emptybds); in qe_ep_rx()
1048 dev_vdbg(udc->dev, "The rxep have no req queued with %d BDs\n", in qe_ep_rx()
1053 tasklet_schedule(&udc->rx_tasklet); in qe_ep_rx()
1062 struct qe_udc *udc = ep->udc; in qe_ep_tx() local
1069 dev_err(udc->dev, "receive ep passed to tx function\n"); in qe_ep_tx()
1074 saveusbmr = in_be16(&udc->usb_regs->usb_usbmr); in qe_ep_tx()
1075 out_be16(&udc->usb_regs->usb_usbmr, in qe_ep_tx()
1083 frame_set_data(frame, udc->nullbuf); in qe_ep_tx()
1086 dev_vdbg(udc->dev, "the frame size = 0\n"); in qe_ep_tx()
1098 if ((ep->epnum == 0) && (udc->ep0_state == DATA_STATE_NEED_ZLP)) in qe_ep_tx()
1114 out_be16(&udc->usb_regs->usb_usbmr, saveusbmr); in qe_ep_tx()
1124 out_be16(&udc->usb_regs->usb_usbmr, saveusbmr); in qe_ep_tx()
1125 dev_vdbg(udc->dev, "The tx bd is not ready!\n"); in qe_ep_tx()
1206 struct qe_udc *udc = ep->udc; in sendnulldata() local
1212 frame_set_data(frame, (u8 *)udc->nullbuf); in sendnulldata()
1238 * in status phase, udc create a request and gain status */
1239 static int ep0_prime_status(struct qe_udc *udc, int direction) in ep0_prime_status() argument
1242 struct qe_ep *ep = &udc->eps[0]; in ep0_prime_status()
1245 udc->ep0_state = DATA_STATE_NEED_ZLP; in ep0_prime_status()
1246 udc->ep0_dir = USB_DIR_IN; in ep0_prime_status()
1249 udc->ep0_dir = USB_DIR_OUT; in ep0_prime_status()
1250 udc->ep0_state = WAIT_FOR_OUT_STATUS; in ep0_prime_status()
1256 /* a request complete in ep0, whether gadget request or udc request */
1257 static void ep0_req_complete(struct qe_udc *udc, struct qe_req *req) in ep0_req_complete() argument
1259 struct qe_ep *ep = &udc->eps[0]; in ep0_req_complete()
1262 switch (udc->ep0_state) { in ep0_req_complete()
1266 if (ep0_prime_status(udc, USB_DIR_OUT)) in ep0_req_complete()
1267 qe_ep0_stall(udc); in ep0_req_complete()
1272 udc->ep0_state = WAIT_FOR_SETUP; in ep0_req_complete()
1278 if (ep0_prime_status(udc, USB_DIR_IN)) in ep0_req_complete()
1279 qe_ep0_stall(udc); in ep0_req_complete()
1284 udc->ep0_state = WAIT_FOR_SETUP; in ep0_req_complete()
1288 dev_vdbg(udc->dev, "Unexpected interrupt\n"); in ep0_req_complete()
1292 qe_ep0_stall(udc); in ep0_req_complete()
1304 ep->udc->ep0_state = WAIT_FOR_SETUP; in ep0_txcomplete()
1323 ep0_req_complete(ep->udc, ep->tx_req); in ep0_txcomplete()
1329 dev_vdbg(ep->udc->dev, "the ep0_controller have no req\n"); in ep0_txcomplete()
1340 dev_vdbg(ep->udc->dev, "The EP0 transmit data have error!\n"); in ep0_txframe_handle()
1395 dev_vdbg(ep->udc->dev, "The EP0 transmit data have error!\n"); in ep_txframe_handle()
1465 struct qe_udc *udc = ep->udc; in ep_req_rx() local
1475 dev_vdbg(udc->dev, "the req already finish!\n"); in ep_req_rx()
1508 dev_vdbg(udc->dev, "the data01 error!\n"); in ep_req_rx()
1528 dev_err(udc->dev, "The receive frame with error!\n"); in ep_req_rx()
1578 struct qe_udc *udc; in qe_ep_enable() local
1590 udc = ep->udc; in qe_ep_enable()
1591 if (!udc->driver || (udc->gadget.speed == USB_SPEED_UNKNOWN)) in qe_ep_enable()
1596 retval = qe_ep_init(udc, epnum, desc); in qe_ep_enable()
1599 dev_dbg(udc->dev, "enable ep%d failed\n", ep->epnum); in qe_ep_enable()
1602 dev_dbg(udc->dev, "enable ep%d successful\n", ep->epnum); in qe_ep_enable()
1608 struct qe_udc *udc; in qe_ep_disable() local
1614 udc = ep->udc; in qe_ep_disable()
1617 dev_dbg(udc->dev, "%s not enabled\n", _ep ? ep->ep.name : NULL); in qe_ep_disable()
1621 spin_lock_irqsave(&udc->lock, flags); in qe_ep_disable()
1627 qe_ep_reset(udc, ep->epnum); in qe_ep_disable()
1628 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_disable()
1642 dma_unmap_single(udc->gadget.dev.parent, in qe_ep_disable()
1648 udc->gadget.dev.parent, in qe_ep_disable()
1658 dev_dbg(udc->dev, "disabled %s OK\n", _ep->name); in qe_ep_disable()
1691 struct qe_udc *udc; in __qe_ep_queue() local
1694 udc = ep->udc; in __qe_ep_queue()
1698 dev_dbg(udc->dev, "bad params\n"); in __qe_ep_queue()
1702 dev_dbg(udc->dev, "bad ep\n"); in __qe_ep_queue()
1706 if (!udc->driver || udc->gadget.speed == USB_SPEED_UNKNOWN) in __qe_ep_queue()
1713 req->req.dma = dma_map_single(ep->udc->gadget.dev.parent, in __qe_ep_queue()
1721 dma_sync_single_for_device(ep->udc->gadget.dev.parent, in __qe_ep_queue()
1733 dev_vdbg(udc->dev, "gadget have request in %s! %d\n", in __qe_ep_queue()
1743 udc->ep0_state = DATA_STATE_XMIT; in __qe_ep_queue()
1745 udc->ep0_state = DATA_STATE_RECV; in __qe_ep_queue()
1759 struct qe_udc *udc = ep->udc; in qe_ep_queue() local
1763 spin_lock_irqsave(&udc->lock, flags); in qe_ep_queue()
1765 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_queue()
1779 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_dequeue()
1788 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1794 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1809 struct qe_udc *udc; in qe_ep_set_halt() local
1817 udc = ep->udc; in qe_ep_set_halt()
1826 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_set_halt()
1829 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_set_halt()
1832 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_set_halt()
1833 udc->ep0_dir = 0; in qe_ep_set_halt()
1840 dev_vdbg(udc->dev, "%s %s halt stat %d\n", ep->ep.name, in qe_ep_set_halt()
1866 struct qe_udc *udc = container_of(gadget, struct qe_udc, gadget); in qe_get_frame() local
1869 tmp = in_be16(&udc->usb_param->frame_n); in qe_get_frame()
1889 static int udc_reset_ep_queue(struct qe_udc *udc, u8 pipe) in udc_reset_ep_queue() argument
1891 struct qe_ep *ep = &udc->eps[pipe]; in udc_reset_ep_queue()
1898 static int reset_queues(struct qe_udc *udc) in reset_queues() argument
1903 udc_reset_ep_queue(udc, pipe); in reset_queues()
1906 spin_unlock(&udc->lock); in reset_queues()
1907 usb_gadget_udc_reset(&udc->gadget, udc->driver); in reset_queues()
1908 spin_lock(&udc->lock); in reset_queues()
1913 static void ch9setaddress(struct qe_udc *udc, u16 value, u16 index, in ch9setaddress() argument
1917 udc->device_address = (u8) value; in ch9setaddress()
1919 udc->usb_state = USB_STATE_ADDRESS; in ch9setaddress()
1922 if (ep0_prime_status(udc, USB_DIR_IN)) in ch9setaddress()
1923 qe_ep0_stall(udc); in ch9setaddress()
1934 static void ch9getstatus(struct qe_udc *udc, u8 request_type, u16 value, in ch9getstatus() argument
1942 ep = &udc->eps[0]; in ch9getstatus()
1948 /* We don't have interface information in udc driver */ in ch9getstatus()
1953 struct qe_ep *target_ep = &udc->eps[pipe]; in ch9getstatus()
1960 usep = in_be16(&udc->usb_regs->usb_usep[pipe]); in ch9getstatus()
1977 req->req.buf = udc->statusbuf; in ch9getstatus()
1983 udc->ep0_dir = USB_DIR_IN; in ch9getstatus()
1991 dev_err(udc->dev, "Can't respond to getstatus request \n"); in ch9getstatus()
1992 qe_ep0_stall(udc); in ch9getstatus()
1996 static void setup_received_handle(struct qe_udc *udc, in setup_received_handle() argument
1999 /* Fix Endian (udc->local_setup_buff is cpu Endian now)*/ in setup_received_handle()
2005 udc_reset_ep_queue(udc, 0); in setup_received_handle()
2008 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2010 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2014 /* Data+Status phase form udc */ in setup_received_handle()
2018 ch9getstatus(udc, setup->bRequestType, wValue, wIndex, in setup_received_handle()
2023 /* Status phase from udc */ in setup_received_handle()
2027 ch9setaddress(udc, wValue, wIndex, wLength); in setup_received_handle()
2032 /* Requests with no data phase, status phase from udc */ in setup_received_handle()
2045 ep = &udc->eps[pipe]; in setup_received_handle()
2047 spin_unlock(&udc->lock); in setup_received_handle()
2051 spin_lock(&udc->lock); in setup_received_handle()
2054 ep0_prime_status(udc, USB_DIR_IN); in setup_received_handle()
2063 /* Data phase from gadget, status phase from udc */ in setup_received_handle()
2065 udc->ep0_state = DATA_STATE_XMIT; in setup_received_handle()
2066 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2068 udc->ep0_state = DATA_STATE_RECV; in setup_received_handle()
2069 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2071 spin_unlock(&udc->lock); in setup_received_handle()
2072 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2073 &udc->local_setup_buff) < 0) in setup_received_handle()
2074 qe_ep0_stall(udc); in setup_received_handle()
2075 spin_lock(&udc->lock); in setup_received_handle()
2078 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2079 spin_unlock(&udc->lock); in setup_received_handle()
2080 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2081 &udc->local_setup_buff) < 0) in setup_received_handle()
2082 qe_ep0_stall(udc); in setup_received_handle()
2083 spin_lock(&udc->lock); in setup_received_handle()
2084 udc->ep0_state = DATA_STATE_NEED_ZLP; in setup_received_handle()
2091 static void suspend_irq(struct qe_udc *udc) in suspend_irq() argument
2093 udc->resume_state = udc->usb_state; in suspend_irq()
2094 udc->usb_state = USB_STATE_SUSPENDED; in suspend_irq()
2097 if (udc->driver->suspend) in suspend_irq()
2098 udc->driver->suspend(&udc->gadget); in suspend_irq()
2101 static void resume_irq(struct qe_udc *udc) in resume_irq() argument
2103 udc->usb_state = udc->resume_state; in resume_irq()
2104 udc->resume_state = 0; in resume_irq()
2107 if (udc->driver->resume) in resume_irq()
2108 udc->driver->resume(&udc->gadget); in resume_irq()
2111 static void idle_irq(struct qe_udc *udc) in idle_irq() argument
2115 usbs = in_8(&udc->usb_regs->usb_usbs); in idle_irq()
2117 if ((udc->usb_state) != USB_STATE_SUSPENDED) in idle_irq()
2118 suspend_irq(udc); in idle_irq()
2120 if (udc->usb_state == USB_STATE_SUSPENDED) in idle_irq()
2121 resume_irq(udc); in idle_irq()
2125 static int reset_irq(struct qe_udc *udc) in reset_irq() argument
2129 if (udc->usb_state == USB_STATE_DEFAULT) in reset_irq()
2132 qe_usb_disable(udc); in reset_irq()
2133 out_8(&udc->usb_regs->usb_usadr, 0); in reset_irq()
2136 if (udc->eps[i].init) in reset_irq()
2137 qe_ep_reset(udc, i); in reset_irq()
2140 reset_queues(udc); in reset_irq()
2141 udc->usb_state = USB_STATE_DEFAULT; in reset_irq()
2142 udc->ep0_state = WAIT_FOR_SETUP; in reset_irq()
2143 udc->ep0_dir = USB_DIR_OUT; in reset_irq()
2144 qe_usb_enable(udc); in reset_irq()
2148 static int bsy_irq(struct qe_udc *udc) in bsy_irq() argument
2153 static int txe_irq(struct qe_udc *udc) in txe_irq() argument
2159 static int tx_irq(struct qe_udc *udc) in tx_irq() argument
2165 if ((udc->usb_state == USB_STATE_ADDRESS) in tx_irq()
2166 && (in_8(&udc->usb_regs->usb_usadr) == 0)) in tx_irq()
2167 out_8(&udc->usb_regs->usb_usadr, udc->device_address); in tx_irq()
2170 ep = &udc->eps[i]; in tx_irq()
2188 static void rx_irq(struct qe_udc *udc) in rx_irq() argument
2195 ep = &udc->eps[i]; in rx_irq()
2201 qe_ep0_rx(udc); in rx_irq()
2213 struct qe_udc *udc = (struct qe_udc *)_udc; in qe_udc_irq() local
2218 spin_lock_irqsave(&udc->lock, flags); in qe_udc_irq()
2220 irq_src = in_be16(&udc->usb_regs->usb_usber) & in qe_udc_irq()
2221 in_be16(&udc->usb_regs->usb_usbmr); in qe_udc_irq()
2223 out_be16(&udc->usb_regs->usb_usber, irq_src); in qe_udc_irq()
2226 idle_irq(udc); in qe_udc_irq()
2232 tx_irq(udc); in qe_udc_irq()
2238 rx_irq(udc); in qe_udc_irq()
2244 reset_irq(udc); in qe_udc_irq()
2250 bsy_irq(udc); in qe_udc_irq()
2256 txe_irq(udc); in qe_udc_irq()
2261 spin_unlock_irqrestore(&udc->lock, flags); in qe_udc_irq()
2272 struct qe_udc *udc; in fsl_qe_start() local
2275 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_start()
2277 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_start()
2281 udc->driver = driver; in fsl_qe_start()
2282 udc->gadget.speed = driver->max_speed; in fsl_qe_start()
2285 qe_usb_enable(udc); in fsl_qe_start()
2287 out_be16(&udc->usb_regs->usb_usber, 0xffff); in fsl_qe_start()
2288 out_be16(&udc->usb_regs->usb_usbmr, USB_E_DEFAULT_DEVICE); in fsl_qe_start()
2289 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_start()
2290 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_start()
2291 udc->ep0_dir = USB_DIR_OUT; in fsl_qe_start()
2292 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_start()
2299 struct qe_udc *udc; in fsl_qe_stop() local
2303 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_stop()
2305 qe_usb_disable(udc); in fsl_qe_stop()
2308 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_stop()
2309 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_stop()
2310 udc->ep0_dir = 0; in fsl_qe_stop()
2313 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_stop()
2314 udc->gadget.speed = USB_SPEED_UNKNOWN; in fsl_qe_stop()
2315 nuke(&udc->eps[0], -ESHUTDOWN); in fsl_qe_stop()
2316 list_for_each_entry(loop_ep, &udc->gadget.ep_list, ep.ep_list) in fsl_qe_stop()
2318 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_stop()
2320 udc->driver = NULL; in fsl_qe_stop()
2325 /* udc structure's alloc and setup, include ep-param alloc */
2328 struct qe_udc *udc; in qe_udc_config() local
2336 udc = kzalloc(sizeof(*udc), GFP_KERNEL); in qe_udc_config()
2337 if (!udc) in qe_udc_config()
2340 udc->dev = &ofdev->dev; in qe_udc_config()
2344 udc->usb_param = cpm_muram_addr(offset); in qe_udc_config()
2345 memset_io(udc->usb_param, 0, size); in qe_udc_config()
2347 usbpram = udc->usb_param; in qe_udc_config()
2359 udc->ep_param[i] = cpm_muram_addr(tmp_addr); in qe_udc_config()
2363 memset_io(udc->ep_param[0], 0, in qe_udc_config()
2366 udc->resume_state = USB_STATE_NOTATTACHED; in qe_udc_config()
2367 udc->usb_state = USB_STATE_POWERED; in qe_udc_config()
2368 udc->ep0_dir = 0; in qe_udc_config()
2370 spin_lock_init(&udc->lock); in qe_udc_config()
2371 return udc; in qe_udc_config()
2374 kfree(udc); in qe_udc_config()
2379 static int qe_udc_reg_init(struct qe_udc *udc) in qe_udc_reg_init() argument
2382 qe_usbregs = udc->usb_regs; in qe_udc_reg_init()
2397 static int qe_ep_config(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_config() argument
2399 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_config()
2401 ep->udc = udc; in qe_ep_config()
2436 list_add_tail(&ep->ep.ep_list, &udc->gadget.ep_list); in qe_ep_config()
2438 ep->gadget = &udc->gadget; in qe_ep_config()
2444 * UDC device Driver operation functions *
2448 struct qe_udc *udc = container_of(dev, struct qe_udc, gadget.dev); in qe_udc_release() local
2451 complete(udc->done); in qe_udc_release()
2452 cpm_muram_free(cpm_muram_offset(udc->ep_param[0])); in qe_udc_release()
2454 udc->ep_param[i] = NULL; in qe_udc_release()
2456 kfree(udc); in qe_udc_release()
2463 struct qe_udc *udc; in qe_udc_probe() local
2479 /* Initialize the udc structure including QH member and other member */ in qe_udc_probe()
2480 udc = qe_udc_config(ofdev); in qe_udc_probe()
2481 if (!udc) { in qe_udc_probe()
2486 udc->soc_type = (unsigned long)match->data; in qe_udc_probe()
2487 udc->usb_regs = of_iomap(np, 0); in qe_udc_probe()
2488 if (!udc->usb_regs) { in qe_udc_probe()
2495 qe_udc_reg_init(udc); in qe_udc_probe()
2499 udc->gadget.ops = &qe_gadget_ops; in qe_udc_probe()
2502 udc->gadget.ep0 = &udc->eps[0].ep; in qe_udc_probe()
2504 INIT_LIST_HEAD(&udc->gadget.ep_list); in qe_udc_probe()
2507 udc->gadget.speed = USB_SPEED_UNKNOWN; in qe_udc_probe()
2510 udc->gadget.name = driver_name; in qe_udc_probe()
2511 udc->gadget.dev.parent = &ofdev->dev; in qe_udc_probe()
2520 qe_ep_config(udc, (unsigned char)i); in qe_udc_probe()
2524 ret = qe_ep_init(udc, 0, &qe_ep0_desc); in qe_udc_probe()
2529 udc->nullbuf = devm_kzalloc(&ofdev->dev, 256, GFP_KERNEL); in qe_udc_probe()
2530 if (udc->nullbuf == NULL) { in qe_udc_probe()
2536 udc->statusbuf = devm_kzalloc(&ofdev->dev, 2, GFP_KERNEL); in qe_udc_probe()
2537 if (udc->statusbuf == NULL) { in qe_udc_probe()
2542 udc->nullp = virt_to_phys((void *)udc->nullbuf); in qe_udc_probe()
2543 if (udc->nullp == DMA_ADDR_INVALID) { in qe_udc_probe()
2544 udc->nullp = dma_map_single( in qe_udc_probe()
2545 udc->gadget.dev.parent, in qe_udc_probe()
2546 udc->nullbuf, in qe_udc_probe()
2549 udc->nullmap = 1; in qe_udc_probe()
2551 dma_sync_single_for_device(udc->gadget.dev.parent, in qe_udc_probe()
2552 udc->nullp, 256, in qe_udc_probe()
2556 tasklet_setup(&udc->rx_tasklet, ep_rx_tasklet); in qe_udc_probe()
2558 udc->usb_irq = irq_of_parse_and_map(np, 0); in qe_udc_probe()
2559 if (!udc->usb_irq) { in qe_udc_probe()
2564 ret = request_irq(udc->usb_irq, qe_udc_irq, 0, in qe_udc_probe()
2565 driver_name, udc); in qe_udc_probe()
2567 dev_err(udc->dev, "cannot request irq %d err %d\n", in qe_udc_probe()
2568 udc->usb_irq, ret); in qe_udc_probe()
2572 ret = usb_add_gadget_udc_release(&ofdev->dev, &udc->gadget, in qe_udc_probe()
2577 platform_set_drvdata(ofdev, udc); in qe_udc_probe()
2578 dev_info(udc->dev, in qe_udc_probe()
2580 (udc->soc_type == PORT_QE) ? "QE" : "CPM"); in qe_udc_probe()
2584 free_irq(udc->usb_irq, udc); in qe_udc_probe()
2586 irq_dispose_mapping(udc->usb_irq); in qe_udc_probe()
2588 if (udc->nullmap) { in qe_udc_probe()
2589 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_probe()
2590 udc->nullp, 256, in qe_udc_probe()
2592 udc->nullp = DMA_ADDR_INVALID; in qe_udc_probe()
2594 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_probe()
2595 udc->nullp, 256, in qe_udc_probe()
2599 ep = &udc->eps[0]; in qe_udc_probe()
2605 iounmap(udc->usb_regs); in qe_udc_probe()
2607 kfree(udc); in qe_udc_probe()
2625 struct qe_udc *udc = platform_get_drvdata(ofdev); in qe_udc_remove() local
2630 usb_del_gadget_udc(&udc->gadget); in qe_udc_remove()
2632 udc->done = &done; in qe_udc_remove()
2633 tasklet_disable(&udc->rx_tasklet); in qe_udc_remove()
2635 if (udc->nullmap) { in qe_udc_remove()
2636 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2637 udc->nullp, 256, in qe_udc_remove()
2639 udc->nullp = DMA_ADDR_INVALID; in qe_udc_remove()
2641 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2642 udc->nullp, 256, in qe_udc_remove()
2646 ep = &udc->eps[0]; in qe_udc_remove()
2652 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2657 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2665 free_irq(udc->usb_irq, udc); in qe_udc_remove()
2666 irq_dispose_mapping(udc->usb_irq); in qe_udc_remove()
2668 tasklet_kill(&udc->rx_tasklet); in qe_udc_remove()
2670 iounmap(udc->usb_regs); in qe_udc_remove()
2672 /* wait for release() of gadget.dev to free udc */ in qe_udc_remove()