|
@@ -0,0 +1,948 @@
|
|
|
|
+/*
|
|
|
|
+ * Faraday USB 2.0 OTG Controller
|
|
|
|
+ *
|
|
|
|
+ * (C) Copyright 2010 Faraday Technology
|
|
|
|
+ * Dante Su <dantesu@faraday-tech.com>
|
|
|
|
+ *
|
|
|
|
+ * This file is released under the terms of GPL v2 and any later version.
|
|
|
|
+ * See the file COPYING in the root directory of the source tree for details.
|
|
|
|
+ */
|
|
|
|
+
|
|
|
|
+#include <common.h>
|
|
|
|
+#include <command.h>
|
|
|
|
+#include <config.h>
|
|
|
|
+#include <net.h>
|
|
|
|
+#include <malloc.h>
|
|
|
|
+#include <asm/io.h>
|
|
|
|
+#include <asm/errno.h>
|
|
|
|
+#include <linux/types.h>
|
|
|
|
+#include <linux/usb/ch9.h>
|
|
|
|
+#include <linux/usb/gadget.h>
|
|
|
|
+
|
|
|
|
+#include <usb/fotg210.h>
|
|
|
|
+
|
|
|
|
+#define CFG_NUM_ENDPOINTS 4
|
|
|
|
+#define CFG_EP0_MAX_PACKET_SIZE 64
|
|
|
|
+#define CFG_EPX_MAX_PACKET_SIZE 512
|
|
|
|
+
|
|
|
|
+#define CFG_CMD_TIMEOUT (CONFIG_SYS_HZ >> 2) /* 250 ms */
|
|
|
|
+
|
|
|
|
+struct fotg210_chip;
|
|
|
|
+
|
|
|
|
+struct fotg210_ep {
|
|
|
|
+ struct usb_ep ep;
|
|
|
|
+
|
|
|
|
+ uint maxpacket;
|
|
|
|
+ uint id;
|
|
|
|
+ uint stopped;
|
|
|
|
+
|
|
|
|
+ struct list_head queue;
|
|
|
|
+ struct fotg210_chip *chip;
|
|
|
|
+ const struct usb_endpoint_descriptor *desc;
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+struct fotg210_request {
|
|
|
|
+ struct usb_request req;
|
|
|
|
+ struct list_head queue;
|
|
|
|
+ struct fotg210_ep *ep;
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+struct fotg210_chip {
|
|
|
|
+ struct usb_gadget gadget;
|
|
|
|
+ struct usb_gadget_driver *driver;
|
|
|
|
+ struct fotg210_regs *regs;
|
|
|
|
+ uint8_t irq;
|
|
|
|
+ uint16_t addr;
|
|
|
|
+ int pullup;
|
|
|
|
+ enum usb_device_state state;
|
|
|
|
+ struct fotg210_ep ep[1 + CFG_NUM_ENDPOINTS];
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static struct usb_endpoint_descriptor ep0_desc = {
|
|
|
|
+ .bLength = sizeof(struct usb_endpoint_descriptor),
|
|
|
|
+ .bDescriptorType = USB_DT_ENDPOINT,
|
|
|
|
+ .bEndpointAddress = USB_DIR_IN,
|
|
|
|
+ .bmAttributes = USB_ENDPOINT_XFER_CONTROL,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static inline int fifo_to_ep(struct fotg210_chip *chip, int id, int in)
|
|
|
|
+{
|
|
|
|
+ return (id < 0) ? 0 : ((id & 0x03) + 1);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static inline int ep_to_fifo(struct fotg210_chip *chip, int id)
|
|
|
|
+{
|
|
|
|
+ return (id <= 0) ? -1 : ((id - 1) & 0x03);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static inline int ep_reset(struct fotg210_chip *chip, uint8_t ep_addr)
|
|
|
|
+{
|
|
|
|
+ int ep = ep_addr & USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+
|
|
|
|
+ if (ep_addr & USB_DIR_IN) {
|
|
|
|
+ /* reset endpoint */
|
|
|
|
+ setbits_le32(®s->iep[ep - 1], IEP_RESET);
|
|
|
|
+ mdelay(1);
|
|
|
|
+ clrbits_le32(®s->iep[ep - 1], IEP_RESET);
|
|
|
|
+ /* clear endpoint stall */
|
|
|
|
+ clrbits_le32(®s->iep[ep - 1], IEP_STALL);
|
|
|
|
+ } else {
|
|
|
|
+ /* reset endpoint */
|
|
|
|
+ setbits_le32(®s->oep[ep - 1], OEP_RESET);
|
|
|
|
+ mdelay(1);
|
|
|
|
+ clrbits_le32(®s->oep[ep - 1], OEP_RESET);
|
|
|
|
+ /* clear endpoint stall */
|
|
|
|
+ clrbits_le32(®s->oep[ep - 1], OEP_STALL);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_reset(struct fotg210_chip *chip)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ uint32_t i;
|
|
|
|
+
|
|
|
|
+ chip->state = USB_STATE_POWERED;
|
|
|
|
+
|
|
|
|
+ /* chip enable */
|
|
|
|
+ writel(DEVCTRL_EN, ®s->dev_ctrl);
|
|
|
|
+
|
|
|
|
+ /* device address reset */
|
|
|
|
+ chip->addr = 0;
|
|
|
|
+ writel(0, ®s->dev_addr);
|
|
|
|
+
|
|
|
|
+ /* set idle counter to 7ms */
|
|
|
|
+ writel(7, ®s->idle);
|
|
|
|
+
|
|
|
|
+ /* disable all interrupts */
|
|
|
|
+ writel(IMR_MASK, ®s->imr);
|
|
|
|
+ writel(GIMR_MASK, ®s->gimr);
|
|
|
|
+ writel(GIMR0_MASK, ®s->gimr0);
|
|
|
|
+ writel(GIMR1_MASK, ®s->gimr1);
|
|
|
|
+ writel(GIMR2_MASK, ®s->gimr2);
|
|
|
|
+
|
|
|
|
+ /* clear interrupts */
|
|
|
|
+ writel(ISR_MASK, ®s->isr);
|
|
|
|
+ writel(0, ®s->gisr);
|
|
|
|
+ writel(0, ®s->gisr0);
|
|
|
|
+ writel(0, ®s->gisr1);
|
|
|
|
+ writel(0, ®s->gisr2);
|
|
|
|
+
|
|
|
|
+ /* chip reset */
|
|
|
|
+ setbits_le32(®s->dev_ctrl, DEVCTRL_RESET);
|
|
|
|
+ mdelay(10);
|
|
|
|
+ if (readl(®s->dev_ctrl) & DEVCTRL_RESET) {
|
|
|
|
+ printf("fotg210: chip reset failed\n");
|
|
|
|
+ return -1;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* CX FIFO reset */
|
|
|
|
+ setbits_le32(®s->cxfifo, CXFIFO_CXFIFOCLR);
|
|
|
|
+ mdelay(10);
|
|
|
|
+ if (readl(®s->cxfifo) & CXFIFO_CXFIFOCLR) {
|
|
|
|
+ printf("fotg210: ep0 fifo reset failed\n");
|
|
|
|
+ return -1;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* create static ep-fifo map (EP1 <-> FIFO0, EP2 <-> FIFO1 ...) */
|
|
|
|
+ writel(EPMAP14_DEFAULT, ®s->epmap14);
|
|
|
|
+ writel(EPMAP58_DEFAULT, ®s->epmap58);
|
|
|
|
+ writel(FIFOMAP_DEFAULT, ®s->fifomap);
|
|
|
|
+ writel(0, ®s->fifocfg);
|
|
|
|
+ for (i = 0; i < 8; ++i) {
|
|
|
|
+ writel(CFG_EPX_MAX_PACKET_SIZE, ®s->iep[i]);
|
|
|
|
+ writel(CFG_EPX_MAX_PACKET_SIZE, ®s->oep[i]);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* FIFO reset */
|
|
|
|
+ for (i = 0; i < 4; ++i) {
|
|
|
|
+ writel(FIFOCSR_RESET, ®s->fifocsr[i]);
|
|
|
|
+ mdelay(10);
|
|
|
|
+ if (readl(®s->fifocsr[i]) & FIFOCSR_RESET) {
|
|
|
|
+ printf("fotg210: fifo%d reset failed\n", i);
|
|
|
|
+ return -1;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* enable only device interrupt and triggered at level-high */
|
|
|
|
+ writel(IMR_IRQLH | IMR_HOST | IMR_OTG, ®s->imr);
|
|
|
|
+ writel(ISR_MASK, ®s->isr);
|
|
|
|
+ /* disable EP0 IN/OUT interrupt */
|
|
|
|
+ writel(GIMR0_CXOUT | GIMR0_CXIN, ®s->gimr0);
|
|
|
|
+ /* disable EPX IN+SPK+OUT interrupts */
|
|
|
|
+ writel(GIMR1_MASK, ®s->gimr1);
|
|
|
|
+ /* disable wakeup+idle+dma+zlp interrupts */
|
|
|
|
+ writel(GIMR2_WAKEUP | GIMR2_IDLE | GIMR2_DMAERR | GIMR2_DMAFIN
|
|
|
|
+ | GIMR2_ZLPRX | GIMR2_ZLPTX, ®s->gimr2);
|
|
|
|
+ /* enable all group interrupt */
|
|
|
|
+ writel(0, ®s->gimr);
|
|
|
|
+
|
|
|
|
+ /* suspend delay = 3 ms */
|
|
|
|
+ writel(3, ®s->idle);
|
|
|
|
+
|
|
|
|
+ /* turn-on device interrupts */
|
|
|
|
+ setbits_le32(®s->dev_ctrl, DEVCTRL_GIRQ_EN);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static inline int fotg210_cxwait(struct fotg210_chip *chip, uint32_t mask)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ int ret = -1;
|
|
|
|
+ ulong ts;
|
|
|
|
+
|
|
|
|
+ for (ts = get_timer(0); get_timer(ts) < CFG_CMD_TIMEOUT; ) {
|
|
|
|
+ if ((readl(®s->cxfifo) & mask) != mask)
|
|
|
|
+ continue;
|
|
|
|
+ ret = 0;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (ret)
|
|
|
|
+ printf("fotg210: cx/ep0 timeout\n");
|
|
|
|
+
|
|
|
|
+ return ret;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_dma(struct fotg210_ep *ep, struct fotg210_request *req)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_chip *chip = ep->chip;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ uint32_t tmp, ts;
|
|
|
|
+ uint8_t *buf = req->req.buf + req->req.actual;
|
|
|
|
+ uint32_t len = req->req.length - req->req.actual;
|
|
|
|
+ int fifo = ep_to_fifo(chip, ep->id);
|
|
|
|
+ int ret = -EBUSY;
|
|
|
|
+
|
|
|
|
+ /* 1. init dma buffer */
|
|
|
|
+ if (len > ep->maxpacket)
|
|
|
|
+ len = ep->maxpacket;
|
|
|
|
+
|
|
|
|
+ /* 2. wait for dma ready (hardware) */
|
|
|
|
+ for (ts = get_timer(0); get_timer(ts) < CFG_CMD_TIMEOUT; ) {
|
|
|
|
+ if (!(readl(®s->dma_ctrl) & DMACTRL_START)) {
|
|
|
|
+ ret = 0;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+ if (ret) {
|
|
|
|
+ printf("fotg210: dma busy\n");
|
|
|
|
+ req->req.status = ret;
|
|
|
|
+ return ret;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* 3. DMA target setup */
|
|
|
|
+ if (ep->desc->bEndpointAddress & USB_DIR_IN)
|
|
|
|
+ flush_dcache_range((ulong)buf, (ulong)buf + len);
|
|
|
|
+ else
|
|
|
|
+ invalidate_dcache_range((ulong)buf, (ulong)buf + len);
|
|
|
|
+
|
|
|
|
+ writel(virt_to_phys(buf), ®s->dma_addr);
|
|
|
|
+
|
|
|
|
+ if (ep->desc->bEndpointAddress & USB_DIR_IN) {
|
|
|
|
+ if (ep->id == 0) {
|
|
|
|
+ /* Wait until cx/ep0 fifo empty */
|
|
|
|
+ fotg210_cxwait(chip, CXFIFO_CXFIFOE);
|
|
|
|
+ writel(DMAFIFO_CX, ®s->dma_fifo);
|
|
|
|
+ } else {
|
|
|
|
+ /* Wait until epx fifo empty */
|
|
|
|
+ fotg210_cxwait(chip, CXFIFO_FIFOE(fifo));
|
|
|
|
+ writel(DMAFIFO_FIFO(fifo), ®s->dma_fifo);
|
|
|
|
+ }
|
|
|
|
+ writel(DMACTRL_LEN(len) | DMACTRL_MEM2FIFO, ®s->dma_ctrl);
|
|
|
|
+ } else {
|
|
|
|
+ uint32_t blen;
|
|
|
|
+
|
|
|
|
+ if (ep->id == 0) {
|
|
|
|
+ writel(DMAFIFO_CX, ®s->dma_fifo);
|
|
|
|
+ do {
|
|
|
|
+ blen = CXFIFO_BYTES(readl(®s->cxfifo));
|
|
|
|
+ } while (blen < len);
|
|
|
|
+ } else {
|
|
|
|
+ writel(DMAFIFO_FIFO(fifo), ®s->dma_fifo);
|
|
|
|
+ blen = FIFOCSR_BYTES(readl(®s->fifocsr[fifo]));
|
|
|
|
+ }
|
|
|
|
+ len = (len < blen) ? len : blen;
|
|
|
|
+ writel(DMACTRL_LEN(len) | DMACTRL_FIFO2MEM, ®s->dma_ctrl);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* 4. DMA start */
|
|
|
|
+ setbits_le32(®s->dma_ctrl, DMACTRL_START);
|
|
|
|
+
|
|
|
|
+ /* 5. DMA wait */
|
|
|
|
+ ret = -EBUSY;
|
|
|
|
+ for (ts = get_timer(0); get_timer(ts) < CFG_CMD_TIMEOUT; ) {
|
|
|
|
+ tmp = readl(®s->gisr2);
|
|
|
|
+ /* DMA complete */
|
|
|
|
+ if (tmp & GISR2_DMAFIN) {
|
|
|
|
+ ret = 0;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ /* DMA error */
|
|
|
|
+ if (tmp & GISR2_DMAERR) {
|
|
|
|
+ printf("fotg210: dma error\n");
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ /* resume, suspend, reset */
|
|
|
|
+ if (tmp & (GISR2_RESUME | GISR2_SUSPEND | GISR2_RESET)) {
|
|
|
|
+ printf("fotg210: dma reset by host\n");
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* 7. DMA target reset */
|
|
|
|
+ if (ret)
|
|
|
|
+ writel(DMACTRL_ABORT | DMACTRL_CLRFF, ®s->dma_ctrl);
|
|
|
|
+
|
|
|
|
+ writel(0, ®s->gisr2);
|
|
|
|
+ writel(0, ®s->dma_fifo);
|
|
|
|
+
|
|
|
|
+ req->req.status = ret;
|
|
|
|
+ if (!ret)
|
|
|
|
+ req->req.actual += len;
|
|
|
|
+ else
|
|
|
|
+ printf("fotg210: ep%d dma error(code=%d)\n", ep->id, ret);
|
|
|
|
+
|
|
|
|
+ return len;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ * result of setup packet
|
|
|
|
+ */
|
|
|
|
+#define CX_IDLE 0
|
|
|
|
+#define CX_FINISH 1
|
|
|
|
+#define CX_STALL 2
|
|
|
|
+
|
|
|
|
+static void fotg210_setup(struct fotg210_chip *chip)
|
|
|
|
+{
|
|
|
|
+ int id, ret = CX_IDLE;
|
|
|
|
+ uint32_t tmp[2];
|
|
|
|
+ struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)tmp;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * If this is the first Cx 8 byte command,
|
|
|
|
+ * we can now query USB mode (high/full speed; USB 2.0/USB 1.0)
|
|
|
|
+ */
|
|
|
|
+ if (chip->state == USB_STATE_POWERED) {
|
|
|
|
+ chip->state = USB_STATE_DEFAULT;
|
|
|
|
+ if (readl(®s->otgcsr) & OTGCSR_DEV_B) {
|
|
|
|
+ /* Mini-B */
|
|
|
|
+ if (readl(®s->dev_ctrl) & DEVCTRL_HS) {
|
|
|
|
+ puts("fotg210: HS\n");
|
|
|
|
+ chip->gadget.speed = USB_SPEED_HIGH;
|
|
|
|
+ /* SOF mask timer = 1100 ticks */
|
|
|
|
+ writel(SOFMTR_TMR(1100), ®s->sof_mtr);
|
|
|
|
+ } else {
|
|
|
|
+ puts("fotg210: FS\n");
|
|
|
|
+ chip->gadget.speed = USB_SPEED_FULL;
|
|
|
|
+ /* SOF mask timer = 10000 ticks */
|
|
|
|
+ writel(SOFMTR_TMR(10000), ®s->sof_mtr);
|
|
|
|
+ }
|
|
|
|
+ } else {
|
|
|
|
+ printf("fotg210: mini-A?\n");
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* switch data port to ep0 */
|
|
|
|
+ writel(DMAFIFO_CX, ®s->dma_fifo);
|
|
|
|
+ /* fetch 8 bytes setup packet */
|
|
|
|
+ tmp[0] = readl(®s->ep0_data);
|
|
|
|
+ tmp[1] = readl(®s->ep0_data);
|
|
|
|
+ /* release data port */
|
|
|
|
+ writel(0, ®s->dma_fifo);
|
|
|
|
+
|
|
|
|
+ if (req->bRequestType & USB_DIR_IN)
|
|
|
|
+ ep0_desc.bEndpointAddress = USB_DIR_IN;
|
|
|
|
+ else
|
|
|
|
+ ep0_desc.bEndpointAddress = USB_DIR_OUT;
|
|
|
|
+
|
|
|
|
+ ret = CX_IDLE;
|
|
|
|
+
|
|
|
|
+ if ((req->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
|
|
|
|
+ switch (req->bRequest) {
|
|
|
|
+ case USB_REQ_SET_CONFIGURATION:
|
|
|
|
+ debug("fotg210: set_cfg(%d)\n", req->wValue & 0x00FF);
|
|
|
|
+ if (!(req->wValue & 0x00FF)) {
|
|
|
|
+ chip->state = USB_STATE_ADDRESS;
|
|
|
|
+ writel(chip->addr, ®s->dev_addr);
|
|
|
|
+ } else {
|
|
|
|
+ chip->state = USB_STATE_CONFIGURED;
|
|
|
|
+ writel(chip->addr | DEVADDR_CONF,
|
|
|
|
+ ®s->dev_addr);
|
|
|
|
+ }
|
|
|
|
+ ret = CX_IDLE;
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_REQ_SET_ADDRESS:
|
|
|
|
+ debug("fotg210: set_addr(0x%04X)\n", req->wValue);
|
|
|
|
+ chip->state = USB_STATE_ADDRESS;
|
|
|
|
+ chip->addr = req->wValue & DEVADDR_ADDR_MASK;
|
|
|
|
+ ret = CX_FINISH;
|
|
|
|
+ writel(chip->addr, ®s->dev_addr);
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_REQ_CLEAR_FEATURE:
|
|
|
|
+ debug("fotg210: clr_feature(%d, %d)\n",
|
|
|
|
+ req->bRequestType & 0x03, req->wValue);
|
|
|
|
+ switch (req->wValue) {
|
|
|
|
+ case 0: /* [Endpoint] halt */
|
|
|
|
+ ep_reset(chip, req->wIndex);
|
|
|
|
+ ret = CX_FINISH;
|
|
|
|
+ break;
|
|
|
|
+ case 1: /* [Device] remote wake-up */
|
|
|
|
+ case 2: /* [Device] test mode */
|
|
|
|
+ default:
|
|
|
|
+ ret = CX_STALL;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_REQ_SET_FEATURE:
|
|
|
|
+ debug("fotg210: set_feature(%d, %d)\n",
|
|
|
|
+ req->wValue, req->wIndex & 0xf);
|
|
|
|
+ switch (req->wValue) {
|
|
|
|
+ case 0: /* Endpoint Halt */
|
|
|
|
+ id = req->wIndex & 0xf;
|
|
|
|
+ setbits_le32(®s->iep[id - 1], IEP_STALL);
|
|
|
|
+ setbits_le32(®s->oep[id - 1], OEP_STALL);
|
|
|
|
+ ret = CX_FINISH;
|
|
|
|
+ break;
|
|
|
|
+ case 1: /* Remote Wakeup */
|
|
|
|
+ case 2: /* Test Mode */
|
|
|
|
+ default:
|
|
|
|
+ ret = CX_STALL;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_REQ_GET_STATUS:
|
|
|
|
+ debug("fotg210: get_status\n");
|
|
|
|
+ ret = CX_STALL;
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_REQ_SET_DESCRIPTOR:
|
|
|
|
+ debug("fotg210: set_descriptor\n");
|
|
|
|
+ ret = CX_STALL;
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_REQ_SYNCH_FRAME:
|
|
|
|
+ debug("fotg210: sync frame\n");
|
|
|
|
+ ret = CX_STALL;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ } /* if ((req->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) */
|
|
|
|
+
|
|
|
|
+ if (ret == CX_IDLE && chip->driver->setup) {
|
|
|
|
+ if (chip->driver->setup(&chip->gadget, req) < 0)
|
|
|
|
+ ret = CX_STALL;
|
|
|
|
+ else
|
|
|
|
+ ret = CX_FINISH;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ switch (ret) {
|
|
|
|
+ case CX_FINISH:
|
|
|
|
+ setbits_le32(®s->cxfifo, CXFIFO_CXFIN);
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case CX_STALL:
|
|
|
|
+ setbits_le32(®s->cxfifo, CXFIFO_CXSTALL | CXFIFO_CXFIN);
|
|
|
|
+ printf("fotg210: cx_stall!\n");
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case CX_IDLE:
|
|
|
|
+ debug("fotg210: cx_idle?\n");
|
|
|
|
+ default:
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ * fifo - FIFO id
|
|
|
|
+ * zlp - zero length packet
|
|
|
|
+ */
|
|
|
|
+static void fotg210_recv(struct fotg210_chip *chip, int ep_id)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ struct fotg210_ep *ep = chip->ep + ep_id;
|
|
|
|
+ struct fotg210_request *req;
|
|
|
|
+ int len;
|
|
|
|
+
|
|
|
|
+ if (ep->stopped || (ep->desc->bEndpointAddress & USB_DIR_IN)) {
|
|
|
|
+ printf("fotg210: ep%d recv, invalid!\n", ep->id);
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (list_empty(&ep->queue)) {
|
|
|
|
+ printf("fotg210: ep%d recv, drop!\n", ep->id);
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ req = list_first_entry(&ep->queue, struct fotg210_request, queue);
|
|
|
|
+ len = fotg210_dma(ep, req);
|
|
|
|
+ if (len < ep->ep.maxpacket || req->req.length <= req->req.actual) {
|
|
|
|
+ list_del_init(&req->queue);
|
|
|
|
+ if (req->req.complete)
|
|
|
|
+ req->req.complete(&ep->ep, &req->req);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (ep->id > 0 && list_empty(&ep->queue)) {
|
|
|
|
+ setbits_le32(®s->gimr1,
|
|
|
|
+ GIMR1_FIFO_RX(ep_to_fifo(chip, ep->id)));
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ * USB Gadget Layer
|
|
|
|
+ */
|
|
|
|
+static int fotg210_ep_enable(
|
|
|
|
+ struct usb_ep *_ep, const struct usb_endpoint_descriptor *desc)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
|
|
|
|
+ struct fotg210_chip *chip = ep->chip;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ int id = ep_to_fifo(chip, ep->id);
|
|
|
|
+ int in = (desc->bEndpointAddress & USB_DIR_IN) ? 1 : 0;
|
|
|
|
+
|
|
|
|
+ if (!_ep || !desc
|
|
|
|
+ || desc->bDescriptorType != USB_DT_ENDPOINT
|
|
|
|
+ || le16_to_cpu(desc->wMaxPacketSize) == 0) {
|
|
|
|
+ printf("fotg210: bad ep or descriptor\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ep->desc = desc;
|
|
|
|
+ ep->stopped = 0;
|
|
|
|
+
|
|
|
|
+ if (in)
|
|
|
|
+ setbits_le32(®s->fifomap, FIFOMAP(id, FIFOMAP_IN));
|
|
|
|
+
|
|
|
|
+ switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
|
|
|
|
+ case USB_ENDPOINT_XFER_CONTROL:
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
|
|
+ case USB_ENDPOINT_XFER_ISOC:
|
|
|
|
+ setbits_le32(®s->fifocfg,
|
|
|
|
+ FIFOCFG(id, FIFOCFG_EN | FIFOCFG_ISOC));
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_ENDPOINT_XFER_BULK:
|
|
|
|
+ setbits_le32(®s->fifocfg,
|
|
|
|
+ FIFOCFG(id, FIFOCFG_EN | FIFOCFG_BULK));
|
|
|
|
+ break;
|
|
|
|
+
|
|
|
|
+ case USB_ENDPOINT_XFER_INT:
|
|
|
|
+ setbits_le32(®s->fifocfg,
|
|
|
|
+ FIFOCFG(id, FIFOCFG_EN | FIFOCFG_INTR));
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_ep_disable(struct usb_ep *_ep)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
|
|
|
|
+ struct fotg210_chip *chip = ep->chip;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ int id = ep_to_fifo(chip, ep->id);
|
|
|
|
+
|
|
|
|
+ ep->desc = NULL;
|
|
|
|
+ ep->stopped = 1;
|
|
|
|
+
|
|
|
|
+ clrbits_le32(®s->fifocfg, FIFOCFG(id, FIFOCFG_CFG_MASK));
|
|
|
|
+ clrbits_le32(®s->fifomap, FIFOMAP(id, FIFOMAP_DIR_MASK));
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static struct usb_request *fotg210_ep_alloc_request(
|
|
|
|
+ struct usb_ep *_ep, gfp_t gfp_flags)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_request *req = malloc(sizeof(*req));
|
|
|
|
+
|
|
|
|
+ if (req) {
|
|
|
|
+ memset(req, 0, sizeof(*req));
|
|
|
|
+ INIT_LIST_HEAD(&req->queue);
|
|
|
|
+ }
|
|
|
|
+ return &req->req;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void fotg210_ep_free_request(
|
|
|
|
+ struct usb_ep *_ep, struct usb_request *_req)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_request *req;
|
|
|
|
+
|
|
|
|
+ req = container_of(_req, struct fotg210_request, req);
|
|
|
|
+ free(req);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_ep_queue(
|
|
|
|
+ struct usb_ep *_ep, struct usb_request *_req, gfp_t gfp_flags)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
|
|
|
|
+ struct fotg210_chip *chip = ep->chip;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ struct fotg210_request *req;
|
|
|
|
+
|
|
|
|
+ req = container_of(_req, struct fotg210_request, req);
|
|
|
|
+ if (!_req || !_req->complete || !_req->buf
|
|
|
|
+ || !list_empty(&req->queue)) {
|
|
|
|
+ printf("fotg210: invalid request to ep%d\n", ep->id);
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (!chip || chip->state == USB_STATE_SUSPENDED) {
|
|
|
|
+ printf("fotg210: request while chip suspended\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ req->req.actual = 0;
|
|
|
|
+ req->req.status = -EINPROGRESS;
|
|
|
|
+
|
|
|
|
+ if (req->req.length == 0) {
|
|
|
|
+ req->req.status = 0;
|
|
|
|
+ if (req->req.complete)
|
|
|
|
+ req->req.complete(&ep->ep, &req->req);
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (ep->id == 0) {
|
|
|
|
+ do {
|
|
|
|
+ int len = fotg210_dma(ep, req);
|
|
|
|
+ if (len < ep->ep.maxpacket)
|
|
|
|
+ break;
|
|
|
|
+ if (ep->desc->bEndpointAddress & USB_DIR_IN)
|
|
|
|
+ udelay(100);
|
|
|
|
+ } while (req->req.length > req->req.actual);
|
|
|
|
+ } else {
|
|
|
|
+ if (ep->desc->bEndpointAddress & USB_DIR_IN) {
|
|
|
|
+ do {
|
|
|
|
+ int len = fotg210_dma(ep, req);
|
|
|
|
+ if (len < ep->ep.maxpacket)
|
|
|
|
+ break;
|
|
|
|
+ } while (req->req.length > req->req.actual);
|
|
|
|
+ } else {
|
|
|
|
+ list_add_tail(&req->queue, &ep->queue);
|
|
|
|
+ clrbits_le32(®s->gimr1,
|
|
|
|
+ GIMR1_FIFO_RX(ep_to_fifo(chip, ep->id)));
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (ep->id == 0 || (ep->desc->bEndpointAddress & USB_DIR_IN)) {
|
|
|
|
+ if (req->req.complete)
|
|
|
|
+ req->req.complete(&ep->ep, &req->req);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
|
|
|
|
+ struct fotg210_request *req;
|
|
|
|
+
|
|
|
|
+ /* make sure it's actually queued on this endpoint */
|
|
|
|
+ list_for_each_entry(req, &ep->queue, queue) {
|
|
|
|
+ if (&req->req == _req)
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ if (&req->req != _req)
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
|
|
+ /* remove the request */
|
|
|
|
+ list_del_init(&req->queue);
|
|
|
|
+
|
|
|
|
+ /* update status & invoke complete callback */
|
|
|
|
+ if (req->req.status == -EINPROGRESS) {
|
|
|
|
+ req->req.status = -ECONNRESET;
|
|
|
|
+ if (req->req.complete)
|
|
|
|
+ req->req.complete(_ep, &req->req);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_ep_halt(struct usb_ep *_ep, int halt)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_ep *ep = container_of(_ep, struct fotg210_ep, ep);
|
|
|
|
+ struct fotg210_chip *chip = ep->chip;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ int ret = -1;
|
|
|
|
+
|
|
|
|
+ debug("fotg210: ep%d halt=%d\n", ep->id, halt);
|
|
|
|
+
|
|
|
|
+ /* Endpoint STALL */
|
|
|
|
+ if (ep->id > 0 && ep->id <= CFG_NUM_ENDPOINTS) {
|
|
|
|
+ if (halt) {
|
|
|
|
+ /* wait until all ep fifo empty */
|
|
|
|
+ fotg210_cxwait(chip, 0xf00);
|
|
|
|
+ /* stall */
|
|
|
|
+ if (ep->desc->bEndpointAddress & USB_DIR_IN) {
|
|
|
|
+ setbits_le32(®s->iep[ep->id - 1],
|
|
|
|
+ IEP_STALL);
|
|
|
|
+ } else {
|
|
|
|
+ setbits_le32(®s->oep[ep->id - 1],
|
|
|
|
+ OEP_STALL);
|
|
|
|
+ }
|
|
|
|
+ } else {
|
|
|
|
+ if (ep->desc->bEndpointAddress & USB_DIR_IN) {
|
|
|
|
+ clrbits_le32(®s->iep[ep->id - 1],
|
|
|
|
+ IEP_STALL);
|
|
|
|
+ } else {
|
|
|
|
+ clrbits_le32(®s->oep[ep->id - 1],
|
|
|
|
+ OEP_STALL);
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+ ret = 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return ret;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ * activate/deactivate link with host.
|
|
|
|
+ */
|
|
|
|
+static void pullup(struct fotg210_chip *chip, int is_on)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+
|
|
|
|
+ if (is_on) {
|
|
|
|
+ if (!chip->pullup) {
|
|
|
|
+ chip->state = USB_STATE_POWERED;
|
|
|
|
+ chip->pullup = 1;
|
|
|
|
+ /* enable the chip */
|
|
|
|
+ setbits_le32(®s->dev_ctrl, DEVCTRL_EN);
|
|
|
|
+ /* clear unplug bit (BIT0) */
|
|
|
|
+ clrbits_le32(®s->phy_tmsr, PHYTMSR_UNPLUG);
|
|
|
|
+ }
|
|
|
|
+ } else {
|
|
|
|
+ chip->state = USB_STATE_NOTATTACHED;
|
|
|
|
+ chip->pullup = 0;
|
|
|
|
+ chip->addr = 0;
|
|
|
|
+ writel(chip->addr, ®s->dev_addr);
|
|
|
|
+ /* set unplug bit (BIT0) */
|
|
|
|
+ setbits_le32(®s->phy_tmsr, PHYTMSR_UNPLUG);
|
|
|
|
+ /* disable the chip */
|
|
|
|
+ clrbits_le32(®s->dev_ctrl, DEVCTRL_EN);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_pullup(struct usb_gadget *_gadget, int is_on)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_chip *chip;
|
|
|
|
+
|
|
|
|
+ chip = container_of(_gadget, struct fotg210_chip, gadget);
|
|
|
|
+
|
|
|
|
+ debug("fotg210: pullup=%d\n", is_on);
|
|
|
|
+
|
|
|
|
+ pullup(chip, is_on);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int fotg210_get_frame(struct usb_gadget *_gadget)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_chip *chip;
|
|
|
|
+ struct fotg210_regs *regs;
|
|
|
|
+
|
|
|
|
+ chip = container_of(_gadget, struct fotg210_chip, gadget);
|
|
|
|
+ regs = chip->regs;
|
|
|
|
+
|
|
|
|
+ return SOFFNR_FNR(readl(®s->sof_fnr));
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static struct usb_gadget_ops fotg210_gadget_ops = {
|
|
|
|
+ .get_frame = fotg210_get_frame,
|
|
|
|
+ .pullup = fotg210_pullup,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static struct usb_ep_ops fotg210_ep_ops = {
|
|
|
|
+ .enable = fotg210_ep_enable,
|
|
|
|
+ .disable = fotg210_ep_disable,
|
|
|
|
+ .queue = fotg210_ep_queue,
|
|
|
|
+ .dequeue = fotg210_ep_dequeue,
|
|
|
|
+ .set_halt = fotg210_ep_halt,
|
|
|
|
+ .alloc_request = fotg210_ep_alloc_request,
|
|
|
|
+ .free_request = fotg210_ep_free_request,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static struct fotg210_chip controller = {
|
|
|
|
+ .regs = (void __iomem *)CONFIG_FOTG210_BASE,
|
|
|
|
+ .gadget = {
|
|
|
|
+ .name = "fotg210_udc",
|
|
|
|
+ .ops = &fotg210_gadget_ops,
|
|
|
|
+ .ep0 = &controller.ep[0].ep,
|
|
|
|
+ .speed = USB_SPEED_UNKNOWN,
|
|
|
|
+ .is_dualspeed = 1,
|
|
|
|
+ .is_otg = 0,
|
|
|
|
+ .is_a_peripheral = 0,
|
|
|
|
+ .b_hnp_enable = 0,
|
|
|
|
+ .a_hnp_support = 0,
|
|
|
|
+ .a_alt_hnp_support = 0,
|
|
|
|
+ },
|
|
|
|
+ .ep[0] = {
|
|
|
|
+ .id = 0,
|
|
|
|
+ .ep = {
|
|
|
|
+ .name = "ep0",
|
|
|
|
+ .ops = &fotg210_ep_ops,
|
|
|
|
+ },
|
|
|
|
+ .desc = &ep0_desc,
|
|
|
|
+ .chip = &controller,
|
|
|
|
+ .maxpacket = CFG_EP0_MAX_PACKET_SIZE,
|
|
|
|
+ },
|
|
|
|
+ .ep[1] = {
|
|
|
|
+ .id = 1,
|
|
|
|
+ .ep = {
|
|
|
|
+ .name = "ep1",
|
|
|
|
+ .ops = &fotg210_ep_ops,
|
|
|
|
+ },
|
|
|
|
+ .chip = &controller,
|
|
|
|
+ .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
|
|
|
|
+ },
|
|
|
|
+ .ep[2] = {
|
|
|
|
+ .id = 2,
|
|
|
|
+ .ep = {
|
|
|
|
+ .name = "ep2",
|
|
|
|
+ .ops = &fotg210_ep_ops,
|
|
|
|
+ },
|
|
|
|
+ .chip = &controller,
|
|
|
|
+ .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
|
|
|
|
+ },
|
|
|
|
+ .ep[3] = {
|
|
|
|
+ .id = 3,
|
|
|
|
+ .ep = {
|
|
|
|
+ .name = "ep3",
|
|
|
|
+ .ops = &fotg210_ep_ops,
|
|
|
|
+ },
|
|
|
|
+ .chip = &controller,
|
|
|
|
+ .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
|
|
|
|
+ },
|
|
|
|
+ .ep[4] = {
|
|
|
|
+ .id = 4,
|
|
|
|
+ .ep = {
|
|
|
|
+ .name = "ep4",
|
|
|
|
+ .ops = &fotg210_ep_ops,
|
|
|
|
+ },
|
|
|
|
+ .chip = &controller,
|
|
|
|
+ .maxpacket = CFG_EPX_MAX_PACKET_SIZE,
|
|
|
|
+ },
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+int usb_gadget_handle_interrupts(void)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_chip *chip = &controller;
|
|
|
|
+ struct fotg210_regs *regs = chip->regs;
|
|
|
|
+ uint32_t id, st, isr, gisr;
|
|
|
|
+
|
|
|
|
+ isr = readl(®s->isr) & (~readl(®s->imr));
|
|
|
|
+ gisr = readl(®s->gisr) & (~readl(®s->gimr));
|
|
|
|
+ if (!(isr & ISR_DEV) || !gisr)
|
|
|
|
+ return 0;
|
|
|
|
+
|
|
|
|
+ writel(ISR_DEV, ®s->isr);
|
|
|
|
+
|
|
|
|
+ /* CX interrupts */
|
|
|
|
+ if (gisr & GISR_GRP0) {
|
|
|
|
+ st = readl(®s->gisr0);
|
|
|
|
+ writel(0, ®s->gisr0);
|
|
|
|
+
|
|
|
|
+ if (st & GISR0_CXERR)
|
|
|
|
+ printf("fotg210: cmd error\n");
|
|
|
|
+
|
|
|
|
+ if (st & GISR0_CXABORT)
|
|
|
|
+ printf("fotg210: cmd abort\n");
|
|
|
|
+
|
|
|
|
+ if (st & GISR0_CXSETUP) /* setup */
|
|
|
|
+ fotg210_setup(chip);
|
|
|
|
+ else if (st & GISR0_CXEND) /* command finish */
|
|
|
|
+ setbits_le32(®s->cxfifo, CXFIFO_CXFIN);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* FIFO interrupts */
|
|
|
|
+ if (gisr & GISR_GRP1) {
|
|
|
|
+ st = readl(®s->gisr1);
|
|
|
|
+ for (id = 0; id < 4; ++id) {
|
|
|
|
+ if (st & GISR1_RX_FIFO(id))
|
|
|
|
+ fotg210_recv(chip, fifo_to_ep(chip, id, 0));
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* Device Status Interrupts */
|
|
|
|
+ if (gisr & GISR_GRP2) {
|
|
|
|
+ st = readl(®s->gisr2);
|
|
|
|
+ writel(0, ®s->gisr2);
|
|
|
|
+
|
|
|
|
+ if (st & GISR2_RESET)
|
|
|
|
+ printf("fotg210: reset by host\n");
|
|
|
|
+ else if (st & GISR2_SUSPEND)
|
|
|
|
+ printf("fotg210: suspend/removed\n");
|
|
|
|
+ else if (st & GISR2_RESUME)
|
|
|
|
+ printf("fotg210: resume\n");
|
|
|
|
+
|
|
|
|
+ /* Errors */
|
|
|
|
+ if (st & GISR2_ISOCERR)
|
|
|
|
+ printf("fotg210: iso error\n");
|
|
|
|
+ if (st & GISR2_ISOCABT)
|
|
|
|
+ printf("fotg210: iso abort\n");
|
|
|
|
+ if (st & GISR2_DMAERR)
|
|
|
|
+ printf("fotg210: dma error\n");
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int usb_gadget_register_driver(struct usb_gadget_driver *driver)
|
|
|
|
+{
|
|
|
|
+ int i, ret = 0;
|
|
|
|
+ struct fotg210_chip *chip = &controller;
|
|
|
|
+
|
|
|
|
+ if (!driver || !driver->bind || !driver->setup) {
|
|
|
|
+ puts("fotg210: bad parameter.\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ INIT_LIST_HEAD(&chip->gadget.ep_list);
|
|
|
|
+ for (i = 0; i < CFG_NUM_ENDPOINTS + 1; ++i) {
|
|
|
|
+ struct fotg210_ep *ep = chip->ep + i;
|
|
|
|
+
|
|
|
|
+ ep->ep.maxpacket = ep->maxpacket;
|
|
|
|
+ INIT_LIST_HEAD(&ep->queue);
|
|
|
|
+
|
|
|
|
+ if (ep->id == 0) {
|
|
|
|
+ ep->stopped = 0;
|
|
|
|
+ } else {
|
|
|
|
+ ep->stopped = 1;
|
|
|
|
+ list_add_tail(&ep->ep.ep_list, &chip->gadget.ep_list);
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (fotg210_reset(chip)) {
|
|
|
|
+ puts("fotg210: reset failed.\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ret = driver->bind(&chip->gadget);
|
|
|
|
+ if (ret) {
|
|
|
|
+ debug("fotg210: driver->bind() returned %d\n", ret);
|
|
|
|
+ return ret;
|
|
|
|
+ }
|
|
|
|
+ chip->driver = driver;
|
|
|
|
+
|
|
|
|
+ return ret;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int usb_gadget_unregister_driver(struct usb_gadget_driver *driver)
|
|
|
|
+{
|
|
|
|
+ struct fotg210_chip *chip = &controller;
|
|
|
|
+
|
|
|
|
+ driver->unbind(&chip->gadget);
|
|
|
|
+ chip->driver = NULL;
|
|
|
|
+
|
|
|
|
+ pullup(chip, 0);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|