diff options
Diffstat (limited to 'drivers/usb/gadget/pxa27x_udc.c')
| -rw-r--r-- | drivers/usb/gadget/pxa27x_udc.c | 702 | 
1 files changed, 702 insertions, 0 deletions
| diff --git a/drivers/usb/gadget/pxa27x_udc.c b/drivers/usb/gadget/pxa27x_udc.c new file mode 100644 index 000000000..e6ccd49ac --- /dev/null +++ b/drivers/usb/gadget/pxa27x_udc.c @@ -0,0 +1,702 @@ +/* + * 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> +#include <usbdcore.h> +#include <usbdcore_ep0.h> +#include <asm/arch/hardware.h> +#include <usb/pxa27x_udc.h> + +/* 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) +{ +	USIR1	= mask | USIR1; +} + +/* + * 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 *addr32 = (u32 *) &UDCDN(ep_num); +	u32 *data32 = (u32 *) urb->buffer; +	u8  *addr8 = (u8 *) &UDCDN(ep_num); +	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) +		UDCCSN(ep_num) = UDCCSR_PC; + +	for (i = 0; i < w; i++) +		*addr32 = data32[endpoint->sent/4 + i]; +	for (i = 0; i < b; i++) +		*addr8 = data8[endpoint->sent + w*4 + i]; + +	/* Set "Packet Complete" if less data then tx_packetSize */ +	if (is_short) +		UDCCSN(ep_num) = ep_num ? UDCCSR_SP : UDCCSR0_IPR; + +	/* Wait for data sent */ +	while (!(UDCCSN(ep_num) & (ep_num ? UDCCSR_PC : UDCCSR0_IPR))) { +		if (ep_num) { +			if (timeout-- == 0) +				return -1; +			else +				udelay(1); +		}; +	} +	endpoint->last = n; + +	if (ep_num) { +		usbd_tx_complete(endpoint); +	} else { +		endpoint->sent += n; +		endpoint->last -= n; +	} + +	if ((endpoint->tx_urb->actual_length - endpoint->sent) <= 0) { +		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 *addr32 = (u32 *) &UDCDN(ep_num); +	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 + +	if (UDCCSN(ep_num) & UDCCSR_BNE) +		n = UDCBCN(ep_num) & 0x3ff; +	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) +		data32[urb->actual_length/4 + i/4] = *addr32; + +	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 *addr32 = (u32 *) &UDCDN(0); +	u32 *data32 = (u32 *) ep0_urb->buffer; +	u8 *addr8 = (u8 *) &UDCDN(0); +	u8 *data8 = (u8 *) ep0_urb->buffer; +	unsigned int i, n, w, b; + +	n = UDCBCR0; +	w = n / 4; +	b = n % 4; + +	for (i = 0; i < w; i++) { +		data32[ep0_urb->actual_length/4 + i] = *addr32; +		ep0_urb->actual_length += 4; +	} + +	for (i = 0; i < b; i++) { +		data8[ep0_urb->actual_length + w*4 + i] = *addr8; +		ep0_urb->actual_length++; +	} + +	UDCCSR0 = UDCCSR0_OPC | UDCCSR0_IPR; +	if (ep0_urb->actual_length == ep0_urb->device_request.wLength) +		return 1; + +	return 0; +} + +static void udc_handle_ep0(struct usb_endpoint_instance *endpoint) +{ +	u32 udccsr0 = UDCCSR0; +	u32 *data = (u32 *) &ep0_urb->device_request; +	int i; + +	usbdbg("udccsr0 %x", udccsr0); + +	/* Clear stall status */ +	if (udccsr0 & UDCCSR0_SST) { +		usberr("clear stall status"); +		UDCCSR0 = UDCCSR0_SST; +		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: + +		udccsr0 = UDCCSR0; +		/* 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++) { +				if ((UDCCSR0 & UDCCSR0_RNE) == 0) { +					usberr("setup packet too short:%d", i); +					goto stall; +				} +				data[i] = UDCDR0; +			} + +			UDCCSR0 |= (UDCCSR0_OPC | UDCCSR0_SA); +			if ((UDCCSR0 & UDCCSR0_RNE) != 0) { +				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; +				} +				UDCCSR0 = UDCCSR0_IPR; +				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; +					UDCCSR0 = UDCCSR0_IPR; +				} 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; + +						UDCCSR0 = UDCCSR0_SA | +						UDCCSR0_OPC | UDCCSR0_FST | +						UDCCS0_FTF; + +						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) +			 */ +			UDCCSR0 = udccsr0 & (UDCCSR0_SA | UDCCSR0_OPC); +		} +		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) { +			UDCCSR0 = UDCCSR0_OPC | UDCCSR0_FTF; +			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: +		UDCCSR0 = UDCCSR0_IPR; +		ep0state = EP0_IDLE; +		break; + +	default: +		usbdbg("Default\n"); +	} +	USIR0 = USIR0_IR0; +} + +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; + +	u32 flags = UDCCSN(ep_num) & (UDCCSR_SST | UDCCSR_TRN); +	if (flags) +		UDCCSN(ep_num) = flags; + +	if (ep_isout) +		udc_read_urb(endpoint); +	else +		udc_write_urb(endpoint); + +	UDCCSN(ep_num) = UDCCSR_PC; +} + +static void udc_state_changed(void) +{ +	int config, interface, alternate; + +	UDCCR |= UDCCR_SMAC; + +	config = (UDCCR & UDCCR_ACN) >> UDCCR_ACN_S; +	interface = (UDCCR & UDCCR_AIN) >> UDCCR_AIN_S; +	alternate = (UDCCR & UDCCR_AAISN) >> UDCCR_AAISN_S; + +	usbdbg("New UDC settings are: conf %d - inter %d - alter %d", +		config, interface, alternate); + +	usbd_device_event_irq(udc_device, DEVICE_CONFIGURED, 0); +	UDCISR1 = UDCISR1_IRCC; +} + +void udc_irq(void) +{ +	int handled; +	struct usb_endpoint_instance *endpoint; +	int ep_num, i; +	u32 udcisr0; + +	do { +		handled = 0; +		/* Suspend Interrupt Request */ +		if (USIR1 & UDCCR_SUSIR) { +			usbdbg("Suspend\n"); +			udc_ack_int_UDCCR(UDCCR_SUSIR); +			handled = 1; +			ep0state = EP0_IDLE; +		} + +		/* Resume Interrupt Request */ +		if (USIR1 & UDCCR_RESIR) { +			udc_ack_int_UDCCR(UDCCR_RESIR); +			handled = 1; +			usbdbg("USB resume\n"); +		} + +		if (USIR1 & (1<<31)) { +			handled = 1; +			udc_state_changed(); +		} + +		/* Reset Interrupt Request */ +		if (USIR1 & UDCCR_RSTIR) { +			udc_ack_int_UDCCR(UDCCR_RSTIR); +			handled = 1; +			usbdbg("Reset\n"); +			usbd_device_event_irq(udc_device, DEVICE_RESET, 0); +		} else { +			if (USIR0) +				usbdbg("UISR0: %x \n", USIR0); + +			if (USIR0 & 0x2) +				USIR0 = 0x2; + +			/* Control traffic */ +			if (USIR0  & USIR0_IR0) { +				handled = 1; +				udc_handle_ep0(udc_device->bus->endpoint_array); +				USIR0 = USIR0_IR0; +			} + +			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; +				udcisr0 = UDCISR0; +				if (udcisr0 & +					UDCISR_INT(ep_num, UDC_INT_PACKETCMP)) { +					UDCISR0 = UDCISR_INT(ep_num, +							 UDC_INT_PACKETCMP); +					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) +{ +    UDCCR = (UDCCR & UDCCR_MASK_BITS) | (mask & UDCCR_MASK_BITS); +} + +static inline void udc_clear_mask_UDCCR(int mask) +{ +    UDCCR = (UDCCR & UDCCR_MASK_BITS) & ~(mask & UDCCR_MASK_BITS); +} + +static void pio_irq_enable(int ep_num) +{ +	if (ep_num < 16) +		UDCICR0 |= 3 << (ep_num * 2); +	else { +		ep_num -= 16; +		UDCICR1 |= 3 << (ep_num * 2); +	} +} + +/* + * 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; + +	UDCCN(ep_num) = tmp; + +	usbdbg("UDCCR%c = %x", 'A' + ep_num-1, UDCCN(ep_num)); +	usbdbg("UDCCSR%c = %x", 'A' + ep_num-1, UDCCSN(ep_num)); +} + +#define CONFIG_USB_DEV_PULLUP_GPIO 87 + +/* Connect the USB device to the bus */ +void udc_connect(void) +{ +	usbdbg("UDC connect"); + +	/* Turn on the USB connection by enabling the pullup resistor */ +	set_GPIO_mode(CONFIG_USB_DEV_PULLUP_GPIO | GPIO_OUT); +	GPSR(CONFIG_USB_DEV_PULLUP_GPIO) = GPIO_bit(CONFIG_USB_DEV_PULLUP_GPIO); +} + +/* Disconnect the USB device to the bus */ +void udc_disconnect(void) +{ +	usbdbg("UDC disconnect"); + +	/* Turn off the USB connection by disabling the pullup resistor */ +	GPCR(CONFIG_USB_DEV_PULLUP_GPIO) = GPIO_bit(CONFIG_USB_DEV_PULLUP_GPIO); +} + +/* Switch on the UDC */ +void udc_enable(struct usb_device_instance *device) +{ + +	ep0state = EP0_IDLE; +	CKEN |= CKEN11_USB; + +	/* enable endpoint 0, A, B's Packet Complete Interrupt. */ +	UDCICR0 = 0x0000003f; +	UDCICR1 = 0xa8000000; + +	/* clear the interrupt status/control registers */ +	UDCISR0 = 0xffffffff; +	UDCISR1 = 0xffffffff; + +	/* 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 */ +	CKEN &= ~CKEN11_USB; + +	/* 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"); + +	/* Disable the UDC */ +	udc_clear_mask_UDCCR(UDCCR_UDE); + +	/* Disable clock for USB device */ +	CKEN &= ~CKEN11_USB; + +	/* Disable IRQs: we don't use them */ +	UDCICR0 = UDCICR1 = 0; + +	return 0; +} |