bad510ad10
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@23263 a1c6a512-1295-4272-9138-f99709370657
857 lines
24 KiB
C
857 lines
24 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2007 by Björn Stenberg
|
|
*
|
|
* 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
#include "system.h"
|
|
#include "thread.h"
|
|
#include "kernel.h"
|
|
#include "string.h"
|
|
//#define LOGF_ENABLE
|
|
#include "logf.h"
|
|
|
|
#include "usb.h"
|
|
#include "usb_ch9.h"
|
|
#include "usb_drv.h"
|
|
#include "usb_core.h"
|
|
#include "usb_class_driver.h"
|
|
|
|
#if defined(USB_ENABLE_STORAGE)
|
|
#include "usb_storage.h"
|
|
#endif
|
|
|
|
#if defined(USB_ENABLE_SERIAL)
|
|
#include "usb_serial.h"
|
|
#endif
|
|
|
|
#if defined(USB_ENABLE_CHARGING_ONLY)
|
|
#include "usb_charging_only.h"
|
|
#endif
|
|
|
|
#ifdef USB_ENABLE_HID
|
|
#include "usb_hid.h"
|
|
#endif
|
|
|
|
/* TODO: Move target-specific stuff somewhere else (serial number reading) */
|
|
|
|
#ifdef HAVE_AS3514
|
|
#include "ascodec.h"
|
|
#include "as3514.h"
|
|
#endif
|
|
|
|
#if !defined(HAVE_AS3514) && !defined(IPOD_ARCH) && (CONFIG_STORAGE & STORAGE_ATA)
|
|
#include "ata.h"
|
|
#endif
|
|
|
|
#ifndef USB_MAX_CURRENT
|
|
#define USB_MAX_CURRENT 500
|
|
#endif
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
/* USB protocol descriptors: */
|
|
|
|
static struct usb_device_descriptor __attribute__((aligned(2)))
|
|
device_descriptor=
|
|
{
|
|
.bLength = sizeof(struct usb_device_descriptor),
|
|
.bDescriptorType = USB_DT_DEVICE,
|
|
#ifndef USB_NO_HIGH_SPEED
|
|
.bcdUSB = 0x0200,
|
|
#else
|
|
.bcdUSB = 0x0110,
|
|
#endif
|
|
.bDeviceClass = USB_CLASS_PER_INTERFACE,
|
|
.bDeviceSubClass = 0,
|
|
.bDeviceProtocol = 0,
|
|
.bMaxPacketSize0 = 64,
|
|
.idVendor = USB_VENDOR_ID,
|
|
.idProduct = USB_PRODUCT_ID,
|
|
.bcdDevice = 0x0100,
|
|
.iManufacturer = 1,
|
|
.iProduct = 2,
|
|
.iSerialNumber = 3,
|
|
.bNumConfigurations = 1
|
|
} ;
|
|
|
|
static struct usb_config_descriptor __attribute__((aligned(2)))
|
|
config_descriptor =
|
|
{
|
|
.bLength = sizeof(struct usb_config_descriptor),
|
|
.bDescriptorType = USB_DT_CONFIG,
|
|
.wTotalLength = 0, /* will be filled in later */
|
|
.bNumInterfaces = 1,
|
|
.bConfigurationValue = 1,
|
|
.iConfiguration = 0,
|
|
.bmAttributes = USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER,
|
|
.bMaxPower = (USB_MAX_CURRENT+1) / 2, /* In 2mA units */
|
|
};
|
|
|
|
static const struct usb_qualifier_descriptor __attribute__((aligned(2)))
|
|
qualifier_descriptor =
|
|
{
|
|
.bLength = sizeof(struct usb_qualifier_descriptor),
|
|
.bDescriptorType = USB_DT_DEVICE_QUALIFIER,
|
|
.bcdUSB = 0x0200,
|
|
.bDeviceClass = 0,
|
|
.bDeviceSubClass = 0,
|
|
.bDeviceProtocol = 0,
|
|
.bMaxPacketSize0 = 64,
|
|
.bNumConfigurations = 1
|
|
};
|
|
|
|
static const struct usb_string_descriptor __attribute__((aligned(2)))
|
|
usb_string_iManufacturer =
|
|
{
|
|
24,
|
|
USB_DT_STRING,
|
|
{'R','o','c','k','b','o','x','.','o','r','g'}
|
|
};
|
|
|
|
static const struct usb_string_descriptor __attribute__((aligned(2)))
|
|
usb_string_iProduct =
|
|
{
|
|
42,
|
|
USB_DT_STRING,
|
|
{'R','o','c','k','b','o','x',' ',
|
|
'm','e','d','i','a',' ',
|
|
'p','l','a','y','e','r'}
|
|
};
|
|
|
|
static struct usb_string_descriptor __attribute__((aligned(2)))
|
|
usb_string_iSerial =
|
|
{
|
|
84,
|
|
USB_DT_STRING,
|
|
{'0','0','0','0','0','0','0','0','0','0','0','0','0','0','0','0',
|
|
'0','0','0','0','0','0','0','0','0','0','0','0','0','0','0','0',
|
|
'0','0','0','0','0','0','0','0','0'}
|
|
};
|
|
|
|
/* Generic for all targets */
|
|
|
|
/* this is stringid #0: languages supported */
|
|
static const struct usb_string_descriptor __attribute__((aligned(2)))
|
|
lang_descriptor =
|
|
{
|
|
4,
|
|
USB_DT_STRING,
|
|
{0x0409} /* LANGID US English */
|
|
};
|
|
|
|
static const struct usb_string_descriptor* const usb_strings[] =
|
|
{
|
|
&lang_descriptor,
|
|
&usb_string_iManufacturer,
|
|
&usb_string_iProduct,
|
|
&usb_string_iSerial
|
|
};
|
|
|
|
static int usb_address = 0;
|
|
static bool initialized = false;
|
|
static enum { DEFAULT, ADDRESS, CONFIGURED } usb_state;
|
|
|
|
static int usb_core_num_interfaces;
|
|
|
|
typedef void (*completion_handler_t)(int ep,int dir,int status,int length);
|
|
typedef bool (*control_handler_t)(struct usb_ctrlrequest* req,unsigned char* dest);
|
|
|
|
static struct
|
|
{
|
|
completion_handler_t completion_handler[2];
|
|
control_handler_t control_handler[2];
|
|
struct usb_transfer_completion_event_data completion_event;
|
|
} ep_data[USB_NUM_ENDPOINTS];
|
|
|
|
static struct usb_class_driver drivers[USB_NUM_DRIVERS] =
|
|
{
|
|
#ifdef USB_ENABLE_STORAGE
|
|
[USB_DRIVER_MASS_STORAGE] = {
|
|
.enabled = false,
|
|
.needs_exclusive_storage = true,
|
|
.first_interface = 0,
|
|
.last_interface = 0,
|
|
.request_endpoints = usb_storage_request_endpoints,
|
|
.set_first_interface = usb_storage_set_first_interface,
|
|
.get_config_descriptor = usb_storage_get_config_descriptor,
|
|
.init_connection = usb_storage_init_connection,
|
|
.init = usb_storage_init,
|
|
.disconnect = usb_storage_disconnect,
|
|
.transfer_complete = usb_storage_transfer_complete,
|
|
.control_request = usb_storage_control_request,
|
|
#ifdef HAVE_HOTSWAP
|
|
.notify_hotswap = usb_storage_notify_hotswap,
|
|
#endif
|
|
},
|
|
#endif
|
|
#ifdef USB_ENABLE_SERIAL
|
|
[USB_DRIVER_SERIAL] = {
|
|
.enabled = false,
|
|
.needs_exclusive_storage = false,
|
|
.first_interface = 0,
|
|
.last_interface = 0,
|
|
.request_endpoints = usb_serial_request_endpoints,
|
|
.set_first_interface = usb_serial_set_first_interface,
|
|
.get_config_descriptor = usb_serial_get_config_descriptor,
|
|
.init_connection = usb_serial_init_connection,
|
|
.init = usb_serial_init,
|
|
.disconnect = usb_serial_disconnect,
|
|
.transfer_complete = usb_serial_transfer_complete,
|
|
.control_request = usb_serial_control_request,
|
|
#ifdef HAVE_HOTSWAP
|
|
.notify_hotswap = NULL,
|
|
#endif
|
|
},
|
|
#endif
|
|
#ifdef USB_ENABLE_CHARGING_ONLY
|
|
[USB_DRIVER_CHARGING_ONLY] = {
|
|
.enabled = false,
|
|
.needs_exclusive_storage = false,
|
|
.first_interface = 0,
|
|
.last_interface = 0,
|
|
.request_endpoints = usb_charging_only_request_endpoints,
|
|
.set_first_interface = usb_charging_only_set_first_interface,
|
|
.get_config_descriptor = usb_charging_only_get_config_descriptor,
|
|
.init_connection = NULL,
|
|
.init = NULL,
|
|
.disconnect = NULL,
|
|
.transfer_complete = NULL,
|
|
.control_request = NULL,
|
|
#ifdef HAVE_HOTSWAP
|
|
.notify_hotswap = NULL,
|
|
#endif
|
|
},
|
|
#endif
|
|
#ifdef USB_ENABLE_HID
|
|
[USB_DRIVER_HID] = {
|
|
.enabled = false,
|
|
.needs_exclusive_storage = false,
|
|
.first_interface = 0,
|
|
.last_interface = 0,
|
|
.request_endpoints = usb_hid_request_endpoints,
|
|
.set_first_interface = usb_hid_set_first_interface,
|
|
.get_config_descriptor = usb_hid_get_config_descriptor,
|
|
.init_connection = usb_hid_init_connection,
|
|
.init = usb_hid_init,
|
|
.disconnect = usb_hid_disconnect,
|
|
.transfer_complete = usb_hid_transfer_complete,
|
|
.control_request = usb_hid_control_request,
|
|
#ifdef HAVE_HOTSWAP
|
|
.notify_hotswap = NULL,
|
|
#endif
|
|
},
|
|
#endif
|
|
};
|
|
|
|
static void usb_core_control_request_handler(struct usb_ctrlrequest* req);
|
|
|
|
static unsigned char response_data[256] USB_DEVBSS_ATTR;
|
|
|
|
static short hex[16] = {'0','1','2','3','4','5','6','7',
|
|
'8','9','A','B','C','D','E','F'};
|
|
#ifdef IPOD_ARCH
|
|
static void set_serial_descriptor(void)
|
|
{
|
|
#ifdef IPOD_VIDEO
|
|
uint32_t* serial = (uint32_t*)(0x20004034);
|
|
#else
|
|
uint32_t* serial = (uint32_t*)(0x20002034);
|
|
#endif
|
|
|
|
/* We need to convert from a little-endian 64-bit int
|
|
into a utf-16 string of hex characters */
|
|
short* p = &usb_string_iSerial.wString[24];
|
|
uint32_t x;
|
|
int i,j;
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
x = serial[i];
|
|
for (j=0;j<8;j++) {
|
|
*p-- = hex[x & 0xf];
|
|
x >>= 4;
|
|
}
|
|
}
|
|
usb_string_iSerial.bLength=52;
|
|
}
|
|
#elif defined(HAVE_AS3514)
|
|
static void set_serial_descriptor(void)
|
|
{
|
|
unsigned char serial[16];
|
|
/* Align 32 digits right in the 40-digit serial number */
|
|
short* p = &usb_string_iSerial.wString[1];
|
|
int i;
|
|
|
|
ascodec_readbytes(AS3514_UID_0, 0x10, serial);
|
|
for (i = 0; i < 16; i++) {
|
|
*p++ = hex[(serial[i] >> 4) & 0xF];
|
|
*p++ = hex[(serial[i] >> 0) & 0xF];
|
|
}
|
|
usb_string_iSerial.bLength=68;
|
|
}
|
|
#elif (CONFIG_STORAGE & STORAGE_ATA)
|
|
/* If we don't know the device serial number, use the one
|
|
* from the disk */
|
|
static void set_serial_descriptor(void)
|
|
{
|
|
short* p = &usb_string_iSerial.wString[1];
|
|
unsigned short* identify = ata_get_identify();
|
|
unsigned short x;
|
|
int i;
|
|
|
|
for (i = 10; i < 20; i++) {
|
|
x = identify[i];
|
|
*p++ = hex[(x >> 12) & 0xF];
|
|
*p++ = hex[(x >> 8) & 0xF];
|
|
*p++ = hex[(x >> 4) & 0xF];
|
|
*p++ = hex[(x >> 0) & 0xF];
|
|
}
|
|
usb_string_iSerial.bLength=84;
|
|
}
|
|
#elif (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
/* This "serial number" isn't unique, but it should never actually
|
|
appear in non-testing use */
|
|
static void set_serial_descriptor(void)
|
|
{
|
|
short* p = &usb_string_iSerial.wString[1];
|
|
int i;
|
|
for (i = 0; i < 16; i++) {
|
|
*p++ = hex[(2*i)&0xF];
|
|
*p++ = hex[(2*i+1)&0xF];
|
|
}
|
|
usb_string_iSerial.bLength=68;
|
|
}
|
|
#else
|
|
static void set_serial_descriptor(void)
|
|
{
|
|
device_descriptor.iSerialNumber = 0;
|
|
}
|
|
#endif
|
|
|
|
void usb_core_init(void)
|
|
{
|
|
int i;
|
|
if (initialized)
|
|
return;
|
|
|
|
usb_drv_init();
|
|
|
|
/* class driver init functions should be safe to call even if the driver
|
|
* won't be used. This simplifies other logic (i.e. we don't need to know
|
|
* yet which drivers will be enabled */
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].init != NULL)
|
|
drivers[i].init();
|
|
}
|
|
|
|
initialized = true;
|
|
usb_state = DEFAULT;
|
|
logf("usb_core_init() finished");
|
|
}
|
|
|
|
void usb_core_exit(void)
|
|
{
|
|
int i;
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled && drivers[i].disconnect != NULL)
|
|
{
|
|
drivers[i].disconnect();
|
|
drivers[i].enabled = false;
|
|
}
|
|
}
|
|
|
|
if (initialized) {
|
|
usb_drv_exit();
|
|
initialized = false;
|
|
}
|
|
usb_state = DEFAULT;
|
|
logf("usb_core_exit() finished");
|
|
}
|
|
|
|
void usb_core_handle_transfer_completion(
|
|
struct usb_transfer_completion_event_data* event)
|
|
{
|
|
completion_handler_t handler;
|
|
int ep = event->endpoint;
|
|
|
|
switch(ep) {
|
|
case EP_CONTROL:
|
|
logf("ctrl handled %ld",current_tick);
|
|
usb_core_control_request_handler(
|
|
(struct usb_ctrlrequest*)event->data);
|
|
break;
|
|
default:
|
|
handler = ep_data[ep].completion_handler[EP_DIR(event->dir)];
|
|
if(handler != NULL)
|
|
handler(ep,event->dir,event->status,event->length);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void usb_core_enable_driver(int driver,bool enabled)
|
|
{
|
|
drivers[driver].enabled = enabled;
|
|
}
|
|
|
|
bool usb_core_driver_enabled(int driver)
|
|
{
|
|
return drivers[driver].enabled;
|
|
}
|
|
|
|
bool usb_core_any_exclusive_storage(void)
|
|
{
|
|
int i;
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled && drivers[i].needs_exclusive_storage)
|
|
{
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
#ifdef HAVE_HOTSWAP
|
|
void usb_core_hotswap_event(int volume,bool inserted)
|
|
{
|
|
int i;
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled && drivers[i].notify_hotswap!=NULL)
|
|
{
|
|
drivers[i].notify_hotswap(volume,inserted);
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
static void usb_core_set_serial_function_id(void)
|
|
{
|
|
int id = 0;
|
|
int i;
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled)
|
|
id |= 1<<i;
|
|
}
|
|
usb_string_iSerial.wString[0] = hex[id];
|
|
}
|
|
|
|
int usb_core_request_endpoint(int type, int dir, struct usb_class_driver* drv)
|
|
{
|
|
int ret, ep;
|
|
|
|
ret = usb_drv_request_endpoint(type, dir);
|
|
|
|
if (ret==-1)
|
|
return -1;
|
|
|
|
dir = EP_DIR(ret);
|
|
ep = EP_NUM(ret);
|
|
|
|
ep_data[ep].completion_handler[dir] = drv->transfer_complete;
|
|
ep_data[ep].control_handler[dir] = drv->control_request;
|
|
|
|
return ret;
|
|
}
|
|
|
|
void usb_core_release_endpoint(int ep)
|
|
{
|
|
int dir;
|
|
|
|
usb_drv_release_endpoint(ep);
|
|
|
|
dir = EP_DIR(ep);
|
|
ep = EP_NUM(ep);
|
|
|
|
ep_data[ep].completion_handler[dir] = NULL;
|
|
ep_data[ep].control_handler[dir] = NULL;
|
|
}
|
|
|
|
static void allocate_interfaces_and_endpoints(void)
|
|
{
|
|
int i;
|
|
int interface=0;
|
|
|
|
memset(ep_data,0,sizeof(ep_data));
|
|
|
|
for (i = 0; i < USB_NUM_ENDPOINTS; i++) {
|
|
usb_drv_release_endpoint(i | USB_DIR_OUT);
|
|
usb_drv_release_endpoint(i | USB_DIR_IN);
|
|
}
|
|
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled) {
|
|
drivers[i].first_interface = interface;
|
|
|
|
if (drivers[i].request_endpoints(&drivers[i])) {
|
|
drivers[i].enabled = false;
|
|
continue;
|
|
}
|
|
|
|
interface = drivers[i].set_first_interface(interface);
|
|
drivers[i].last_interface = interface;
|
|
}
|
|
}
|
|
usb_core_num_interfaces = interface;
|
|
}
|
|
|
|
static int usb_core_ack_control(struct usb_ctrlrequest* req)
|
|
{
|
|
if (req->bRequestType & USB_DIR_IN)
|
|
return usb_drv_recv(EP_CONTROL,NULL,0);
|
|
else
|
|
return usb_drv_send(EP_CONTROL,NULL,0);
|
|
}
|
|
|
|
|
|
static void control_request_handler_drivers(struct usb_ctrlrequest* req)
|
|
{
|
|
int i, interface = req->wIndex;
|
|
bool handled=false;
|
|
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled &&
|
|
drivers[i].control_request &&
|
|
drivers[i].first_interface <= interface &&
|
|
drivers[i].last_interface > interface)
|
|
{
|
|
handled = drivers[i].control_request(req, response_data);
|
|
if(handled)
|
|
break;
|
|
}
|
|
}
|
|
if(!handled) {
|
|
/* nope. flag error */
|
|
logf("bad req:desc %d:%d", req->bRequest, req->wValue>>8);
|
|
usb_drv_stall(EP_CONTROL, true, true);
|
|
usb_core_ack_control(req);
|
|
}
|
|
}
|
|
|
|
static void request_handler_device_get_descriptor(struct usb_ctrlrequest* req)
|
|
{
|
|
int size;
|
|
bool handled = true;
|
|
const void* ptr = NULL;
|
|
int length = req->wLength;
|
|
int index = req->wValue & 0xff;
|
|
|
|
switch(req->wValue>>8) { /* type */
|
|
case USB_DT_DEVICE:
|
|
ptr = &device_descriptor;
|
|
size = sizeof(struct usb_device_descriptor);
|
|
break;
|
|
|
|
case USB_DT_OTHER_SPEED_CONFIG:
|
|
case USB_DT_CONFIG: {
|
|
int i, max_packet_size;
|
|
|
|
if(req->wValue>>8==USB_DT_CONFIG) {
|
|
max_packet_size=(usb_drv_port_speed() ? 512 : 64);
|
|
config_descriptor.bDescriptorType=USB_DT_CONFIG;
|
|
}
|
|
else {
|
|
max_packet_size=(usb_drv_port_speed() ? 64 : 512);
|
|
config_descriptor.bDescriptorType =
|
|
USB_DT_OTHER_SPEED_CONFIG;
|
|
}
|
|
size = sizeof(struct usb_config_descriptor);
|
|
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled && drivers[i].get_config_descriptor) {
|
|
size+=drivers[i].get_config_descriptor(
|
|
&response_data[size],max_packet_size);
|
|
}
|
|
}
|
|
config_descriptor.bNumInterfaces = usb_core_num_interfaces;
|
|
config_descriptor.wTotalLength = (uint16_t)size;
|
|
memcpy(&response_data[0],&config_descriptor,
|
|
sizeof(struct usb_config_descriptor));
|
|
|
|
ptr = response_data;
|
|
break;
|
|
}
|
|
|
|
case USB_DT_STRING:
|
|
logf("STRING %d",index);
|
|
if ((unsigned)index < (sizeof(usb_strings)/
|
|
sizeof(struct usb_string_descriptor*))) {
|
|
size = usb_strings[index]->bLength;
|
|
ptr = usb_strings[index];
|
|
}
|
|
else {
|
|
logf("bad string id %d",index);
|
|
usb_drv_stall(EP_CONTROL,true,true);
|
|
}
|
|
break;
|
|
|
|
case USB_DT_DEVICE_QUALIFIER:
|
|
ptr = &qualifier_descriptor;
|
|
size = sizeof(struct usb_qualifier_descriptor);
|
|
break;
|
|
|
|
default:
|
|
logf("ctrl desc.");
|
|
handled = false;
|
|
control_request_handler_drivers(req);
|
|
break;
|
|
}
|
|
|
|
if (ptr) {
|
|
logf("data %d (%d)",size,length);
|
|
length = MIN(size,length);
|
|
|
|
if (ptr != response_data) {
|
|
memcpy(response_data,ptr,length);
|
|
}
|
|
|
|
usb_drv_recv(EP_CONTROL,NULL,0);
|
|
usb_drv_send(EP_CONTROL,response_data,length);
|
|
}
|
|
}
|
|
|
|
static void request_handler_device(struct usb_ctrlrequest* req)
|
|
{
|
|
int i;
|
|
|
|
switch(req->bRequest) {
|
|
case USB_REQ_GET_CONFIGURATION: {
|
|
logf("usb_core: GET_CONFIG");
|
|
response_data[0] = (usb_state == ADDRESS ? 0 : 1);
|
|
usb_drv_recv(EP_CONTROL,NULL,0);
|
|
usb_drv_send(EP_CONTROL, response_data, 1);
|
|
break;
|
|
}
|
|
case USB_REQ_SET_CONFIGURATION: {
|
|
logf("usb_core: SET_CONFIG");
|
|
usb_drv_cancel_all_transfers();
|
|
if(req->wValue) {
|
|
usb_state = CONFIGURED;
|
|
for(i=0;i<USB_NUM_DRIVERS;i++) {
|
|
if(drivers[i].enabled && drivers[i].init_connection)
|
|
drivers[i].init_connection();
|
|
}
|
|
}
|
|
else {
|
|
usb_state = ADDRESS;
|
|
}
|
|
usb_drv_send(EP_CONTROL,NULL,0);
|
|
break;
|
|
}
|
|
case USB_REQ_SET_ADDRESS: {
|
|
unsigned char address = req->wValue;
|
|
logf("usb_core: SET_ADR %d", address);
|
|
usb_drv_send(EP_CONTROL,NULL,0);
|
|
usb_drv_cancel_all_transfers();
|
|
usb_address = address;
|
|
usb_drv_set_address(usb_address);
|
|
usb_state = ADDRESS;
|
|
break;
|
|
}
|
|
case USB_REQ_GET_DESCRIPTOR:
|
|
logf("usb_core: GET_DESC %d", req->wValue>>8);
|
|
request_handler_device_get_descriptor(req);
|
|
break;
|
|
case USB_REQ_CLEAR_FEATURE:
|
|
break;
|
|
case USB_REQ_SET_FEATURE:
|
|
if(req->wValue==USB_DEVICE_TEST_MODE) {
|
|
int mode=req->wIndex>>8;
|
|
usb_drv_send(EP_CONTROL,NULL,0);
|
|
usb_drv_set_test_mode(mode);
|
|
}
|
|
break;
|
|
case USB_REQ_GET_STATUS:
|
|
response_data[0]= 0;
|
|
response_data[1]= 0;
|
|
usb_drv_recv(EP_CONTROL,NULL,0);
|
|
usb_drv_send(EP_CONTROL, response_data, 2);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void request_handler_interface_standard(struct usb_ctrlrequest* req)
|
|
{
|
|
switch (req->bRequest)
|
|
{
|
|
case USB_REQ_SET_INTERFACE:
|
|
logf("usb_core: SET_INTERFACE");
|
|
usb_drv_send(EP_CONTROL,NULL,0);
|
|
break;
|
|
|
|
case USB_REQ_GET_INTERFACE:
|
|
logf("usb_core: GET_INTERFACE");
|
|
response_data[0]=0;
|
|
usb_drv_recv(EP_CONTROL,NULL,0);
|
|
usb_drv_send(EP_CONTROL,response_data,1);
|
|
break;
|
|
case USB_REQ_CLEAR_FEATURE:
|
|
break;
|
|
case USB_REQ_SET_FEATURE:
|
|
break;
|
|
case USB_REQ_GET_STATUS:
|
|
response_data[0]=0;
|
|
response_data[1]=0;
|
|
usb_drv_recv(EP_CONTROL,NULL,0);
|
|
usb_drv_send(EP_CONTROL, response_data, 2);
|
|
break;
|
|
default:
|
|
control_request_handler_drivers(req);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void request_handler_interface(struct usb_ctrlrequest* req)
|
|
{
|
|
switch(req->bRequestType & USB_TYPE_MASK) {
|
|
case USB_TYPE_STANDARD:
|
|
request_handler_interface_standard(req);
|
|
break;
|
|
case USB_TYPE_CLASS:
|
|
control_request_handler_drivers(req);
|
|
break;
|
|
case USB_TYPE_VENDOR:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void request_handler_endpoint(struct usb_ctrlrequest* req)
|
|
{
|
|
switch (req->bRequest) {
|
|
case USB_REQ_CLEAR_FEATURE:
|
|
if (req->wValue==USB_ENDPOINT_HALT) {
|
|
usb_drv_stall(EP_NUM(req->wIndex), false, EP_DIR(req->wIndex));
|
|
}
|
|
usb_drv_send(EP_CONTROL,NULL,0);
|
|
break;
|
|
case USB_REQ_SET_FEATURE:
|
|
if (req->wValue==USB_ENDPOINT_HALT) {
|
|
usb_drv_stall(EP_NUM(req->wIndex), true, EP_DIR(req->wIndex));
|
|
}
|
|
usb_drv_send(EP_CONTROL,NULL,0);
|
|
break;
|
|
case USB_REQ_GET_STATUS:
|
|
response_data[0]=0;
|
|
response_data[1]=0;
|
|
logf("usb_core: GET_STATUS");
|
|
if(req->wIndex>0) {
|
|
response_data[0]=usb_drv_stalled(EP_NUM(req->wIndex),
|
|
EP_DIR(req->wIndex));
|
|
}
|
|
usb_drv_recv(EP_CONTROL,NULL,0);
|
|
usb_drv_send(EP_CONTROL,response_data,2);
|
|
break;
|
|
default: {
|
|
bool handled;
|
|
control_handler_t control_handler;
|
|
|
|
control_handler=
|
|
ep_data[EP_NUM(req->wIndex)].control_handler[EP_CONTROL];
|
|
if (!control_handler)
|
|
break;
|
|
|
|
handled=control_handler(req, response_data);
|
|
if (!handled) {
|
|
/* nope. flag error */
|
|
logf("usb bad req %d",req->bRequest);
|
|
usb_drv_stall(EP_CONTROL,true,true);
|
|
usb_core_ack_control(req);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Handling USB requests starts here */
|
|
static void usb_core_control_request_handler(struct usb_ctrlrequest* req)
|
|
{
|
|
if (usb_state==DEFAULT) {
|
|
set_serial_descriptor();
|
|
usb_core_set_serial_function_id();
|
|
|
|
allocate_interfaces_and_endpoints();
|
|
}
|
|
|
|
switch(req->bRequestType & USB_RECIP_MASK) {
|
|
case USB_RECIP_DEVICE:
|
|
request_handler_device(req);
|
|
break;
|
|
case USB_RECIP_INTERFACE:
|
|
request_handler_interface(req);
|
|
break;
|
|
case USB_RECIP_ENDPOINT:
|
|
request_handler_endpoint(req);
|
|
break;
|
|
case USB_RECIP_OTHER:
|
|
logf("unsupported recipient");
|
|
break;
|
|
}
|
|
//logf("control handled");
|
|
}
|
|
|
|
/* called by usb_drv_int() */
|
|
void usb_core_bus_reset(void)
|
|
{
|
|
usb_address=0;
|
|
usb_state=DEFAULT;
|
|
}
|
|
|
|
/* called by usb_drv_transfer_completed() */
|
|
void usb_core_transfer_complete(int endpoint,int dir,int status,int length)
|
|
{
|
|
struct usb_transfer_completion_event_data *completion_event;
|
|
|
|
switch (endpoint) {
|
|
case EP_CONTROL:
|
|
/* already handled */
|
|
break;
|
|
|
|
default:
|
|
completion_event=&ep_data[endpoint].completion_event;
|
|
|
|
completion_event->endpoint=endpoint;
|
|
completion_event->dir=dir;
|
|
completion_event->data=0;
|
|
completion_event->status=status;
|
|
completion_event->length=length;
|
|
/* All other endoints. Let the thread deal with it */
|
|
usb_signal_transfer_completion(completion_event);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* called by usb_drv_int() */
|
|
void usb_core_control_request(struct usb_ctrlrequest* req)
|
|
{
|
|
struct usb_transfer_completion_event_data* completion_event =
|
|
&ep_data[EP_CONTROL].completion_event;
|
|
|
|
completion_event->endpoint=EP_CONTROL;
|
|
completion_event->dir=0;
|
|
completion_event->data=(void*)req;
|
|
completion_event->status=0;
|
|
completion_event->length=0;
|
|
logf("ctrl received %ld",current_tick);
|
|
usb_signal_transfer_completion(completion_event);
|
|
}
|
|
|
|
#ifdef HAVE_USB_POWER
|
|
unsigned short usb_allowed_current()
|
|
{
|
|
return (usb_state==CONFIGURED) ? MAX(USB_MAX_CURRENT, 100) : 100;
|
|
}
|
|
#endif
|