/* * Intel Langwell USB Device Controller driver * Copyright (C) 2008-2009, Intel Corporation. * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. */ /* #undef DEBUG */ /* #undef VERBOSE_DEBUG */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "langwell_udc.h" #define DRIVER_DESC "Intel Langwell USB Device Controller driver" #define DRIVER_VERSION "16 May 2009" static const char driver_name[] = "langwell_udc"; static const char driver_desc[] = DRIVER_DESC; /* for endpoint 0 operations */ static const struct usb_endpoint_descriptor langwell_ep0_desc = { .bLength = USB_DT_ENDPOINT_SIZE, .bDescriptorType = USB_DT_ENDPOINT, .bEndpointAddress = 0, .bmAttributes = USB_ENDPOINT_XFER_CONTROL, .wMaxPacketSize = EP0_MAX_PKT_SIZE, }; /*-------------------------------------------------------------------------*/ /* debugging */ #ifdef VERBOSE_DEBUG static inline void print_all_registers(struct langwell_udc *dev) { int i; /* Capability Registers */ dev_dbg(&dev->pdev->dev, "Capability Registers (offset: 0x%04x, length: 0x%08x)\n", CAP_REG_OFFSET, (u32)sizeof(struct langwell_cap_regs)); dev_dbg(&dev->pdev->dev, "caplength=0x%02x\n", readb(&dev->cap_regs->caplength)); dev_dbg(&dev->pdev->dev, "hciversion=0x%04x\n", readw(&dev->cap_regs->hciversion)); dev_dbg(&dev->pdev->dev, "hcsparams=0x%08x\n", readl(&dev->cap_regs->hcsparams)); dev_dbg(&dev->pdev->dev, "hccparams=0x%08x\n", readl(&dev->cap_regs->hccparams)); dev_dbg(&dev->pdev->dev, "dciversion=0x%04x\n", readw(&dev->cap_regs->dciversion)); dev_dbg(&dev->pdev->dev, "dccparams=0x%08x\n", readl(&dev->cap_regs->dccparams)); /* Operational Registers */ dev_dbg(&dev->pdev->dev, "Operational Registers (offset: 0x%04x, length: 0x%08x)\n", OP_REG_OFFSET, (u32)sizeof(struct langwell_op_regs)); dev_dbg(&dev->pdev->dev, "extsts=0x%08x\n", readl(&dev->op_regs->extsts)); dev_dbg(&dev->pdev->dev, "extintr=0x%08x\n", readl(&dev->op_regs->extintr)); dev_dbg(&dev->pdev->dev, "usbcmd=0x%08x\n", readl(&dev->op_regs->usbcmd)); dev_dbg(&dev->pdev->dev, "usbsts=0x%08x\n", readl(&dev->op_regs->usbsts)); dev_dbg(&dev->pdev->dev, "usbintr=0x%08x\n", readl(&dev->op_regs->usbintr)); dev_dbg(&dev->pdev->dev, "frindex=0x%08x\n", readl(&dev->op_regs->frindex)); dev_dbg(&dev->pdev->dev, "ctrldssegment=0x%08x\n", readl(&dev->op_regs->ctrldssegment)); dev_dbg(&dev->pdev->dev, "deviceaddr=0x%08x\n", readl(&dev->op_regs->deviceaddr)); dev_dbg(&dev->pdev->dev, "endpointlistaddr=0x%08x\n", readl(&dev->op_regs->endpointlistaddr)); dev_dbg(&dev->pdev->dev, "ttctrl=0x%08x\n", readl(&dev->op_regs->ttctrl)); dev_dbg(&dev->pdev->dev, "burstsize=0x%08x\n", readl(&dev->op_regs->burstsize)); dev_dbg(&dev->pdev->dev, "txfilltuning=0x%08x\n", readl(&dev->op_regs->txfilltuning)); dev_dbg(&dev->pdev->dev, "txttfilltuning=0x%08x\n", readl(&dev->op_regs->txttfilltuning)); dev_dbg(&dev->pdev->dev, "ic_usb=0x%08x\n", readl(&dev->op_regs->ic_usb)); dev_dbg(&dev->pdev->dev, "ulpi_viewport=0x%08x\n", readl(&dev->op_regs->ulpi_viewport)); dev_dbg(&dev->pdev->dev, "configflag=0x%08x\n", readl(&dev->op_regs->configflag)); dev_dbg(&dev->pdev->dev, "portsc1=0x%08x\n", readl(&dev->op_regs->portsc1)); dev_dbg(&dev->pdev->dev, "devlc=0x%08x\n", readl(&dev->op_regs->devlc)); dev_dbg(&dev->pdev->dev, "otgsc=0x%08x\n", readl(&dev->op_regs->otgsc)); dev_dbg(&dev->pdev->dev, "usbmode=0x%08x\n", readl(&dev->op_regs->usbmode)); dev_dbg(&dev->pdev->dev, "endptnak=0x%08x\n", readl(&dev->op_regs->endptnak)); dev_dbg(&dev->pdev->dev, "endptnaken=0x%08x\n", readl(&dev->op_regs->endptnaken)); dev_dbg(&dev->pdev->dev, "endptsetupstat=0x%08x\n", readl(&dev->op_regs->endptsetupstat)); dev_dbg(&dev->pdev->dev, "endptprime=0x%08x\n", readl(&dev->op_regs->endptprime)); dev_dbg(&dev->pdev->dev, "endptflush=0x%08x\n", readl(&dev->op_regs->endptflush)); dev_dbg(&dev->pdev->dev, "endptstat=0x%08x\n", readl(&dev->op_regs->endptstat)); dev_dbg(&dev->pdev->dev, "endptcomplete=0x%08x\n", readl(&dev->op_regs->endptcomplete)); for (i = 0; i < dev->ep_max / 2; i++) { dev_dbg(&dev->pdev->dev, "endptctrl[%d]=0x%08x\n", i, readl(&dev->op_regs->endptctrl[i])); } } #else #define print_all_registers(dev) do { } while (0) #endif /* VERBOSE_DEBUG */ /*-------------------------------------------------------------------------*/ #define is_in(ep) (((ep)->ep_num == 0) ? ((ep)->dev->ep0_dir == \ USB_DIR_IN) : (usb_endpoint_dir_in((ep)->ep.desc))) #define DIR_STRING(ep) (is_in(ep) ? "in" : "out") static char *type_string(const struct usb_endpoint_descriptor *desc) { switch (usb_endpoint_type(desc)) { case USB_ENDPOINT_XFER_BULK: return "bulk"; case USB_ENDPOINT_XFER_ISOC: return "iso"; case USB_ENDPOINT_XFER_INT: return "int"; }; return "control"; } /* configure endpoint control registers */ static void ep_reset(struct langwell_ep *ep, unsigned char ep_num, unsigned char is_in, unsigned char ep_type) { struct langwell_udc *dev; u32 endptctrl; dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); endptctrl = readl(&dev->op_regs->endptctrl[ep_num]); if (is_in) { /* TX */ if (ep_num) endptctrl |= EPCTRL_TXR; endptctrl |= EPCTRL_TXE; endptctrl |= ep_type << EPCTRL_TXT_SHIFT; } else { /* RX */ if (ep_num) endptctrl |= EPCTRL_RXR; endptctrl |= EPCTRL_RXE; endptctrl |= ep_type << EPCTRL_RXT_SHIFT; } writel(endptctrl, &dev->op_regs->endptctrl[ep_num]); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* reset ep0 dQH and endptctrl */ static void ep0_reset(struct langwell_udc *dev) { struct langwell_ep *ep; int i; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* ep0 in and out */ for (i = 0; i < 2; i++) { ep = &dev->ep[i]; ep->dev = dev; /* ep0 dQH */ ep->dqh = &dev->ep_dqh[i]; /* configure ep0 endpoint capabilities in dQH */ ep->dqh->dqh_ios = 1; ep->dqh->dqh_mpl = EP0_MAX_PKT_SIZE; /* enable ep0-in HW zero length termination select */ if (is_in(ep)) ep->dqh->dqh_zlt = 0; ep->dqh->dqh_mult = 0; ep->dqh->dtd_next = DTD_TERM; /* configure ep0 control registers */ ep_reset(&dev->ep[0], 0, i, USB_ENDPOINT_XFER_CONTROL); } dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /*-------------------------------------------------------------------------*/ /* endpoints operations */ /* configure endpoint, making it usable */ static int langwell_ep_enable(struct usb_ep *_ep, const struct usb_endpoint_descriptor *desc) { struct langwell_udc *dev; struct langwell_ep *ep; u16 max = 0; unsigned long flags; int i, retval = 0; unsigned char zlt, ios = 0, mult = 0; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !desc || ep->ep.desc || desc->bDescriptorType != USB_DT_ENDPOINT) return -EINVAL; if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN) return -ESHUTDOWN; max = usb_endpoint_maxp(desc); /* * disable HW zero length termination select * driver handles zero length packet through req->req.zero */ zlt = 1; /* * sanity check type, direction, address, and then * initialize the endpoint capabilities fields in dQH */ switch (usb_endpoint_type(desc)) { case USB_ENDPOINT_XFER_CONTROL: ios = 1; break; case USB_ENDPOINT_XFER_BULK: if ((dev->gadget.speed == USB_SPEED_HIGH && max != 512) || (dev->gadget.speed == USB_SPEED_FULL && max > 64)) { goto done; } break; case USB_ENDPOINT_XFER_INT: if (strstr(ep->ep.name, "-iso")) /* bulk is ok */ goto done; switch (dev->gadget.speed) { case USB_SPEED_HIGH: if (max <= 1024) break; case USB_SPEED_FULL: if (max <= 64) break; default: if (max <= 8) break; goto done; } break; case USB_ENDPOINT_XFER_ISOC: if (strstr(ep->ep.name, "-bulk") || strstr(ep->ep.name, "-int")) goto done; switch (dev->gadget.speed) { case USB_SPEED_HIGH: if (max <= 1024) break; case USB_SPEED_FULL: if (max <= 1023) break; default: goto done; } /* * FIXME: * calculate transactions needed for high bandwidth iso */ mult = (unsigned char)(1 + ((max >> 11) & 0x03)); max = max & 0x8ff; /* bit 0~10 */ /* 3 transactions at most */ if (mult > 3) goto done; break; default: goto done; } spin_lock_irqsave(&dev->lock, flags); ep->ep.maxpacket = max; ep->ep.desc = desc; ep->stopped = 0; ep->ep_num = usb_endpoint_num(desc); /* ep_type */ ep->ep_type = usb_endpoint_type(desc); /* configure endpoint control registers */ ep_reset(ep, ep->ep_num, is_in(ep), ep->ep_type); /* configure endpoint capabilities in dQH */ i = ep->ep_num * 2 + is_in(ep); ep->dqh = &dev->ep_dqh[i]; ep->dqh->dqh_ios = ios; ep->dqh->dqh_mpl = cpu_to_le16(max); ep->dqh->dqh_zlt = zlt; ep->dqh->dqh_mult = mult; ep->dqh->dtd_next = DTD_TERM; dev_dbg(&dev->pdev->dev, "enabled %s (ep%d%s-%s), max %04x\n", _ep->name, ep->ep_num, DIR_STRING(ep), type_string(desc), max); spin_unlock_irqrestore(&dev->lock, flags); done: dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return retval; } /*-------------------------------------------------------------------------*/ /* retire a request */ static void done(struct langwell_ep *ep, struct langwell_request *req, int status) { struct langwell_udc *dev = ep->dev; unsigned stopped = ep->stopped; struct langwell_dtd *curr_dtd, *next_dtd; int i; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* remove the req from ep->queue */ list_del_init(&req->queue); if (req->req.status == -EINPROGRESS) req->req.status = status; else status = req->req.status; /* free dTD for the request */ next_dtd = req->head; for (i = 0; i < req->dtd_count; i++) { curr_dtd = next_dtd; if (i != req->dtd_count - 1) next_dtd = curr_dtd->next_dtd_virt; dma_pool_free(dev->dtd_pool, curr_dtd, curr_dtd->dtd_dma); } usb_gadget_unmap_request(&dev->gadget, &req->req, is_in(ep)); if (status != -ESHUTDOWN) dev_dbg(&dev->pdev->dev, "complete %s, req %p, stat %d, len %u/%u\n", ep->ep.name, &req->req, status, req->req.actual, req->req.length); /* don't modify queue heads during completion callback */ ep->stopped = 1; spin_unlock(&dev->lock); /* complete routine from gadget driver */ if (req->req.complete) req->req.complete(&ep->ep, &req->req); spin_lock(&dev->lock); ep->stopped = stopped; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } static void langwell_ep_fifo_flush(struct usb_ep *_ep); /* delete all endpoint requests, called with spinlock held */ static void nuke(struct langwell_ep *ep, int status) { /* called with spinlock held */ ep->stopped = 1; /* endpoint fifo flush */ if (&ep->ep && ep->ep.desc) langwell_ep_fifo_flush(&ep->ep); while (!list_empty(&ep->queue)) { struct langwell_request *req = NULL; req = list_entry(ep->queue.next, struct langwell_request, queue); done(ep, req, status); } } /*-------------------------------------------------------------------------*/ /* endpoint is no longer usable */ static int langwell_ep_disable(struct usb_ep *_ep) { struct langwell_ep *ep; unsigned long flags; struct langwell_udc *dev; int ep_num; u32 endptctrl; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !ep->ep.desc) return -EINVAL; spin_lock_irqsave(&dev->lock, flags); /* disable endpoint control register */ ep_num = ep->ep_num; endptctrl = readl(&dev->op_regs->endptctrl[ep_num]); if (is_in(ep)) endptctrl &= ~EPCTRL_TXE; else endptctrl &= ~EPCTRL_RXE; writel(endptctrl, &dev->op_regs->endptctrl[ep_num]); /* nuke all pending requests (does flush) */ nuke(ep, -ESHUTDOWN); ep->ep.desc = NULL; ep->stopped = 1; spin_unlock_irqrestore(&dev->lock, flags); dev_dbg(&dev->pdev->dev, "disabled %s\n", _ep->name); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* allocate a request object to use with this endpoint */ static struct usb_request *langwell_alloc_request(struct usb_ep *_ep, gfp_t gfp_flags) { struct langwell_ep *ep; struct langwell_udc *dev; struct langwell_request *req = NULL; if (!_ep) return NULL; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); req = kzalloc(sizeof(*req), gfp_flags); if (!req) return NULL; req->req.dma = DMA_ADDR_INVALID; INIT_LIST_HEAD(&req->queue); dev_vdbg(&dev->pdev->dev, "alloc request for %s\n", _ep->name); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return &req->req; } /* free a request object */ static void langwell_free_request(struct usb_ep *_ep, struct usb_request *_req) { struct langwell_ep *ep; struct langwell_udc *dev; struct langwell_request *req = NULL; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !_req) return; req = container_of(_req, struct langwell_request, req); WARN_ON(!list_empty(&req->queue)); if (_req) kfree(req); dev_vdbg(&dev->pdev->dev, "free request for %s\n", _ep->name); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /*-------------------------------------------------------------------------*/ /* queue dTD and PRIME endpoint */ static int queue_dtd(struct langwell_ep *ep, struct langwell_request *req) { u32 bit_mask, usbcmd, endptstat, dtd_dma; u8 dtd_status; int i; struct langwell_dqh *dqh; struct langwell_udc *dev; dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); i = ep->ep_num * 2 + is_in(ep); dqh = &dev->ep_dqh[i]; if (ep->ep_num) dev_vdbg(&dev->pdev->dev, "%s\n", ep->name); else /* ep0 */ dev_vdbg(&dev->pdev->dev, "%s-%s\n", ep->name, DIR_STRING(ep)); dev_vdbg(&dev->pdev->dev, "ep_dqh[%d] addr: 0x%p\n", i, &(dev->ep_dqh[i])); bit_mask = is_in(ep) ? (1 << (ep->ep_num + 16)) : (1 << (ep->ep_num)); dev_vdbg(&dev->pdev->dev, "bit_mask = 0x%08x\n", bit_mask); /* check if the pipe is empty */ if (!(list_empty(&ep->queue))) { /* add dTD to the end of linked list */ struct langwell_request *lastreq; lastreq = list_entry(ep->queue.prev, struct langwell_request, queue); lastreq->tail->dtd_next = cpu_to_le32(req->head->dtd_dma & DTD_NEXT_MASK); /* read prime bit, if 1 goto out */ if (readl(&dev->op_regs->endptprime) & bit_mask) goto out; do { /* set ATDTW bit in USBCMD */ usbcmd = readl(&dev->op_regs->usbcmd); writel(usbcmd | CMD_ATDTW, &dev->op_regs->usbcmd); /* read correct status bit */ endptstat = readl(&dev->op_regs->endptstat) & bit_mask; } while (!(readl(&dev->op_regs->usbcmd) & CMD_ATDTW)); /* write ATDTW bit to 0 */ usbcmd = readl(&dev->op_regs->usbcmd); writel(usbcmd & ~CMD_ATDTW, &dev->op_regs->usbcmd); if (endptstat) goto out; } /* write dQH next pointer and terminate bit to 0 */ dtd_dma = req->head->dtd_dma & DTD_NEXT_MASK; dqh->dtd_next = cpu_to_le32(dtd_dma); /* clear active and halt bit */ dtd_status = (u8) ~(DTD_STS_ACTIVE | DTD_STS_HALTED); dqh->dtd_status &= dtd_status; dev_vdbg(&dev->pdev->dev, "dqh->dtd_status = 0x%x\n", dqh->dtd_status); /* ensure that updates to the dQH will occur before priming */ wmb(); /* write 1 to endptprime register to PRIME endpoint */ bit_mask = is_in(ep) ? (1 << (ep->ep_num + 16)) : (1 << ep->ep_num); dev_vdbg(&dev->pdev->dev, "endprime bit_mask = 0x%08x\n", bit_mask); writel(bit_mask, &dev->op_regs->endptprime); out: dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* fill in the dTD structure to build a transfer descriptor */ static struct langwell_dtd *build_dtd(struct langwell_request *req, unsigned *length, dma_addr_t *dma, int *is_last) { u32 buf_ptr; struct langwell_dtd *dtd; struct langwell_udc *dev; int i; dev = req->ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* the maximum transfer length, up to 16k bytes */ *length = min(req->req.length - req->req.actual, (unsigned)DTD_MAX_TRANSFER_LENGTH); /* create dTD dma_pool resource */ dtd = dma_pool_alloc(dev->dtd_pool, GFP_KERNEL, dma); if (dtd == NULL) return dtd; dtd->dtd_dma = *dma; /* initialize buffer page pointers */ buf_ptr = (u32)(req->req.dma + req->req.actual); for (i = 0; i < 5; i++) dtd->dtd_buf[i] = cpu_to_le32(buf_ptr + i * PAGE_SIZE); req->req.actual += *length; /* fill in total bytes with transfer size */ dtd->dtd_total = cpu_to_le16(*length); dev_vdbg(&dev->pdev->dev, "dtd->dtd_total = %d\n", dtd->dtd_total); /* set is_last flag if req->req.zero is set or not */ if (req->req.zero) { if (*length == 0 || (*length % req->ep->ep.maxpacket) != 0) *is_last = 1; else *is_last = 0; } else if (req->req.length == req->req.actual) { *is_last = 1; } else *is_last = 0; if (*is_last == 0) dev_vdbg(&dev->pdev->dev, "multi-dtd request!\n"); /* set interrupt on complete bit for the last dTD */ if (*is_last && !req->req.no_interrupt) dtd->dtd_ioc = 1; /* set multiplier override 0 for non-ISO and non-TX endpoint */ dtd->dtd_multo = 0; /* set the active bit of status field to 1 */ dtd->dtd_status = DTD_STS_ACTIVE; dev_vdbg(&dev->pdev->dev, "dtd->dtd_status = 0x%02x\n", dtd->dtd_status); dev_vdbg(&dev->pdev->dev, "length = %d, dma addr= 0x%08x\n", *length, (int)*dma); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return dtd; } /* generate dTD linked list for a request */ static int req_to_dtd(struct langwell_request *req) { unsigned count; int is_last, is_first = 1; struct langwell_dtd *dtd, *last_dtd = NULL; struct langwell_udc *dev; dma_addr_t dma; dev = req->ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); do { dtd = build_dtd(req, &count, &dma, &is_last); if (dtd == NULL) return -ENOMEM; if (is_first) { is_first = 0; req->head = dtd; } else { last_dtd->dtd_next = cpu_to_le32(dma); last_dtd->next_dtd_virt = dtd; } last_dtd = dtd; req->dtd_count++; } while (!is_last); /* set terminate bit to 1 for the last dTD */ dtd->dtd_next = DTD_TERM; req->tail = dtd; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /*-------------------------------------------------------------------------*/ /* queue (submits) an I/O requests to an endpoint */ static int langwell_ep_queue(struct usb_ep *_ep, struct usb_request *_req, gfp_t gfp_flags) { struct langwell_request *req; struct langwell_ep *ep; struct langwell_udc *dev; unsigned long flags; int is_iso = 0; int ret; /* always require a cpu-view buffer */ req = container_of(_req, struct langwell_request, req); ep = container_of(_ep, struct langwell_ep, ep); if (!_req || !_req->complete || !_req->buf || !list_empty(&req->queue)) { return -EINVAL; } if (unlikely(!_ep || !ep->ep.desc)) return -EINVAL; dev = ep->dev; req->ep = ep; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (usb_endpoint_xfer_isoc(ep->ep.desc)) { if (req->req.length > ep->ep.maxpacket) return -EMSGSIZE; is_iso = 1; } if (unlikely(!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN)) return -ESHUTDOWN; /* set up dma mapping */ ret = usb_gadget_map_request(&dev->gadget, &req->req, is_in(ep)); if (ret) return ret; dev_dbg(&dev->pdev->dev, "%s queue req %p, len %u, buf %p, dma 0x%08x\n", _ep->name, _req, _req->length, _req->buf, (int)_req->dma); _req->status = -EINPROGRESS; _req->actual = 0; req->dtd_count = 0; spin_lock_irqsave(&dev->lock, flags); /* build and put dTDs to endpoint queue */ if (!req_to_dtd(req)) { queue_dtd(ep, req); } else { spin_unlock_irqrestore(&dev->lock, flags); return -ENOMEM; } /* update ep0 state */ if (ep->ep_num == 0) dev->ep0_state = DATA_STATE_XMIT; if (likely(req != NULL)) { list_add_tail(&req->queue, &ep->queue); dev_vdbg(&dev->pdev->dev, "list_add_tail()\n"); } spin_unlock_irqrestore(&dev->lock, flags); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* dequeue (cancels, unlinks) an I/O request from an endpoint */ static int langwell_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req) { struct langwell_ep *ep; struct langwell_udc *dev; struct langwell_request *req; unsigned long flags; int stopped, ep_num, retval = 0; u32 endptctrl; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !ep->ep.desc || !_req) return -EINVAL; if (!dev->driver) return -ESHUTDOWN; spin_lock_irqsave(&dev->lock, flags); stopped = ep->stopped; /* quiesce dma while we patch the queue */ ep->stopped = 1; ep_num = ep->ep_num; /* disable endpoint control register */ endptctrl = readl(&dev->op_regs->endptctrl[ep_num]); if (is_in(ep)) endptctrl &= ~EPCTRL_TXE; else endptctrl &= ~EPCTRL_RXE; writel(endptctrl, &dev->op_regs->endptctrl[ep_num]); /* make sure it's still queued on this endpoint */ list_for_each_entry(req, &ep->queue, queue) { if (&req->req == _req) break; } if (&req->req != _req) { retval = -EINVAL; goto done; } /* queue head may be partially complete. */ if (ep->queue.next == &req->queue) { dev_dbg(&dev->pdev->dev, "unlink (%s) dma\n", _ep->name); _req->status = -ECONNRESET; langwell_ep_fifo_flush(&ep->ep); /* not the last request in endpoint queue */ if (likely(ep->queue.next == &req->queue)) { struct langwell_dqh *dqh; struct langwell_request *next_req; dqh = ep->dqh; next_req = list_entry(req->queue.next, struct langwell_request, queue); /* point the dQH to the first dTD of next request */ writel((u32) next_req->head, &dqh->dqh_current); } } else { struct langwell_request *prev_req; prev_req = list_entry(req->queue.prev, struct langwell_request, queue); writel(readl(&req->tail->dtd_next), &prev_req->tail->dtd_next); } done(ep, req, -ECONNRESET); done: /* enable endpoint again */ endptctrl = readl(&dev->op_regs->endptctrl[ep_num]); if (is_in(ep)) endptctrl |= EPCTRL_TXE; else endptctrl |= EPCTRL_RXE; writel(endptctrl, &dev->op_regs->endptctrl[ep_num]); ep->stopped = stopped; spin_unlock_irqrestore(&dev->lock, flags); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return retval; } /*-------------------------------------------------------------------------*/ /* endpoint set/clear halt */ static void ep_set_halt(struct langwell_ep *ep, int value) { u32 endptctrl = 0; int ep_num; struct langwell_udc *dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); ep_num = ep->ep_num; endptctrl = readl(&dev->op_regs->endptctrl[ep_num]); /* value: 1 - set halt, 0 - clear halt */ if (value) { /* set the stall bit */ if (is_in(ep)) endptctrl |= EPCTRL_TXS; else endptctrl |= EPCTRL_RXS; } else { /* clear the stall bit and reset data toggle */ if (is_in(ep)) { endptctrl &= ~EPCTRL_TXS; endptctrl |= EPCTRL_TXR; } else { endptctrl &= ~EPCTRL_RXS; endptctrl |= EPCTRL_RXR; } } writel(endptctrl, &dev->op_regs->endptctrl[ep_num]); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* set the endpoint halt feature */ static int langwell_ep_set_halt(struct usb_ep *_ep, int value) { struct langwell_ep *ep; struct langwell_udc *dev; unsigned long flags; int retval = 0; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !ep->ep.desc) return -EINVAL; if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN) return -ESHUTDOWN; if (usb_endpoint_xfer_isoc(ep->ep.desc)) return -EOPNOTSUPP; spin_lock_irqsave(&dev->lock, flags); /* * attempt to halt IN ep will fail if any transfer requests * are still queue */ if (!list_empty(&ep->queue) && is_in(ep) && value) { /* IN endpoint FIFO holds bytes */ dev_dbg(&dev->pdev->dev, "%s FIFO holds bytes\n", _ep->name); retval = -EAGAIN; goto done; } /* endpoint set/clear halt */ if (ep->ep_num) { ep_set_halt(ep, value); } else { /* endpoint 0 */ dev->ep0_state = WAIT_FOR_SETUP; dev->ep0_dir = USB_DIR_OUT; } done: spin_unlock_irqrestore(&dev->lock, flags); dev_dbg(&dev->pdev->dev, "%s %s halt\n", _ep->name, value ? "set" : "clear"); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return retval; } /* set the halt feature and ignores clear requests */ static int langwell_ep_set_wedge(struct usb_ep *_ep) { struct langwell_ep *ep; struct langwell_udc *dev; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !ep->ep.desc) return -EINVAL; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return usb_ep_set_halt(_ep); } /* flush contents of a fifo */ static void langwell_ep_fifo_flush(struct usb_ep *_ep) { struct langwell_ep *ep; struct langwell_udc *dev; u32 flush_bit; unsigned long timeout; ep = container_of(_ep, struct langwell_ep, ep); dev = ep->dev; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (!_ep || !ep->ep.desc) { dev_vdbg(&dev->pdev->dev, "ep or ep->ep.desc is NULL\n"); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return; } dev_vdbg(&dev->pdev->dev, "%s-%s fifo flush\n", _ep->name, DIR_STRING(ep)); /* flush endpoint buffer */ if (ep->ep_num == 0) flush_bit = (1 << 16) | 1; else if (is_in(ep)) flush_bit = 1 << (ep->ep_num + 16); /* TX */ else flush_bit = 1 << ep->ep_num; /* RX */ /* wait until flush complete */ timeout = jiffies + FLUSH_TIMEOUT; do { writel(flush_bit, &dev->op_regs->endptflush); while (readl(&dev->op_regs->endptflush)) { if (time_after(jiffies, timeout)) { dev_err(&dev->pdev->dev, "ep flush timeout\n"); goto done; } cpu_relax(); } } while (readl(&dev->op_regs->endptstat) & flush_bit); done: dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* endpoints operations structure */ static const struct usb_ep_ops langwell_ep_ops = { /* configure endpoint, making it usable */ .enable = langwell_ep_enable, /* endpoint is no longer usable */ .disable = langwell_ep_disable, /* allocate a request object to use with this endpoint */ .alloc_request = langwell_alloc_request, /* free a request object */ .free_request = langwell_free_request, /* queue (submits) an I/O requests to an endpoint */ .queue = langwell_ep_queue, /* dequeue (cancels, unlinks) an I/O request from an endpoint */ .dequeue = langwell_ep_dequeue, /* set the endpoint halt feature */ .set_halt = langwell_ep_set_halt, /* set the halt feature and ignores clear requests */ .set_wedge = langwell_ep_set_wedge, /* flush contents of a fifo */ .fifo_flush = langwell_ep_fifo_flush, }; /*-------------------------------------------------------------------------*/ /* device controller usb_gadget_ops structure */ /* returns the current frame number */ static int langwell_get_frame(struct usb_gadget *_gadget) { struct langwell_udc *dev; u16 retval; if (!_gadget) return -ENODEV; dev = container_of(_gadget, struct langwell_udc, gadget); dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); retval = readl(&dev->op_regs->frindex) & FRINDEX_MASK; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return retval; } /* enter or exit PHY low power state */ static void langwell_phy_low_power(struct langwell_udc *dev, bool flag) { u32 devlc; u8 devlc_byte2; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); devlc = readl(&dev->op_regs->devlc); dev_vdbg(&dev->pdev->dev, "devlc = 0x%08x\n", devlc); if (flag) devlc |= LPM_PHCD; else devlc &= ~LPM_PHCD; /* FIXME: workaround for Langwell A1/A2/A3 sighting */ devlc_byte2 = (devlc >> 16) & 0xff; writeb(devlc_byte2, (u8 *)&dev->op_regs->devlc + 2); devlc = readl(&dev->op_regs->devlc); dev_vdbg(&dev->pdev->dev, "%s PHY low power suspend, devlc = 0x%08x\n", flag ? "enter" : "exit", devlc); } /* tries to wake up the host connected to this gadget */ static int langwell_wakeup(struct usb_gadget *_gadget) { struct langwell_udc *dev; u32 portsc1; unsigned long flags; if (!_gadget) return 0; dev = container_of(_gadget, struct langwell_udc, gadget); dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* remote wakeup feature not enabled by host */ if (!dev->remote_wakeup) { dev_info(&dev->pdev->dev, "remote wakeup is disabled\n"); return -ENOTSUPP; } spin_lock_irqsave(&dev->lock, flags); portsc1 = readl(&dev->op_regs->portsc1); if (!(portsc1 & PORTS_SUSP)) { spin_unlock_irqrestore(&dev->lock, flags); return 0; } /* LPM L1 to L0 or legacy remote wakeup */ if (dev->lpm && dev->lpm_state == LPM_L1) dev_info(&dev->pdev->dev, "LPM L1 to L0 remote wakeup\n"); else dev_info(&dev->pdev->dev, "device remote wakeup\n"); /* exit PHY low power suspend */ if (dev->pdev->device != 0x0829) langwell_phy_low_power(dev, 0); /* force port resume */ portsc1 |= PORTS_FPR; writel(portsc1, &dev->op_regs->portsc1); spin_unlock_irqrestore(&dev->lock, flags); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* notify controller that VBUS is powered or not */ static int langwell_vbus_session(struct usb_gadget *_gadget, int is_active) { struct langwell_udc *dev; unsigned long flags; u32 usbcmd; if (!_gadget) return -ENODEV; dev = container_of(_gadget, struct langwell_udc, gadget); dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); spin_lock_irqsave(&dev->lock, flags); dev_vdbg(&dev->pdev->dev, "VBUS status: %s\n", is_active ? "on" : "off"); dev->vbus_active = (is_active != 0); if (dev->driver && dev->softconnected && dev->vbus_active) { usbcmd = readl(&dev->op_regs->usbcmd); usbcmd |= CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); } else { usbcmd = readl(&dev->op_regs->usbcmd); usbcmd &= ~CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); } spin_unlock_irqrestore(&dev->lock, flags); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* constrain controller's VBUS power usage */ static int langwell_vbus_draw(struct usb_gadget *_gadget, unsigned mA) { struct langwell_udc *dev; if (!_gadget) return -ENODEV; dev = container_of(_gadget, struct langwell_udc, gadget); dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (dev->transceiver) { dev_vdbg(&dev->pdev->dev, "usb_phy_set_power\n"); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return usb_phy_set_power(dev->transceiver, mA); } dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return -ENOTSUPP; } /* D+ pullup, software-controlled connect/disconnect to USB host */ static int langwell_pullup(struct usb_gadget *_gadget, int is_on) { struct langwell_udc *dev; u32 usbcmd; unsigned long flags; if (!_gadget) return -ENODEV; dev = container_of(_gadget, struct langwell_udc, gadget); dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); spin_lock_irqsave(&dev->lock, flags); dev->softconnected = (is_on != 0); if (dev->driver && dev->softconnected && dev->vbus_active) { usbcmd = readl(&dev->op_regs->usbcmd); usbcmd |= CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); } else { usbcmd = readl(&dev->op_regs->usbcmd); usbcmd &= ~CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); } spin_unlock_irqrestore(&dev->lock, flags); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } static int langwell_start(struct usb_gadget *g, struct usb_gadget_driver *driver); static int langwell_stop(struct usb_gadget *g, struct usb_gadget_driver *driver); /* device controller usb_gadget_ops structure */ static const struct usb_gadget_ops langwell_ops = { /* returns the current frame number */ .get_frame = langwell_get_frame, /* tries to wake up the host connected to this gadget */ .wakeup = langwell_wakeup, /* set the device selfpowered feature, always selfpowered */ /* .set_selfpowered = langwell_set_selfpowered, */ /* notify controller that VBUS is powered or not */ .vbus_session = langwell_vbus_session, /* constrain controller's VBUS power usage */ .vbus_draw = langwell_vbus_draw, /* D+ pullup, software-controlled connect/disconnect to USB host */ .pullup = langwell_pullup, .udc_start = langwell_start, .udc_stop = langwell_stop, }; /*-------------------------------------------------------------------------*/ /* device controller operations */ /* reset device controller */ static int langwell_udc_reset(struct langwell_udc *dev) { u32 usbcmd, usbmode, devlc, endpointlistaddr; u8 devlc_byte0, devlc_byte2; unsigned long timeout; if (!dev) return -EINVAL; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); /* set controller to stop state */ usbcmd = readl(&dev->op_regs->usbcmd); usbcmd &= ~CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); /* reset device controller */ usbcmd = readl(&dev->op_regs->usbcmd); usbcmd |= CMD_RST; writel(usbcmd, &dev->op_regs->usbcmd); /* wait for reset to complete */ timeout = jiffies + RESET_TIMEOUT; while (readl(&dev->op_regs->usbcmd) & CMD_RST) { if (time_after(jiffies, timeout)) { dev_err(&dev->pdev->dev, "device reset timeout\n"); return -ETIMEDOUT; } cpu_relax(); } /* set controller to device mode */ usbmode = readl(&dev->op_regs->usbmode); usbmode |= MODE_DEVICE; /* turn setup lockout off, require setup tripwire in usbcmd */ usbmode |= MODE_SLOM; writel(usbmode, &dev->op_regs->usbmode); usbmode = readl(&dev->op_regs->usbmode); dev_vdbg(&dev->pdev->dev, "usbmode=0x%08x\n", usbmode); /* Write-Clear setup status */ writel(0, &dev->op_regs->usbsts); /* if support USB LPM, ACK all LPM token */ if (dev->lpm) { devlc = readl(&dev->op_regs->devlc); dev_vdbg(&dev->pdev->dev, "devlc = 0x%08x\n", devlc); /* FIXME: workaround for Langwell A1/A2/A3 sighting */ devlc &= ~LPM_STL; /* don't STALL LPM token */ devlc &= ~LPM_NYT_ACK; /* ACK LPM token */ devlc_byte0 = devlc & 0xff; devlc_byte2 = (devlc >> 16) & 0xff; writeb(devlc_byte0, (u8 *)&dev->op_regs->devlc); writeb(devlc_byte2, (u8 *)&dev->op_regs->devlc + 2); devlc = readl(&dev->op_regs->devlc); dev_vdbg(&dev->pdev->dev, "ACK LPM token, devlc = 0x%08x\n", devlc); } /* fill endpointlistaddr register */ endpointlistaddr = dev->ep_dqh_dma; endpointlistaddr &= ENDPOINTLISTADDR_MASK; writel(endpointlistaddr, &dev->op_regs->endpointlistaddr); dev_vdbg(&dev->pdev->dev, "dQH base (vir: %p, phy: 0x%08x), endpointlistaddr=0x%08x\n", dev->ep_dqh, endpointlistaddr, readl(&dev->op_regs->endpointlistaddr)); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* reinitialize device controller endpoints */ static int eps_reinit(struct langwell_udc *dev) { struct langwell_ep *ep; char name[14]; int i; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* initialize ep0 */ ep = &dev->ep[0]; ep->dev = dev; strncpy(ep->name, "ep0", sizeof(ep->name)); ep->ep.name = ep->name; ep->ep.ops = &langwell_ep_ops; ep->stopped = 0; ep->ep.maxpacket = EP0_MAX_PKT_SIZE; ep->ep_num = 0; ep->ep.desc = &langwell_ep0_desc; INIT_LIST_HEAD(&ep->queue); ep->ep_type = USB_ENDPOINT_XFER_CONTROL; /* initialize other endpoints */ for (i = 2; i < dev->ep_max; i++) { ep = &dev->ep[i]; if (i % 2) snprintf(name, sizeof(name), "ep%din", i / 2); else snprintf(name, sizeof(name), "ep%dout", i / 2); ep->dev = dev; strncpy(ep->name, name, sizeof(ep->name)); ep->ep.name = ep->name; ep->ep.ops = &langwell_ep_ops; ep->stopped = 0; ep->ep.maxpacket = (unsigned short) ~0; ep->ep_num = i / 2; INIT_LIST_HEAD(&ep->queue); list_add_tail(&ep->ep.ep_list, &dev->gadget.ep_list); } dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* enable interrupt and set controller to run state */ static void langwell_udc_start(struct langwell_udc *dev) { u32 usbintr, usbcmd; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); /* enable interrupts */ usbintr = INTR_ULPIE /* ULPI */ | INTR_SLE /* suspend */ /* | INTR_SRE SOF received */ | INTR_URE /* USB reset */ | INTR_AAE /* async advance */ | INTR_SEE /* system error */ | INTR_FRE /* frame list rollover */ | INTR_PCE /* port change detect */ | INTR_UEE /* USB error interrupt */ | INTR_UE; /* USB interrupt */ writel(usbintr, &dev->op_regs->usbintr); /* clear stopped bit */ dev->stopped = 0; /* set controller to run */ usbcmd = readl(&dev->op_regs->usbcmd); usbcmd |= CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* disable interrupt and set controller to stop state */ static void langwell_udc_stop(struct langwell_udc *dev) { u32 usbcmd; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); /* disable all interrupts */ writel(0, &dev->op_regs->usbintr); /* set stopped bit */ dev->stopped = 1; /* set controller to stop state */ usbcmd = readl(&dev->op_regs->usbcmd); usbcmd &= ~CMD_RUNSTOP; writel(usbcmd, &dev->op_regs->usbcmd); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* stop all USB activities */ static void stop_activity(struct langwell_udc *dev) { struct langwell_ep *ep; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); nuke(&dev->ep[0], -ESHUTDOWN); list_for_each_entry(ep, &dev->gadget.ep_list, ep.ep_list) { nuke(ep, -ESHUTDOWN); } /* report disconnect; the driver is already quiesced */ if (dev->driver) { spin_unlock(&dev->lock); dev->driver->disconnect(&dev->gadget); spin_lock(&dev->lock); } dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /*-------------------------------------------------------------------------*/ /* device "function" sysfs attribute file */ static ssize_t show_function(struct device *_dev, struct device_attribute *attr, char *buf) { struct langwell_udc *dev = dev_get_drvdata(_dev); if (!dev->driver || !dev->driver->function || strlen(dev->driver->function) > PAGE_SIZE) return 0; return scnprintf(buf, PAGE_SIZE, "%s\n", dev->driver->function); } static DEVICE_ATTR(function, S_IRUGO, show_function, NULL); static inline enum usb_device_speed lpm_device_speed(u32 reg) { switch (LPM_PSPD(reg)) { case LPM_SPEED_HIGH: return USB_SPEED_HIGH; case LPM_SPEED_FULL: return USB_SPEED_FULL; case LPM_SPEED_LOW: return USB_SPEED_LOW; default: return USB_SPEED_UNKNOWN; } } /* device "langwell_udc" sysfs attribute file */ static ssize_t show_langwell_udc(struct device *_dev, struct device_attribute *attr, char *buf) { struct langwell_udc *dev = dev_get_drvdata(_dev); struct langwell_request *req; struct langwell_ep *ep = NULL; char *next; unsigned size; unsigned t; unsigned i; unsigned long flags; u32 tmp_reg; next = buf; size = PAGE_SIZE; spin_lock_irqsave(&dev->lock, flags); /* driver basic information */ t = scnprintf(next, size, DRIVER_DESC "\n" "%s version: %s\n" "Gadget driver: %s\n\n", driver_name, DRIVER_VERSION, dev->driver ? dev->driver->driver.name : "(none)"); size -= t; next += t; /* device registers */ tmp_reg = readl(&dev->op_regs->usbcmd); t = scnprintf(next, size, "USBCMD reg:\n" "SetupTW: %d\n" "Run/Stop: %s\n\n", (tmp_reg & CMD_SUTW) ? 1 : 0, (tmp_reg & CMD_RUNSTOP) ? "Run" : "Stop"); size -= t; next += t; tmp_reg = readl(&dev->op_regs->usbsts); t = scnprintf(next, size, "USB Status Reg:\n" "Device Suspend: %d\n" "Reset Received: %d\n" "System Error: %s\n" "USB Error Interrupt: %s\n\n", (tmp_reg & STS_SLI) ? 1 : 0, (tmp_reg & STS_URI) ? 1 : 0, (tmp_reg & STS_SEI) ? "Error" : "No error", (tmp_reg & STS_UEI) ? "Error detected" : "No error"); size -= t; next += t; tmp_reg = readl(&dev->op_regs->usbintr); t = scnprintf(next, size, "USB Intrrupt Enable Reg:\n" "Sleep Enable: %d\n" "SOF Received Enable: %d\n" "Reset Enable: %d\n" "System Error Enable: %d\n" "Port Change Dectected Enable: %d\n" "USB Error Intr Enable: %d\n" "USB Intr Enable: %d\n\n", (tmp_reg & INTR_SLE) ? 1 : 0, (tmp_reg & INTR_SRE) ? 1 : 0, (tmp_reg & INTR_URE) ? 1 : 0, (tmp_reg & INTR_SEE) ? 1 : 0, (tmp_reg & INTR_PCE) ? 1 : 0, (tmp_reg & INTR_UEE) ? 1 : 0, (tmp_reg & INTR_UE) ? 1 : 0); size -= t; next += t; tmp_reg = readl(&dev->op_regs->frindex); t = scnprintf(next, size, "USB Frame Index Reg:\n" "Frame Number is 0x%08x\n\n", (tmp_reg & FRINDEX_MASK)); size -= t; next += t; tmp_reg = readl(&dev->op_regs->deviceaddr); t = scnprintf(next, size, "USB Device Address Reg:\n" "Device Addr is 0x%x\n\n", USBADR(tmp_reg)); size -= t; next += t; tmp_reg = readl(&dev->op_regs->endpointlistaddr); t = scnprintf(next, size, "USB Endpoint List Address Reg:\n" "Endpoint List Pointer is 0x%x\n\n", EPBASE(tmp_reg)); size -= t; next += t; tmp_reg = readl(&dev->op_regs->portsc1); t = scnprintf(next, size, "USB Port Status & Control Reg:\n" "Port Reset: %s\n" "Port Suspend Mode: %s\n" "Over-current Change: %s\n" "Port Enable/Disable Change: %s\n" "Port Enabled/Disabled: %s\n" "Current Connect Status: %s\n" "LPM Suspend Status: %s\n\n", (tmp_reg & PORTS_PR) ? "Reset" : "Not Reset", (tmp_reg & PORTS_SUSP) ? "Suspend " : "Not Suspend", (tmp_reg & PORTS_OCC) ? "Detected" : "No", (tmp_reg & PORTS_PEC) ? "Changed" : "Not Changed", (tmp_reg & PORTS_PE) ? "Enable" : "Not Correct", (tmp_reg & PORTS_CCS) ? "Attached" : "Not Attached", (tmp_reg & PORTS_SLP) ? "LPM L1" : "LPM L0"); size -= t; next += t; tmp_reg = readl(&dev->op_regs->devlc); t = scnprintf(next, size, "Device LPM Control Reg:\n" "Parallel Transceiver : %d\n" "Serial Transceiver : %d\n" "Port Speed: %s\n" "Port Force Full Speed Connenct: %s\n" "PHY Low Power Suspend Clock: %s\n" "BmAttributes: %d\n\n", LPM_PTS(tmp_reg), (tmp_reg & LPM_STS) ? 1 : 0, usb_speed_string(lpm_device_speed(tmp_reg)), (tmp_reg & LPM_PFSC) ? "Force Full Speed" : "Not Force", (tmp_reg & LPM_PHCD) ? "Disabled" : "Enabled", LPM_BA(tmp_reg)); size -= t; next += t; tmp_reg = readl(&dev->op_regs->usbmode); t = scnprintf(next, size, "USB Mode Reg:\n" "Controller Mode is : %s\n\n", ({ char *s; switch (MODE_CM(tmp_reg)) { case MODE_IDLE: s = "Idle"; break; case MODE_DEVICE: s = "Device Controller"; break; case MODE_HOST: s = "Host Controller"; break; default: s = "None"; break; } s; })); size -= t; next += t; tmp_reg = readl(&dev->op_regs->endptsetupstat); t = scnprintf(next, size, "Endpoint Setup Status Reg:\n" "SETUP on ep 0x%04x\n\n", tmp_reg & SETUPSTAT_MASK); size -= t; next += t; for (i = 0; i < dev->ep_max / 2; i++) { tmp_reg = readl(&dev->op_regs->endptctrl[i]); t = scnprintf(next, size, "EP Ctrl Reg [%d]: 0x%08x\n", i, tmp_reg); size -= t; next += t; } tmp_reg = readl(&dev->op_regs->endptprime); t = scnprintf(next, size, "EP Prime Reg: 0x%08x\n\n", tmp_reg); size -= t; next += t; /* langwell_udc, langwell_ep, langwell_request structure information */ ep = &dev->ep[0]; t = scnprintf(next, size, "%s MaxPacketSize: 0x%x, ep_num: %d\n", ep->ep.name, ep->ep.maxpacket, ep->ep_num); size -= t; next += t; if (list_empty(&ep->queue)) { t = scnprintf(next, size, "its req queue is empty\n\n"); size -= t; next += t; } else { list_for_each_entry(req, &ep->queue, queue) { t = scnprintf(next, size, "req %p actual 0x%x length 0x%x buf %p\n", &req->req, req->req.actual, req->req.length, req->req.buf); size -= t; next += t; } } /* other gadget->eplist ep */ list_for_each_entry(ep, &dev->gadget.ep_list, ep.ep_list) { if (ep->ep.desc) { t = scnprintf(next, size, "\n%s MaxPacketSize: 0x%x, " "ep_num: %d\n", ep->ep.name, ep->ep.maxpacket, ep->ep_num); size -= t; next += t; if (list_empty(&ep->queue)) { t = scnprintf(next, size, "its req queue is empty\n\n"); size -= t; next += t; } else { list_for_each_entry(req, &ep->queue, queue) { t = scnprintf(next, size, "req %p actual 0x%x length " "0x%x buf %p\n", &req->req, req->req.actual, req->req.length, req->req.buf); size -= t; next += t; } } } } spin_unlock_irqrestore(&dev->lock, flags); return PAGE_SIZE - size; } static DEVICE_ATTR(langwell_udc, S_IRUGO, show_langwell_udc, NULL); /* device "remote_wakeup" sysfs attribute file */ static ssize_t store_remote_wakeup(struct device *_dev, struct device_attribute *attr, const char *buf, size_t count) { struct langwell_udc *dev = dev_get_drvdata(_dev); unsigned long flags; ssize_t rc = count; if (count > 2) return -EINVAL; if (count > 0 && buf[count-1] == '\n') ((char *) buf)[count-1] = 0; if (buf[0] != '1') return -EINVAL; /* force remote wakeup enabled in case gadget driver doesn't support */ spin_lock_irqsave(&dev->lock, flags); dev->remote_wakeup = 1; dev->dev_status |= (1 << USB_DEVICE_REMOTE_WAKEUP); spin_unlock_irqrestore(&dev->lock, flags); langwell_wakeup(&dev->gadget); return rc; } static DEVICE_ATTR(remote_wakeup, S_IWUSR, NULL, store_remote_wakeup); /*-------------------------------------------------------------------------*/ /* * when a driver is successfully registered, it will receive * control requests including set_configuration(), which enables * non-control requests. then usb traffic follows until a * disconnect is reported. then a host may connect again, or * the driver might get unbound. */ static int langwell_start(struct usb_gadget *g, struct usb_gadget_driver *driver) { struct langwell_udc *dev = gadget_to_langwell(g); unsigned long flags; int retval; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); spin_lock_irqsave(&dev->lock, flags); /* hook up the driver ... */ driver->driver.bus = NULL; dev->driver = driver; dev->gadget.dev.driver = &driver->driver; spin_unlock_irqrestore(&dev->lock, flags); retval = device_create_file(&dev->pdev->dev, &dev_attr_function); if (retval) goto err; dev->usb_state = USB_STATE_ATTACHED; dev->ep0_state = WAIT_FOR_SETUP; dev->ep0_dir = USB_DIR_OUT; /* enable interrupt and set controller to run state */ if (dev->got_irq) langwell_udc_start(dev); dev_vdbg(&dev->pdev->dev, "After langwell_udc_start(), print all registers:\n"); print_all_registers(dev); dev_info(&dev->pdev->dev, "register driver: %s\n", driver->driver.name); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; err: dev->gadget.dev.driver = NULL; dev->driver = NULL; dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); return retval; } /* unregister gadget driver */ static int langwell_stop(struct usb_gadget *g, struct usb_gadget_driver *driver) { struct langwell_udc *dev = gadget_to_langwell(g); unsigned long flags; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); /* exit PHY low power suspend */ if (dev->pdev->device != 0x0829) langwell_phy_low_power(dev, 0); /* unbind OTG transceiver */ if (dev->transceiver) (void)otg_set_peripheral(dev->transceiver->otg, 0); /* disable interrupt and set controller to stop state */ langwell_udc_stop(dev); dev->usb_state = USB_STATE_ATTACHED; dev->ep0_state = WAIT_FOR_SETUP; dev->ep0_dir = USB_DIR_OUT; spin_lock_irqsave(&dev->lock, flags); /* stop all usb activities */ dev->gadget.speed = USB_SPEED_UNKNOWN; dev->gadget.dev.driver = NULL; dev->driver = NULL; stop_activity(dev); spin_unlock_irqrestore(&dev->lock, flags); device_remove_file(&dev->pdev->dev, &dev_attr_function); dev_info(&dev->pdev->dev, "unregistered driver '%s'\n", driver->driver.name); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /*-------------------------------------------------------------------------*/ /* * setup tripwire is used as a semaphore to ensure that the setup data * payload is extracted from a dQH without being corrupted */ static void setup_tripwire(struct langwell_udc *dev) { u32 usbcmd, endptsetupstat; unsigned long timeout; struct langwell_dqh *dqh; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* ep0 OUT dQH */ dqh = &dev->ep_dqh[EP_DIR_OUT]; /* Write-Clear endptsetupstat */ endptsetupstat = readl(&dev->op_regs->endptsetupstat); writel(endptsetupstat, &dev->op_regs->endptsetupstat); /* wait until endptsetupstat is cleared */ timeout = jiffies + SETUPSTAT_TIMEOUT; while (readl(&dev->op_regs->endptsetupstat)) { if (time_after(jiffies, timeout)) { dev_err(&dev->pdev->dev, "setup_tripwire timeout\n"); break; } cpu_relax(); } /* while a hazard exists when setup packet arrives */ do { /* set setup tripwire bit */ usbcmd = readl(&dev->op_regs->usbcmd); writel(usbcmd | CMD_SUTW, &dev->op_regs->usbcmd); /* copy the setup packet to local buffer */ memcpy(&dev->local_setup_buff, &dqh->dqh_setup, 8); } while (!(readl(&dev->op_regs->usbcmd) & CMD_SUTW)); /* Write-Clear setup tripwire bit */ usbcmd = readl(&dev->op_regs->usbcmd); writel(usbcmd & ~CMD_SUTW, &dev->op_regs->usbcmd); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* protocol ep0 stall, will automatically be cleared on new transaction */ static void ep0_stall(struct langwell_udc *dev) { u32 endptctrl; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* set TX and RX to stall */ endptctrl = readl(&dev->op_regs->endptctrl[0]); endptctrl |= EPCTRL_TXS | EPCTRL_RXS; writel(endptctrl, &dev->op_regs->endptctrl[0]); /* update ep0 state */ dev->ep0_state = WAIT_FOR_SETUP; dev->ep0_dir = USB_DIR_OUT; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* PRIME a status phase for ep0 */ static int prime_status_phase(struct langwell_udc *dev, int dir) { struct langwell_request *req; struct langwell_ep *ep; int status = 0; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (dir == EP_DIR_IN) dev->ep0_dir = USB_DIR_IN; else dev->ep0_dir = USB_DIR_OUT; ep = &dev->ep[0]; dev->ep0_state = WAIT_FOR_OUT_STATUS; req = dev->status_req; req->ep = ep; req->req.length = 0; req->req.status = -EINPROGRESS; req->req.actual = 0; req->req.complete = NULL; req->dtd_count = 0; if (!req_to_dtd(req)) status = queue_dtd(ep, req); else return -ENOMEM; if (status) dev_err(&dev->pdev->dev, "can't queue ep0 status request\n"); list_add_tail(&req->queue, &ep->queue); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return status; } /* SET_ADDRESS request routine */ static void set_address(struct langwell_udc *dev, u16 value, u16 index, u16 length) { dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* save the new address to device struct */ dev->dev_addr = (u8) value; dev_vdbg(&dev->pdev->dev, "dev->dev_addr = %d\n", dev->dev_addr); /* update usb state */ dev->usb_state = USB_STATE_ADDRESS; /* STATUS phase */ if (prime_status_phase(dev, EP_DIR_IN)) ep0_stall(dev); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* return endpoint by windex */ static struct langwell_ep *get_ep_by_windex(struct langwell_udc *dev, u16 wIndex) { struct langwell_ep *ep; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if ((wIndex & USB_ENDPOINT_NUMBER_MASK) == 0) return &dev->ep[0]; list_for_each_entry(ep, &dev->gadget.ep_list, ep.ep_list) { u8 bEndpointAddress; if (!ep->ep.desc) continue; bEndpointAddress = ep->ep.desc->bEndpointAddress; if ((wIndex ^ bEndpointAddress) & USB_DIR_IN) continue; if ((wIndex & USB_ENDPOINT_NUMBER_MASK) == (bEndpointAddress & USB_ENDPOINT_NUMBER_MASK)) return ep; } dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return NULL; } /* return whether endpoint is stalled, 0: not stalled; 1: stalled */ static int ep_is_stall(struct langwell_ep *ep) { struct langwell_udc *dev = ep->dev; u32 endptctrl; int retval; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); endptctrl = readl(&dev->op_regs->endptctrl[ep->ep_num]); if (is_in(ep)) retval = endptctrl & EPCTRL_TXS ? 1 : 0; else retval = endptctrl & EPCTRL_RXS ? 1 : 0; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return retval; } /* GET_STATUS request routine */ static void get_status(struct langwell_udc *dev, u8 request_type, u16 value, u16 index, u16 length) { struct langwell_request *req; struct langwell_ep *ep; u16 status_data = 0; /* 16 bits cpu view status data */ int status = 0; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); ep = &dev->ep[0]; if ((request_type & USB_RECIP_MASK) == USB_RECIP_DEVICE) { /* get device status */ status_data = dev->dev_status; } else if ((request_type & USB_RECIP_MASK) == USB_RECIP_INTERFACE) { /* get interface status */ status_data = 0; } else if ((request_type & USB_RECIP_MASK) == USB_RECIP_ENDPOINT) { /* get endpoint status */ struct langwell_ep *epn; epn = get_ep_by_windex(dev, index); /* stall if endpoint doesn't exist */ if (!epn) goto stall; status_data = ep_is_stall(epn) << USB_ENDPOINT_HALT; } dev_dbg(&dev->pdev->dev, "get status data: 0x%04x\n", status_data); dev->ep0_dir = USB_DIR_IN; /* borrow the per device status_req */ req = dev->status_req; /* fill in the reqest structure */ *((u16 *) req->req.buf) = cpu_to_le16(status_data); req->ep = ep; req->req.length = 2; req->req.status = -EINPROGRESS; req->req.actual = 0; req->req.complete = NULL; req->dtd_count = 0; /* prime the data phase */ if (!req_to_dtd(req)) status = queue_dtd(ep, req); else /* no mem */ goto stall; if (status) { dev_err(&dev->pdev->dev, "response error on GET_STATUS request\n"); goto stall; } list_add_tail(&req->queue, &ep->queue); dev->ep0_state = DATA_STATE_XMIT; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return; stall: ep0_stall(dev); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* setup packet interrupt handler */ static void handle_setup_packet(struct langwell_udc *dev, struct usb_ctrlrequest *setup) { u16 wValue = le16_to_cpu(setup->wValue); u16 wIndex = le16_to_cpu(setup->wIndex); u16 wLength = le16_to_cpu(setup->wLength); u32 portsc1; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* ep0 fifo flush */ nuke(&dev->ep[0], -ESHUTDOWN); dev_dbg(&dev->pdev->dev, "SETUP %02x.%02x v%04x i%04x l%04x\n", setup->bRequestType, setup->bRequest, wValue, wIndex, wLength); /* RNDIS gadget delegate */ if ((setup->bRequestType == 0x21) && (setup->bRequest == 0x00)) { /* USB_CDC_SEND_ENCAPSULATED_COMMAND */ goto delegate; } /* USB_CDC_GET_ENCAPSULATED_RESPONSE */ if ((setup->bRequestType == 0xa1) && (setup->bRequest == 0x01)) { /* USB_CDC_GET_ENCAPSULATED_RESPONSE */ goto delegate; } /* We process some stardard setup requests here */ switch (setup->bRequest) { case USB_REQ_GET_STATUS: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_GET_STATUS\n"); /* get status, DATA and STATUS phase */ if ((setup->bRequestType & (USB_DIR_IN | USB_TYPE_MASK)) != (USB_DIR_IN | USB_TYPE_STANDARD)) break; get_status(dev, setup->bRequestType, wValue, wIndex, wLength); goto end; case USB_REQ_SET_ADDRESS: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_SET_ADDRESS\n"); /* STATUS phase */ if (setup->bRequestType != (USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE)) break; set_address(dev, wValue, wIndex, wLength); goto end; case USB_REQ_CLEAR_FEATURE: case USB_REQ_SET_FEATURE: /* STATUS phase */ { int rc = -EOPNOTSUPP; if (setup->bRequest == USB_REQ_SET_FEATURE) dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_SET_FEATURE\n"); else if (setup->bRequest == USB_REQ_CLEAR_FEATURE) dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_CLEAR_FEATURE\n"); if ((setup->bRequestType & (USB_RECIP_MASK | USB_TYPE_MASK)) == (USB_RECIP_ENDPOINT | USB_TYPE_STANDARD)) { struct langwell_ep *epn; epn = get_ep_by_windex(dev, wIndex); /* stall if endpoint doesn't exist */ if (!epn) { ep0_stall(dev); goto end; } if (wValue != 0 || wLength != 0 || epn->ep_num > dev->ep_max) break; spin_unlock(&dev->lock); rc = langwell_ep_set_halt(&epn->ep, (setup->bRequest == USB_REQ_SET_FEATURE) ? 1 : 0); spin_lock(&dev->lock); } else if ((setup->bRequestType & (USB_RECIP_MASK | USB_TYPE_MASK)) == (USB_RECIP_DEVICE | USB_TYPE_STANDARD)) { rc = 0; switch (wValue) { case USB_DEVICE_REMOTE_WAKEUP: if (setup->bRequest == USB_REQ_SET_FEATURE) { dev->remote_wakeup = 1; dev->dev_status |= (1 << wValue); } else { dev->remote_wakeup = 0; dev->dev_status &= ~(1 << wValue); } break; case USB_DEVICE_TEST_MODE: dev_dbg(&dev->pdev->dev, "SETUP: TEST MODE\n"); if ((wIndex & 0xff) || (dev->gadget.speed != USB_SPEED_HIGH)) ep0_stall(dev); switch (wIndex >> 8) { case TEST_J: case TEST_K: case TEST_SE0_NAK: case TEST_PACKET: case TEST_FORCE_EN: if (prime_status_phase(dev, EP_DIR_IN)) ep0_stall(dev); portsc1 = readl(&dev->op_regs->portsc1); portsc1 |= (wIndex & 0xf00) << 8; writel(portsc1, &dev->op_regs->portsc1); goto end; default: rc = -EOPNOTSUPP; } break; default: rc = -EOPNOTSUPP; break; } if (!gadget_is_otg(&dev->gadget)) break; else if (setup->bRequest == USB_DEVICE_B_HNP_ENABLE) dev->gadget.b_hnp_enable = 1; else if (setup->bRequest == USB_DEVICE_A_HNP_SUPPORT) dev->gadget.a_hnp_support = 1; else if (setup->bRequest == USB_DEVICE_A_ALT_HNP_SUPPORT) dev->gadget.a_alt_hnp_support = 1; else break; } else break; if (rc == 0) { if (prime_status_phase(dev, EP_DIR_IN)) ep0_stall(dev); } goto end; } case USB_REQ_GET_DESCRIPTOR: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_GET_DESCRIPTOR\n"); goto delegate; case USB_REQ_SET_DESCRIPTOR: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_SET_DESCRIPTOR unsupported\n"); goto delegate; case USB_REQ_GET_CONFIGURATION: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_GET_CONFIGURATION\n"); goto delegate; case USB_REQ_SET_CONFIGURATION: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_SET_CONFIGURATION\n"); goto delegate; case USB_REQ_GET_INTERFACE: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_GET_INTERFACE\n"); goto delegate; case USB_REQ_SET_INTERFACE: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_SET_INTERFACE\n"); goto delegate; case USB_REQ_SYNCH_FRAME: dev_dbg(&dev->pdev->dev, "SETUP: USB_REQ_SYNCH_FRAME unsupported\n"); goto delegate; default: /* delegate USB standard requests to the gadget driver */ goto delegate; delegate: /* USB requests handled by gadget */ if (wLength) { /* DATA phase from gadget, STATUS phase from udc */ dev->ep0_dir = (setup->bRequestType & USB_DIR_IN) ? USB_DIR_IN : USB_DIR_OUT; dev_vdbg(&dev->pdev->dev, "dev->ep0_dir = 0x%x, wLength = %d\n", dev->ep0_dir, wLength); spin_unlock(&dev->lock); if (dev->driver->setup(&dev->gadget, &dev->local_setup_buff) < 0) ep0_stall(dev); spin_lock(&dev->lock); dev->ep0_state = (setup->bRequestType & USB_DIR_IN) ? DATA_STATE_XMIT : DATA_STATE_RECV; } else { /* no DATA phase, IN STATUS phase from gadget */ dev->ep0_dir = USB_DIR_IN; dev_vdbg(&dev->pdev->dev, "dev->ep0_dir = 0x%x, wLength = %d\n", dev->ep0_dir, wLength); spin_unlock(&dev->lock); if (dev->driver->setup(&dev->gadget, &dev->local_setup_buff) < 0) ep0_stall(dev); spin_lock(&dev->lock); dev->ep0_state = WAIT_FOR_OUT_STATUS; } break; } end: dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* transfer completion, process endpoint request and free the completed dTDs * for this request */ static int process_ep_req(struct langwell_udc *dev, int index, struct langwell_request *curr_req) { struct langwell_dtd *curr_dtd; struct langwell_dqh *curr_dqh; int td_complete, actual, remaining_length; int i, dir; u8 dtd_status = 0; int retval = 0; curr_dqh = &dev->ep_dqh[index]; dir = index % 2; curr_dtd = curr_req->head; td_complete = 0; actual = curr_req->req.length; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); for (i = 0; i < curr_req->dtd_count; i++) { /* command execution states by dTD */ dtd_status = curr_dtd->dtd_status; barrier(); remaining_length = le16_to_cpu(curr_dtd->dtd_total); actual -= remaining_length; if (!dtd_status) { /* transfers completed successfully */ if (!remaining_length) { td_complete++; dev_vdbg(&dev->pdev->dev, "dTD transmitted successfully\n"); } else { if (dir) { dev_vdbg(&dev->pdev->dev, "TX dTD remains data\n"); retval = -EPROTO; break; } else { td_complete++; break; } } } else { /* transfers completed with errors */ if (dtd_status & DTD_STS_ACTIVE) { dev_dbg(&dev->pdev->dev, "dTD status ACTIVE dQH[%d]\n", index); retval = 1; return retval; } else if (dtd_status & DTD_STS_HALTED) { dev_err(&dev->pdev->dev, "dTD error %08x dQH[%d]\n", dtd_status, index); /* clear the errors and halt condition */ curr_dqh->dtd_status = 0; retval = -EPIPE; break; } else if (dtd_status & DTD_STS_DBE) { dev_dbg(&dev->pdev->dev, "data buffer (overflow) error\n"); retval = -EPROTO; break; } else if (dtd_status & DTD_STS_TRE) { dev_dbg(&dev->pdev->dev, "transaction(ISO) error\n"); retval = -EILSEQ; break; } else dev_err(&dev->pdev->dev, "unknown error (0x%x)!\n", dtd_status); } if (i != curr_req->dtd_count - 1) curr_dtd = (struct langwell_dtd *) curr_dtd->next_dtd_virt; } if (retval) return retval; curr_req->req.actual = actual; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* complete DATA or STATUS phase of ep0 prime status phase if needed */ static void ep0_req_complete(struct langwell_udc *dev, struct langwell_ep *ep0, struct langwell_request *req) { u32 new_addr; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (dev->usb_state == USB_STATE_ADDRESS) { /* set the new address */ new_addr = (u32)dev->dev_addr; writel(new_addr << USBADR_SHIFT, &dev->op_regs->deviceaddr); new_addr = USBADR(readl(&dev->op_regs->deviceaddr)); dev_vdbg(&dev->pdev->dev, "new_addr = %d\n", new_addr); } done(ep0, req, 0); switch (dev->ep0_state) { case DATA_STATE_XMIT: /* receive status phase */ if (prime_status_phase(dev, EP_DIR_OUT)) ep0_stall(dev); break; case DATA_STATE_RECV: /* send status phase */ if (prime_status_phase(dev, EP_DIR_IN)) ep0_stall(dev); break; case WAIT_FOR_OUT_STATUS: dev->ep0_state = WAIT_FOR_SETUP; break; case WAIT_FOR_SETUP: dev_err(&dev->pdev->dev, "unexpect ep0 packets\n"); break; default: ep0_stall(dev); break; } dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* USB transfer completion interrupt */ static void handle_trans_complete(struct langwell_udc *dev) { u32 complete_bits; int i, ep_num, dir, bit_mask, status; struct langwell_ep *epn; struct langwell_request *curr_req, *temp_req; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); complete_bits = readl(&dev->op_regs->endptcomplete); dev_vdbg(&dev->pdev->dev, "endptcomplete register: 0x%08x\n", complete_bits); /* Write-Clear the bits in endptcomplete register */ writel(complete_bits, &dev->op_regs->endptcomplete); if (!complete_bits) { dev_dbg(&dev->pdev->dev, "complete_bits = 0\n"); goto done; } for (i = 0; i < dev->ep_max; i++) { ep_num = i / 2; dir = i % 2; bit_mask = 1 << (ep_num + 16 * dir); if (!(complete_bits & bit_mask)) continue; /* ep0 */ if (i == 1) epn = &dev->ep[0]; else epn = &dev->ep[i]; if (epn->name == NULL) { dev_warn(&dev->pdev->dev, "invalid endpoint\n"); continue; } if (i < 2) /* ep0 in and out */ dev_dbg(&dev->pdev->dev, "%s-%s transfer completed\n", epn->name, is_in(epn) ? "in" : "out"); else dev_dbg(&dev->pdev->dev, "%s transfer completed\n", epn->name); /* process the req queue until an uncomplete request */ list_for_each_entry_safe(curr_req, temp_req, &epn->queue, queue) { status = process_ep_req(dev, i, curr_req); dev_vdbg(&dev->pdev->dev, "%s req status: %d\n", epn->name, status); if (status) break; /* write back status to req */ curr_req->req.status = status; /* ep0 request completion */ if (ep_num == 0) { ep0_req_complete(dev, epn, curr_req); break; } else { done(epn, curr_req, status); } } } done: dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* port change detect interrupt handler */ static void handle_port_change(struct langwell_udc *dev) { u32 portsc1, devlc; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (dev->bus_reset) dev->bus_reset = 0; portsc1 = readl(&dev->op_regs->portsc1); devlc = readl(&dev->op_regs->devlc); dev_vdbg(&dev->pdev->dev, "portsc1 = 0x%08x, devlc = 0x%08x\n", portsc1, devlc); /* bus reset is finished */ if (!(portsc1 & PORTS_PR)) { /* get the speed */ dev->gadget.speed = lpm_device_speed(devlc); dev_vdbg(&dev->pdev->dev, "dev->gadget.speed = %d\n", dev->gadget.speed); } /* LPM L0 to L1 */ if (dev->lpm && dev->lpm_state == LPM_L0) if (portsc1 & PORTS_SUSP && portsc1 & PORTS_SLP) { dev_info(&dev->pdev->dev, "LPM L0 to L1\n"); dev->lpm_state = LPM_L1; } /* LPM L1 to L0, force resume or remote wakeup finished */ if (dev->lpm && dev->lpm_state == LPM_L1) if (!(portsc1 & PORTS_SUSP)) { dev_info(&dev->pdev->dev, "LPM L1 to L0\n"); dev->lpm_state = LPM_L0; } /* update USB state */ if (!dev->resume_state) dev->usb_state = USB_STATE_DEFAULT; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* USB reset interrupt handler */ static void handle_usb_reset(struct langwell_udc *dev) { u32 deviceaddr, endptsetupstat, endptcomplete; unsigned long timeout; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); /* Write-Clear the device address */ deviceaddr = readl(&dev->op_regs->deviceaddr); writel(deviceaddr & ~USBADR_MASK, &dev->op_regs->deviceaddr); dev->dev_addr = 0; /* clear usb state */ dev->resume_state = 0; /* LPM L1 to L0, reset */ if (dev->lpm) dev->lpm_state = LPM_L0; dev->ep0_dir = USB_DIR_OUT; dev->ep0_state = WAIT_FOR_SETUP; /* remote wakeup reset to 0 when the device is reset */ dev->remote_wakeup = 0; dev->dev_status = 1 << USB_DEVICE_SELF_POWERED; dev->gadget.b_hnp_enable = 0; dev->gadget.a_hnp_support = 0; dev->gadget.a_alt_hnp_support = 0; /* Write-Clear all the setup token semaphores */ endptsetupstat = readl(&dev->op_regs->endptsetupstat); writel(endptsetupstat, &dev->op_regs->endptsetupstat); /* Write-Clear all the endpoint complete status bits */ endptcomplete = readl(&dev->op_regs->endptcomplete); writel(endptcomplete, &dev->op_regs->endptcomplete); /* wait until all endptprime bits cleared */ timeout = jiffies + PRIME_TIMEOUT; while (readl(&dev->op_regs->endptprime)) { if (time_after(jiffies, timeout)) { dev_err(&dev->pdev->dev, "USB reset timeout\n"); break; } cpu_relax(); } /* write 1s to endptflush register to clear any primed buffers */ writel((u32) ~0, &dev->op_regs->endptflush); if (readl(&dev->op_regs->portsc1) & PORTS_PR) { dev_vdbg(&dev->pdev->dev, "USB bus reset\n"); /* bus is reseting */ dev->bus_reset = 1; /* reset all the queues, stop all USB activities */ stop_activity(dev); dev->usb_state = USB_STATE_DEFAULT; } else { dev_vdbg(&dev->pdev->dev, "device controller reset\n"); /* controller reset */ langwell_udc_reset(dev); /* reset all the queues, stop all USB activities */ stop_activity(dev); /* reset ep0 dQH and endptctrl */ ep0_reset(dev); /* enable interrupt and set controller to run state */ langwell_udc_start(dev); dev->usb_state = USB_STATE_ATTACHED; } dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* USB bus suspend/resume interrupt */ static void handle_bus_suspend(struct langwell_udc *dev) { dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); dev->resume_state = dev->usb_state; dev->usb_state = USB_STATE_SUSPENDED; /* report suspend to the driver */ if (dev->driver) { if (dev->driver->suspend) { spin_unlock(&dev->lock); dev->driver->suspend(&dev->gadget); spin_lock(&dev->lock); dev_dbg(&dev->pdev->dev, "suspend %s\n", dev->driver->driver.name); } } /* enter PHY low power suspend */ if (dev->pdev->device != 0x0829) langwell_phy_low_power(dev, 0); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } static void handle_bus_resume(struct langwell_udc *dev) { dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); dev->usb_state = dev->resume_state; dev->resume_state = 0; /* exit PHY low power suspend */ if (dev->pdev->device != 0x0829) langwell_phy_low_power(dev, 0); /* report resume to the driver */ if (dev->driver) { if (dev->driver->resume) { spin_unlock(&dev->lock); dev->driver->resume(&dev->gadget); spin_lock(&dev->lock); dev_dbg(&dev->pdev->dev, "resume %s\n", dev->driver->driver.name); } } dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* USB device controller interrupt handler */ static irqreturn_t langwell_irq(int irq, void *_dev) { struct langwell_udc *dev = _dev; u32 usbsts, usbintr, irq_sts, portsc1; dev_vdbg(&dev->pdev->dev, "---> %s()\n", __func__); if (dev->stopped) { dev_vdbg(&dev->pdev->dev, "handle IRQ_NONE\n"); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return IRQ_NONE; } spin_lock(&dev->lock); /* USB status */ usbsts = readl(&dev->op_regs->usbsts); /* USB interrupt enable */ usbintr = readl(&dev->op_regs->usbintr); irq_sts = usbsts & usbintr; dev_vdbg(&dev->pdev->dev, "usbsts = 0x%08x, usbintr = 0x%08x, irq_sts = 0x%08x\n", usbsts, usbintr, irq_sts); if (!irq_sts) { dev_vdbg(&dev->pdev->dev, "handle IRQ_NONE\n"); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); spin_unlock(&dev->lock); return IRQ_NONE; } /* Write-Clear interrupt status bits */ writel(irq_sts, &dev->op_regs->usbsts); /* resume from suspend */ portsc1 = readl(&dev->op_regs->portsc1); if (dev->usb_state == USB_STATE_SUSPENDED) if (!(portsc1 & PORTS_SUSP)) handle_bus_resume(dev); /* USB interrupt */ if (irq_sts & STS_UI) { dev_vdbg(&dev->pdev->dev, "USB interrupt\n"); /* setup packet received from ep0 */ if (readl(&dev->op_regs->endptsetupstat) & EP0SETUPSTAT_MASK) { dev_vdbg(&dev->pdev->dev, "USB SETUP packet received interrupt\n"); /* setup tripwire semaphone */ setup_tripwire(dev); handle_setup_packet(dev, &dev->local_setup_buff); } /* USB transfer completion */ if (readl(&dev->op_regs->endptcomplete)) { dev_vdbg(&dev->pdev->dev, "USB transfer completion interrupt\n"); handle_trans_complete(dev); } } /* SOF received interrupt (for ISO transfer) */ if (irq_sts & STS_SRI) { /* FIXME */ /* dev_vdbg(&dev->pdev->dev, "SOF received interrupt\n"); */ } /* port change detect interrupt */ if (irq_sts & STS_PCI) { dev_vdbg(&dev->pdev->dev, "port change detect interrupt\n"); handle_port_change(dev); } /* suspend interrupt */ if (irq_sts & STS_SLI) { dev_vdbg(&dev->pdev->dev, "suspend interrupt\n"); handle_bus_suspend(dev); } /* USB reset interrupt */ if (irq_sts & STS_URI) { dev_vdbg(&dev->pdev->dev, "USB reset interrupt\n"); handle_usb_reset(dev); } /* USB error or system error interrupt */ if (irq_sts & (STS_UEI | STS_SEI)) { /* FIXME */ dev_warn(&dev->pdev->dev, "error IRQ, irq_sts: %x\n", irq_sts); } spin_unlock(&dev->lock); dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return IRQ_HANDLED; } /*-------------------------------------------------------------------------*/ /* release device structure */ static void gadget_release(struct device *_dev) { struct langwell_udc *dev = dev_get_drvdata(_dev); dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); complete(dev->done); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); kfree(dev); } /* enable SRAM caching if SRAM detected */ static void sram_init(struct langwell_udc *dev) { struct pci_dev *pdev = dev->pdev; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); dev->sram_addr = pci_resource_start(pdev, 1); dev->sram_size = pci_resource_len(pdev, 1); dev_info(&dev->pdev->dev, "Found private SRAM at %x size:%x\n", dev->sram_addr, dev->sram_size); dev->got_sram = 1; if (pci_request_region(pdev, 1, kobject_name(&pdev->dev.kobj))) { dev_warn(&dev->pdev->dev, "SRAM request failed\n"); dev->got_sram = 0; } else if (!dma_declare_coherent_memory(&pdev->dev, dev->sram_addr, dev->sram_addr, dev->sram_size, DMA_MEMORY_MAP)) { dev_warn(&dev->pdev->dev, "SRAM DMA declare failed\n"); pci_release_region(pdev, 1); dev->got_sram = 0; } dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* release SRAM caching */ static void sram_deinit(struct langwell_udc *dev) { struct pci_dev *pdev = dev->pdev; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); dma_release_declared_memory(&pdev->dev); pci_release_region(pdev, 1); dev->got_sram = 0; dev_info(&dev->pdev->dev, "release SRAM caching\n"); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /* tear down the binding between this driver and the pci device */ static void langwell_udc_remove(struct pci_dev *pdev) { struct langwell_udc *dev = pci_get_drvdata(pdev); DECLARE_COMPLETION(done); BUG_ON(dev->driver); dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); dev->done = &done; /* free dTD dma_pool and dQH */ if (dev->dtd_pool) dma_pool_destroy(dev->dtd_pool); if (dev->ep_dqh) dma_free_coherent(&pdev->dev, dev->ep_dqh_size, dev->ep_dqh, dev->ep_dqh_dma); /* release SRAM caching */ if (dev->has_sram && dev->got_sram) sram_deinit(dev); if (dev->status_req) { kfree(dev->status_req->req.buf); kfree(dev->status_req); } kfree(dev->ep); /* disable IRQ handler */ if (dev->got_irq) free_irq(pdev->irq, dev); if (dev->cap_regs) iounmap(dev->cap_regs); if (dev->region) release_mem_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); if (dev->enabled) pci_disable_device(pdev); dev->cap_regs = NULL; dev_info(&dev->pdev->dev, "unbind\n"); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); device_unregister(&dev->gadget.dev); device_remove_file(&pdev->dev, &dev_attr_langwell_udc); device_remove_file(&pdev->dev, &dev_attr_remote_wakeup); pci_set_drvdata(pdev, NULL); /* free dev, wait for the release() finished */ wait_for_completion(&done); } /* * wrap this driver around the specified device, but * don't respond over USB until a gadget driver binds to us. */ static int langwell_udc_probe(struct pci_dev *pdev, const struct pci_device_id *id) { struct langwell_udc *dev; unsigned long resource, len; void __iomem *base = NULL; size_t size; int retval; /* alloc, and start init */ dev = kzalloc(sizeof *dev, GFP_KERNEL); if (dev == NULL) { retval = -ENOMEM; goto error; } /* initialize device spinlock */ spin_lock_init(&dev->lock); dev->pdev = pdev; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); pci_set_drvdata(pdev, dev); /* now all the pci goodies ... */ if (pci_enable_device(pdev) < 0) { retval = -ENODEV; goto error; } dev->enabled = 1; /* control register: BAR 0 */ resource = pci_resource_start(pdev, 0); len = pci_resource_len(pdev, 0); if (!request_mem_region(resource, len, driver_name)) { dev_err(&dev->pdev->dev, "controller already in use\n"); retval = -EBUSY; goto error; } dev->region = 1; base = ioremap_nocache(resource, len); if (base == NULL) { dev_err(&dev->pdev->dev, "can't map memory\n"); retval = -EFAULT; goto error; } dev->cap_regs = (struct langwell_cap_regs __iomem *) base; dev_vdbg(&dev->pdev->dev, "dev->cap_regs: %p\n", dev->cap_regs); dev->op_regs = (struct langwell_op_regs __iomem *) (base + OP_REG_OFFSET); dev_vdbg(&dev->pdev->dev, "dev->op_regs: %p\n", dev->op_regs); /* irq setup after old hardware is cleaned up */ if (!pdev->irq) { dev_err(&dev->pdev->dev, "No IRQ. Check PCI setup!\n"); retval = -ENODEV; goto error; } dev->has_sram = 1; dev->got_sram = 0; dev_vdbg(&dev->pdev->dev, "dev->has_sram: %d\n", dev->has_sram); /* enable SRAM caching if detected */ if (dev->has_sram && !dev->got_sram) sram_init(dev); dev_info(&dev->pdev->dev, "irq %d, io mem: 0x%08lx, len: 0x%08lx, pci mem 0x%p\n", pdev->irq, resource, len, base); /* enables bus-mastering for device dev */ pci_set_master(pdev); if (request_irq(pdev->irq, langwell_irq, IRQF_SHARED, driver_name, dev) != 0) { dev_err(&dev->pdev->dev, "request interrupt %d failed\n", pdev->irq); retval = -EBUSY; goto error; } dev->got_irq = 1; /* set stopped bit */ dev->stopped = 1; /* capabilities and endpoint number */ dev->lpm = (readl(&dev->cap_regs->hccparams) & HCC_LEN) ? 1 : 0; dev->dciversion = readw(&dev->cap_regs->dciversion); dev->devcap = (readl(&dev->cap_regs->dccparams) & DEVCAP) ? 1 : 0; dev_vdbg(&dev->pdev->dev, "dev->lpm: %d\n", dev->lpm); dev_vdbg(&dev->pdev->dev, "dev->dciversion: 0x%04x\n", dev->dciversion); dev_vdbg(&dev->pdev->dev, "dccparams: 0x%08x\n", readl(&dev->cap_regs->dccparams)); dev_vdbg(&dev->pdev->dev, "dev->devcap: %d\n", dev->devcap); if (!dev->devcap) { dev_err(&dev->pdev->dev, "can't support device mode\n"); retval = -ENODEV; goto error; } /* a pair of endpoints (out/in) for each address */ dev->ep_max = DEN(readl(&dev->cap_regs->dccparams)) * 2; dev_vdbg(&dev->pdev->dev, "dev->ep_max: %d\n", dev->ep_max); /* allocate endpoints memory */ dev->ep = kzalloc(sizeof(struct langwell_ep) * dev->ep_max, GFP_KERNEL); if (!dev->ep) { dev_err(&dev->pdev->dev, "allocate endpoints memory failed\n"); retval = -ENOMEM; goto error; } /* allocate device dQH memory */ size = dev->ep_max * sizeof(struct langwell_dqh); dev_vdbg(&dev->pdev->dev, "orig size = %zd\n", size); if (size < DQH_ALIGNMENT) size = DQH_ALIGNMENT; else if ((size % DQH_ALIGNMENT) != 0) { size += DQH_ALIGNMENT + 1; size &= ~(DQH_ALIGNMENT - 1); } dev->ep_dqh = dma_alloc_coherent(&pdev->dev, size, &dev->ep_dqh_dma, GFP_KERNEL); if (!dev->ep_dqh) { dev_err(&dev->pdev->dev, "allocate dQH memory failed\n"); retval = -ENOMEM; goto error; } dev->ep_dqh_size = size; dev_vdbg(&dev->pdev->dev, "ep_dqh_size = %zd\n", dev->ep_dqh_size); /* initialize ep0 status request structure */ dev->status_req = kzalloc(sizeof(struct langwell_request), GFP_KERNEL); if (!dev->status_req) { dev_err(&dev->pdev->dev, "allocate status_req memory failed\n"); retval = -ENOMEM; goto error; } INIT_LIST_HEAD(&dev->status_req->queue); /* allocate a small amount of memory to get valid address */ dev->status_req->req.buf = kmalloc(8, GFP_KERNEL); dev->status_req->req.dma = virt_to_phys(dev->status_req->req.buf); dev->resume_state = USB_STATE_NOTATTACHED; dev->usb_state = USB_STATE_POWERED; dev->ep0_dir = USB_DIR_OUT; /* remote wakeup reset to 0 when the device is reset */ dev->remote_wakeup = 0; dev->dev_status = 1 << USB_DEVICE_SELF_POWERED; /* reset device controller */ langwell_udc_reset(dev); /* initialize gadget structure */ dev->gadget.ops = &langwell_ops; /* usb_gadget_ops */ dev->gadget.ep0 = &dev->ep[0].ep; /* gadget ep0 */ INIT_LIST_HEAD(&dev->gadget.ep_list); /* ep_list */ dev->gadget.speed = USB_SPEED_UNKNOWN; /* speed */ dev->gadget.max_speed = USB_SPEED_HIGH; /* support dual speed */ /* the "gadget" abstracts/virtualizes the controller */ dev_set_name(&dev->gadget.dev, "gadget"); dev->gadget.dev.parent = &pdev->dev; dev->gadget.dev.dma_mask = pdev->dev.dma_mask; dev->gadget.dev.release = gadget_release; dev->gadget.name = driver_name; /* gadget name */ /* controller endpoints reinit */ eps_reinit(dev); /* reset ep0 dQH and endptctrl */ ep0_reset(dev); /* create dTD dma_pool resource */ dev->dtd_pool = dma_pool_create("langwell_dtd", &dev->pdev->dev, sizeof(struct langwell_dtd), DTD_ALIGNMENT, DMA_BOUNDARY); if (!dev->dtd_pool) { retval = -ENOMEM; goto error; } /* done */ dev_info(&dev->pdev->dev, "%s\n", driver_desc); dev_info(&dev->pdev->dev, "irq %d, pci mem %p\n", pdev->irq, base); dev_info(&dev->pdev->dev, "Driver version: " DRIVER_VERSION "\n"); dev_info(&dev->pdev->dev, "Support (max) %d endpoints\n", dev->ep_max); dev_info(&dev->pdev->dev, "Device interface version: 0x%04x\n", dev->dciversion); dev_info(&dev->pdev->dev, "Controller mode: %s\n", dev->devcap ? "Device" : "Host"); dev_info(&dev->pdev->dev, "Support USB LPM: %s\n", dev->lpm ? "Yes" : "No"); dev_vdbg(&dev->pdev->dev, "After langwell_udc_probe(), print all registers:\n"); print_all_registers(dev); retval = device_register(&dev->gadget.dev); if (retval) goto error; retval = usb_add_gadget_udc(&pdev->dev, &dev->gadget); if (retval) goto error; retval = device_create_file(&pdev->dev, &dev_attr_langwell_udc); if (retval) goto error; retval = device_create_file(&pdev->dev, &dev_attr_remote_wakeup); if (retval) goto error_attr1; dev_vdbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; error_attr1: device_remove_file(&pdev->dev, &dev_attr_langwell_udc); error: if (dev) { dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); langwell_udc_remove(pdev); } return retval; } /* device controller suspend */ static int langwell_udc_suspend(struct pci_dev *pdev, pm_message_t state) { struct langwell_udc *dev = pci_get_drvdata(pdev); dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); usb_del_gadget_udc(&dev->gadget); /* disable interrupt and set controller to stop state */ langwell_udc_stop(dev); /* disable IRQ handler */ if (dev->got_irq) free_irq(pdev->irq, dev); dev->got_irq = 0; /* save PCI state */ pci_save_state(pdev); spin_lock_irq(&dev->lock); /* stop all usb activities */ stop_activity(dev); spin_unlock_irq(&dev->lock); /* free dTD dma_pool and dQH */ if (dev->dtd_pool) dma_pool_destroy(dev->dtd_pool); if (dev->ep_dqh) dma_free_coherent(&pdev->dev, dev->ep_dqh_size, dev->ep_dqh, dev->ep_dqh_dma); /* release SRAM caching */ if (dev->has_sram && dev->got_sram) sram_deinit(dev); /* set device power state */ pci_set_power_state(pdev, PCI_D3hot); /* enter PHY low power suspend */ if (dev->pdev->device != 0x0829) langwell_phy_low_power(dev, 1); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* device controller resume */ static int langwell_udc_resume(struct pci_dev *pdev) { struct langwell_udc *dev = pci_get_drvdata(pdev); size_t size; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); /* exit PHY low power suspend */ if (dev->pdev->device != 0x0829) langwell_phy_low_power(dev, 0); /* set device D0 power state */ pci_set_power_state(pdev, PCI_D0); /* enable SRAM caching if detected */ if (dev->has_sram && !dev->got_sram) sram_init(dev); /* allocate device dQH memory */ size = dev->ep_max * sizeof(struct langwell_dqh); dev_vdbg(&dev->pdev->dev, "orig size = %zd\n", size); if (size < DQH_ALIGNMENT) size = DQH_ALIGNMENT; else if ((size % DQH_ALIGNMENT) != 0) { size += DQH_ALIGNMENT + 1; size &= ~(DQH_ALIGNMENT - 1); } dev->ep_dqh = dma_alloc_coherent(&pdev->dev, size, &dev->ep_dqh_dma, GFP_KERNEL); if (!dev->ep_dqh) { dev_err(&dev->pdev->dev, "allocate dQH memory failed\n"); return -ENOMEM; } dev->ep_dqh_size = size; dev_vdbg(&dev->pdev->dev, "ep_dqh_size = %zd\n", dev->ep_dqh_size); /* create dTD dma_pool resource */ dev->dtd_pool = dma_pool_create("langwell_dtd", &dev->pdev->dev, sizeof(struct langwell_dtd), DTD_ALIGNMENT, DMA_BOUNDARY); if (!dev->dtd_pool) return -ENOMEM; /* restore PCI state */ pci_restore_state(pdev); /* enable IRQ handler */ if (request_irq(pdev->irq, langwell_irq, IRQF_SHARED, driver_name, dev) != 0) { dev_err(&dev->pdev->dev, "request interrupt %d failed\n", pdev->irq); return -EBUSY; } dev->got_irq = 1; /* reset and start controller to run state */ if (dev->stopped) { /* reset device controller */ langwell_udc_reset(dev); /* reset ep0 dQH and endptctrl */ ep0_reset(dev); /* start device if gadget is loaded */ if (dev->driver) langwell_udc_start(dev); } /* reset USB status */ dev->usb_state = USB_STATE_ATTACHED; dev->ep0_state = WAIT_FOR_SETUP; dev->ep0_dir = USB_DIR_OUT; dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); return 0; } /* pci driver shutdown */ static void langwell_udc_shutdown(struct pci_dev *pdev) { struct langwell_udc *dev = pci_get_drvdata(pdev); u32 usbmode; dev_dbg(&dev->pdev->dev, "---> %s()\n", __func__); /* reset controller mode to IDLE */ usbmode = readl(&dev->op_regs->usbmode); dev_dbg(&dev->pdev->dev, "usbmode = 0x%08x\n", usbmode); usbmode &= (~3 | MODE_IDLE); writel(usbmode, &dev->op_regs->usbmode); dev_dbg(&dev->pdev->dev, "<--- %s()\n", __func__); } /*-------------------------------------------------------------------------*/ static const struct pci_device_id pci_ids[] = { { .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe), .class_mask = ~0, .vendor = 0x8086, .device = 0x0811, .subvendor = PCI_ANY_ID, .subdevice = PCI_ANY_ID, }, { /* end: all zeroes */ } }; MODULE_DEVICE_TABLE(pci, pci_ids); static struct pci_driver langwell_pci_driver = { .name = (char *) driver_name, .id_table = pci_ids, .probe = langwell_udc_probe, .remove = langwell_udc_remove, /* device controller suspend/resume */ .suspend = langwell_udc_suspend, .resume = langwell_udc_resume, .shutdown = langwell_udc_shutdown, }; module_pci_driver(langwell_pci_driver); MODULE_DESCRIPTION(DRIVER_DESC); MODULE_AUTHOR("Xiaochen Shen "); MODULE_VERSION(DRIVER_VERSION); MODULE_LICENSE("GPL");