1 // SPDX-License-Identifier: GPL-2.0+
3 * Faraday USB 2.0 OTG Controller
5 * (C) Copyright 2010 Faraday Technology
6 * Dante Su <dantesu@faraday-tech.com>
17 #include <linux/errno.h>
18 #include <linux/types.h>
19 #include <linux/usb/ch9.h>
20 #include <linux/usb/gadget.h>
22 #include <usb/fotg210.h>
24 #define CFG_NUM_ENDPOINTS 4
25 #define CFG_EP0_MAX_PACKET_SIZE 64
26 #define CFG_EPX_MAX_PACKET_SIZE 512
28 #define CFG_CMD_TIMEOUT (CONFIG_SYS_HZ >> 2) /* 250 ms */
39 struct list_head queue;
40 struct fotg210_chip *chip;
41 const struct usb_endpoint_descriptor *desc;
44 struct fotg210_request {
45 struct usb_request req;
46 struct list_head queue;
47 struct fotg210_ep *ep;
51 struct usb_gadget gadget;
52 struct usb_gadget_driver *driver;
53 struct fotg210_regs *regs;
57 enum usb_device_state state;
58 struct fotg210_ep ep[1 + CFG_NUM_ENDPOINTS];
61 static struct usb_endpoint_descriptor ep0_desc = {
62 .bLength = sizeof(struct usb_endpoint_descriptor),
63 .bDescriptorType = USB_DT_ENDPOINT,
64 .bEndpointAddress = USB_DIR_IN,
65 .bmAttributes = USB_ENDPOINT_XFER_CONTROL,
68 static inline int fifo_to_ep(struct fotg210_chip *chip, int id, int in)
70 return (id < 0) ? 0 : ((id & 0x03) + 1);
73 static inline int ep_to_fifo(struct fotg210_chip *chip, int id)
75 return (id <= 0) ? -1 : ((id - 1) & 0x03);
78 static inline int ep_reset(struct fotg210_chip *chip, uint8_t ep_addr)
80 int ep = ep_addr & USB_ENDPOINT_NUMBER_MASK;
81 struct fotg210_regs *regs = chip->regs;
83 if (ep_addr & USB_DIR_IN) {
85 setbits_le32(®s->iep[ep - 1], IEP_RESET);
87 clrbits_le32(®s->iep[ep - 1], IEP_RESET);
88 /* clear endpoint stall */
89 clrbits_le32(®s->iep[ep - 1], IEP_STALL);
92 setbits_le32(®s->oep[ep - 1], OEP_RESET);
94 clrbits_le32(®s->oep[ep - 1], OEP_RESET);
95 /* clear endpoint stall */
96 clrbits_le32(®s->oep[ep - 1], OEP_STALL);
102 static int fotg210_reset(struct fotg210_chip *chip)
104 struct fotg210_regs *regs = chip->regs;
107 chip->state = USB_STATE_POWERED;
110 writel(DEVCTRL_EN, ®s->dev_ctrl);
112 /* device address reset */
114 writel(0, ®s->dev_addr);
116 /* set idle counter to 7ms */
117 writel(7, ®s->idle);
119 /* disable all interrupts */
120 writel(IMR_MASK, ®s->imr);
121 writel(GIMR_MASK, ®s->gimr);
122 writel(GIMR0_MASK, ®s->gimr0);
123 writel(GIMR1_MASK, ®s->gimr1);
124 writel(GIMR2_MASK, ®s->gimr2);
126 /* clear interrupts */
127 writel(ISR_MASK, ®s->isr);
128 writel(0, ®s->gisr);
129 writel(0, ®s->gisr0);
130 writel(0, ®s->gisr1);
131 writel(0, ®s->gisr2);
134 setbits_le32(®s->dev_ctrl, DEVCTRL_RESET);
136 if (readl(®s->dev_ctrl) & DEVCTRL_RESET) {
137 printf("fotg210: chip reset failed\n");
142 setbits_le32(®s->cxfifo, CXFIFO_CXFIFOCLR);
144 if (readl(®s->cxfifo) & CXFIFO_CXFIFOCLR) {
145 printf("fotg210: ep0 fifo reset failed\n");
149 /* create static ep-fifo map (EP1 <-> FIFO0, EP2 <-> FIFO1 ...) */
150 writel(EPMAP14_DEFAULT, ®s->epmap14);
151 writel(EPMAP58_DEFAULT, ®s->epmap58);
152 writel(FIFOMAP_DEFAULT, ®s->fifomap);
153 writel(0, ®s->fifocfg);
154 for (i = 0; i < 8; ++i) {
155 writel(CFG_EPX_MAX_PACKET_SIZE, ®s->iep[i]);
156 writel(CFG_EPX_MAX_PACKET_SIZE, ®s->oep[i]);
160 for (i = 0; i < 4; ++i) {
161 writel(FIFOCSR_RESET, ®s->fifocsr[i]);
163 if (readl(®s->fifocsr[i]) & FIFOCSR_RESET) {
164 printf("fotg210: fifo%d reset failed\n", i);
169 /* enable only device interrupt and triggered at level-high */
170 writel(IMR_IRQLH | IMR_HOST | IMR_OTG, ®s->imr);
171 writel(ISR_MASK, ®s->isr);
172 /* disable EP0 IN/OUT interrupt */
173 writel(GIMR0_CXOUT | GIMR0_CXIN, ®s->gimr0);
174 /* disable EPX IN+SPK+OUT interrupts */
175 writel(GIMR1_MASK, ®s->gimr1);
176 /* disable wakeup+idle+dma+zlp interrupts */
177 writel(GIMR2_WAKEUP | GIMR2_IDLE | GIMR2_DMAERR | GIMR2_DMAFIN
178 | GIMR2_ZLPRX | GIMR2_ZLPTX, ®s->gimr2);
179 /* enable all group interrupt */
180 writel(0, ®s->gimr);
182 /* suspend delay = 3 ms */
183 writel(3, ®s->idle);
185 /* turn-on device interrupts */
186 setbits_le32(®s->dev_ctrl, DEVCTRL_GIRQ_EN);
191 static inline int fotg210_cxwait(struct fotg210_chip *chip, uint32_t mask)
193 struct fotg210_regs *regs = chip->regs;
197 for (ts = get_timer(0); get_timer(ts) < CFG_CMD_TIMEOUT; ) {
198 if ((readl(®s->cxfifo) & mask) != mask)
205 printf("fotg210: cx/ep0 timeout\n");
210 static int fotg210_dma(struct fotg210_ep *ep, struct fotg210_request *req)
212 struct fotg210_chip *chip = ep->chip;
213 struct fotg210_regs *regs = chip->regs;
215 uint8_t *buf = req->req.buf + req->req.actual;
216 uint32_t len = req->req.length - req->req.actual;
217 int fifo = ep_to_fifo(chip, ep->id);
220 /* 1. init dma buffer */
221 if (len > ep->maxpacket)
224 /* 2. wait for dma ready (hardware) */
225 for (ts = get_timer(0); get_timer(ts) < CFG_CMD_TIMEOUT; ) {
226 if (!(readl(®s->dma_ctrl) & DMACTRL_START)) {
232 printf("fotg210: dma busy\n");
233 req->req.status = ret;
237 /* 3. DMA target setup */
238 if (ep->desc->bEndpointAddress & USB_DIR_IN)
239 flush_dcache_range((ulong)buf, (ulong)buf + len);
241 invalidate_dcache_range((ulong)buf, (ulong)buf + len);
243 writel(virt_to_phys(buf), ®s->dma_addr);
245 if (ep->desc->bEndpointAddress & USB_DIR_IN) {
247 /* Wait until cx/ep0 fifo empty */
248 fotg210_cxwait(chip, CXFIFO_CXFIFOE);
250 writel(DMAFIFO_CX, ®s->dma_fifo);
252 /* Wait until epx fifo empty */
253 fotg210_cxwait(chip, CXFIFO_FIFOE(fifo));
254 writel(DMAFIFO_FIFO(fifo), ®s->dma_fifo);
256 writel(DMACTRL_LEN(len) | DMACTRL_MEM2FIFO, ®s->dma_ctrl);
261 writel(DMAFIFO_CX, ®s->dma_fifo);
263 blen = CXFIFO_BYTES(readl(®s->cxfifo));
264 } while (blen < len);
266 writel(DMAFIFO_FIFO(fifo), ®s->dma_fifo);
267 blen = FIFOCSR_BYTES(readl(®s->fifocsr[fifo]));
269 len = (len < blen) ? len : blen;
270 writel(DMACTRL_LEN(len) | DMACTRL_FIFO2MEM, ®s->dma_ctrl);
274 setbits_le32(®s->dma_ctrl, DMACTRL_START);
278 for (ts = get_timer(0); get_timer(ts) < CFG_CMD_TIMEOUT; ) {
279 tmp = readl(®s->gisr2);
281 if (tmp & GISR2_DMAFIN) {
286 if (tmp & GISR2_DMAERR) {
287 printf("fotg210: dma error\n");
290 /* resume, suspend, reset */
291 if (tmp & (GISR2_RESUME | GISR2_SUSPEND | GISR2_RESET)) {
292 printf("fotg210: dma reset by host\n");
297 /* 7. DMA target reset */
299 writel(DMACTRL_ABORT | DMACTRL_CLRFF, ®s->dma_ctrl);
301 writel(0, ®s->gisr2);
302 writel(0, ®s->dma_fifo);
304 req->req.status = ret;
306 req->req.actual += len;
308 printf("fotg210: ep%d dma error(code=%d)\n", ep->id, ret);
314 * result of setup packet
320 static void fotg210_setup(struct fotg210_chip *chip)
322 int id, ret = CX_IDLE;
324 struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)tmp;
325 struct fotg210_regs *regs = chip->regs;
328 * If this is the first Cx 8 byte command,
329 * we can now query USB mode (high/full speed; USB 2.0/USB 1.0)
331 if (chip->state == USB_STATE_POWERED) {
332 chip->state = USB_STATE_DEFAULT;
333 if (readl(®s->otgcsr) & OTGCSR_DEV_B) {
335 if (readl(®s->dev_ctrl) & DEVCTRL_HS) {
336 puts("fotg210: HS\n");
337 chip->gadget.speed = USB_SPEED_HIGH;
338 /* SOF mask timer = 1100 ticks */
339 writel(SOFMTR_TMR(1100), ®s->sof_mtr);
341 puts("fotg210: FS\n");
342 chip->gadget.speed = USB_SPEED_FULL;
343 /* SOF mask timer = 10000 ticks */
344 writel(SOFMTR_TMR(10000), ®s->sof_mtr);
347 printf("fotg210: mini-A?\n");
351 /* switch data port to ep0 */
352 writel(DMAFIFO_CX, ®s->dma_fifo);
353 /* fetch 8 bytes setup packet */
354 tmp[0] = readl(®s->ep0_data);
355 tmp[1] = readl(®s->ep0_data);
356 /* release data port */
357 writel(0, ®s->dma_fifo);
359 if (req->bRequestType & USB_DIR_IN)
360 ep0_desc.bEndpointAddress = USB_DIR_IN;
362 ep0_desc.bEndpointAddress = USB_DIR_OUT;
366 if ((req->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
367 switch (req->bRequest) {
368 case USB_REQ_SET_CONFIGURATION:
369 debug("fotg210: set_cfg(%d)\n", req->wValue & 0x00FF);
370 if (!(req->wValue & 0x00FF)) {
371 chip->state = USB_STATE_ADDRESS;
372 writel(chip->addr, ®s->dev_addr);
374 chip->state = USB_STATE_CONFIGURED;
375 writel(chip->addr | DEVADDR_CONF,
381 case USB_REQ_SET_ADDRESS:
382 debug("fotg210: set_addr(0x%04X)\n", req->wValue);
383 chip->state = USB_STATE_ADDRESS;
384 chip->addr = req->wValue & DEVADDR_ADDR_MASK;
386 writel(chip->addr, ®s->dev_addr);
389 case USB_REQ_CLEAR_FEATURE:
390 debug("fotg210: clr_feature(%d, %d)\n",
391 req->bRequestType & 0x03, req->wValue);
392 switch (req->wValue) {
393 case 0: /* [Endpoint] halt */
394 ep_reset(chip, req->wIndex);
397 case 1: /* [Device] remote wake-up */
398 case 2: /* [Device] test mode */
405 case USB_REQ_SET_FEATURE:
406 debug("fotg210: set_feature(%d, %d)\n",
407 req->wValue, req->wIndex & 0xf);
408 switch (req->wValue) {
409 case 0: /* Endpoint Halt */
410 id = req->wIndex & 0xf;
411 setbits_le32(®s->iep[id - 1], IEP_STALL);
412 setbits_le32(®s->oep[id - 1], OEP_STALL);
415 case 1: /* Remote Wakeup */
416 case 2: /* Test Mode */
423 case USB_REQ_GET_STATUS:
424 debug("fotg210: get_status\n");
428 case USB_REQ_SET_DESCRIPTOR:
429 debug("fotg210: set_descriptor\n");
433 case USB_REQ_SYNCH_FRAME:
434 debug("fotg210: sync frame\n");
438 } /* if ((req->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) */
440 if (ret == CX_IDLE && chip->driver->setup) {
441 if (chip->driver->setup(&chip->gadget, req) < 0)
449 setbits_le32(®s->cxfifo, CXFIFO_CXFIN);
453 setbits_le32(®s->cxfifo, CXFIFO_CXSTALL | CXFIFO_CXFIN);
454 printf("fotg210: cx_stall!\n");
458 debug("fotg210: cx_idle?\n");
466 * zlp - zero length packet
468 static void fotg210_recv(struct fotg210_chip *chip, int ep_id)
470 struct fotg210_regs *regs = chip->regs;
471 struct fotg210_ep *ep = chip->ep + ep_id;
472 struct fotg210_request *req;
475 if (ep->stopped || (ep->desc->bEndpointAddress & USB_DIR_IN)) {
476 printf("fotg210: ep%d recv, invalid!\n", ep->id);
480 if (list_empty(&ep->queue)) {
481 printf("fotg210: ep%d recv, drop!\n", ep->id);
485 req = list_first_entry(&ep->queue, struct fotg210_request, queue);
486 len = fotg210_dma(ep, req);
487 if (len < ep->ep.maxpacket || req->req.length <= req->req.actual) {
488 list_del_init(&req->queue);
489 if (req->req.complete)
490 req->req.complete(&ep->ep, &req->req);
493 if (ep->id > 0 && list_empty(&ep->queue)) {
494 setbits_le32(®s->gimr1,
495 GIMR1_FIFO_RX(ep_to_fifo(chip, ep->id)));
502 static int fotg210_ep_enable(
503 struct usb_ep *_ep, const struct usb_endpoint_descriptor *desc)
505 struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
506 struct fotg210_chip *chip = ep->chip;
507 struct fotg210_regs *regs = chip->regs;
508 int id = ep_to_fifo(chip, ep->id);
509 int in = (desc->bEndpointAddress & USB_DIR_IN) ? 1 : 0;
512 || desc->bDescriptorType != USB_DT_ENDPOINT
513 || le16_to_cpu(desc->wMaxPacketSize) == 0) {
514 printf("fotg210: bad ep or descriptor\n");
522 setbits_le32(®s->fifomap, FIFOMAP(id, FIFOMAP_IN));
524 switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
525 case USB_ENDPOINT_XFER_CONTROL:
528 case USB_ENDPOINT_XFER_ISOC:
529 setbits_le32(®s->fifocfg,
530 FIFOCFG(id, FIFOCFG_EN | FIFOCFG_ISOC));
533 case USB_ENDPOINT_XFER_BULK:
534 setbits_le32(®s->fifocfg,
535 FIFOCFG(id, FIFOCFG_EN | FIFOCFG_BULK));
538 case USB_ENDPOINT_XFER_INT:
539 setbits_le32(®s->fifocfg,
540 FIFOCFG(id, FIFOCFG_EN | FIFOCFG_INTR));
547 static int fotg210_ep_disable(struct usb_ep *_ep)
549 struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
550 struct fotg210_chip *chip = ep->chip;
551 struct fotg210_regs *regs = chip->regs;
552 int id = ep_to_fifo(chip, ep->id);
557 clrbits_le32(®s->fifocfg, FIFOCFG(id, FIFOCFG_CFG_MASK));
558 clrbits_le32(®s->fifomap, FIFOMAP(id, FIFOMAP_DIR_MASK));
563 static struct usb_request *fotg210_ep_alloc_request(
564 struct usb_ep *_ep, gfp_t gfp_flags)
566 struct fotg210_request *req = malloc(sizeof(*req));
569 memset(req, 0, sizeof(*req));
570 INIT_LIST_HEAD(&req->queue);
575 static void fotg210_ep_free_request(
576 struct usb_ep *_ep, struct usb_request *_req)
578 struct fotg210_request *req;
580 req = container_of(_req, struct fotg210_request, req);
584 static int fotg210_ep_queue(
585 struct usb_ep *_ep, struct usb_request *_req, gfp_t gfp_flags)
587 struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
588 struct fotg210_chip *chip = ep->chip;
589 struct fotg210_regs *regs = chip->regs;
590 struct fotg210_request *req;
592 req = container_of(_req, struct fotg210_request, req);
593 if (!_req || !_req->complete || !_req->buf
594 || !list_empty(&req->queue)) {
595 printf("fotg210: invalid request to ep%d\n", ep->id);
599 if (!chip || chip->state == USB_STATE_SUSPENDED) {
600 printf("fotg210: request while chip suspended\n");
605 req->req.status = -EINPROGRESS;
607 if (req->req.length == 0) {
609 if (req->req.complete)
610 req->req.complete(&ep->ep, &req->req);
616 int len = fotg210_dma(ep, req);
617 if (len < ep->ep.maxpacket)
619 if (ep->desc->bEndpointAddress & USB_DIR_IN)
621 } while (req->req.length > req->req.actual);
623 if (ep->desc->bEndpointAddress & USB_DIR_IN) {
625 int len = fotg210_dma(ep, req);
626 if (len < ep->ep.maxpacket)
628 } while (req->req.length > req->req.actual);
630 list_add_tail(&req->queue, &ep->queue);
631 clrbits_le32(®s->gimr1,
632 GIMR1_FIFO_RX(ep_to_fifo(chip, ep->id)));
636 if (ep->id == 0 || (ep->desc->bEndpointAddress & USB_DIR_IN)) {
637 if (req->req.complete)
638 req->req.complete(&ep->ep, &req->req);
644 static int fotg210_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req)
646 struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
647 struct fotg210_request *req;
649 /* make sure it's actually queued on this endpoint */
650 list_for_each_entry(req, &ep->queue, queue) {
651 if (&req->req == _req)
654 if (&req->req != _req)
657 /* remove the request */
658 list_del_init(&req->queue);
660 /* update status & invoke complete callback */
661 if (req->req.status == -EINPROGRESS) {
662 req->req.status = -ECONNRESET;
663 if (req->req.complete)
664 req->req.complete(_ep, &req->req);
670 static int fotg210_ep_halt(struct usb_ep *_ep, int halt)
672 struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
673 struct fotg210_chip *chip = ep->chip;
674 struct fotg210_regs *regs = chip->regs;
677 debug("fotg210: ep%d halt=%d\n", ep->id, halt);
680 if (ep->id > 0 && ep->id <= CFG_NUM_ENDPOINTS) {
682 /* wait until all ep fifo empty */
683 fotg210_cxwait(chip, 0xf00);
685 if (ep->desc->bEndpointAddress & USB_DIR_IN) {
686 setbits_le32(®s->iep[ep->id - 1],
689 setbits_le32(®s->oep[ep->id - 1],
693 if (ep->desc->bEndpointAddress & USB_DIR_IN) {
694 clrbits_le32(®s->iep[ep->id - 1],
697 clrbits_le32(®s->oep[ep->id - 1],
708 * activate/deactivate link with host.
710 static void pullup(struct fotg210_chip *chip, int is_on)
712 struct fotg210_regs *regs = chip->regs;
716 chip->state = USB_STATE_POWERED;
718 /* enable the chip */
719 setbits_le32(®s->dev_ctrl, DEVCTRL_EN);
720 /* clear unplug bit (BIT0) */
721 clrbits_le32(®s->phy_tmsr, PHYTMSR_UNPLUG);
724 chip->state = USB_STATE_NOTATTACHED;
727 writel(chip->addr, ®s->dev_addr);
728 /* set unplug bit (BIT0) */
729 setbits_le32(®s->phy_tmsr, PHYTMSR_UNPLUG);
730 /* disable the chip */
731 clrbits_le32(®s->dev_ctrl, DEVCTRL_EN);
735 static int fotg210_pullup(struct usb_gadget *_gadget, int is_on)
737 struct fotg210_chip *chip;
739 chip = container_of(_gadget, struct fotg210_chip, gadget);
741 debug("fotg210: pullup=%d\n", is_on);
748 static int fotg210_get_frame(struct usb_gadget *_gadget)
750 struct fotg210_chip *chip;
751 struct fotg210_regs *regs;
753 chip = container_of(_gadget, struct fotg210_chip, gadget);
756 return SOFFNR_FNR(readl(®s->sof_fnr));
759 static struct usb_gadget_ops fotg210_gadget_ops = {
760 .get_frame = fotg210_get_frame,
761 .pullup = fotg210_pullup,
764 static struct usb_ep_ops fotg210_ep_ops = {
765 .enable = fotg210_ep_enable,
766 .disable = fotg210_ep_disable,
767 .queue = fotg210_ep_queue,
768 .dequeue = fotg210_ep_dequeue,
769 .set_halt = fotg210_ep_halt,
770 .alloc_request = fotg210_ep_alloc_request,
771 .free_request = fotg210_ep_free_request,
774 static struct fotg210_chip controller = {
775 .regs = (void __iomem *)CONFIG_FOTG210_BASE,
777 .name = "fotg210_udc",
778 .ops = &fotg210_gadget_ops,
779 .ep0 = &controller.ep[0].ep,
780 .speed = USB_SPEED_UNKNOWN,
783 .is_a_peripheral = 0,
786 .a_alt_hnp_support = 0,
792 .ops = &fotg210_ep_ops,
796 .maxpacket = CFG_EP0_MAX_PACKET_SIZE,
802 .ops = &fotg210_ep_ops,
805 .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
811 .ops = &fotg210_ep_ops,
814 .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
820 .ops = &fotg210_ep_ops,
823 .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
829 .ops = &fotg210_ep_ops,
832 .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
836 int usb_gadget_handle_interrupts(int index)
838 struct fotg210_chip *chip = &controller;
839 struct fotg210_regs *regs = chip->regs;
840 uint32_t id, st, isr, gisr;
842 isr = readl(®s->isr) & (~readl(®s->imr));
843 gisr = readl(®s->gisr) & (~readl(®s->gimr));
844 if (!(isr & ISR_DEV) || !gisr)
847 writel(ISR_DEV, ®s->isr);
850 if (gisr & GISR_GRP0) {
851 st = readl(®s->gisr0);
853 * Write 1 and then 0 works for both W1C & RW.
855 * HW v1.11.0+: It's a W1C register (write 1 clear)
856 * HW v1.10.0-: It's a R/W register (write 0 clear)
858 writel(st & GISR0_CXABORT, ®s->gisr0);
859 writel(0, ®s->gisr0);
861 if (st & GISR0_CXERR)
862 printf("fotg210: cmd error\n");
864 if (st & GISR0_CXABORT)
865 printf("fotg210: cmd abort\n");
867 if (st & GISR0_CXSETUP) /* setup */
869 else if (st & GISR0_CXEND) /* command finish */
870 setbits_le32(®s->cxfifo, CXFIFO_CXFIN);
873 /* FIFO interrupts */
874 if (gisr & GISR_GRP1) {
875 st = readl(®s->gisr1);
876 for (id = 0; id < 4; ++id) {
877 if (st & GISR1_RX_FIFO(id))
878 fotg210_recv(chip, fifo_to_ep(chip, id, 0));
882 /* Device Status Interrupts */
883 if (gisr & GISR_GRP2) {
884 st = readl(®s->gisr2);
886 * Write 1 and then 0 works for both W1C & RW.
888 * HW v1.11.0+: It's a W1C register (write 1 clear)
889 * HW v1.10.0-: It's a R/W register (write 0 clear)
891 writel(st, ®s->gisr2);
892 writel(0, ®s->gisr2);
894 if (st & GISR2_RESET)
895 printf("fotg210: reset by host\n");
896 else if (st & GISR2_SUSPEND)
897 printf("fotg210: suspend/removed\n");
898 else if (st & GISR2_RESUME)
899 printf("fotg210: resume\n");
902 if (st & GISR2_ISOCERR)
903 printf("fotg210: iso error\n");
904 if (st & GISR2_ISOCABT)
905 printf("fotg210: iso abort\n");
906 if (st & GISR2_DMAERR)
907 printf("fotg210: dma error\n");
913 int usb_gadget_register_driver(struct usb_gadget_driver *driver)
916 struct fotg210_chip *chip = &controller;
918 if (!driver || !driver->bind || !driver->setup) {
919 puts("fotg210: bad parameter.\n");
923 INIT_LIST_HEAD(&chip->gadget.ep_list);
924 for (i = 0; i < CFG_NUM_ENDPOINTS + 1; ++i) {
925 struct fotg210_ep *ep = chip->ep + i;
927 ep->ep.maxpacket = ep->maxpacket;
928 INIT_LIST_HEAD(&ep->queue);
934 list_add_tail(&ep->ep.ep_list, &chip->gadget.ep_list);
938 if (fotg210_reset(chip)) {
939 puts("fotg210: reset failed.\n");
943 ret = driver->bind(&chip->gadget);
945 debug("fotg210: driver->bind() returned %d\n", ret);
948 chip->driver = driver;
953 int usb_gadget_unregister_driver(struct usb_gadget_driver *driver)
955 struct fotg210_chip *chip = &controller;
957 driver->unbind(&chip->gadget);