mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-12 14:23:00 +00:00
83d290c56f
When U-Boot started using SPDX tags we were among the early adopters and there weren't a lot of other examples to borrow from. So we picked the area of the file that usually had a full license text and replaced it with an appropriate SPDX-License-Identifier: entry. Since then, the Linux Kernel has adopted SPDX tags and they place it as the very first line in a file (except where shebangs are used, then it's second line) and with slightly different comment styles than us. In part due to community overlap, in part due to better tag visibility and in part for other minor reasons, switch over to that style. This commit changes all instances where we have a single declared license in the tag as both the before and after are identical in tag contents. There's also a few places where I found we did not have a tag and have introduced one. Signed-off-by: Tom Rini <trini@konsulko.com>
961 lines
22 KiB
C
961 lines
22 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Faraday USB 2.0 OTG Controller
|
|
*
|
|
* (C) Copyright 2010 Faraday Technology
|
|
* Dante Su <dantesu@faraday-tech.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <config.h>
|
|
#include <net.h>
|
|
#include <malloc.h>
|
|
#include <asm/io.h>
|
|
#include <linux/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);
|
|
udelay(1);
|
|
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(int index)
|
|
{
|
|
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);
|
|
/*
|
|
* Write 1 and then 0 works for both W1C & RW.
|
|
*
|
|
* HW v1.11.0+: It's a W1C register (write 1 clear)
|
|
* HW v1.10.0-: It's a R/W register (write 0 clear)
|
|
*/
|
|
writel(st & GISR0_CXABORT, ®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);
|
|
/*
|
|
* Write 1 and then 0 works for both W1C & RW.
|
|
*
|
|
* HW v1.11.0+: It's a W1C register (write 1 clear)
|
|
* HW v1.10.0-: It's a R/W register (write 0 clear)
|
|
*/
|
|
writel(st, ®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;
|
|
}
|