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()
1785 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_dequeue()
1794 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1800 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1815 struct qe_udc *udc; in qe_ep_set_halt() local
1823 udc = ep->udc; in qe_ep_set_halt()
1832 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_set_halt()
1835 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_set_halt()
1838 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_set_halt()
1839 udc->ep0_dir = 0; in qe_ep_set_halt()
1846 dev_vdbg(udc->dev, "%s %s halt stat %d\n", ep->ep.name, in qe_ep_set_halt()
1872 struct qe_udc *udc = container_of(gadget, struct qe_udc, gadget); in qe_get_frame() local
1875 tmp = in_be16(&udc->usb_param->frame_n); in qe_get_frame()
1895 static int udc_reset_ep_queue(struct qe_udc *udc, u8 pipe) in udc_reset_ep_queue() argument
1897 struct qe_ep *ep = &udc->eps[pipe]; in udc_reset_ep_queue()
1904 static int reset_queues(struct qe_udc *udc) in reset_queues() argument
1909 udc_reset_ep_queue(udc, pipe); in reset_queues()
1912 spin_unlock(&udc->lock); in reset_queues()
1913 usb_gadget_udc_reset(&udc->gadget, udc->driver); in reset_queues()
1914 spin_lock(&udc->lock); in reset_queues()
1919 static void ch9setaddress(struct qe_udc *udc, u16 value, u16 index, in ch9setaddress() argument
1923 udc->device_address = (u8) value; in ch9setaddress()
1925 udc->usb_state = USB_STATE_ADDRESS; in ch9setaddress()
1928 if (ep0_prime_status(udc, USB_DIR_IN)) in ch9setaddress()
1929 qe_ep0_stall(udc); in ch9setaddress()
1940 static void ch9getstatus(struct qe_udc *udc, u8 request_type, u16 value, in ch9getstatus() argument
1948 ep = &udc->eps[0]; in ch9getstatus()
1954 /* We don't have interface information in udc driver */ in ch9getstatus()
1959 struct qe_ep *target_ep = &udc->eps[pipe]; in ch9getstatus()
1966 usep = in_be16(&udc->usb_regs->usb_usep[pipe]); in ch9getstatus()
1983 req->req.buf = udc->statusbuf; in ch9getstatus()
1989 udc->ep0_dir = USB_DIR_IN; in ch9getstatus()
1997 dev_err(udc->dev, "Can't respond to getstatus request \n"); in ch9getstatus()
1998 qe_ep0_stall(udc); in ch9getstatus()
2002 static void setup_received_handle(struct qe_udc *udc, in setup_received_handle() argument
2005 /* Fix Endian (udc->local_setup_buff is cpu Endian now)*/ in setup_received_handle()
2011 udc_reset_ep_queue(udc, 0); in setup_received_handle()
2014 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2016 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2020 /* Data+Status phase form udc */ in setup_received_handle()
2024 ch9getstatus(udc, setup->bRequestType, wValue, wIndex, in setup_received_handle()
2029 /* Status phase from udc */ in setup_received_handle()
2033 ch9setaddress(udc, wValue, wIndex, wLength); in setup_received_handle()
2038 /* Requests with no data phase, status phase from udc */ in setup_received_handle()
2051 ep = &udc->eps[pipe]; in setup_received_handle()
2053 spin_unlock(&udc->lock); in setup_received_handle()
2057 spin_lock(&udc->lock); in setup_received_handle()
2060 ep0_prime_status(udc, USB_DIR_IN); in setup_received_handle()
2069 /* Data phase from gadget, status phase from udc */ in setup_received_handle()
2071 udc->ep0_state = DATA_STATE_XMIT; in setup_received_handle()
2072 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2074 udc->ep0_state = DATA_STATE_RECV; in setup_received_handle()
2075 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2077 spin_unlock(&udc->lock); in setup_received_handle()
2078 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2079 &udc->local_setup_buff) < 0) in setup_received_handle()
2080 qe_ep0_stall(udc); in setup_received_handle()
2081 spin_lock(&udc->lock); in setup_received_handle()
2084 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2085 spin_unlock(&udc->lock); in setup_received_handle()
2086 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2087 &udc->local_setup_buff) < 0) in setup_received_handle()
2088 qe_ep0_stall(udc); in setup_received_handle()
2089 spin_lock(&udc->lock); in setup_received_handle()
2090 udc->ep0_state = DATA_STATE_NEED_ZLP; in setup_received_handle()
2097 static void suspend_irq(struct qe_udc *udc) in suspend_irq() argument
2099 udc->resume_state = udc->usb_state; in suspend_irq()
2100 udc->usb_state = USB_STATE_SUSPENDED; in suspend_irq()
2103 if (udc->driver->suspend) in suspend_irq()
2104 udc->driver->suspend(&udc->gadget); in suspend_irq()
2107 static void resume_irq(struct qe_udc *udc) in resume_irq() argument
2109 udc->usb_state = udc->resume_state; in resume_irq()
2110 udc->resume_state = 0; in resume_irq()
2113 if (udc->driver->resume) in resume_irq()
2114 udc->driver->resume(&udc->gadget); in resume_irq()
2117 static void idle_irq(struct qe_udc *udc) in idle_irq() argument
2121 usbs = in_8(&udc->usb_regs->usb_usbs); in idle_irq()
2123 if ((udc->usb_state) != USB_STATE_SUSPENDED) in idle_irq()
2124 suspend_irq(udc); in idle_irq()
2126 if (udc->usb_state == USB_STATE_SUSPENDED) in idle_irq()
2127 resume_irq(udc); in idle_irq()
2131 static int reset_irq(struct qe_udc *udc) in reset_irq() argument
2135 if (udc->usb_state == USB_STATE_DEFAULT) in reset_irq()
2138 qe_usb_disable(udc); in reset_irq()
2139 out_8(&udc->usb_regs->usb_usadr, 0); in reset_irq()
2142 if (udc->eps[i].init) in reset_irq()
2143 qe_ep_reset(udc, i); in reset_irq()
2146 reset_queues(udc); in reset_irq()
2147 udc->usb_state = USB_STATE_DEFAULT; in reset_irq()
2148 udc->ep0_state = WAIT_FOR_SETUP; in reset_irq()
2149 udc->ep0_dir = USB_DIR_OUT; in reset_irq()
2150 qe_usb_enable(udc); in reset_irq()
2154 static int bsy_irq(struct qe_udc *udc) in bsy_irq() argument
2159 static int txe_irq(struct qe_udc *udc) in txe_irq() argument
2165 static int tx_irq(struct qe_udc *udc) in tx_irq() argument
2171 if ((udc->usb_state == USB_STATE_ADDRESS) in tx_irq()
2172 && (in_8(&udc->usb_regs->usb_usadr) == 0)) in tx_irq()
2173 out_8(&udc->usb_regs->usb_usadr, udc->device_address); in tx_irq()
2176 ep = &udc->eps[i]; in tx_irq()
2194 static void rx_irq(struct qe_udc *udc) in rx_irq() argument
2201 ep = &udc->eps[i]; in rx_irq()
2207 qe_ep0_rx(udc); in rx_irq()
2219 struct qe_udc *udc = (struct qe_udc *)_udc; in qe_udc_irq() local
2224 spin_lock_irqsave(&udc->lock, flags); in qe_udc_irq()
2226 irq_src = in_be16(&udc->usb_regs->usb_usber) & in qe_udc_irq()
2227 in_be16(&udc->usb_regs->usb_usbmr); in qe_udc_irq()
2229 out_be16(&udc->usb_regs->usb_usber, irq_src); in qe_udc_irq()
2232 idle_irq(udc); in qe_udc_irq()
2238 tx_irq(udc); in qe_udc_irq()
2244 rx_irq(udc); in qe_udc_irq()
2250 reset_irq(udc); in qe_udc_irq()
2256 bsy_irq(udc); in qe_udc_irq()
2262 txe_irq(udc); in qe_udc_irq()
2267 spin_unlock_irqrestore(&udc->lock, flags); in qe_udc_irq()
2278 struct qe_udc *udc; in fsl_qe_start() local
2281 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_start()
2283 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_start()
2287 udc->driver = driver; in fsl_qe_start()
2288 udc->gadget.speed = driver->max_speed; in fsl_qe_start()
2291 qe_usb_enable(udc); in fsl_qe_start()
2293 out_be16(&udc->usb_regs->usb_usber, 0xffff); in fsl_qe_start()
2294 out_be16(&udc->usb_regs->usb_usbmr, USB_E_DEFAULT_DEVICE); in fsl_qe_start()
2295 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_start()
2296 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_start()
2297 udc->ep0_dir = USB_DIR_OUT; in fsl_qe_start()
2298 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_start()
2305 struct qe_udc *udc; in fsl_qe_stop() local
2309 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_stop()
2311 qe_usb_disable(udc); in fsl_qe_stop()
2314 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_stop()
2315 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_stop()
2316 udc->ep0_dir = 0; in fsl_qe_stop()
2319 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_stop()
2320 udc->gadget.speed = USB_SPEED_UNKNOWN; in fsl_qe_stop()
2321 nuke(&udc->eps[0], -ESHUTDOWN); in fsl_qe_stop()
2322 list_for_each_entry(loop_ep, &udc->gadget.ep_list, ep.ep_list) in fsl_qe_stop()
2324 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_stop()
2326 udc->driver = NULL; in fsl_qe_stop()
2331 /* udc structure's alloc and setup, include ep-param alloc */
2334 struct qe_udc *udc; in qe_udc_config() local
2342 udc = kzalloc(sizeof(*udc), GFP_KERNEL); in qe_udc_config()
2343 if (!udc) in qe_udc_config()
2346 udc->dev = &ofdev->dev; in qe_udc_config()
2350 udc->usb_param = cpm_muram_addr(offset); in qe_udc_config()
2351 memset_io(udc->usb_param, 0, size); in qe_udc_config()
2353 usbpram = udc->usb_param; in qe_udc_config()
2365 udc->ep_param[i] = cpm_muram_addr(tmp_addr); in qe_udc_config()
2369 memset_io(udc->ep_param[0], 0, in qe_udc_config()
2372 udc->resume_state = USB_STATE_NOTATTACHED; in qe_udc_config()
2373 udc->usb_state = USB_STATE_POWERED; in qe_udc_config()
2374 udc->ep0_dir = 0; in qe_udc_config()
2376 spin_lock_init(&udc->lock); in qe_udc_config()
2377 return udc; in qe_udc_config()
2380 kfree(udc); in qe_udc_config()
2385 static int qe_udc_reg_init(struct qe_udc *udc) in qe_udc_reg_init() argument
2388 qe_usbregs = udc->usb_regs; in qe_udc_reg_init()
2403 static int qe_ep_config(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_config() argument
2405 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_config()
2407 ep->udc = udc; in qe_ep_config()
2442 list_add_tail(&ep->ep.ep_list, &udc->gadget.ep_list); in qe_ep_config()
2444 ep->gadget = &udc->gadget; in qe_ep_config()
2450 * UDC device Driver operation functions *
2454 struct qe_udc *udc = container_of(dev, struct qe_udc, gadget.dev); in qe_udc_release() local
2457 complete(udc->done); in qe_udc_release()
2458 cpm_muram_free(cpm_muram_offset(udc->ep_param[0])); in qe_udc_release()
2460 udc->ep_param[i] = NULL; in qe_udc_release()
2462 kfree(udc); in qe_udc_release()
2469 struct qe_udc *udc; in qe_udc_probe() local
2485 /* Initialize the udc structure including QH member and other member */ in qe_udc_probe()
2486 udc = qe_udc_config(ofdev); in qe_udc_probe()
2487 if (!udc) { in qe_udc_probe()
2492 udc->soc_type = (unsigned long)match->data; in qe_udc_probe()
2493 udc->usb_regs = of_iomap(np, 0); in qe_udc_probe()
2494 if (!udc->usb_regs) { in qe_udc_probe()
2501 qe_udc_reg_init(udc); in qe_udc_probe()
2505 udc->gadget.ops = &qe_gadget_ops; in qe_udc_probe()
2508 udc->gadget.ep0 = &udc->eps[0].ep; in qe_udc_probe()
2510 INIT_LIST_HEAD(&udc->gadget.ep_list); in qe_udc_probe()
2513 udc->gadget.speed = USB_SPEED_UNKNOWN; in qe_udc_probe()
2516 udc->gadget.name = driver_name; in qe_udc_probe()
2517 udc->gadget.dev.parent = &ofdev->dev; in qe_udc_probe()
2526 qe_ep_config(udc, (unsigned char)i); in qe_udc_probe()
2530 ret = qe_ep_init(udc, 0, &qe_ep0_desc); in qe_udc_probe()
2535 udc->nullbuf = devm_kzalloc(&ofdev->dev, 256, GFP_KERNEL); in qe_udc_probe()
2536 if (udc->nullbuf == NULL) { in qe_udc_probe()
2542 udc->statusbuf = devm_kzalloc(&ofdev->dev, 2, GFP_KERNEL); in qe_udc_probe()
2543 if (udc->statusbuf == NULL) { in qe_udc_probe()
2548 udc->nullp = virt_to_phys((void *)udc->nullbuf); in qe_udc_probe()
2549 if (udc->nullp == DMA_ADDR_INVALID) { in qe_udc_probe()
2550 udc->nullp = dma_map_single( in qe_udc_probe()
2551 udc->gadget.dev.parent, in qe_udc_probe()
2552 udc->nullbuf, in qe_udc_probe()
2555 udc->nullmap = 1; in qe_udc_probe()
2557 dma_sync_single_for_device(udc->gadget.dev.parent, in qe_udc_probe()
2558 udc->nullp, 256, in qe_udc_probe()
2562 tasklet_setup(&udc->rx_tasklet, ep_rx_tasklet); in qe_udc_probe()
2564 udc->usb_irq = irq_of_parse_and_map(np, 0); in qe_udc_probe()
2565 if (!udc->usb_irq) { in qe_udc_probe()
2570 ret = request_irq(udc->usb_irq, qe_udc_irq, 0, in qe_udc_probe()
2571 driver_name, udc); in qe_udc_probe()
2573 dev_err(udc->dev, "cannot request irq %d err %d\n", in qe_udc_probe()
2574 udc->usb_irq, ret); in qe_udc_probe()
2578 ret = usb_add_gadget_udc_release(&ofdev->dev, &udc->gadget, in qe_udc_probe()
2583 platform_set_drvdata(ofdev, udc); in qe_udc_probe()
2584 dev_info(udc->dev, in qe_udc_probe()
2586 (udc->soc_type == PORT_QE) ? "QE" : "CPM"); in qe_udc_probe()
2590 free_irq(udc->usb_irq, udc); in qe_udc_probe()
2592 irq_dispose_mapping(udc->usb_irq); in qe_udc_probe()
2594 if (udc->nullmap) { in qe_udc_probe()
2595 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_probe()
2596 udc->nullp, 256, in qe_udc_probe()
2598 udc->nullp = DMA_ADDR_INVALID; in qe_udc_probe()
2600 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_probe()
2601 udc->nullp, 256, in qe_udc_probe()
2605 ep = &udc->eps[0]; in qe_udc_probe()
2611 iounmap(udc->usb_regs); in qe_udc_probe()
2613 kfree(udc); in qe_udc_probe()
2631 struct qe_udc *udc = platform_get_drvdata(ofdev); in qe_udc_remove() local
2636 usb_del_gadget_udc(&udc->gadget); in qe_udc_remove()
2638 udc->done = &done; in qe_udc_remove()
2639 tasklet_disable(&udc->rx_tasklet); in qe_udc_remove()
2641 if (udc->nullmap) { in qe_udc_remove()
2642 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2643 udc->nullp, 256, in qe_udc_remove()
2645 udc->nullp = DMA_ADDR_INVALID; in qe_udc_remove()
2647 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2648 udc->nullp, 256, in qe_udc_remove()
2652 ep = &udc->eps[0]; in qe_udc_remove()
2658 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2663 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2671 free_irq(udc->usb_irq, udc); in qe_udc_remove()
2672 irq_dispose_mapping(udc->usb_irq); in qe_udc_remove()
2674 tasklet_kill(&udc->rx_tasklet); in qe_udc_remove()
2676 iounmap(udc->usb_regs); in qe_udc_remove()
2678 /* wait for release() of gadget.dev to free udc */ in qe_udc_remove()