2009-04-05 09:43:28 +00:00
|
|
|
/*
|
|
|
|
* PXA27x USB device driver for u-boot.
|
|
|
|
*
|
|
|
|
* Copyright (C) 2007 Rodolfo Giometti <giometti@linux.it>
|
|
|
|
* Copyright (C) 2007 Eurotech S.p.A. <info@eurotech.it>
|
|
|
|
* Copyright (C) 2008 Vivek Kutal <vivek.kutal@azingo.com>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public License as
|
|
|
|
* published by the Free Software Foundation; either version 2 of
|
|
|
|
* the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
|
|
* MA 02111-1307 USA
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
#include <common.h>
|
|
|
|
#include <config.h>
|
|
|
|
#include <asm/byteorder.h>
|
2011-10-17 15:22:48 +00:00
|
|
|
#include <usbdevice.h>
|
2009-04-05 09:43:28 +00:00
|
|
|
#include <asm/arch/hardware.h>
|
2011-10-17 15:22:48 +00:00
|
|
|
#include <asm/io.h>
|
2009-04-05 09:43:28 +00:00
|
|
|
#include <usb/pxa27x_udc.h>
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
#include "ep0.h"
|
|
|
|
|
2009-04-05 09:43:28 +00:00
|
|
|
/* number of endpoints on this UDC */
|
|
|
|
#define UDC_MAX_ENDPOINTS 24
|
|
|
|
|
|
|
|
static struct urb *ep0_urb;
|
|
|
|
static struct usb_device_instance *udc_device;
|
|
|
|
static int ep0state = EP0_IDLE;
|
|
|
|
|
|
|
|
#ifdef USBDDBG
|
|
|
|
static void udc_dump_buffer(char *name, u8 *buf, int len)
|
|
|
|
{
|
|
|
|
usbdbg("%s - buf %p, len %d", name, buf, len);
|
|
|
|
print_buffer(0, buf, 1, len, 0);
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
#define udc_dump_buffer(name, buf, len) /* void */
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static inline void udc_ack_int_UDCCR(int mask)
|
|
|
|
{
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(readl(USIR1) | mask, USIR1);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* If the endpoint has an active tx_urb, then the next packet of data from the
|
|
|
|
* URB is written to the tx FIFO.
|
|
|
|
* The total amount of data in the urb is given by urb->actual_length.
|
|
|
|
* The maximum amount of data that can be sent in any one packet is given by
|
|
|
|
* endpoint->tx_packetSize.
|
|
|
|
* The number of data bytes from this URB that have already been transmitted
|
|
|
|
* is given by endpoint->sent.
|
|
|
|
* endpoint->last is updated by this routine with the number of data bytes
|
|
|
|
* transmitted in this packet.
|
|
|
|
*/
|
|
|
|
static int udc_write_urb(struct usb_endpoint_instance *endpoint)
|
|
|
|
{
|
|
|
|
struct urb *urb = endpoint->tx_urb;
|
|
|
|
int ep_num = endpoint->endpoint_address & USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
u32 *data32 = (u32 *) urb->buffer;
|
|
|
|
u8 *data8 = (u8 *) urb->buffer;
|
|
|
|
unsigned int i, n, w, b, is_short;
|
|
|
|
int timeout = 2000; /* 2ms */
|
|
|
|
|
|
|
|
if (!urb || !urb->actual_length)
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
n = MIN(urb->actual_length - endpoint->sent, endpoint->tx_packetSize);
|
|
|
|
if (n <= 0)
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
usbdbg("write urb on ep %d", ep_num);
|
|
|
|
#if defined(USBDDBG) && defined(USBDPARANOIA)
|
|
|
|
usbdbg("urb: buf %p, buf_len %d, actual_len %d",
|
|
|
|
urb->buffer, urb->buffer_length, urb->actual_length);
|
|
|
|
usbdbg("endpoint: sent %d, tx_packetSize %d, last %d",
|
|
|
|
endpoint->sent, endpoint->tx_packetSize, endpoint->last);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
is_short = n != endpoint->tx_packetSize;
|
|
|
|
w = n / 4;
|
|
|
|
b = n % 4;
|
|
|
|
usbdbg("n %d%s w %d b %d", n, is_short ? "-s" : "", w, b);
|
|
|
|
udc_dump_buffer("urb write", data8 + endpoint->sent, n);
|
|
|
|
|
|
|
|
/* Prepare for data send */
|
|
|
|
if (ep_num)
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR_PC ,UDCCSN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
for (i = 0; i < w; i++)
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(data32[endpoint->sent / 4 + i], UDCDN(ep_num));
|
|
|
|
|
2009-04-05 09:43:28 +00:00
|
|
|
for (i = 0; i < b; i++)
|
2011-10-17 15:22:48 +00:00
|
|
|
writeb(data8[endpoint->sent + w * 4 + i], UDCDN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
/* Set "Packet Complete" if less data then tx_packetSize */
|
|
|
|
if (is_short)
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(ep_num ? UDCCSR_SP : UDCCSR0_IPR, UDCCSN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
/* Wait for data sent */
|
2011-10-17 15:22:48 +00:00
|
|
|
if (ep_num) {
|
|
|
|
while (!(readl(UDCCSN(ep_num)) & UDCCSR_PC)) {
|
2009-04-05 09:43:28 +00:00
|
|
|
if (timeout-- == 0)
|
|
|
|
return -1;
|
|
|
|
else
|
|
|
|
udelay(1);
|
2011-10-17 15:22:48 +00:00
|
|
|
}
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
2011-10-17 15:22:48 +00:00
|
|
|
|
2009-04-05 09:43:28 +00:00
|
|
|
endpoint->last = n;
|
|
|
|
|
|
|
|
if (ep_num) {
|
|
|
|
usbd_tx_complete(endpoint);
|
|
|
|
} else {
|
|
|
|
endpoint->sent += n;
|
|
|
|
endpoint->last -= n;
|
|
|
|
}
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
if (endpoint->sent >= urb->actual_length) {
|
2009-04-05 09:43:28 +00:00
|
|
|
urb->actual_length = 0;
|
|
|
|
endpoint->sent = 0;
|
|
|
|
endpoint->last = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((endpoint->sent >= urb->actual_length) && (!ep_num)) {
|
|
|
|
usbdbg("ep0 IN stage done");
|
|
|
|
if (is_short)
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
else
|
|
|
|
ep0state = EP0_XFER_COMPLETE;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int udc_read_urb(struct usb_endpoint_instance *endpoint)
|
|
|
|
{
|
|
|
|
struct urb *urb = endpoint->rcv_urb;
|
|
|
|
int ep_num = endpoint->endpoint_address & USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
u32 *data32 = (u32 *) urb->buffer;
|
|
|
|
unsigned int i, n, is_short ;
|
|
|
|
|
|
|
|
usbdbg("read urb on ep %d", ep_num);
|
|
|
|
#if defined(USBDDBG) && defined(USBDPARANOIA)
|
|
|
|
usbdbg("urb: buf %p, buf_len %d, actual_len %d",
|
|
|
|
urb->buffer, urb->buffer_length, urb->actual_length);
|
|
|
|
usbdbg("endpoint: rcv_packetSize %d",
|
|
|
|
endpoint->rcv_packetSize);
|
|
|
|
#endif
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(UDCCSN(ep_num)) & UDCCSR_BNE)
|
|
|
|
n = readl(UDCBCN(ep_num)) & 0x3ff;
|
2009-04-05 09:43:28 +00:00
|
|
|
else /* zlp */
|
|
|
|
n = 0;
|
|
|
|
is_short = n != endpoint->rcv_packetSize;
|
|
|
|
|
|
|
|
usbdbg("n %d%s", n, is_short ? "-s" : "");
|
|
|
|
for (i = 0; i < n; i += 4)
|
2011-10-17 15:22:48 +00:00
|
|
|
data32[urb->actual_length / 4 + i / 4] = readl(UDCDN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
udc_dump_buffer("urb read", (u8 *) data32, urb->actual_length + n);
|
|
|
|
usbd_rcv_complete(endpoint, n, 0);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int udc_read_urb_ep0(void)
|
|
|
|
{
|
|
|
|
u32 *data32 = (u32 *) ep0_urb->buffer;
|
|
|
|
u8 *data8 = (u8 *) ep0_urb->buffer;
|
|
|
|
unsigned int i, n, w, b;
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
usbdbg("read urb on ep 0");
|
|
|
|
#if defined(USBDDBG) && defined(USBDPARANOIA)
|
|
|
|
usbdbg("urb: buf %p, buf_len %d, actual_len %d",
|
|
|
|
ep0_urb->buffer, ep0_urb->buffer_length, ep0_urb->actual_length);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
n = readl(UDCBCR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
w = n / 4;
|
|
|
|
b = n % 4;
|
|
|
|
|
|
|
|
for (i = 0; i < w; i++) {
|
2011-10-17 15:22:48 +00:00
|
|
|
data32[ep0_urb->actual_length / 4 + i] = readl(UDCDN(0));
|
2011-12-19 10:52:36 +00:00
|
|
|
/* ep0_urb->actual_length += 4; */
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < b; i++) {
|
2011-10-17 15:22:48 +00:00
|
|
|
data8[ep0_urb->actual_length + w * 4 + i] = readb(UDCDN(0));
|
2011-12-19 10:52:36 +00:00
|
|
|
/* ep0_urb->actual_length++; */
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
ep0_urb->actual_length += n;
|
|
|
|
|
|
|
|
udc_dump_buffer("urb read", (u8 *) data32, ep0_urb->actual_length);
|
|
|
|
|
|
|
|
writel(UDCCSR0_OPC | UDCCSR0_IPR, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
if (ep0_urb->actual_length == ep0_urb->device_request.wLength)
|
|
|
|
return 1;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void udc_handle_ep0(struct usb_endpoint_instance *endpoint)
|
|
|
|
{
|
2011-10-17 15:22:48 +00:00
|
|
|
u32 udccsr0 = readl(UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
u32 *data = (u32 *) &ep0_urb->device_request;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
usbdbg("udccsr0 %x", udccsr0);
|
|
|
|
|
|
|
|
/* Clear stall status */
|
|
|
|
if (udccsr0 & UDCCSR0_SST) {
|
|
|
|
usberr("clear stall status");
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR0_SST, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* previous request unfinished? non-error iff back-to-back ... */
|
|
|
|
if ((udccsr0 & UDCCSR0_SA) != 0 && ep0state != EP0_IDLE)
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
|
|
|
|
switch (ep0state) {
|
|
|
|
|
|
|
|
case EP0_IDLE:
|
2011-10-17 15:22:48 +00:00
|
|
|
udccsr0 = readl(UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
/* Start control request? */
|
|
|
|
if ((udccsr0 & (UDCCSR0_OPC | UDCCSR0_SA | UDCCSR0_RNE))
|
|
|
|
== (UDCCSR0_OPC | UDCCSR0_SA | UDCCSR0_RNE)) {
|
|
|
|
|
|
|
|
/* Read SETUP packet.
|
|
|
|
* SETUP packet size is 8 bytes (aka 2 words)
|
|
|
|
*/
|
|
|
|
usbdbg("try reading SETUP packet");
|
|
|
|
for (i = 0; i < 2; i++) {
|
2011-10-17 15:22:48 +00:00
|
|
|
if ((readl(UDCCSR0) & UDCCSR0_RNE) == 0) {
|
2009-04-05 09:43:28 +00:00
|
|
|
usberr("setup packet too short:%d", i);
|
|
|
|
goto stall;
|
|
|
|
}
|
2011-10-17 15:22:48 +00:00
|
|
|
data[i] = readl(UDCDR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(readl(UDCCSR0) | UDCCSR0_OPC | UDCCSR0_SA, UDCCSR0);
|
|
|
|
if ((readl(UDCCSR0) & UDCCSR0_RNE) != 0) {
|
2009-04-05 09:43:28 +00:00
|
|
|
usberr("setup packet too long");
|
|
|
|
goto stall;
|
|
|
|
}
|
|
|
|
|
|
|
|
udc_dump_buffer("ep0 setup read", (u8 *) data, 8);
|
|
|
|
|
|
|
|
if (ep0_urb->device_request.wLength == 0) {
|
|
|
|
usbdbg("Zero Data control Packet\n");
|
|
|
|
if (ep0_recv_setup(ep0_urb)) {
|
|
|
|
usberr("Invalid Setup Packet\n");
|
|
|
|
udc_dump_buffer("ep0 setup read",
|
|
|
|
(u8 *)data, 8);
|
|
|
|
goto stall;
|
|
|
|
}
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR0_IPR, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
} else {
|
|
|
|
/* Check direction */
|
|
|
|
if ((ep0_urb->device_request.bmRequestType &
|
|
|
|
USB_REQ_DIRECTION_MASK)
|
|
|
|
== USB_REQ_HOST2DEVICE) {
|
|
|
|
ep0state = EP0_OUT_DATA;
|
|
|
|
ep0_urb->buffer =
|
|
|
|
(u8 *)ep0_urb->buffer_data;
|
|
|
|
ep0_urb->buffer_length =
|
|
|
|
sizeof(ep0_urb->buffer_data);
|
|
|
|
ep0_urb->actual_length = 0;
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR0_IPR, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
} else {
|
|
|
|
/* The ep0_recv_setup function has
|
|
|
|
* already placed our response packet
|
|
|
|
* data in ep0_urb->buffer and the
|
|
|
|
* packet length in
|
|
|
|
* ep0_urb->actual_length.
|
|
|
|
*/
|
|
|
|
if (ep0_recv_setup(ep0_urb)) {
|
|
|
|
stall:
|
|
|
|
usberr("Invalid setup packet");
|
|
|
|
udc_dump_buffer("ep0 setup read"
|
|
|
|
, (u8 *) data, 8);
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR0_SA |
|
2009-04-05 09:43:28 +00:00
|
|
|
UDCCSR0_OPC | UDCCSR0_FST |
|
2011-10-17 15:22:48 +00:00
|
|
|
UDCCS0_FTF, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
endpoint->tx_urb = ep0_urb;
|
|
|
|
endpoint->sent = 0;
|
|
|
|
usbdbg("EP0_IN_DATA");
|
|
|
|
ep0state = EP0_IN_DATA;
|
|
|
|
if (udc_write_urb(endpoint) < 0)
|
|
|
|
goto stall;
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return;
|
|
|
|
} else if ((udccsr0 & (UDCCSR0_OPC | UDCCSR0_SA))
|
|
|
|
== (UDCCSR0_OPC|UDCCSR0_SA)) {
|
|
|
|
usberr("Setup Active but no data. Stalling ....\n");
|
|
|
|
goto stall;
|
|
|
|
} else {
|
|
|
|
usbdbg("random early IRQs");
|
|
|
|
/* Some random early IRQs:
|
|
|
|
* - we acked FST
|
|
|
|
* - IPR cleared
|
|
|
|
* - OPC got set, without SA (likely status stage)
|
|
|
|
*/
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(udccsr0 & (UDCCSR0_SA | UDCCSR0_OPC), UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case EP0_OUT_DATA:
|
|
|
|
|
|
|
|
if ((udccsr0 & UDCCSR0_OPC) && !(udccsr0 & UDCCSR0_SA)) {
|
|
|
|
if (udc_read_urb_ep0()) {
|
|
|
|
read_complete:
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
if (ep0_recv_setup(ep0_urb)) {
|
|
|
|
/* Not a setup packet, stall next
|
|
|
|
* EP0 transaction
|
|
|
|
*/
|
|
|
|
udc_dump_buffer("ep0 setup read",
|
|
|
|
(u8 *) data, 8);
|
|
|
|
usberr("can't parse setup packet\n");
|
|
|
|
goto stall;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else if (!(udccsr0 & UDCCSR0_OPC) &&
|
|
|
|
!(udccsr0 & UDCCSR0_IPR)) {
|
|
|
|
if (ep0_urb->device_request.wLength ==
|
|
|
|
ep0_urb->actual_length)
|
|
|
|
goto read_complete;
|
|
|
|
|
|
|
|
usberr("Premature Status\n");
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case EP0_IN_DATA:
|
|
|
|
/* GET_DESCRIPTOR etc */
|
|
|
|
if (udccsr0 & UDCCSR0_OPC) {
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR0_OPC | UDCCSR0_FTF, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
usberr("ep0in premature status");
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
} else {
|
|
|
|
/* irq was IPR clearing */
|
|
|
|
if (udc_write_urb(endpoint) < 0) {
|
|
|
|
usberr("ep0_write_error\n");
|
|
|
|
goto stall;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case EP0_XFER_COMPLETE:
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR0_IPR, UDCCSR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
usbdbg("Default\n");
|
|
|
|
}
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(USIR0_IR0, USIR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static void udc_handle_ep(struct usb_endpoint_instance *endpoint)
|
|
|
|
{
|
|
|
|
int ep_addr = endpoint->endpoint_address;
|
|
|
|
int ep_num = ep_addr & USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
int ep_isout = (ep_addr & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT;
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
u32 flags = readl(UDCCSN(ep_num)) & (UDCCSR_SST | UDCCSR_TRN);
|
2009-04-05 09:43:28 +00:00
|
|
|
if (flags)
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(flags, UDCCSN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
if (ep_isout)
|
|
|
|
udc_read_urb(endpoint);
|
|
|
|
else
|
|
|
|
udc_write_urb(endpoint);
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCCSR_PC, UDCCSN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static void udc_state_changed(void)
|
|
|
|
{
|
|
|
|
int config, interface, alternate;
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(readl(UDCCR) | UDCCR_SMAC, UDCCR);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
config = (readl(UDCCR) & UDCCR_ACN) >> UDCCR_ACN_S;
|
|
|
|
interface = (readl(UDCCR) & UDCCR_AIN) >> UDCCR_AIN_S;
|
|
|
|
alternate = (readl(UDCCR) & UDCCR_AAISN) >> UDCCR_AAISN_S;
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
usbdbg("New UDC settings are: conf %d - inter %d - alter %d",
|
|
|
|
config, interface, alternate);
|
|
|
|
|
|
|
|
usbd_device_event_irq(udc_device, DEVICE_CONFIGURED, 0);
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCISR1_IRCC, UDCISR1);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void udc_irq(void)
|
|
|
|
{
|
|
|
|
int handled;
|
|
|
|
struct usb_endpoint_instance *endpoint;
|
|
|
|
int ep_num, i;
|
|
|
|
u32 udcisr0;
|
|
|
|
|
|
|
|
do {
|
|
|
|
handled = 0;
|
|
|
|
/* Suspend Interrupt Request */
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR1) & UDCCR_SUSIR) {
|
2009-04-05 09:43:28 +00:00
|
|
|
usbdbg("Suspend\n");
|
|
|
|
udc_ack_int_UDCCR(UDCCR_SUSIR);
|
|
|
|
handled = 1;
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Resume Interrupt Request */
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR1) & UDCCR_RESIR) {
|
2009-04-05 09:43:28 +00:00
|
|
|
udc_ack_int_UDCCR(UDCCR_RESIR);
|
|
|
|
handled = 1;
|
|
|
|
usbdbg("USB resume\n");
|
|
|
|
}
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR1) & (1<<31)) {
|
2009-04-05 09:43:28 +00:00
|
|
|
handled = 1;
|
|
|
|
udc_state_changed();
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Reset Interrupt Request */
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR1) & UDCCR_RSTIR) {
|
2009-04-05 09:43:28 +00:00
|
|
|
udc_ack_int_UDCCR(UDCCR_RSTIR);
|
|
|
|
handled = 1;
|
|
|
|
usbdbg("Reset\n");
|
|
|
|
usbd_device_event_irq(udc_device, DEVICE_RESET, 0);
|
|
|
|
} else {
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR0))
|
|
|
|
usbdbg("UISR0: %x \n", readl(USIR0));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR0) & 0x2)
|
|
|
|
writel(0x2, USIR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
/* Control traffic */
|
2011-10-17 15:22:48 +00:00
|
|
|
if (readl(USIR0) & USIR0_IR0) {
|
2009-04-05 09:43:28 +00:00
|
|
|
handled = 1;
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(USIR0_IR0, USIR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
udc_handle_ep0(udc_device->bus->endpoint_array);
|
|
|
|
}
|
|
|
|
|
|
|
|
endpoint = udc_device->bus->endpoint_array;
|
|
|
|
for (i = 0; i < udc_device->bus->max_endpoints; i++) {
|
|
|
|
ep_num = (endpoint[i].endpoint_address) &
|
|
|
|
USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
if (!ep_num)
|
|
|
|
continue;
|
2011-10-17 15:22:48 +00:00
|
|
|
udcisr0 = readl(UDCISR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
if (udcisr0 &
|
|
|
|
UDCISR_INT(ep_num, UDC_INT_PACKETCMP)) {
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(UDCISR_INT(ep_num, UDC_INT_PACKETCMP),
|
|
|
|
UDCISR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
udc_handle_ep(&endpoint[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
} while (handled);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* The UDCCR reg contains mask and interrupt status bits,
|
|
|
|
* so using '|=' isn't safe as it may ack an interrupt.
|
|
|
|
*/
|
|
|
|
#define UDCCR_OEN (1 << 31) /* On-the-Go Enable */
|
|
|
|
#define UDCCR_MASK_BITS (UDCCR_OEN | UDCCR_UDE)
|
|
|
|
|
|
|
|
static inline void udc_set_mask_UDCCR(int mask)
|
|
|
|
{
|
2011-10-17 15:22:48 +00:00
|
|
|
writel((readl(UDCCR) & UDCCR_MASK_BITS) | (mask & UDCCR_MASK_BITS), UDCCR);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static inline void udc_clear_mask_UDCCR(int mask)
|
|
|
|
{
|
2011-10-17 15:22:48 +00:00
|
|
|
writel((readl(UDCCR) & UDCCR_MASK_BITS) & ~(mask & UDCCR_MASK_BITS), UDCCR);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static void pio_irq_enable(int ep_num)
|
|
|
|
{
|
|
|
|
if (ep_num < 16)
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(readl(UDCICR0) | 3 << (ep_num * 2), UDCICR0);
|
2009-04-05 09:43:28 +00:00
|
|
|
else {
|
|
|
|
ep_num -= 16;
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(readl(UDCICR1) | 3 << (ep_num * 2), UDCICR1);
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* udc_set_nak
|
|
|
|
*
|
|
|
|
* Allow upper layers to signal lower layers should not accept more RX data
|
|
|
|
*/
|
|
|
|
void udc_set_nak(int ep_num)
|
|
|
|
{
|
|
|
|
/* TODO */
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* udc_unset_nak
|
|
|
|
*
|
|
|
|
* Suspend sending of NAK tokens for DATA OUT tokens on a given endpoint.
|
|
|
|
* Switch off NAKing on this endpoint to accept more data output from host.
|
|
|
|
*/
|
|
|
|
void udc_unset_nak(int ep_num)
|
|
|
|
{
|
|
|
|
/* TODO */
|
|
|
|
}
|
|
|
|
|
|
|
|
int udc_endpoint_write(struct usb_endpoint_instance *endpoint)
|
|
|
|
{
|
|
|
|
return udc_write_urb(endpoint);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Associate a physical endpoint with endpoint instance */
|
|
|
|
void udc_setup_ep(struct usb_device_instance *device, unsigned int id,
|
|
|
|
struct usb_endpoint_instance *endpoint)
|
|
|
|
{
|
|
|
|
int ep_num, ep_addr, ep_isout, ep_type, ep_size;
|
|
|
|
int config, interface, alternate;
|
|
|
|
u32 tmp;
|
|
|
|
|
|
|
|
usbdbg("setting up endpoint id %d", id);
|
|
|
|
|
|
|
|
if (!endpoint) {
|
|
|
|
usberr("endpoint void!");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
ep_num = endpoint->endpoint_address & USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
if (ep_num >= UDC_MAX_ENDPOINTS) {
|
|
|
|
usberr("unable to setup ep %d!", ep_num);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
pio_irq_enable(ep_num);
|
|
|
|
if (ep_num == 0) {
|
|
|
|
/* Done for ep0 */
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
config = 1;
|
|
|
|
interface = 0;
|
|
|
|
alternate = 0;
|
|
|
|
|
|
|
|
usbdbg("config %d - interface %d - alternate %d",
|
|
|
|
config, interface, alternate);
|
|
|
|
|
|
|
|
ep_addr = endpoint->endpoint_address;
|
|
|
|
ep_num = ep_addr & USB_ENDPOINT_NUMBER_MASK;
|
|
|
|
ep_isout = (ep_addr & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT;
|
|
|
|
ep_type = ep_isout ? endpoint->rcv_attributes : endpoint->tx_attributes;
|
|
|
|
ep_size = ep_isout ? endpoint->rcv_packetSize : endpoint->tx_packetSize;
|
|
|
|
|
|
|
|
usbdbg("addr %x, num %d, dir %s, type %s, packet size %d",
|
|
|
|
ep_addr, ep_num,
|
|
|
|
ep_isout ? "out" : "in",
|
|
|
|
ep_type == USB_ENDPOINT_XFER_ISOC ? "isoc" :
|
|
|
|
ep_type == USB_ENDPOINT_XFER_BULK ? "bulk" :
|
|
|
|
ep_type == USB_ENDPOINT_XFER_INT ? "int" : "???",
|
|
|
|
ep_size
|
|
|
|
);
|
|
|
|
|
|
|
|
/* Configure UDCCRx */
|
|
|
|
tmp = 0;
|
|
|
|
tmp |= (config << UDCCONR_CN_S) & UDCCONR_CN;
|
|
|
|
tmp |= (interface << UDCCONR_IN_S) & UDCCONR_IN;
|
|
|
|
tmp |= (alternate << UDCCONR_AISN_S) & UDCCONR_AISN;
|
|
|
|
tmp |= (ep_num << UDCCONR_EN_S) & UDCCONR_EN;
|
|
|
|
tmp |= (ep_type << UDCCONR_ET_S) & UDCCONR_ET;
|
|
|
|
tmp |= ep_isout ? 0 : UDCCONR_ED;
|
|
|
|
tmp |= (ep_size << UDCCONR_MPS_S) & UDCCONR_MPS;
|
|
|
|
tmp |= UDCCONR_EE;
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(tmp, UDCCN(ep_num));
|
2009-04-05 09:43:28 +00:00
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
usbdbg("UDCCR%c = %x", 'A' + ep_num-1, readl(UDCCN(ep_num)));
|
|
|
|
usbdbg("UDCCSR%c = %x", 'A' + ep_num-1, readl(UDCCSN(ep_num)));
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Connect the USB device to the bus */
|
|
|
|
void udc_connect(void)
|
|
|
|
{
|
|
|
|
usbdbg("UDC connect");
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
#ifdef CONFIG_USB_DEV_PULLUP_GPIO
|
2009-04-05 09:43:28 +00:00
|
|
|
/* Turn on the USB connection by enabling the pullup resistor */
|
2013-04-12 18:59:15 +00:00
|
|
|
writel(readl(GPDR(CONFIG_USB_DEV_PULLUP_GPIO))
|
|
|
|
| GPIO_bit(CONFIG_USB_DEV_PULLUP_GPIO),
|
|
|
|
GPDR(CONFIG_USB_DEV_PULLUP_GPIO));
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(GPIO_bit(CONFIG_USB_DEV_PULLUP_GPIO), GPSR(CONFIG_USB_DEV_PULLUP_GPIO));
|
|
|
|
#else
|
|
|
|
/* Host port 2 transceiver D+ pull up enable */
|
|
|
|
writel(readl(UP2OCR) | UP2OCR_DPPUE, UP2OCR);
|
|
|
|
#endif
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Disconnect the USB device to the bus */
|
|
|
|
void udc_disconnect(void)
|
|
|
|
{
|
|
|
|
usbdbg("UDC disconnect");
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
#ifdef CONFIG_USB_DEV_PULLUP_GPIO
|
2009-04-05 09:43:28 +00:00
|
|
|
/* Turn off the USB connection by disabling the pullup resistor */
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(GPIO_bit(CONFIG_USB_DEV_PULLUP_GPIO), GPCR(CONFIG_USB_DEV_PULLUP_GPIO));
|
|
|
|
#else
|
|
|
|
/* Host port 2 transceiver D+ pull up disable */
|
|
|
|
writel(readl(UP2OCR) & ~UP2OCR_DPPUE, UP2OCR);
|
|
|
|
#endif
|
2009-04-05 09:43:28 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Switch on the UDC */
|
|
|
|
void udc_enable(struct usb_device_instance *device)
|
|
|
|
{
|
|
|
|
|
|
|
|
ep0state = EP0_IDLE;
|
|
|
|
|
|
|
|
/* enable endpoint 0, A, B's Packet Complete Interrupt. */
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(0xffffffff, UDCICR0);
|
|
|
|
writel(0xa8000000, UDCICR1);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
/* clear the interrupt status/control registers */
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(0xffffffff, UDCISR0);
|
|
|
|
writel(0xffffffff, UDCISR1);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
/* set UDC-enable */
|
|
|
|
udc_set_mask_UDCCR(UDCCR_UDE);
|
|
|
|
|
|
|
|
udc_device = device;
|
|
|
|
if (!ep0_urb)
|
|
|
|
ep0_urb = usbd_alloc_urb(udc_device,
|
|
|
|
udc_device->bus->endpoint_array);
|
|
|
|
else
|
|
|
|
usbinfo("ep0_urb %p already allocated", ep0_urb);
|
|
|
|
|
|
|
|
usbdbg("UDC Enabled\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Need to check this again */
|
|
|
|
void udc_disable(void)
|
|
|
|
{
|
|
|
|
usbdbg("disable UDC");
|
|
|
|
|
|
|
|
udc_clear_mask_UDCCR(UDCCR_UDE);
|
|
|
|
|
|
|
|
/* Disable clock for USB device */
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(readl(CKEN) & ~CKEN11_USB, CKEN);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
/* Free ep0 URB */
|
|
|
|
if (ep0_urb) {
|
|
|
|
usbd_dealloc_urb(ep0_urb);
|
|
|
|
ep0_urb = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Reset device pointer */
|
|
|
|
udc_device = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Allow udc code to do any additional startup */
|
|
|
|
void udc_startup_events(struct usb_device_instance *device)
|
|
|
|
{
|
|
|
|
/* The DEVICE_INIT event puts the USB device in the state STATE_INIT */
|
|
|
|
usbd_device_event_irq(device, DEVICE_INIT, 0);
|
|
|
|
|
|
|
|
/* The DEVICE_CREATE event puts the USB device in the state
|
|
|
|
* STATE_ATTACHED */
|
|
|
|
usbd_device_event_irq(device, DEVICE_CREATE, 0);
|
|
|
|
|
|
|
|
/* Some USB controller driver implementations signal
|
|
|
|
* DEVICE_HUB_CONFIGURED and DEVICE_RESET events here.
|
|
|
|
* DEVICE_HUB_CONFIGURED causes a transition to the state
|
|
|
|
* STATE_POWERED, and DEVICE_RESET causes a transition to
|
|
|
|
* the state STATE_DEFAULT.
|
|
|
|
*/
|
|
|
|
udc_enable(device);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initialize h/w stuff */
|
|
|
|
int udc_init(void)
|
|
|
|
{
|
|
|
|
udc_device = NULL;
|
|
|
|
usbdbg("PXA27x usbd start");
|
|
|
|
|
2011-10-17 15:22:48 +00:00
|
|
|
/* Enable clock for USB device */
|
|
|
|
writel(readl(CKEN) | CKEN11_USB, CKEN);
|
|
|
|
|
2009-04-05 09:43:28 +00:00
|
|
|
/* Disable the UDC */
|
|
|
|
udc_clear_mask_UDCCR(UDCCR_UDE);
|
|
|
|
|
|
|
|
/* Disable IRQs: we don't use them */
|
2011-10-17 15:22:48 +00:00
|
|
|
writel(0, UDCICR0);
|
|
|
|
writel(0, UDCICR1);
|
2009-04-05 09:43:28 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|