Lines Matching refs:udc
82 struct qe_udc *udc = ep->udc; in done() local
98 dma_unmap_single(udc->gadget.dev.parent, in done()
106 dma_sync_single_for_cpu(udc->gadget.dev.parent, in done()
113 dev_vdbg(udc->dev, "complete %s req %p stat %d len %u/%u\n", in done()
119 spin_unlock(&udc->lock); in done()
123 spin_lock(&udc->lock); in done()
150 struct qe_udc *udc = ep->udc; in qe_eprx_stall_change() local
152 tem_usep = in_be16(&udc->usb_regs->usb_usep[epnum]); in qe_eprx_stall_change()
159 out_be16(&udc->usb_regs->usb_usep[epnum], tem_usep); in qe_eprx_stall_change()
167 struct qe_udc *udc = ep->udc; in qe_eptx_stall_change() local
169 tem_usep = in_be16(&udc->usb_regs->usb_usep[epnum]); in qe_eptx_stall_change()
176 out_be16(&udc->usb_regs->usb_usep[epnum], tem_usep); in qe_eptx_stall_change()
181 static int qe_ep0_stall(struct qe_udc *udc) in qe_ep0_stall() argument
183 qe_eptx_stall_change(&udc->eps[0], 1); in qe_ep0_stall()
184 qe_eprx_stall_change(&udc->eps[0], 1); in qe_ep0_stall()
185 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep0_stall()
186 udc->ep0_dir = 0; in qe_ep0_stall()
193 struct qe_udc *udc = ep->udc; in qe_eprx_nack() local
197 clrsetbits_be16(&udc->usb_regs->usb_usep[epnum], in qe_eprx_nack()
201 clrbits16(&udc->usb_regs->usb_usbmr, in qe_eprx_nack()
211 struct qe_udc *udc = ep->udc; in qe_eprx_normal() local
214 clrsetbits_be16(&udc->usb_regs->usb_usep[ep->epnum], in qe_eprx_normal()
218 out_be16(&udc->usb_regs->usb_usber, in qe_eprx_normal()
220 setbits16(&udc->usb_regs->usb_usbmr, in qe_eprx_normal()
232 if (ep->udc->soc_type == PORT_CPM) in qe_ep_cmd_stoptx()
244 if (ep->udc->soc_type == PORT_CPM) in qe_ep_cmd_restarttx()
256 struct qe_udc *udc = ep->udc; in qe_ep_flushtxfifo() local
262 out_8(&udc->usb_regs->usb_uscom, in qe_ep_flushtxfifo()
264 out_be16(&udc->ep_param[i]->tbptr, in_be16(&udc->ep_param[i]->tbase)); in qe_ep_flushtxfifo()
265 out_be32(&udc->ep_param[i]->tstate, 0); in qe_ep_flushtxfifo()
266 out_be16(&udc->ep_param[i]->tbcnt, 0); in qe_ep_flushtxfifo()
276 struct qe_udc *udc = ep->udc; in qe_ep_filltxfifo() local
278 out_8(&udc->usb_regs->usb_uscom, in qe_ep_filltxfifo()
283 static int qe_epbds_reset(struct qe_udc *udc, int pipe_num) in qe_epbds_reset() argument
290 ep = &udc->eps[pipe_num]; in qe_epbds_reset()
315 static int qe_ep_reset(struct qe_udc *udc, int pipe_num) in qe_ep_reset() argument
320 ep = &udc->eps[pipe_num]; in qe_ep_reset()
321 tmpusep = in_be16(&udc->usb_regs->usb_usep[pipe_num]); in qe_ep_reset()
338 out_be16(&udc->usb_regs->usb_usep[pipe_num], tmpusep); in qe_ep_reset()
340 qe_epbds_reset(udc, pipe_num); in qe_ep_reset()
351 static int qe_ep_bd_init(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_bd_init() argument
353 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_bd_init()
365 epparam = udc->ep_param[pipe_num]; in qe_ep_bd_init()
425 dev_err(ep->udc->dev, "malloc rxframe failed\n"); in qe_ep_rxbd_update()
439 dev_err(ep->udc->dev, "malloc rxbuffer failed,size=%d\n", in qe_ep_rxbd_update()
447 ep->rxbuf_d = dma_map_single(ep->udc->gadget.dev.parent, in qe_ep_rxbd_update()
453 dma_sync_single_for_device(ep->udc->gadget.dev.parent, in qe_ep_rxbd_update()
475 static int qe_ep_register_init(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_register_init() argument
477 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_register_init()
483 epparam = udc->ep_param[pipe_num]; in qe_ep_register_init()
514 out_be16(&udc->usb_regs->usb_usep[pipe_num], usep); in qe_ep_register_init()
528 static int qe_ep_init(struct qe_udc *udc, in qe_ep_init() argument
532 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_init()
548 switch (udc->gadget.speed) { in qe_ep_init()
569 switch (udc->gadget.speed) { in qe_ep_init()
586 switch (udc->gadget.speed) { in qe_ep_init()
601 switch (udc->gadget.speed) { in qe_ep_init()
636 spin_lock_irqsave(&udc->lock, flags); in qe_ep_init()
647 udc->ep0_dir = USB_DIR_OUT; in qe_ep_init()
648 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_init()
662 qe_ep_bd_init(udc, pipe_num); in qe_ep_init()
672 dev_err(udc->dev, "malloc txframe failed\n"); in qe_ep_init()
678 qe_ep_register_init(udc, pipe_num); in qe_ep_init()
682 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_init()
689 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_init()
691 dev_err(udc->dev, "failed to initialize %s\n", ep->ep.name); in qe_ep_init()
695 static inline void qe_usb_enable(struct qe_udc *udc) in qe_usb_enable() argument
697 setbits8(&udc->usb_regs->usb_usmod, USB_MODE_EN); in qe_usb_enable()
700 static inline void qe_usb_disable(struct qe_udc *udc) in qe_usb_disable() argument
702 clrbits8(&udc->usb_regs->usb_usmod, USB_MODE_EN); in qe_usb_disable()
759 struct qe_udc *udc = ep->udc; in ep_recycle_rxbds() local
764 ((in_be16(&udc->ep_param[epnum]->rbptr) - in ep_recycle_rxbds()
765 in_be16(&udc->ep_param[epnum]->rbase)) in ep_recycle_rxbds()
780 if (in_be16(&udc->usb_regs->usb_usber) & USB_E_BSY_MASK) in ep_recycle_rxbds()
781 out_be16(&udc->usb_regs->usb_usber, USB_E_BSY_MASK); in ep_recycle_rxbds()
789 static void setup_received_handle(struct qe_udc *udc,
792 static void ep0_req_complete(struct qe_udc *udc, struct qe_req *req);
794 static int ep0_setup_handle(struct qe_udc *udc) in ep0_setup_handle() argument
796 struct qe_ep *ep = &udc->eps[0]; in ep0_setup_handle()
803 && (udc->ep0_state == WAIT_FOR_SETUP)) { in ep0_setup_handle()
807 cp = (u8 *)&udc->local_setup_buff; in ep0_setup_handle()
812 setup_received_handle(udc, &udc->local_setup_buff); in ep0_setup_handle()
818 static int qe_ep0_rx(struct qe_udc *udc) in qe_ep0_rx() argument
820 struct qe_ep *ep = &udc->eps[0]; in qe_ep0_rx()
829 dev_err(udc->dev, "ep0 not a control endpoint\n"); in qe_ep0_rx()
841 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep0_rx()
842 dev_vdbg(udc->dev, in qe_ep0_rx()
864 ep0_setup_handle(udc); in qe_ep0_rx()
869 dev_err(udc->dev, "The receive frame with error!\n"); in qe_ep0_rx()
905 dev_err(ep->udc->dev, "the data01 error!\n"); in qe_ep_rxframe_handle()
911 dev_err(ep->udc->dev, "the %s have no requeue!\n", ep->name); in qe_ep_rxframe_handle()
922 ep0_req_complete(ep->udc, req); in qe_ep_rxframe_handle()
938 struct qe_udc *udc = (struct qe_udc *)data; in ep_rx_tasklet() local
946 spin_lock_irqsave(&udc->lock, flags); in ep_rx_tasklet()
949 ep = &udc->eps[i]; in ep_rx_tasklet()
952 dev_dbg(udc->dev, in ep_rx_tasklet()
965 dev_dbg(udc->dev, in ep_rx_tasklet()
993 dev_err(udc->dev, in ep_rx_tasklet()
1021 spin_unlock_irqrestore(&udc->lock, flags); in ep_rx_tasklet()
1026 struct qe_udc *udc; in qe_ep_rx() local
1031 udc = ep->udc; in qe_ep_rx()
1035 dev_err(udc->dev, "transmit ep in rx function\n"); in qe_ep_rx()
1042 ucoffs = (u16)((in_be16(&udc->ep_param[ep->epnum]->rbptr) - in qe_ep_rx()
1043 in_be16(&udc->ep_param[ep->epnum]->rbase)) >> 3); in qe_ep_rx()
1052 dev_vdbg(udc->dev, "%d empty bds, send NACK\n", emptybds); in qe_ep_rx()
1058 dev_vdbg(udc->dev, "The rxep have no req queued with %d BDs\n", in qe_ep_rx()
1063 tasklet_schedule(&udc->rx_tasklet); in qe_ep_rx()
1072 struct qe_udc *udc = ep->udc; in qe_ep_tx() local
1079 dev_err(udc->dev, "receive ep passed to tx function\n"); in qe_ep_tx()
1084 saveusbmr = in_be16(&udc->usb_regs->usb_usbmr); in qe_ep_tx()
1085 out_be16(&udc->usb_regs->usb_usbmr, in qe_ep_tx()
1093 frame_set_data(frame, udc->nullbuf); in qe_ep_tx()
1096 dev_vdbg(udc->dev, "the frame size = 0\n"); in qe_ep_tx()
1108 if ((ep->epnum == 0) && (udc->ep0_state == DATA_STATE_NEED_ZLP)) in qe_ep_tx()
1124 out_be16(&udc->usb_regs->usb_usbmr, saveusbmr); in qe_ep_tx()
1134 out_be16(&udc->usb_regs->usb_usbmr, saveusbmr); in qe_ep_tx()
1135 dev_vdbg(udc->dev, "The tx bd is not ready!\n"); in qe_ep_tx()
1216 struct qe_udc *udc = ep->udc; in sendnulldata() local
1222 frame_set_data(frame, (u8 *)udc->nullbuf); in sendnulldata()
1249 static int ep0_prime_status(struct qe_udc *udc, int direction) in ep0_prime_status() argument
1252 struct qe_ep *ep = &udc->eps[0]; in ep0_prime_status()
1255 udc->ep0_state = DATA_STATE_NEED_ZLP; in ep0_prime_status()
1256 udc->ep0_dir = USB_DIR_IN; in ep0_prime_status()
1259 udc->ep0_dir = USB_DIR_OUT; in ep0_prime_status()
1260 udc->ep0_state = WAIT_FOR_OUT_STATUS; in ep0_prime_status()
1267 static void ep0_req_complete(struct qe_udc *udc, struct qe_req *req) in ep0_req_complete() argument
1269 struct qe_ep *ep = &udc->eps[0]; in ep0_req_complete()
1272 switch (udc->ep0_state) { in ep0_req_complete()
1276 if (ep0_prime_status(udc, USB_DIR_OUT)) in ep0_req_complete()
1277 qe_ep0_stall(udc); in ep0_req_complete()
1282 udc->ep0_state = WAIT_FOR_SETUP; in ep0_req_complete()
1288 if (ep0_prime_status(udc, USB_DIR_IN)) in ep0_req_complete()
1289 qe_ep0_stall(udc); in ep0_req_complete()
1294 udc->ep0_state = WAIT_FOR_SETUP; in ep0_req_complete()
1298 dev_vdbg(udc->dev, "Unexpected interrupt\n"); in ep0_req_complete()
1302 qe_ep0_stall(udc); in ep0_req_complete()
1314 ep->udc->ep0_state = WAIT_FOR_SETUP; in ep0_txcomplete()
1333 ep0_req_complete(ep->udc, ep->tx_req); in ep0_txcomplete()
1339 dev_vdbg(ep->udc->dev, "the ep0_controller have no req\n"); in ep0_txcomplete()
1350 dev_vdbg(ep->udc->dev, "The EP0 transmit data have error!\n"); in ep0_txframe_handle()
1405 dev_vdbg(ep->udc->dev, "The EP0 transmit data have error!\n"); in ep_txframe_handle()
1475 struct qe_udc *udc = ep->udc; in ep_req_rx() local
1485 dev_vdbg(udc->dev, "the req already finish!\n"); in ep_req_rx()
1518 dev_vdbg(udc->dev, "the data01 error!\n"); in ep_req_rx()
1538 dev_err(udc->dev, "The receive frame with error!\n"); in ep_req_rx()
1588 struct qe_udc *udc; in qe_ep_enable() local
1600 udc = ep->udc; in qe_ep_enable()
1601 if (!udc->driver || (udc->gadget.speed == USB_SPEED_UNKNOWN)) in qe_ep_enable()
1606 retval = qe_ep_init(udc, epnum, desc); in qe_ep_enable()
1609 dev_dbg(udc->dev, "enable ep%d failed\n", ep->epnum); in qe_ep_enable()
1612 dev_dbg(udc->dev, "enable ep%d successful\n", ep->epnum); in qe_ep_enable()
1618 struct qe_udc *udc; in qe_ep_disable() local
1624 udc = ep->udc; in qe_ep_disable()
1627 dev_dbg(udc->dev, "%s not enabled\n", _ep ? ep->ep.name : NULL); in qe_ep_disable()
1631 spin_lock_irqsave(&udc->lock, flags); in qe_ep_disable()
1637 qe_ep_reset(udc, ep->epnum); in qe_ep_disable()
1638 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_disable()
1652 dma_unmap_single(udc->gadget.dev.parent, in qe_ep_disable()
1658 udc->gadget.dev.parent, in qe_ep_disable()
1668 dev_dbg(udc->dev, "disabled %s OK\n", _ep->name); in qe_ep_disable()
1701 struct qe_udc *udc; in __qe_ep_queue() local
1704 udc = ep->udc; in __qe_ep_queue()
1708 dev_dbg(udc->dev, "bad params\n"); in __qe_ep_queue()
1712 dev_dbg(udc->dev, "bad ep\n"); in __qe_ep_queue()
1716 if (!udc->driver || udc->gadget.speed == USB_SPEED_UNKNOWN) in __qe_ep_queue()
1723 req->req.dma = dma_map_single(ep->udc->gadget.dev.parent, in __qe_ep_queue()
1731 dma_sync_single_for_device(ep->udc->gadget.dev.parent, in __qe_ep_queue()
1743 dev_vdbg(udc->dev, "gadget have request in %s! %d\n", in __qe_ep_queue()
1753 udc->ep0_state = DATA_STATE_XMIT; in __qe_ep_queue()
1755 udc->ep0_state = DATA_STATE_RECV; in __qe_ep_queue()
1769 struct qe_udc *udc = ep->udc; in qe_ep_queue() local
1773 spin_lock_irqsave(&udc->lock, flags); in qe_ep_queue()
1775 spin_unlock_irqrestore(&udc->lock, flags); in qe_ep_queue()
1789 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_dequeue()
1798 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1804 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_dequeue()
1819 struct qe_udc *udc; in qe_ep_set_halt() local
1827 udc = ep->udc; in qe_ep_set_halt()
1836 spin_lock_irqsave(&ep->udc->lock, flags); in qe_ep_set_halt()
1839 spin_unlock_irqrestore(&ep->udc->lock, flags); in qe_ep_set_halt()
1842 udc->ep0_state = WAIT_FOR_SETUP; in qe_ep_set_halt()
1843 udc->ep0_dir = 0; in qe_ep_set_halt()
1850 dev_vdbg(udc->dev, "%s %s halt stat %d\n", ep->ep.name, in qe_ep_set_halt()
1876 struct qe_udc *udc = container_of(gadget, struct qe_udc, gadget); in qe_get_frame() local
1879 tmp = in_be16(&udc->usb_param->frame_n); in qe_get_frame()
1902 static int udc_reset_ep_queue(struct qe_udc *udc, u8 pipe) in udc_reset_ep_queue() argument
1904 struct qe_ep *ep = &udc->eps[pipe]; in udc_reset_ep_queue()
1911 static int reset_queues(struct qe_udc *udc) in reset_queues() argument
1916 udc_reset_ep_queue(udc, pipe); in reset_queues()
1919 spin_unlock(&udc->lock); in reset_queues()
1920 usb_gadget_udc_reset(&udc->gadget, udc->driver); in reset_queues()
1921 spin_lock(&udc->lock); in reset_queues()
1926 static void ch9setaddress(struct qe_udc *udc, u16 value, u16 index, in ch9setaddress() argument
1930 udc->device_address = (u8) value; in ch9setaddress()
1932 udc->usb_state = USB_STATE_ADDRESS; in ch9setaddress()
1935 if (ep0_prime_status(udc, USB_DIR_IN)) in ch9setaddress()
1936 qe_ep0_stall(udc); in ch9setaddress()
1947 static void ch9getstatus(struct qe_udc *udc, u8 request_type, u16 value, in ch9getstatus() argument
1955 ep = &udc->eps[0]; in ch9getstatus()
1966 struct qe_ep *target_ep = &udc->eps[pipe]; in ch9getstatus()
1973 usep = in_be16(&udc->usb_regs->usb_usep[pipe]); in ch9getstatus()
1990 req->req.buf = udc->statusbuf; in ch9getstatus()
1996 udc->ep0_dir = USB_DIR_IN; in ch9getstatus()
2004 dev_err(udc->dev, "Can't respond to getstatus request \n"); in ch9getstatus()
2005 qe_ep0_stall(udc); in ch9getstatus()
2009 static void setup_received_handle(struct qe_udc *udc, in setup_received_handle() argument
2018 udc_reset_ep_queue(udc, 0); in setup_received_handle()
2021 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2023 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2031 ch9getstatus(udc, setup->bRequestType, wValue, wIndex, in setup_received_handle()
2040 ch9setaddress(udc, wValue, wIndex, wLength); in setup_received_handle()
2058 ep = &udc->eps[pipe]; in setup_received_handle()
2060 spin_unlock(&udc->lock); in setup_received_handle()
2064 spin_lock(&udc->lock); in setup_received_handle()
2067 ep0_prime_status(udc, USB_DIR_IN); in setup_received_handle()
2078 udc->ep0_state = DATA_STATE_XMIT; in setup_received_handle()
2079 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2081 udc->ep0_state = DATA_STATE_RECV; in setup_received_handle()
2082 udc->ep0_dir = USB_DIR_OUT; in setup_received_handle()
2084 spin_unlock(&udc->lock); in setup_received_handle()
2085 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2086 &udc->local_setup_buff) < 0) in setup_received_handle()
2087 qe_ep0_stall(udc); in setup_received_handle()
2088 spin_lock(&udc->lock); in setup_received_handle()
2091 udc->ep0_dir = USB_DIR_IN; in setup_received_handle()
2092 spin_unlock(&udc->lock); in setup_received_handle()
2093 if (udc->driver->setup(&udc->gadget, in setup_received_handle()
2094 &udc->local_setup_buff) < 0) in setup_received_handle()
2095 qe_ep0_stall(udc); in setup_received_handle()
2096 spin_lock(&udc->lock); in setup_received_handle()
2097 udc->ep0_state = DATA_STATE_NEED_ZLP; in setup_received_handle()
2104 static void suspend_irq(struct qe_udc *udc) in suspend_irq() argument
2106 udc->resume_state = udc->usb_state; in suspend_irq()
2107 udc->usb_state = USB_STATE_SUSPENDED; in suspend_irq()
2110 if (udc->driver->suspend) in suspend_irq()
2111 udc->driver->suspend(&udc->gadget); in suspend_irq()
2114 static void resume_irq(struct qe_udc *udc) in resume_irq() argument
2116 udc->usb_state = udc->resume_state; in resume_irq()
2117 udc->resume_state = 0; in resume_irq()
2120 if (udc->driver->resume) in resume_irq()
2121 udc->driver->resume(&udc->gadget); in resume_irq()
2124 static void idle_irq(struct qe_udc *udc) in idle_irq() argument
2128 usbs = in_8(&udc->usb_regs->usb_usbs); in idle_irq()
2130 if ((udc->usb_state) != USB_STATE_SUSPENDED) in idle_irq()
2131 suspend_irq(udc); in idle_irq()
2133 if (udc->usb_state == USB_STATE_SUSPENDED) in idle_irq()
2134 resume_irq(udc); in idle_irq()
2138 static int reset_irq(struct qe_udc *udc) in reset_irq() argument
2142 if (udc->usb_state == USB_STATE_DEFAULT) in reset_irq()
2145 qe_usb_disable(udc); in reset_irq()
2146 out_8(&udc->usb_regs->usb_usadr, 0); in reset_irq()
2149 if (udc->eps[i].init) in reset_irq()
2150 qe_ep_reset(udc, i); in reset_irq()
2153 reset_queues(udc); in reset_irq()
2154 udc->usb_state = USB_STATE_DEFAULT; in reset_irq()
2155 udc->ep0_state = WAIT_FOR_SETUP; in reset_irq()
2156 udc->ep0_dir = USB_DIR_OUT; in reset_irq()
2157 qe_usb_enable(udc); in reset_irq()
2161 static int bsy_irq(struct qe_udc *udc) in bsy_irq() argument
2166 static int txe_irq(struct qe_udc *udc) in txe_irq() argument
2172 static int tx_irq(struct qe_udc *udc) in tx_irq() argument
2178 if ((udc->usb_state == USB_STATE_ADDRESS) in tx_irq()
2179 && (in_8(&udc->usb_regs->usb_usadr) == 0)) in tx_irq()
2180 out_8(&udc->usb_regs->usb_usadr, udc->device_address); in tx_irq()
2183 ep = &udc->eps[i]; in tx_irq()
2201 static void rx_irq(struct qe_udc *udc) in rx_irq() argument
2208 ep = &udc->eps[i]; in rx_irq()
2214 qe_ep0_rx(udc); in rx_irq()
2226 struct qe_udc *udc = (struct qe_udc *)_udc; in qe_udc_irq() local
2231 spin_lock_irqsave(&udc->lock, flags); in qe_udc_irq()
2233 irq_src = in_be16(&udc->usb_regs->usb_usber) & in qe_udc_irq()
2234 in_be16(&udc->usb_regs->usb_usbmr); in qe_udc_irq()
2236 out_be16(&udc->usb_regs->usb_usber, irq_src); in qe_udc_irq()
2239 idle_irq(udc); in qe_udc_irq()
2245 tx_irq(udc); in qe_udc_irq()
2251 rx_irq(udc); in qe_udc_irq()
2257 reset_irq(udc); in qe_udc_irq()
2263 bsy_irq(udc); in qe_udc_irq()
2269 txe_irq(udc); in qe_udc_irq()
2274 spin_unlock_irqrestore(&udc->lock, flags); in qe_udc_irq()
2285 struct qe_udc *udc; in fsl_qe_start() local
2288 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_start()
2290 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_start()
2294 udc->driver = driver; in fsl_qe_start()
2295 udc->gadget.speed = driver->max_speed; in fsl_qe_start()
2298 qe_usb_enable(udc); in fsl_qe_start()
2300 out_be16(&udc->usb_regs->usb_usber, 0xffff); in fsl_qe_start()
2301 out_be16(&udc->usb_regs->usb_usbmr, USB_E_DEFAULT_DEVICE); in fsl_qe_start()
2302 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_start()
2303 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_start()
2304 udc->ep0_dir = USB_DIR_OUT; in fsl_qe_start()
2305 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_start()
2312 struct qe_udc *udc; in fsl_qe_stop() local
2316 udc = container_of(gadget, struct qe_udc, gadget); in fsl_qe_stop()
2318 qe_usb_disable(udc); in fsl_qe_stop()
2321 udc->usb_state = USB_STATE_ATTACHED; in fsl_qe_stop()
2322 udc->ep0_state = WAIT_FOR_SETUP; in fsl_qe_stop()
2323 udc->ep0_dir = 0; in fsl_qe_stop()
2326 spin_lock_irqsave(&udc->lock, flags); in fsl_qe_stop()
2327 udc->gadget.speed = USB_SPEED_UNKNOWN; in fsl_qe_stop()
2328 nuke(&udc->eps[0], -ESHUTDOWN); in fsl_qe_stop()
2329 list_for_each_entry(loop_ep, &udc->gadget.ep_list, ep.ep_list) in fsl_qe_stop()
2331 spin_unlock_irqrestore(&udc->lock, flags); in fsl_qe_stop()
2333 udc->driver = NULL; in fsl_qe_stop()
2341 struct qe_udc *udc; in qe_udc_config() local
2349 udc = kzalloc(sizeof(*udc), GFP_KERNEL); in qe_udc_config()
2350 if (udc == NULL) { in qe_udc_config()
2355 udc->dev = &ofdev->dev; in qe_udc_config()
2359 udc->usb_param = cpm_muram_addr(offset); in qe_udc_config()
2360 memset_io(udc->usb_param, 0, size); in qe_udc_config()
2362 usbpram = udc->usb_param; in qe_udc_config()
2374 udc->ep_param[i] = cpm_muram_addr(tmp_addr); in qe_udc_config()
2378 memset_io(udc->ep_param[0], 0, in qe_udc_config()
2381 udc->resume_state = USB_STATE_NOTATTACHED; in qe_udc_config()
2382 udc->usb_state = USB_STATE_POWERED; in qe_udc_config()
2383 udc->ep0_dir = 0; in qe_udc_config()
2385 spin_lock_init(&udc->lock); in qe_udc_config()
2386 return udc; in qe_udc_config()
2389 kfree(udc); in qe_udc_config()
2394 static int qe_udc_reg_init(struct qe_udc *udc) in qe_udc_reg_init() argument
2397 qe_usbregs = udc->usb_regs; in qe_udc_reg_init()
2412 static int qe_ep_config(struct qe_udc *udc, unsigned char pipe_num) in qe_ep_config() argument
2414 struct qe_ep *ep = &udc->eps[pipe_num]; in qe_ep_config()
2416 ep->udc = udc; in qe_ep_config()
2451 list_add_tail(&ep->ep.ep_list, &udc->gadget.ep_list); in qe_ep_config()
2453 ep->gadget = &udc->gadget; in qe_ep_config()
2463 struct qe_udc *udc = container_of(dev, struct qe_udc, gadget.dev); in qe_udc_release() local
2466 complete(udc->done); in qe_udc_release()
2467 cpm_muram_free(cpm_muram_offset(udc->ep_param[0])); in qe_udc_release()
2469 udc->ep_param[i] = NULL; in qe_udc_release()
2471 kfree(udc); in qe_udc_release()
2478 struct qe_udc *udc; in qe_udc_probe() local
2495 udc = qe_udc_config(ofdev); in qe_udc_probe()
2496 if (!udc) { in qe_udc_probe()
2501 udc->soc_type = (unsigned long)match->data; in qe_udc_probe()
2502 udc->usb_regs = of_iomap(np, 0); in qe_udc_probe()
2503 if (!udc->usb_regs) { in qe_udc_probe()
2510 qe_udc_reg_init(udc); in qe_udc_probe()
2514 udc->gadget.ops = &qe_gadget_ops; in qe_udc_probe()
2517 udc->gadget.ep0 = &udc->eps[0].ep; in qe_udc_probe()
2519 INIT_LIST_HEAD(&udc->gadget.ep_list); in qe_udc_probe()
2522 udc->gadget.speed = USB_SPEED_UNKNOWN; in qe_udc_probe()
2525 udc->gadget.name = driver_name; in qe_udc_probe()
2526 udc->gadget.dev.parent = &ofdev->dev; in qe_udc_probe()
2535 qe_ep_config(udc, (unsigned char)i); in qe_udc_probe()
2539 ret = qe_ep_init(udc, 0, &qe_ep0_desc); in qe_udc_probe()
2544 udc->nullbuf = devm_kzalloc(&ofdev->dev, 256, GFP_KERNEL); in qe_udc_probe()
2545 if (udc->nullbuf == NULL) { in qe_udc_probe()
2551 udc->statusbuf = devm_kzalloc(&ofdev->dev, 2, GFP_KERNEL); in qe_udc_probe()
2552 if (udc->statusbuf == NULL) { in qe_udc_probe()
2557 udc->nullp = virt_to_phys((void *)udc->nullbuf); in qe_udc_probe()
2558 if (udc->nullp == DMA_ADDR_INVALID) { in qe_udc_probe()
2559 udc->nullp = dma_map_single( in qe_udc_probe()
2560 udc->gadget.dev.parent, in qe_udc_probe()
2561 udc->nullbuf, in qe_udc_probe()
2564 udc->nullmap = 1; in qe_udc_probe()
2566 dma_sync_single_for_device(udc->gadget.dev.parent, in qe_udc_probe()
2567 udc->nullp, 256, in qe_udc_probe()
2571 tasklet_init(&udc->rx_tasklet, ep_rx_tasklet, in qe_udc_probe()
2572 (unsigned long)udc); in qe_udc_probe()
2574 udc->usb_irq = irq_of_parse_and_map(np, 0); in qe_udc_probe()
2575 if (!udc->usb_irq) { in qe_udc_probe()
2580 ret = request_irq(udc->usb_irq, qe_udc_irq, 0, in qe_udc_probe()
2581 driver_name, udc); in qe_udc_probe()
2583 dev_err(udc->dev, "cannot request irq %d err %d\n", in qe_udc_probe()
2584 udc->usb_irq, ret); in qe_udc_probe()
2588 ret = usb_add_gadget_udc_release(&ofdev->dev, &udc->gadget, in qe_udc_probe()
2593 platform_set_drvdata(ofdev, udc); in qe_udc_probe()
2594 dev_info(udc->dev, in qe_udc_probe()
2596 (udc->soc_type == PORT_QE) ? "QE" : "CPM"); in qe_udc_probe()
2600 free_irq(udc->usb_irq, udc); in qe_udc_probe()
2602 irq_dispose_mapping(udc->usb_irq); in qe_udc_probe()
2604 if (udc->nullmap) { in qe_udc_probe()
2605 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_probe()
2606 udc->nullp, 256, in qe_udc_probe()
2608 udc->nullp = DMA_ADDR_INVALID; in qe_udc_probe()
2610 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_probe()
2611 udc->nullp, 256, in qe_udc_probe()
2615 ep = &udc->eps[0]; in qe_udc_probe()
2621 iounmap(udc->usb_regs); in qe_udc_probe()
2623 kfree(udc); in qe_udc_probe()
2641 struct qe_udc *udc = platform_get_drvdata(ofdev); in qe_udc_remove() local
2646 usb_del_gadget_udc(&udc->gadget); in qe_udc_remove()
2648 udc->done = &done; in qe_udc_remove()
2649 tasklet_disable(&udc->rx_tasklet); in qe_udc_remove()
2651 if (udc->nullmap) { in qe_udc_remove()
2652 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2653 udc->nullp, 256, in qe_udc_remove()
2655 udc->nullp = DMA_ADDR_INVALID; in qe_udc_remove()
2657 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2658 udc->nullp, 256, in qe_udc_remove()
2662 ep = &udc->eps[0]; in qe_udc_remove()
2668 dma_unmap_single(udc->gadget.dev.parent, in qe_udc_remove()
2673 dma_sync_single_for_cpu(udc->gadget.dev.parent, in qe_udc_remove()
2681 free_irq(udc->usb_irq, udc); in qe_udc_remove()
2682 irq_dispose_mapping(udc->usb_irq); in qe_udc_remove()
2684 tasklet_kill(&udc->rx_tasklet); in qe_udc_remove()
2686 iounmap(udc->usb_regs); in qe_udc_remove()