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()
562 switch (udc->gadget.speed) { in qe_ep_init()
581 switch (udc->gadget.speed) { in qe_ep_init()
598 switch (udc->gadget.speed) { in qe_ep_init()
634 spin_lock_irqsave(&udc->lock, flags); in qe_ep_init()
645 udc->ep0_dir = USB_DIR_OUT; in qe_ep_init()
646 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_init()
660 qe_ep_bd_init(udc, pipe_num); in qe_ep_init()
674 qe_ep_register_init(udc, pipe_num); in qe_ep_init()
678 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_init()
685 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_init()
687 dev_err(udc->dev, "failed to initialize %s\n", ep->ep.name); in qe_ep_init()
691 static inline void qe_usb_enable(struct qe_udc *udc) in qe_usb_enable() argument
693 setbits8(&udc->usb_regs->usb_usmod, USB_MODE_EN); in qe_usb_enable()
696 static inline void qe_usb_disable(struct qe_udc *udc) in qe_usb_disable() argument
698 clrbits8(&udc->usb_regs->usb_usmod, USB_MODE_EN); in qe_usb_disable()
707 UDC transmit and receive process
755 struct qe_udc *udc = ep->udc; in ep_recycle_rxbds() local
760 ((in_be16(&udc->ep_param[epnum]->rbptr) - in ep_recycle_rxbds()
761 in_be16(&udc->ep_param[epnum]->rbase)) in ep_recycle_rxbds()
776 if (in_be16(&udc->usb_regs->usb_usber) & USB_E_BSY_MASK) in ep_recycle_rxbds()
777 out_be16(&udc->usb_regs->usb_usber, USB_E_BSY_MASK); in ep_recycle_rxbds()
785 static void setup_received_handle(struct qe_udc *udc,
788 static void ep0_req_complete(struct qe_udc *udc, struct qe_req *req);
790 static int ep0_setup_handle(struct qe_udc *udc) in ep0_setup_handle() argument
792 struct qe_ep *ep = &udc->eps[0]; in ep0_setup_handle()
799 && (udc->ep0_state == WAIT_FOR_SETUP)) { in ep0_setup_handle()
803 cp = (u8 *)&udc->local_setup_buff; in ep0_setup_handle()
808 setup_received_handle(udc, &udc->local_setup_buff); in ep0_setup_handle()
814 static int qe_ep0_rx(struct qe_udc *udc) in qe_ep0_rx() argument
816 struct qe_ep *ep = &udc->eps[0]; in qe_ep0_rx()
825 dev_err(udc->dev, "ep0 not a control endpoint\n"); in qe_ep0_rx()
837 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep0_rx()
838 dev_vdbg(udc->dev, in qe_ep0_rx()
860 ep0_setup_handle(udc); in qe_ep0_rx()
865 dev_err(udc->dev, "The receive frame with error!\n"); in qe_ep0_rx()
901 dev_err(ep->udc->dev, "the data01 error!\n"); in qe_ep_rxframe_handle()
907 dev_err(ep->udc->dev, "the %s have no requeue!\n", ep->name); in qe_ep_rxframe_handle()
918 ep0_req_complete(ep->udc, req); in qe_ep_rxframe_handle()
934 struct qe_udc *udc = from_tasklet(udc, t, rx_tasklet); in ep_rx_tasklet() local
942 spin_lock_irqsave(&udc->lock, flags); in ep_rx_tasklet()
945 ep = &udc->eps[i]; in ep_rx_tasklet()
948 dev_dbg(udc->dev, in ep_rx_tasklet()
961 dev_dbg(udc->dev, in ep_rx_tasklet()
989 dev_err(udc->dev, in ep_rx_tasklet()
1017 spin_unlock_irqrestore(&udc->lock, flags); in ep_rx_tasklet()
1022 struct qe_udc *udc; in qe_ep_rx() local
1027 udc = ep->udc; in qe_ep_rx()
1031 dev_err(udc->dev, "transmit ep in rx function\n"); in qe_ep_rx()
1038 ucoffs = (u16)((in_be16(&udc->ep_param[ep->epnum]->rbptr) - in qe_ep_rx()
1039 in_be16(&udc->ep_param[ep->epnum]->rbase)) >> 3); in qe_ep_rx()
1048 dev_vdbg(udc->dev, "%d empty bds, send NACK\n", emptybds); in qe_ep_rx()
1054 dev_vdbg(udc->dev, "The rxep have no req queued with %d BDs\n", in qe_ep_rx()
1059 tasklet_schedule(&udc->rx_tasklet); in qe_ep_rx()
1068 struct qe_udc *udc = ep->udc; in qe_ep_tx() local
1075 dev_err(udc->dev, "receive ep passed to tx function\n"); in qe_ep_tx()
1080 saveusbmr = in_be16(&udc->usb_regs->usb_usbmr); in qe_ep_tx()
1081 out_be16(&udc->usb_regs->usb_usbmr, in qe_ep_tx()
1089 frame_set_data(frame, udc->nullbuf); in qe_ep_tx()
1092 dev_vdbg(udc->dev, "the frame size = 0\n"); in qe_ep_tx()
1104 if ((ep->epnum == 0) && (udc->ep0_state == DATA_STATE_NEED_ZLP)) in qe_ep_tx()
1120 out_be16(&udc->usb_regs->usb_usbmr, saveusbmr); in qe_ep_tx()
1130 out_be16(&udc->usb_regs->usb_usbmr, saveusbmr); in qe_ep_tx()
1131 dev_vdbg(udc->dev, "The tx bd is not ready!\n"); in qe_ep_tx()
1212 struct qe_udc *udc = ep->udc; in sendnulldata() local
1218 frame_set_data(frame, (u8 *)udc->nullbuf); in sendnulldata()
1244 * in status phase, udc create a request and gain status */
1245 static int ep0_prime_status(struct qe_udc *udc, int direction) in ep0_prime_status() argument
1248 struct qe_ep *ep = &udc->eps[0]; in ep0_prime_status()
1251 udc->ep0_state = DATA_STATE_NEED_ZLP; in ep0_prime_status()
1252 udc->ep0_dir = USB_DIR_IN; in ep0_prime_status()
1255 udc->ep0_dir = USB_DIR_OUT; in ep0_prime_status()
1256 udc->ep0_state = WAIT_FOR_OUT_STATUS; in ep0_prime_status()
1262 /* a request complete in ep0, whether gadget request or udc request */
1263 static void ep0_req_complete(struct qe_udc *udc, struct qe_req *req) in ep0_req_complete() argument
1265 struct qe_ep *ep = &udc->eps[0]; in ep0_req_complete()
1268 switch (udc->ep0_state) { in ep0_req_complete()
1272 if (ep0_prime_status(udc, USB_DIR_OUT)) in ep0_req_complete()
1273 qe_ep0_stall(udc); in ep0_req_complete()
1278 udc->ep0_state = WAIT_FOR_SETUP; in ep0_req_complete()
1284 if (ep0_prime_status(udc, USB_DIR_IN)) in ep0_req_complete()
1285 qe_ep0_stall(udc); in ep0_req_complete()
1290 udc->ep0_state = WAIT_FOR_SETUP; in ep0_req_complete()
1294 dev_vdbg(udc->dev, "Unexpected interrupt\n"); in ep0_req_complete()
1298 qe_ep0_stall(udc); in ep0_req_complete()
1310 ep->udc->ep0_state = WAIT_FOR_SETUP; in ep0_txcomplete()
1329 ep0_req_complete(ep->udc, ep->tx_req); in ep0_txcomplete()
1335 dev_vdbg(ep->udc->dev, "the ep0_controller have no req\n"); in ep0_txcomplete()
1346 dev_vdbg(ep->udc->dev, "The EP0 transmit data have error!\n"); in ep0_txframe_handle()
1401 dev_vdbg(ep->udc->dev, "The EP0 transmit data have error!\n"); in ep_txframe_handle()
1471 struct qe_udc *udc = ep->udc; in ep_req_rx() local
1481 dev_vdbg(udc->dev, "the req already finish!\n"); in ep_req_rx()
1514 dev_vdbg(udc->dev, "the data01 error!\n"); in ep_req_rx()
1534 dev_err(udc->dev, "The receive frame with error!\n"); in ep_req_rx()
1584 struct qe_udc *udc; in qe_ep_enable() local
1596 udc = ep->udc; in qe_ep_enable()
1597 if (!udc->driver || (udc->gadget.speed == USB_SPEED_UNKNOWN)) in qe_ep_enable()
1602 retval = qe_ep_init(udc, epnum, desc); in qe_ep_enable()
1605 dev_dbg(udc->dev, "enable ep%d failed\n", ep->epnum); in qe_ep_enable()
1608 dev_dbg(udc->dev, "enable ep%d successful\n", ep->epnum); in qe_ep_enable()
1614 struct qe_udc *udc; in qe_ep_disable() local
1620 udc = ep->udc; in qe_ep_disable()
1623 dev_dbg(udc->dev, "%s not enabled\n", _ep ? ep->ep.name : NULL); in qe_ep_disable()
1627 spin_lock_irqsave(&udc->lock, flags); in qe_ep_disable()
1633 qe_ep_reset(udc, ep->epnum); in qe_ep_disable()
1634 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_disable()
1648 dma_unmap_single(udc->gadget.dev.parent, in qe_ep_disable()
1654 udc->gadget.dev.parent, in qe_ep_disable()
1664 dev_dbg(udc->dev, "disabled %s OK\n", _ep->name); in qe_ep_disable()
1697 struct qe_udc *udc; in __qe_ep_queue() local
1700 udc = ep->udc; in __qe_ep_queue()
1704 dev_dbg(udc->dev, "bad params\n"); in __qe_ep_queue()
1708 dev_dbg(udc->dev, "bad ep\n"); in __qe_ep_queue()
1712 if (!udc->driver || udc->gadget.speed == USB_SPEED_UNKNOWN) in __qe_ep_queue()
1719 req->req.dma = dma_map_single(ep->udc->gadget.dev.parent, in __qe_ep_queue()
1727 dma_sync_single_for_device(ep->udc->gadget.dev.parent, in __qe_ep_queue()
1739 dev_vdbg(udc->dev, "gadget have request in %s! %d\n", in __qe_ep_queue()
1749 udc->ep0_state = DATA_STATE_XMIT; in __qe_ep_queue()
1751 udc->ep0_state = DATA_STATE_RECV; in __qe_ep_queue()
1765 struct qe_udc *udc = ep->udc; in qe_ep_queue() local
1769 spin_lock_irqsave(&udc->lock, flags); in qe_ep_queue()
1771 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_queue()
1786 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_dequeue()
1797 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1803 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1818 struct qe_udc *udc; in qe_ep_set_halt() local
1826 udc = ep->udc; in qe_ep_set_halt()
1835 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_set_halt()
1838 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_set_halt()
1841 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_set_halt()
1842 udc->ep0_dir = 0; in qe_ep_set_halt()
1849 dev_vdbg(udc->dev, "%s %s halt stat %d\n", ep->ep.name, in qe_ep_set_halt()
1875 struct qe_udc *udc = container_of(gadget, struct qe_udc, gadget); in qe_get_frame() local
1878 tmp = in_be16(&udc->usb_param->frame_n); in qe_get_frame()
1898 static int udc_reset_ep_queue(struct qe_udc *udc, u8 pipe) in udc_reset_ep_queue() argument
1900 struct qe_ep *ep = &udc->eps[pipe]; in udc_reset_ep_queue()
1907 static int reset_queues(struct qe_udc *udc) in reset_queues() argument
1912 udc_reset_ep_queue(udc, pipe); in reset_queues()
1915 spin_unlock(&udc->lock); in reset_queues()
1916 usb_gadget_udc_reset(&udc->gadget, udc->driver); in reset_queues()
1917 spin_lock(&udc->lock); in reset_queues()
1922 static void ch9setaddress(struct qe_udc *udc, u16 value, u16 index, in ch9setaddress() argument
1926 udc->device_address = (u8) value; in ch9setaddress()
1928 udc->usb_state = USB_STATE_ADDRESS; in ch9setaddress()
1931 if (ep0_prime_status(udc, USB_DIR_IN)) in ch9setaddress()
1932 qe_ep0_stall(udc); in ch9setaddress()
1943 static void ch9getstatus(struct qe_udc *udc, u8 request_type, u16 value, in ch9getstatus() argument
1951 ep = &udc->eps[0]; in ch9getstatus()
1957 /* We don't have interface information in udc driver */ in ch9getstatus()
1964 struct qe_ep *target_ep = &udc->eps[pipe]; in ch9getstatus()
1971 usep = in_be16(&udc->usb_regs->usb_usep[pipe]); in ch9getstatus()
1988 req->req.buf = udc->statusbuf; in ch9getstatus()
1994 udc->ep0_dir = USB_DIR_IN; in ch9getstatus()
2002 dev_err(udc->dev, "Can't respond to getstatus request \n"); in ch9getstatus()
2003 qe_ep0_stall(udc); in ch9getstatus()
2007 static void setup_received_handle(struct qe_udc *udc, in setup_received_handle() argument
2010 /* Fix Endian (udc->local_setup_buff is cpu Endian now)*/ in setup_received_handle()
2016 udc_reset_ep_queue(udc, 0); in setup_received_handle()
2019 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2021 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2025 /* Data+Status phase form udc */ in setup_received_handle()
2029 ch9getstatus(udc, setup->bRequestType, wValue, wIndex, in setup_received_handle()
2034 /* Status phase from udc */ in setup_received_handle()
2038 ch9setaddress(udc, wValue, wIndex, wLength); in setup_received_handle()
2043 /* Requests with no data phase, status phase from udc */ in setup_received_handle()
2056 ep = &udc->eps[pipe]; in setup_received_handle()
2058 spin_unlock(&udc->lock); in setup_received_handle()
2062 spin_lock(&udc->lock); in setup_received_handle()
2065 ep0_prime_status(udc, USB_DIR_IN); in setup_received_handle()
2074 /* Data phase from gadget, status phase from udc */ in setup_received_handle()
2076 udc->ep0_state = DATA_STATE_XMIT; in setup_received_handle()
2077 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2079 udc->ep0_state = DATA_STATE_RECV; in setup_received_handle()
2080 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2082 spin_unlock(&udc->lock); in setup_received_handle()
2083 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2084 &udc->local_setup_buff) < 0) in setup_received_handle()
2085 qe_ep0_stall(udc); in setup_received_handle()
2086 spin_lock(&udc->lock); in setup_received_handle()
2089 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2090 spin_unlock(&udc->lock); in setup_received_handle()
2091 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2092 &udc->local_setup_buff) < 0) in setup_received_handle()
2093 qe_ep0_stall(udc); in setup_received_handle()
2094 spin_lock(&udc->lock); in setup_received_handle()
2095 udc->ep0_state = DATA_STATE_NEED_ZLP; in setup_received_handle()
2102 static void suspend_irq(struct qe_udc *udc) in suspend_irq() argument
2104 udc->resume_state = udc->usb_state; in suspend_irq()
2105 udc->usb_state = USB_STATE_SUSPENDED; in suspend_irq()
2108 if (udc->driver->suspend) in suspend_irq()
2109 udc->driver->suspend(&udc->gadget); in suspend_irq()
2112 static void resume_irq(struct qe_udc *udc) in resume_irq() argument
2114 udc->usb_state = udc->resume_state; in resume_irq()
2115 udc->resume_state = 0; in resume_irq()
2118 if (udc->driver->resume) in resume_irq()
2119 udc->driver->resume(&udc->gadget); in resume_irq()
2122 static void idle_irq(struct qe_udc *udc) in idle_irq() argument
2126 usbs = in_8(&udc->usb_regs->usb_usbs); in idle_irq()
2128 if ((udc->usb_state) != USB_STATE_SUSPENDED) in idle_irq()
2129 suspend_irq(udc); in idle_irq()
2131 if (udc->usb_state == USB_STATE_SUSPENDED) in idle_irq()
2132 resume_irq(udc); in idle_irq()
2136 static int reset_irq(struct qe_udc *udc) in reset_irq() argument
2140 if (udc->usb_state == USB_STATE_DEFAULT) in reset_irq()
2143 qe_usb_disable(udc); in reset_irq()
2144 out_8(&udc->usb_regs->usb_usadr, 0); in reset_irq()
2147 if (udc->eps[i].init) in reset_irq()
2148 qe_ep_reset(udc, i); in reset_irq()
2151 reset_queues(udc); in reset_irq()
2152 udc->usb_state = USB_STATE_DEFAULT; in reset_irq()
2153 udc->ep0_state = WAIT_FOR_SETUP; in reset_irq()
2154 udc->ep0_dir = USB_DIR_OUT; in reset_irq()
2155 qe_usb_enable(udc); in reset_irq()
2159 static int bsy_irq(struct qe_udc *udc) in bsy_irq() argument
2164 static int txe_irq(struct qe_udc *udc) in txe_irq() argument
2170 static int tx_irq(struct qe_udc *udc) in tx_irq() argument
2176 if ((udc->usb_state == USB_STATE_ADDRESS) in tx_irq()
2177 && (in_8(&udc->usb_regs->usb_usadr) == 0)) in tx_irq()
2178 out_8(&udc->usb_regs->usb_usadr, udc->device_address); in tx_irq()
2181 ep = &udc->eps[i]; in tx_irq()
2199 static void rx_irq(struct qe_udc *udc) in rx_irq() argument
2206 ep = &udc->eps[i]; in rx_irq()
2212 qe_ep0_rx(udc); in rx_irq()
2224 struct qe_udc *udc = (struct qe_udc *)_udc; in qe_udc_irq() local
2229 spin_lock_irqsave(&udc->lock, flags); in qe_udc_irq()
2231 irq_src = in_be16(&udc->usb_regs->usb_usber) & in qe_udc_irq()
2232 in_be16(&udc->usb_regs->usb_usbmr); in qe_udc_irq()
2234 out_be16(&udc->usb_regs->usb_usber, irq_src); in qe_udc_irq()
2237 idle_irq(udc); in qe_udc_irq()
2243 tx_irq(udc); in qe_udc_irq()
2249 rx_irq(udc); in qe_udc_irq()
2255 reset_irq(udc); in qe_udc_irq()
2261 bsy_irq(udc); in qe_udc_irq()
2267 txe_irq(udc); in qe_udc_irq()
2272 spin_unlock_irqrestore(&udc->lock, flags); in qe_udc_irq()
2283 struct qe_udc *udc; in fsl_qe_start() local
2286 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_start()
2288 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_start()
2291 udc->driver = driver; in fsl_qe_start()
2292 udc->gadget.speed = driver->max_speed; in fsl_qe_start()
2295 qe_usb_enable(udc); in fsl_qe_start()
2297 out_be16(&udc->usb_regs->usb_usber, 0xffff); in fsl_qe_start()
2298 out_be16(&udc->usb_regs->usb_usbmr, USB_E_DEFAULT_DEVICE); in fsl_qe_start()
2299 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_start()
2300 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_start()
2301 udc->ep0_dir = USB_DIR_OUT; in fsl_qe_start()
2302 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_start()
2309 struct qe_udc *udc; in fsl_qe_stop() local
2313 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_stop()
2315 qe_usb_disable(udc); in fsl_qe_stop()
2318 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_stop()
2319 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_stop()
2320 udc->ep0_dir = 0; in fsl_qe_stop()
2323 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_stop()
2324 udc->gadget.speed = USB_SPEED_UNKNOWN; in fsl_qe_stop()
2325 nuke(&udc->eps[0], -ESHUTDOWN); in fsl_qe_stop()
2326 list_for_each_entry(loop_ep, &udc->gadget.ep_list, ep.ep_list) in fsl_qe_stop()
2328 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_stop()
2330 udc->driver = NULL; in fsl_qe_stop()
2335 /* udc structure's alloc and setup, include ep-param alloc */
2338 struct qe_udc *udc; in qe_udc_config() local
2346 udc = kzalloc(sizeof(*udc), GFP_KERNEL); in qe_udc_config()
2347 if (!udc) in qe_udc_config()
2350 udc->dev = &ofdev->dev; in qe_udc_config()
2354 udc->usb_param = cpm_muram_addr(offset); in qe_udc_config()
2355 memset_io(udc->usb_param, 0, size); in qe_udc_config()
2357 usbpram = udc->usb_param; in qe_udc_config()
2369 udc->ep_param[i] = cpm_muram_addr(tmp_addr); in qe_udc_config()
2373 memset_io(udc->ep_param[0], 0, in qe_udc_config()
2376 udc->resume_state = USB_STATE_NOTATTACHED; in qe_udc_config()
2377 udc->usb_state = USB_STATE_POWERED; in qe_udc_config()
2378 udc->ep0_dir = 0; in qe_udc_config()
2380 spin_lock_init(&udc->lock); in qe_udc_config()
2381 return udc; in qe_udc_config()
2384 kfree(udc); in qe_udc_config()
2389 static int qe_udc_reg_init(struct qe_udc *udc) in qe_udc_reg_init() argument
2392 qe_usbregs = udc->usb_regs; in qe_udc_reg_init()
2407 static int qe_ep_config(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_config() argument
2409 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_config()
2411 ep->udc = udc; in qe_ep_config()
2446 list_add_tail(&ep->ep.ep_list, &udc->gadget.ep_list); in qe_ep_config()
2448 ep->gadget = &udc->gadget; in qe_ep_config()
2454 * UDC device Driver operation functions *
2458 struct qe_udc *udc = container_of(dev, struct qe_udc, gadget.dev); in qe_udc_release() local
2461 complete(udc->done); in qe_udc_release()
2462 cpm_muram_free(cpm_muram_offset(udc->ep_param[0])); in qe_udc_release()
2464 udc->ep_param[i] = NULL; in qe_udc_release()
2466 kfree(udc); in qe_udc_release()
2473 struct qe_udc *udc; in qe_udc_probe() local
2489 /* Initialize the udc structure including QH member and other member */ in qe_udc_probe()
2490 udc = qe_udc_config(ofdev); in qe_udc_probe()
2491 if (!udc) { in qe_udc_probe()
2496 udc->soc_type = (unsigned long)match->data; in qe_udc_probe()
2497 udc->usb_regs = of_iomap(np, 0); in qe_udc_probe()
2498 if (!udc->usb_regs) { in qe_udc_probe()
2505 qe_udc_reg_init(udc); in qe_udc_probe()
2509 udc->gadget.ops = &qe_gadget_ops; in qe_udc_probe()
2512 udc->gadget.ep0 = &udc->eps[0].ep; in qe_udc_probe()
2514 INIT_LIST_HEAD(&udc->gadget.ep_list); in qe_udc_probe()
2517 udc->gadget.speed = USB_SPEED_UNKNOWN; in qe_udc_probe()
2520 udc->gadget.name = driver_name; in qe_udc_probe()
2521 udc->gadget.dev.parent = &ofdev->dev; in qe_udc_probe()
2530 qe_ep_config(udc, (unsigned char)i); in qe_udc_probe()
2534 ret = qe_ep_init(udc, 0, &qe_ep0_desc); in qe_udc_probe()
2539 udc->nullbuf = devm_kzalloc(&ofdev->dev, 256, GFP_KERNEL); in qe_udc_probe()
2540 if (udc->nullbuf == NULL) { in qe_udc_probe()
2546 udc->statusbuf = devm_kzalloc(&ofdev->dev, 2, GFP_KERNEL); in qe_udc_probe()
2547 if (udc->statusbuf == NULL) { in qe_udc_probe()
2552 udc->nullp = virt_to_phys((void *)udc->nullbuf); in qe_udc_probe()
2553 if (udc->nullp == DMA_ADDR_INVALID) { in qe_udc_probe()
2554 udc->nullp = dma_map_single( in qe_udc_probe()
2555 udc->gadget.dev.parent, in qe_udc_probe()
2556 udc->nullbuf, in qe_udc_probe()
2559 udc->nullmap = 1; in qe_udc_probe()
2561 dma_sync_single_for_device(udc->gadget.dev.parent, in qe_udc_probe()
2562 udc->nullp, 256, in qe_udc_probe()
2566 tasklet_setup(&udc->rx_tasklet, ep_rx_tasklet); in qe_udc_probe()
2568 udc->usb_irq = irq_of_parse_and_map(np, 0); in qe_udc_probe()
2569 if (!udc->usb_irq) { in qe_udc_probe()
2574 ret = request_irq(udc->usb_irq, qe_udc_irq, 0, in qe_udc_probe()
2575 driver_name, udc); in qe_udc_probe()
2577 dev_err(udc->dev, "cannot request irq %d err %d\n", in qe_udc_probe()
2578 udc->usb_irq, ret); in qe_udc_probe()
2582 ret = usb_add_gadget_udc_release(&ofdev->dev, &udc->gadget, in qe_udc_probe()
2587 platform_set_drvdata(ofdev, udc); in qe_udc_probe()
2588 dev_info(udc->dev, in qe_udc_probe()
2590 (udc->soc_type == PORT_QE) ? "QE" : "CPM"); in qe_udc_probe()
2594 free_irq(udc->usb_irq, udc); in qe_udc_probe()
2596 irq_dispose_mapping(udc->usb_irq); in qe_udc_probe()
2598 if (udc->nullmap) { in qe_udc_probe()
2599 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_probe()
2600 udc->nullp, 256, in qe_udc_probe()
2602 udc->nullp = DMA_ADDR_INVALID; in qe_udc_probe()
2604 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_probe()
2605 udc->nullp, 256, in qe_udc_probe()
2609 ep = &udc->eps[0]; in qe_udc_probe()
2615 iounmap(udc->usb_regs); in qe_udc_probe()
2617 kfree(udc); in qe_udc_probe()
2635 struct qe_udc *udc = platform_get_drvdata(ofdev); in qe_udc_remove() local
2640 usb_del_gadget_udc(&udc->gadget); in qe_udc_remove()
2642 udc->done = &done; in qe_udc_remove()
2643 tasklet_disable(&udc->rx_tasklet); in qe_udc_remove()
2645 if (udc->nullmap) { in qe_udc_remove()
2646 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2647 udc->nullp, 256, in qe_udc_remove()
2649 udc->nullp = DMA_ADDR_INVALID; in qe_udc_remove()
2651 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2652 udc->nullp, 256, in qe_udc_remove()
2656 ep = &udc->eps[0]; in qe_udc_remove()
2662 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2667 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2675 free_irq(udc->usb_irq, udc); in qe_udc_remove()
2676 irq_dispose_mapping(udc->usb_irq); in qe_udc_remove()
2678 tasklet_kill(&udc->rx_tasklet); in qe_udc_remove()
2680 iounmap(udc->usb_regs); in qe_udc_remove()
2682 /* wait for release() of gadget.dev to free udc */ in qe_udc_remove()