[msm] hsusb udc driver for the chipidea usb client peripheral
This commit is contained in:
740
platform/msm_shared/hsusb.c
Normal file
740
platform/msm_shared/hsusb.c
Normal file
@@ -0,0 +1,740 @@
|
||||
/*
|
||||
* Copyright (c) 2008, Google Inc.
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
|
||||
* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <debug.h>
|
||||
#include <platform/iomap.h>
|
||||
#include <platform/irqs.h>
|
||||
#include <platform/interrupts.h>
|
||||
#include <kernel/thread.h>
|
||||
#include <reg.h>
|
||||
|
||||
#include <dev/udc.h>
|
||||
|
||||
#include "hsusb.h"
|
||||
|
||||
/* common code - factor out into a shared file */
|
||||
|
||||
struct udc_descriptor {
|
||||
struct udc_descriptor *next;
|
||||
unsigned short tag; /* ((TYPE << 8) | NUM) */
|
||||
unsigned short len; /* total length */
|
||||
unsigned char data[0];
|
||||
};
|
||||
|
||||
struct udc_descriptor *udc_descriptor_alloc(unsigned type, unsigned num, unsigned len)
|
||||
{
|
||||
struct udc_descriptor *desc;
|
||||
if ((len > 255) || (len < 2) || (num > 255) || (type > 255))
|
||||
return 0;
|
||||
|
||||
if(!(desc = malloc(sizeof(struct udc_descriptor) + len)))
|
||||
return 0;
|
||||
|
||||
desc->next = 0;
|
||||
desc->tag = (type << 8) | num;
|
||||
desc->len = len;
|
||||
desc->data[0] = len;
|
||||
desc->data[1] = type;
|
||||
|
||||
return desc;
|
||||
}
|
||||
|
||||
static struct udc_descriptor *desc_list = 0;
|
||||
static unsigned next_string_id = 1;
|
||||
|
||||
void udc_descriptor_register(struct udc_descriptor *desc)
|
||||
{
|
||||
desc->next = desc_list;
|
||||
desc_list = desc;
|
||||
}
|
||||
|
||||
unsigned udc_string_desc_alloc(const char *str)
|
||||
{
|
||||
unsigned len;
|
||||
struct udc_descriptor *desc;
|
||||
unsigned char *data;
|
||||
|
||||
if (next_string_id > 255)
|
||||
return 0;
|
||||
|
||||
if (!str)
|
||||
return 0;
|
||||
|
||||
len = strlen(str);
|
||||
desc = udc_descriptor_alloc(TYPE_STRING, next_string_id, len * 2 + 2);
|
||||
if (!desc)
|
||||
return 0;
|
||||
next_string_id++;
|
||||
|
||||
/* expand ascii string to utf16 */
|
||||
data = desc->data + 2;
|
||||
while (len-- > 0) {
|
||||
*data++ = *str++;
|
||||
*data++ = 0;
|
||||
}
|
||||
|
||||
udc_descriptor_register(desc);
|
||||
return desc->tag & 0xff;
|
||||
}
|
||||
|
||||
/* end of common code */
|
||||
|
||||
void hsusb_clock_init(void);
|
||||
|
||||
#if 1
|
||||
#define DBG(x...) do {} while(0)
|
||||
#else
|
||||
#define DBG(x...) dprintf(INFO, x)
|
||||
#endif
|
||||
|
||||
#define DBG1(x...) dprintf(INFO, x)
|
||||
|
||||
#define usb_status(a,b)
|
||||
|
||||
struct usb_request {
|
||||
struct udc_request req;
|
||||
struct ept_queue_item *item;
|
||||
};
|
||||
|
||||
struct udc_endpoint
|
||||
{
|
||||
struct udc_endpoint *next;
|
||||
unsigned bit;
|
||||
struct ept_queue_head *head;
|
||||
struct usb_request *req;
|
||||
unsigned char num;
|
||||
unsigned char in;
|
||||
unsigned short maxpkt;
|
||||
};
|
||||
|
||||
struct udc_endpoint *ept_list = 0;
|
||||
struct ept_queue_head *epts = 0;
|
||||
|
||||
static int usb_online = 0;
|
||||
static int usb_highspeed = 0;
|
||||
|
||||
static struct udc_device *the_device;
|
||||
static struct udc_gadget *the_gadget;
|
||||
|
||||
struct udc_endpoint *_udc_endpoint_alloc(unsigned num, unsigned in, unsigned max_pkt)
|
||||
{
|
||||
struct udc_endpoint *ept;
|
||||
unsigned cfg;
|
||||
|
||||
ept = malloc(sizeof(*ept));
|
||||
|
||||
ept->maxpkt = max_pkt;
|
||||
ept->num = num;
|
||||
ept->in = !!in;
|
||||
ept->req = 0;
|
||||
|
||||
cfg = CONFIG_MAX_PKT(max_pkt) | CONFIG_ZLT;
|
||||
|
||||
if(ept->in) {
|
||||
ept->bit = EPT_TX(ept->num);
|
||||
} else {
|
||||
ept->bit = EPT_RX(ept->num);
|
||||
if(num == 0)
|
||||
cfg |= CONFIG_IOS;
|
||||
}
|
||||
|
||||
ept->head = epts + (num * 2) + (ept->in);
|
||||
ept->head->config = cfg;
|
||||
|
||||
ept->next = ept_list;
|
||||
ept_list = ept;
|
||||
|
||||
// arch_clean_invalidate_cache_range(ept->head, 64);
|
||||
DBG("ept%d %s @%p/%p max=%d bit=%x\n",
|
||||
num, in ? "in":"out", ept, ept->head, max_pkt, ept->bit);
|
||||
|
||||
return ept;
|
||||
}
|
||||
|
||||
static unsigned ept_alloc_table = EPT_TX(0) | EPT_RX(0);
|
||||
|
||||
struct udc_endpoint *udc_endpoint_alloc(unsigned type, unsigned maxpkt)
|
||||
{
|
||||
struct udc_endpoint *ept;
|
||||
unsigned n;
|
||||
unsigned in;
|
||||
|
||||
if (type == UDC_TYPE_BULK_IN) {
|
||||
in = 1;
|
||||
} else if (type == UDC_TYPE_BULK_OUT) {
|
||||
in = 0;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
|
||||
for (n = 1; n < 16; n++) {
|
||||
unsigned bit = in ? EPT_TX(n) : EPT_RX(n);
|
||||
if (ept_alloc_table & bit)
|
||||
continue;
|
||||
ept = _udc_endpoint_alloc(n, in, maxpkt);
|
||||
if (ept)
|
||||
ept_alloc_table |= bit;
|
||||
return ept;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
void udc_endpoint_free(struct udc_endpoint *ept)
|
||||
{
|
||||
/* todo */
|
||||
}
|
||||
|
||||
static void endpoint_enable(struct udc_endpoint *ept, unsigned yes)
|
||||
{
|
||||
unsigned n = readl(USB_ENDPTCTRL(ept->num));
|
||||
|
||||
if(yes) {
|
||||
if(ept->in) {
|
||||
n |= (CTRL_TXE | CTRL_TXR | CTRL_TXT_BULK);
|
||||
} else {
|
||||
n |= (CTRL_RXE | CTRL_RXR | CTRL_RXT_BULK);
|
||||
}
|
||||
|
||||
if(ept->num != 0) {
|
||||
/* XXX should be more dynamic... */
|
||||
if(usb_highspeed) {
|
||||
ept->head->config = CONFIG_MAX_PKT(512) | CONFIG_ZLT;
|
||||
} else {
|
||||
ept->head->config = CONFIG_MAX_PKT(64) | CONFIG_ZLT;
|
||||
}
|
||||
}
|
||||
}
|
||||
writel(n, USB_ENDPTCTRL(ept->num));
|
||||
}
|
||||
|
||||
struct udc_request *udc_request_alloc(void)
|
||||
{
|
||||
struct usb_request *req;
|
||||
req = malloc(sizeof(*req));
|
||||
req->req.buf = 0;
|
||||
req->req.length = 0;
|
||||
req->item = memalign(32, 32);
|
||||
return &req->req;
|
||||
}
|
||||
|
||||
void udc_request_free(struct udc_request *req)
|
||||
{
|
||||
free(req);
|
||||
}
|
||||
|
||||
int udc_request_queue(struct udc_endpoint *ept, struct udc_request *_req)
|
||||
{
|
||||
struct usb_request *req = (struct usb_request *) _req;
|
||||
struct ept_queue_item *item = req->item;
|
||||
unsigned phys = (unsigned) req->req.buf;
|
||||
|
||||
item->next = TERMINATE;
|
||||
item->info = INFO_BYTES(req->req.length) | INFO_IOC | INFO_ACTIVE;
|
||||
item->page0 = phys;
|
||||
item->page1 = (phys & 0xfffff000) + 0x1000;
|
||||
|
||||
enter_critical_section();
|
||||
ept->head->next = (unsigned) item;
|
||||
ept->head->info = 0;
|
||||
ept->req = req;
|
||||
|
||||
// arch_clean_invalidate_cache_range(item, 32);
|
||||
// arch_clean_invalidate_cache_range(ept->head, 64);
|
||||
// arch_clean_invalidate_cache_range(req->req.buf, req->req.length);
|
||||
DBG("ept%d %s queue req=%p\n",
|
||||
ept->num, ept->in ? "in" : "out", req);
|
||||
|
||||
writel(ept->bit, USB_ENDPTPRIME);
|
||||
exit_critical_section();
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void handle_ept_complete(struct udc_endpoint *ept)
|
||||
{
|
||||
struct ept_queue_item *item;
|
||||
unsigned actual;
|
||||
int status;
|
||||
struct usb_request *req;
|
||||
|
||||
DBG("ept%d %s complete req=%p\n",
|
||||
ept->num, ept->in ? "in" : "out", ept->req);
|
||||
|
||||
req = ept->req;
|
||||
if(req) {
|
||||
ept->req = 0;
|
||||
|
||||
item = req->item;
|
||||
|
||||
/* For some reason we are getting the notification for
|
||||
* transfer completion before the active bit has cleared.
|
||||
* HACK: wait for the ACTIVE bit to clear:
|
||||
*/
|
||||
while (readl(&(item->info)) & INFO_ACTIVE) ;
|
||||
|
||||
// arch_clean_invalidate_cache_range(item, 32);
|
||||
// arch_clean_invalidate_cache_range(req->req.buf, req->req.length);
|
||||
|
||||
if(item->info & 0xff) {
|
||||
actual = 0;
|
||||
status = -1;
|
||||
dprintf(INFO, "EP%d/%s FAIL nfo=%x pg0=%x\n",
|
||||
ept->num, ept->in ? "in" : "out", item->info, item->page0);
|
||||
} else {
|
||||
actual = req->req.length - ((item->info >> 16) & 0x7fff);
|
||||
status = 0;
|
||||
}
|
||||
if(req->req.complete)
|
||||
req->req.complete(&req->req, actual, status);
|
||||
}
|
||||
}
|
||||
|
||||
static const char *reqname(unsigned r)
|
||||
{
|
||||
switch(r) {
|
||||
case GET_STATUS: return "GET_STATUS";
|
||||
case CLEAR_FEATURE: return "CLEAR_FEATURE";
|
||||
case SET_FEATURE: return "SET_FEATURE";
|
||||
case SET_ADDRESS: return "SET_ADDRESS";
|
||||
case GET_DESCRIPTOR: return "GET_DESCRIPTOR";
|
||||
case SET_DESCRIPTOR: return "SET_DESCRIPTOR";
|
||||
case GET_CONFIGURATION: return "GET_CONFIGURATION";
|
||||
case SET_CONFIGURATION: return "SET_CONFIGURATION";
|
||||
case GET_INTERFACE: return "GET_INTERFACE";
|
||||
case SET_INTERFACE: return "SET_INTERFACE";
|
||||
default: return "*UNKNOWN*";
|
||||
}
|
||||
}
|
||||
|
||||
static struct udc_endpoint *ep0in, *ep0out;
|
||||
static struct udc_request *ep0req;
|
||||
|
||||
static void setup_ack(void)
|
||||
{
|
||||
ep0req->complete = 0;
|
||||
ep0req->length = 0;
|
||||
udc_request_queue(ep0in, ep0req);
|
||||
}
|
||||
|
||||
static void ep0in_complete(struct udc_request *req, unsigned actual, int status)
|
||||
{
|
||||
DBG("ep0in_complete %p %d %d\n", req, actual, status);
|
||||
if(status == 0) {
|
||||
req->length = 0;
|
||||
req->complete = 0;
|
||||
udc_request_queue(ep0out, req);
|
||||
}
|
||||
}
|
||||
|
||||
static void setup_tx(void *buf, unsigned len)
|
||||
{
|
||||
DBG("setup_tx %p %d\n", buf, len);
|
||||
memcpy(ep0req->buf, buf, len);
|
||||
ep0req->complete = ep0in_complete;
|
||||
ep0req->length = len;
|
||||
udc_request_queue(ep0in, ep0req);
|
||||
}
|
||||
|
||||
static unsigned char usb_config_value = 0;
|
||||
|
||||
#define SETUP(type,request) (((type) << 8) | (request))
|
||||
|
||||
static void handle_setup(struct udc_endpoint *ept)
|
||||
{
|
||||
struct setup_packet s;
|
||||
|
||||
memcpy(&s, ept->head->setup_data, sizeof(s));
|
||||
writel(ept->bit, USB_ENDPTSETUPSTAT);
|
||||
|
||||
#if 0
|
||||
DBG("handle_setup type=0x%02x req=0x%02x val=%d idx=%d len=%d (%s)\n",
|
||||
s.type, s.request, s.value, s.index, s.length,
|
||||
reqname(s.request));
|
||||
#endif
|
||||
switch (SETUP(s.type,s.request)) {
|
||||
case SETUP(DEVICE_READ, GET_STATUS): {
|
||||
unsigned zero = 0;
|
||||
if (s.length == 2) {
|
||||
setup_tx(&zero, 2);
|
||||
return;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case SETUP(DEVICE_READ, GET_DESCRIPTOR): {
|
||||
struct udc_descriptor *desc;
|
||||
/* usb_highspeed? */
|
||||
for (desc = desc_list; desc; desc = desc->next) {
|
||||
if (desc->tag == s.value) {
|
||||
unsigned len = desc->len;
|
||||
if (len > s.length) len = s.length;
|
||||
setup_tx(desc->data, len);
|
||||
return;
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
case SETUP(DEVICE_READ, GET_CONFIGURATION):
|
||||
/* disabling this causes data transaction failures on OSX. Why? */
|
||||
if ((s.value == 0) && (s.index == 0) && (s.length == 1)) {
|
||||
setup_tx(&usb_config_value, 1);
|
||||
return;
|
||||
}
|
||||
break;
|
||||
case SETUP(DEVICE_WRITE, SET_CONFIGURATION):
|
||||
if (s.value == 1) {
|
||||
struct udc_endpoint *ept;
|
||||
/* enable endpoints */
|
||||
for (ept = ept_list; ept; ept = ept->next){
|
||||
if (ept->num == 0)
|
||||
continue;
|
||||
endpoint_enable(ept, s.value);
|
||||
}
|
||||
usb_config_value = 1;
|
||||
the_gadget->notify(the_gadget, UDC_EVENT_ONLINE);
|
||||
} else {
|
||||
writel(0, USB_ENDPTCTRL(1));
|
||||
usb_config_value = 0;
|
||||
the_gadget->notify(the_gadget, UDC_EVENT_OFFLINE);
|
||||
}
|
||||
setup_ack();
|
||||
usb_online = s.value ? 1 : 0;
|
||||
usb_status(s.value ? 1 : 0, usb_highspeed);
|
||||
return;
|
||||
case SETUP(DEVICE_WRITE, SET_ADDRESS):
|
||||
/* write address delayed (will take effect
|
||||
** after the next IN txn)
|
||||
*/
|
||||
writel((s.value << 25) | (1 << 24), USB_DEVICEADDR);
|
||||
setup_ack();
|
||||
return;
|
||||
case SETUP(INTERFACE_WRITE, SET_INTERFACE):
|
||||
/* if we ack this everything hangs */
|
||||
/* per spec, STALL is valid if there is not alt func */
|
||||
goto stall;
|
||||
case SETUP(ENDPOINT_WRITE, CLEAR_FEATURE): {
|
||||
struct udc_endpoint *ept;
|
||||
unsigned num = s.index & 15;
|
||||
unsigned in = !!(s.index & 0x80);
|
||||
|
||||
if ((s.value == 0) && (s.length == 0)) {
|
||||
DBG("clr feat %d %d\n", num, in);
|
||||
for (ept = ept_list; ept; ept = ept->next) {
|
||||
if ((ept->num == num) && (ept->in == in)) {
|
||||
endpoint_enable(ept, 1);
|
||||
setup_ack();
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
dprintf(INFO, "STALL %s %d %d %d %d %d\n",
|
||||
reqname(s.request),
|
||||
s.type, s.request, s.value, s.index, s.length);
|
||||
|
||||
stall:
|
||||
writel((1<<16) | (1 << 0), USB_ENDPTCTRL(ept->num));
|
||||
}
|
||||
|
||||
unsigned ulpi_read(unsigned reg)
|
||||
{
|
||||
/* initiate read operation */
|
||||
writel(ULPI_RUN | ULPI_READ | ULPI_ADDR(reg),
|
||||
USB_ULPI_VIEWPORT);
|
||||
|
||||
/* wait for completion */
|
||||
while(readl(USB_ULPI_VIEWPORT) & ULPI_RUN) ;
|
||||
|
||||
return ULPI_DATA_READ(readl(USB_ULPI_VIEWPORT));
|
||||
}
|
||||
|
||||
void ulpi_write(unsigned val, unsigned reg)
|
||||
{
|
||||
/* initiate write operation */
|
||||
writel(ULPI_RUN | ULPI_WRITE |
|
||||
ULPI_ADDR(reg) | ULPI_DATA(val),
|
||||
USB_ULPI_VIEWPORT);
|
||||
|
||||
/* wait for completion */
|
||||
while(readl(USB_ULPI_VIEWPORT) & ULPI_RUN) ;
|
||||
}
|
||||
|
||||
void board_usb_init(void);
|
||||
void board_ulpi_init(void);
|
||||
|
||||
int udc_init(struct udc_device *dev)
|
||||
{
|
||||
hsusb_clock_init();
|
||||
|
||||
epts = memalign(4096, 4096);
|
||||
|
||||
dprintf(INFO, "USB init ept @ %p\n", epts);
|
||||
memset(epts, 0, 32 * sizeof(struct ept_queue_head));
|
||||
|
||||
dprintf(INFO, "USB ID %08x\n", readl(USB_ID));
|
||||
// board_usb_init();
|
||||
|
||||
/* select ULPI phy */
|
||||
writel(0x81000000, USB_PORTSC);
|
||||
|
||||
/* RESET */
|
||||
writel(0x00080002, USB_USBCMD);
|
||||
|
||||
thread_sleep(20);
|
||||
|
||||
// board_ulpi_init();
|
||||
|
||||
// arch_clean_invalidate_cache_range(epts, 32 * sizeof(struct ept_queue_head));
|
||||
writel((unsigned) epts, USB_ENDPOINTLISTADDR);
|
||||
|
||||
/* select DEVICE mode */
|
||||
writel(0x02, USB_USBMODE);
|
||||
|
||||
writel(0xffffffff, USB_ENDPTFLUSH);
|
||||
thread_sleep(20);
|
||||
|
||||
ep0out = _udc_endpoint_alloc(0, 0, 64);
|
||||
ep0in = _udc_endpoint_alloc(0, 1, 64);
|
||||
ep0req = udc_request_alloc();
|
||||
ep0req->buf = malloc(4096);
|
||||
|
||||
{
|
||||
/* create and register a language table descriptor */
|
||||
/* language 0x0409 is US English */
|
||||
struct udc_descriptor *desc = udc_descriptor_alloc(TYPE_STRING, 0, 4);
|
||||
desc->data[2] = 0x09;
|
||||
desc->data[3] = 0x04;
|
||||
udc_descriptor_register(desc);
|
||||
}
|
||||
|
||||
the_device = dev;
|
||||
return 0;
|
||||
}
|
||||
|
||||
enum handler_return udc_interrupt(void *arg)
|
||||
{
|
||||
struct udc_endpoint *ept;
|
||||
unsigned ret = INT_NO_RESCHEDULE;
|
||||
unsigned n = readl(USB_USBSTS);
|
||||
writel(n, USB_USBSTS);
|
||||
|
||||
n &= (STS_SLI | STS_URI | STS_PCI | STS_UI | STS_UEI);
|
||||
|
||||
if (n == 0)
|
||||
return ret;
|
||||
|
||||
if (n & STS_URI) {
|
||||
writel(readl(USB_ENDPTCOMPLETE), USB_ENDPTCOMPLETE);
|
||||
writel(readl(USB_ENDPTSETUPSTAT), USB_ENDPTSETUPSTAT);
|
||||
writel(0xffffffff, USB_ENDPTFLUSH);
|
||||
writel(0, USB_ENDPTCTRL(1));
|
||||
DBG1("-- reset --\n");
|
||||
usb_online = 0;
|
||||
usb_config_value = 0;
|
||||
the_gadget->notify(the_gadget, UDC_EVENT_OFFLINE);
|
||||
|
||||
/* error out any pending reqs */
|
||||
for (ept = ept_list; ept; ept = ept->next) {
|
||||
/* ensure that ept_complete considers
|
||||
* this to be an error state
|
||||
*/
|
||||
if (ept->req) {
|
||||
ept->req->item->info = INFO_HALTED;
|
||||
handle_ept_complete(ept);
|
||||
}
|
||||
}
|
||||
usb_status(0, usb_highspeed);
|
||||
}
|
||||
if (n & STS_SLI) {
|
||||
DBG1("-- suspend --\n");
|
||||
}
|
||||
if (n & STS_PCI) {
|
||||
DBG1("-- portchange --\n");
|
||||
unsigned spd = (readl(USB_PORTSC) >> 26) & 3;
|
||||
if(spd == 2) {
|
||||
usb_highspeed = 1;
|
||||
} else {
|
||||
usb_highspeed = 0;
|
||||
}
|
||||
}
|
||||
if (n & STS_UEI) {
|
||||
dprintf(INFO, "<UEI %x>\n", readl(USB_ENDPTCOMPLETE));
|
||||
}
|
||||
#if 0
|
||||
DBG("STS: ");
|
||||
if (n & STS_UEI) DBG("ERROR ");
|
||||
if (n & STS_SLI) DBG("SUSPEND ");
|
||||
if (n & STS_URI) DBG("RESET ");
|
||||
if (n & STS_PCI) DBG("PORTCHANGE ");
|
||||
if (n & STS_UI) DBG("USB ");
|
||||
DBG("\n");
|
||||
#endif
|
||||
if ((n & STS_UI) || (n & STS_UEI)) {
|
||||
n = readl(USB_ENDPTSETUPSTAT);
|
||||
if (n & EPT_RX(0)) {
|
||||
handle_setup(ep0out);
|
||||
ret = INT_RESCHEDULE;
|
||||
}
|
||||
|
||||
n = readl(USB_ENDPTCOMPLETE);
|
||||
if (n != 0) {
|
||||
writel(n, USB_ENDPTCOMPLETE);
|
||||
}
|
||||
|
||||
for (ept = ept_list; ept; ept = ept->next){
|
||||
if (n & ept->bit) {
|
||||
handle_ept_complete(ept);
|
||||
ret = INT_RESCHEDULE;
|
||||
}
|
||||
}
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
int udc_register_gadget(struct udc_gadget *gadget)
|
||||
{
|
||||
if (the_gadget) {
|
||||
dprintf(CRITICAL, "only one gadget supported\n");
|
||||
return -1;
|
||||
}
|
||||
the_gadget = gadget;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void udc_ept_desc_fill(struct udc_endpoint *ept, unsigned char *data)
|
||||
{
|
||||
data[0] = 7;
|
||||
data[1] = TYPE_ENDPOINT;
|
||||
data[2] = ept->num | (ept->in ? 0x80 : 0x00);
|
||||
data[3] = 0x02; /* bulk -- the only kind we support */
|
||||
data[4] = ept->maxpkt;
|
||||
data[5] = ept->maxpkt >> 8;
|
||||
data[6] = ept->in ? 0x00 : 0x01;
|
||||
}
|
||||
|
||||
static unsigned udc_ifc_desc_size(struct udc_gadget *g)
|
||||
{
|
||||
return 9 + g->ifc_endpoints * 7;
|
||||
}
|
||||
|
||||
static void udc_ifc_desc_fill(struct udc_gadget *g, unsigned char *data)
|
||||
{
|
||||
unsigned n;
|
||||
|
||||
data[0] = 0x09;
|
||||
data[1] = TYPE_INTERFACE;
|
||||
data[2] = 0x00; /* ifc number */
|
||||
data[3] = 0x00; /* alt number */
|
||||
data[4] = g->ifc_endpoints;
|
||||
data[5] = g->ifc_class;
|
||||
data[6] = g->ifc_subclass;
|
||||
data[7] = g->ifc_protocol;
|
||||
data[8] = udc_string_desc_alloc(g->ifc_string);
|
||||
|
||||
data += 9;
|
||||
for (n = 0; n < g->ifc_endpoints; n++) {
|
||||
udc_ept_desc_fill(g->ept[n], data);
|
||||
data += 7;
|
||||
}
|
||||
}
|
||||
|
||||
int udc_start(void)
|
||||
{
|
||||
struct udc_descriptor *desc;
|
||||
unsigned char *data;
|
||||
unsigned size;
|
||||
|
||||
dprintf(INFO, "udc_start()\n");
|
||||
|
||||
if (!the_device) {
|
||||
dprintf(CRITICAL, "udc cannot start before init\n");
|
||||
return -1;
|
||||
}
|
||||
if (!the_gadget) {
|
||||
dprintf(CRITICAL, "udc has no gadget registered\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
/* create our device descriptor */
|
||||
desc = udc_descriptor_alloc(TYPE_DEVICE, 0, 18);
|
||||
data = desc->data;
|
||||
data[2] = 0x10; /* usb spec rev 2.10 */
|
||||
data[3] = 0x02;
|
||||
data[4] = 0x00; /* class */
|
||||
data[5] = 0x00; /* subclass */
|
||||
data[6] = 0x00; /* protocol */
|
||||
data[7] = 0x40; /* max packet size on ept 0 */
|
||||
memcpy(data + 8, &the_device->vendor_id, sizeof(short));
|
||||
memcpy(data + 10, &the_device->product_id, sizeof(short));
|
||||
memcpy(data + 12, &the_device->version_id, sizeof(short));
|
||||
data[14] = udc_string_desc_alloc(the_device->manufacturer);
|
||||
data[15] = udc_string_desc_alloc(the_device->product);
|
||||
data[16] = udc_string_desc_alloc(the_device->serialno);
|
||||
data[17] = 1; /* number of configurations */
|
||||
udc_descriptor_register(desc);
|
||||
|
||||
/* create our configuration descriptor */
|
||||
size = 9 + udc_ifc_desc_size(the_gadget);
|
||||
desc = udc_descriptor_alloc(TYPE_CONFIGURATION, 0, size);
|
||||
data = desc->data;
|
||||
data[0] = 0x09;
|
||||
data[2] = size;
|
||||
data[3] = size >> 8;
|
||||
data[4] = 0x01; /* number of interfaces */
|
||||
data[5] = 0x01; /* configuration value */
|
||||
data[6] = 0x00; /* configuration string */
|
||||
data[7] = 0x80; /* attributes */
|
||||
data[8] = 0x80; /* max power (250ma) -- todo fix this */
|
||||
udc_ifc_desc_fill(the_gadget, data + 9);
|
||||
udc_descriptor_register(desc);
|
||||
|
||||
/* go to RUN mode (D+ pullup enable) */
|
||||
writel(0x00080001, USB_USBCMD);
|
||||
register_int_handler(INT_USB_HS, udc_interrupt, (void*) 0);
|
||||
unmask_interrupt(INT_USB_HS);
|
||||
writel(STS_URI | STS_SLI | STS_UI | STS_PCI, USB_USBINTR);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int udc_stop(void)
|
||||
{
|
||||
writel(0, USB_USBINTR);
|
||||
mask_interrupt(INT_USB_HS);
|
||||
|
||||
/* disable pullup */
|
||||
writel(0x0008000, USB_USBCMD);
|
||||
thread_sleep(10);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
169
platform/msm_shared/hsusb.h
Normal file
169
platform/msm_shared/hsusb.h
Normal file
@@ -0,0 +1,169 @@
|
||||
/*
|
||||
* Copyright (c) 2008, Google Inc.
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
|
||||
* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#ifndef _MSM7200_USB_H_
|
||||
#define _MSM7200_USB_H_
|
||||
|
||||
#define MSM_USB_BASE 0xA0800000
|
||||
|
||||
|
||||
#define USB_ID (MSM_USB_BASE + 0x0000)
|
||||
#define USB_HWGENERAL (MSM_USB_BASE + 0x0004)
|
||||
#define USB_HWHOST (MSM_USB_BASE + 0x0008)
|
||||
#define USB_HWDEVICE (MSM_USB_BASE + 0x000C)
|
||||
#define USB_HWTXBUF (MSM_USB_BASE + 0x0010)
|
||||
#define USB_HWRXBUF (MSM_USB_BASE + 0x0014)
|
||||
#define USB_SBUSCFG (MSM_USB_BASE + 0x0090)
|
||||
|
||||
#define USB_CAPLENGTH (MSM_USB_BASE + 0x0100) /* 8 bit */
|
||||
#define USB_HCIVERSION (MSM_USB_BASE + 0x0102) /* 16 bit */
|
||||
#define USB_HCSPARAMS (MSM_USB_BASE + 0x0104)
|
||||
#define USB_HCCPARAMS (MSM_USB_BASE + 0x0108)
|
||||
#define USB_DCIVERSION (MSM_USB_BASE + 0x0120) /* 16 bit */
|
||||
#define USB_USBCMD (MSM_USB_BASE + 0x0140)
|
||||
#define USB_USBSTS (MSM_USB_BASE + 0x0144)
|
||||
#define USB_USBINTR (MSM_USB_BASE + 0x0148)
|
||||
#define USB_FRINDEX (MSM_USB_BASE + 0x014C)
|
||||
#define USB_DEVICEADDR (MSM_USB_BASE + 0x0154)
|
||||
#define USB_ENDPOINTLISTADDR (MSM_USB_BASE + 0x0158)
|
||||
#define USB_BURSTSIZE (MSM_USB_BASE + 0x0160)
|
||||
#define USB_TXFILLTUNING (MSM_USB_BASE + 0x0164)
|
||||
#define USB_ULPI_VIEWPORT (MSM_USB_BASE + 0x0170)
|
||||
#define USB_ENDPTNAK (MSM_USB_BASE + 0x0178)
|
||||
#define USB_ENDPTNAKEN (MSM_USB_BASE + 0x017C)
|
||||
#define USB_PORTSC (MSM_USB_BASE + 0x0184)
|
||||
#define USB_OTGSC (MSM_USB_BASE + 0x01A4)
|
||||
#define USB_USBMODE (MSM_USB_BASE + 0x01A8)
|
||||
#define USB_ENDPTSETUPSTAT (MSM_USB_BASE + 0x01AC)
|
||||
#define USB_ENDPTPRIME (MSM_USB_BASE + 0x01B0)
|
||||
#define USB_ENDPTFLUSH (MSM_USB_BASE + 0x01B4)
|
||||
#define USB_ENDPTSTAT (MSM_USB_BASE + 0x01B8)
|
||||
#define USB_ENDPTCOMPLETE (MSM_USB_BASE + 0x01BC)
|
||||
#define USB_ENDPTCTRL(n) (MSM_USB_BASE + 0x01C0 + (4 * (n)))
|
||||
|
||||
|
||||
#define USBCMD_RESET 2
|
||||
#define USBCMD_ATTACH 1
|
||||
|
||||
#define USBMODE_DEVICE 2
|
||||
#define USBMODE_HOST 3
|
||||
|
||||
struct ept_queue_head
|
||||
{
|
||||
unsigned config;
|
||||
unsigned current; /* read-only */
|
||||
|
||||
unsigned next;
|
||||
unsigned info;
|
||||
unsigned page0;
|
||||
unsigned page1;
|
||||
unsigned page2;
|
||||
unsigned page3;
|
||||
unsigned page4;
|
||||
unsigned reserved_0;
|
||||
|
||||
unsigned char setup_data[8];
|
||||
|
||||
unsigned reserved_1;
|
||||
unsigned reserved_2;
|
||||
unsigned reserved_3;
|
||||
unsigned reserved_4;
|
||||
};
|
||||
|
||||
#define CONFIG_MAX_PKT(n) ((n) << 16)
|
||||
#define CONFIG_ZLT (1 << 29) /* stop on zero-len xfer */
|
||||
#define CONFIG_IOS (1 << 15) /* IRQ on setup */
|
||||
|
||||
struct ept_queue_item
|
||||
{
|
||||
unsigned next;
|
||||
unsigned info;
|
||||
unsigned page0;
|
||||
unsigned page1;
|
||||
unsigned page2;
|
||||
unsigned page3;
|
||||
unsigned page4;
|
||||
unsigned reserved;
|
||||
};
|
||||
|
||||
#define TERMINATE 1
|
||||
|
||||
#define INFO_BYTES(n) ((n) << 16)
|
||||
#define INFO_IOC (1 << 15)
|
||||
#define INFO_ACTIVE (1 << 7)
|
||||
#define INFO_HALTED (1 << 6)
|
||||
#define INFO_BUFFER_ERROR (1 << 5)
|
||||
#define INFO_TX_ERROR (1 << 3)
|
||||
|
||||
|
||||
#define STS_NAKI (1 << 16) /* */
|
||||
#define STS_SLI (1 << 8) /* R/WC - suspend state entered */
|
||||
#define STS_SRI (1 << 7) /* R/WC - SOF recv'd */
|
||||
#define STS_URI (1 << 6) /* R/WC - RESET recv'd - write to clear */
|
||||
#define STS_FRI (1 << 3) /* R/WC - Frame List Rollover */
|
||||
#define STS_PCI (1 << 2) /* R/WC - Port Change Detect */
|
||||
#define STS_UEI (1 << 1) /* R/WC - USB Error */
|
||||
#define STS_UI (1 << 0) /* R/WC - USB Transaction Complete */
|
||||
|
||||
|
||||
/* bits used in all the endpoint status registers */
|
||||
#define EPT_TX(n) (1 << ((n) + 16))
|
||||
#define EPT_RX(n) (1 << (n))
|
||||
|
||||
|
||||
#define CTRL_TXE (1 << 23)
|
||||
#define CTRL_TXR (1 << 22)
|
||||
#define CTRL_TXI (1 << 21)
|
||||
#define CTRL_TXD (1 << 17)
|
||||
#define CTRL_TXS (1 << 16)
|
||||
#define CTRL_RXE (1 << 7)
|
||||
#define CTRL_RXR (1 << 6)
|
||||
#define CTRL_RXI (1 << 5)
|
||||
#define CTRL_RXD (1 << 1)
|
||||
#define CTRL_RXS (1 << 0)
|
||||
|
||||
#define CTRL_TXT_CTRL (0 << 18)
|
||||
#define CTRL_TXT_ISOCH (1 << 18)
|
||||
#define CTRL_TXT_BULK (2 << 18)
|
||||
#define CTRL_TXT_INT (3 << 18)
|
||||
|
||||
#define CTRL_RXT_CTRL (0 << 2)
|
||||
#define CTRL_RXT_ISOCH (1 << 2)
|
||||
#define CTRL_RXT_BULK (2 << 2)
|
||||
#define CTRL_RXT_INT (3 << 2)
|
||||
|
||||
#define ULPI_WAKEUP (1 << 31)
|
||||
#define ULPI_RUN (1 << 30)
|
||||
#define ULPI_WRITE (1 << 29)
|
||||
#define ULPI_READ (0 << 29)
|
||||
#define ULPI_STATE_NORMAL (1 << 27)
|
||||
#define ULPI_ADDR(n) (((n) & 255) << 16)
|
||||
#define ULPI_DATA(n) ((n) & 255)
|
||||
#define ULPI_DATA_READ(n) (((n) >> 8) & 255)
|
||||
|
||||
#endif
|
||||
@@ -3,6 +3,7 @@ LOCAL_DIR := $(GET_LOCAL_DIR)
|
||||
OBJS += \
|
||||
$(LOCAL_DIR)/uart.o \
|
||||
$(LOCAL_DIR)/timer.o \
|
||||
$(LOCAL_DIR)/proc_comm.o
|
||||
$(LOCAL_DIR)/proc_comm.o \
|
||||
$(LOCAL_DIR)/hsusb.o
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user