Merge pull request #981 from enkiller/modify_usb_stack_
[usb]update usb stack
This commit is contained in:
commit
d3e72e7498
|
@ -358,6 +358,9 @@ struct usb_qualifier_descriptor
|
|||
rt_uint8_t bRESERVED;
|
||||
} __attribute__ ((packed));
|
||||
|
||||
#ifndef HID_SUB_DESCRIPTOR_MAX
|
||||
#define HID_SUB_DESCRIPTOR_MAX 1
|
||||
#endif
|
||||
struct uhid_descriptor
|
||||
{
|
||||
rt_uint8_t bLength;
|
||||
|
@ -369,22 +372,24 @@ struct uhid_descriptor
|
|||
{
|
||||
rt_uint8_t type;
|
||||
rt_uint16_t wLength;
|
||||
}Descriptor[1];
|
||||
}Descriptor[HID_SUB_DESCRIPTOR_MAX];
|
||||
};
|
||||
typedef struct uhid_descriptor* uhid_desc_t;
|
||||
|
||||
struct urequest
|
||||
{
|
||||
rt_uint8_t request_type;
|
||||
rt_uint8_t request;
|
||||
rt_uint16_t value;
|
||||
rt_uint16_t index;
|
||||
rt_uint16_t length;
|
||||
rt_uint8_t bRequest;
|
||||
rt_uint16_t wValue;
|
||||
rt_uint16_t wIndex;
|
||||
rt_uint16_t wLength;
|
||||
};
|
||||
typedef struct urequest* ureq_t;
|
||||
|
||||
#ifndef MIN
|
||||
#define MIN(a, b) (a < b ? a : b)
|
||||
#endif
|
||||
#ifndef MAX
|
||||
#define MAX(a, b) (a > b ? a : b)
|
||||
#endif
|
||||
|
||||
|
|
|
@ -28,7 +28,7 @@
|
|||
#define __USB_DEVICE_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
#include "usb_common.h"
|
||||
#include "drivers/usb_common.h"
|
||||
|
||||
/* Vendor ID */
|
||||
#ifdef USB_VENDOR_ID
|
||||
|
@ -76,7 +76,7 @@ typedef enum
|
|||
/* request to read full count */
|
||||
UIO_REQUEST_READ_FULL,
|
||||
/* request to read any count */
|
||||
UIO_REQUEST_READ_MOST,
|
||||
UIO_REQUEST_READ_BEST,
|
||||
/* request to write full count */
|
||||
UIO_REQUEST_WRITE,
|
||||
}UIO_REQUEST_TYPE;
|
||||
|
@ -102,7 +102,7 @@ struct ep_id
|
|||
rt_uint8_t addr;
|
||||
rt_uint8_t type;
|
||||
rt_uint8_t dir;
|
||||
rt_uint8_t maxpacket;
|
||||
rt_uint16_t maxpacket;
|
||||
rt_uint8_t status;
|
||||
};
|
||||
|
||||
|
@ -295,7 +295,7 @@ rt_err_t rt_usbd_ep0_clear_stall(udevice_t device);
|
|||
rt_err_t rt_usbd_ep0_setup_handler(udcd_t dcd, struct urequest* setup);
|
||||
rt_err_t rt_usbd_ep0_in_handler(udcd_t dcd);
|
||||
rt_err_t rt_usbd_ep0_out_handler(udcd_t dcd, rt_size_t size);
|
||||
rt_err_t rt_usbd_ep_in_handler(udcd_t dcd, rt_uint8_t address);
|
||||
rt_err_t rt_usbd_ep_in_handler(udcd_t dcd, rt_uint8_t address, rt_size_t size);
|
||||
rt_err_t rt_usbd_ep_out_handler(udcd_t dcd, rt_uint8_t address, rt_size_t size);
|
||||
rt_err_t rt_usbd_reset_handler(udcd_t dcd);
|
||||
rt_err_t rt_usbd_connect_handler(udcd_t dcd);
|
||||
|
|
|
@ -10,5 +10,4 @@ for d in list:
|
|||
path = os.path.join(cwd, d)
|
||||
if os.path.isfile(os.path.join(path, 'SConscript')):
|
||||
objs = objs + SConscript(os.path.join(d, 'SConscript'))
|
||||
|
||||
Return('objs')
|
||||
|
|
|
@ -10,11 +10,14 @@ core/usbdevice.c
|
|||
if GetDepend('RT_USB_DEVICE_CDC'):
|
||||
src += Glob('class/cdc_vcom.c')
|
||||
|
||||
if GetDepend('RT_USB_DEVICE_HID'):
|
||||
src += Glob('class/hid.c')
|
||||
|
||||
if GetDepend('RT_USB_DEVICE_MSTORAGE'):
|
||||
src += Glob('class/mstorage.c')
|
||||
|
||||
CPPPATH = [cwd]
|
||||
|
||||
group = DefineGroup('DeviceDrivers', src, depend = ['RT_USING_USB_DEVICE'], CPPPATH = CPPPATH)
|
||||
group = DefineGroup('rt_usbd', src, depend = ['RT_USING_USB_DEVICE'], CPPPATH = CPPPATH)
|
||||
|
||||
Return('group')
|
||||
|
|
|
@ -23,23 +23,30 @@
|
|||
* 2012-12-12 heyuanjie87 change endpoints and function handler
|
||||
* 2013-06-25 heyuanjie87 remove SOF mechinism
|
||||
* 2013-07-20 Yi Qiu do more test
|
||||
* 2016-02-01 Urey Fix some error
|
||||
*/
|
||||
|
||||
#include <rthw.h>
|
||||
#include <rtthread.h>
|
||||
#include <rtservice.h>
|
||||
#include <rtdevice.h>
|
||||
#include <rthw.h>
|
||||
#include <drivers/serial.h>
|
||||
#include "drivers/usb_device.h"
|
||||
#include "cdc.h"
|
||||
|
||||
#ifdef RT_USB_DEVICE_CDC
|
||||
|
||||
#define TX_TIMEOUT 100
|
||||
#define TX_TIMEOUT 1000
|
||||
#define CDC_RX_BUFSIZE 2048
|
||||
#define CDC_MAX_PACKET_SIZE 64
|
||||
#define VCOM_DEVICE "vcom"
|
||||
|
||||
#define VCOM_TASK_STK_SIZE 2048
|
||||
|
||||
//#define VCOM_TX_USE_DMA
|
||||
|
||||
ALIGN(RT_ALIGN_SIZE)
|
||||
static rt_uint8_t vcom_thread_stack[512];
|
||||
static rt_uint8_t vcom_thread_stack[VCOM_TASK_STK_SIZE];
|
||||
static struct rt_thread vcom_thread;
|
||||
#define VCOM_MQ_MSG_SZ 16
|
||||
#define VCOM_MQ_MAX_MSG 4
|
||||
|
@ -61,7 +68,6 @@ struct vcom
|
|||
struct rt_completion wait;
|
||||
rt_uint8_t rx_rbp[CDC_RX_BUFSIZE];
|
||||
struct rt_ringbuffer rx_ringbuffer;
|
||||
struct serial_ringbuffer vcom_int_rx;
|
||||
};
|
||||
|
||||
struct vcom_tx_msg
|
||||
|
@ -227,7 +233,7 @@ static rt_err_t _ep_in_handler(ufunction_t func, rt_size_t size)
|
|||
RT_ASSERT(func != RT_NULL);
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_ep_in_handler %d\n", size));
|
||||
|
||||
rt_kprintf("%s size = %d\n",__func__,size);
|
||||
data = (struct vcom*)func->user_data;
|
||||
if ((size != 0) && (size % CDC_MAX_PACKET_SIZE == 0))
|
||||
{
|
||||
|
@ -276,11 +282,11 @@ static rt_err_t _ep_out_handler(ufunction_t func, rt_size_t size)
|
|||
rt_hw_interrupt_enable(level);
|
||||
|
||||
/* notify receive data */
|
||||
rt_hw_serial_isr(&data->serial);
|
||||
rt_hw_serial_isr(&data->serial,RT_SERIAL_EVENT_RX_IND);
|
||||
|
||||
data->ep_out->request.buffer = data->ep_out->buffer;
|
||||
data->ep_out->request.size = EP_MAXPACKET(data->ep_out);
|
||||
data->ep_out->request.req_type = UIO_REQUEST_READ_MOST;
|
||||
data->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
|
||||
rt_usbd_io_request(func->device, data->ep_out, &data->ep_out->request);
|
||||
|
||||
return RT_EOK;
|
||||
|
@ -325,7 +331,7 @@ static rt_err_t _cdc_get_line_coding(udevice_t device, ureq_t setup)
|
|||
data.bCharFormat = 0;
|
||||
data.bDataBits = 8;
|
||||
data.bParityType = 0;
|
||||
size = setup->length > 7 ? 7 : setup->length;
|
||||
size = setup->wLength > 7 ? 7 : setup->wLength;
|
||||
|
||||
rt_usbd_ep0_write(device, (void*)&data, size);
|
||||
|
||||
|
@ -380,7 +386,7 @@ static rt_err_t _interface_handler(ufunction_t func, ureq_t setup)
|
|||
|
||||
data = (struct vcom*)func->user_data;
|
||||
|
||||
switch(setup->request)
|
||||
switch(setup->bRequest)
|
||||
{
|
||||
case CDC_SEND_ENCAPSULATED_COMMAND:
|
||||
break;
|
||||
|
@ -435,7 +441,7 @@ static rt_err_t _function_enable(ufunction_t func)
|
|||
data->ep_out->request.buffer = data->ep_out->buffer;
|
||||
data->ep_out->request.size = EP_MAXPACKET(data->ep_out);
|
||||
|
||||
data->ep_out->request.req_type = UIO_REQUEST_READ_MOST;
|
||||
data->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
|
||||
rt_usbd_io_request(func->device, data->ep_out, &data->ep_out->request);
|
||||
|
||||
return RT_EOK;
|
||||
|
@ -630,20 +636,21 @@ static int _vcom_getc(struct rt_serial_device *serial)
|
|||
return result;
|
||||
}
|
||||
|
||||
static rt_size_t _vcom_tx(struct rt_serial_device *serial,
|
||||
const char *buf, rt_size_t size)
|
||||
#ifdef VCOM_TX_USE_DMA
|
||||
static rt_size_t _vcom_tx(struct rt_serial_device *serial, const char *buf, rt_size_t size,int direction)
|
||||
{
|
||||
struct vcom_tx_msg msg;
|
||||
static struct vcom_tx_msg msg;
|
||||
|
||||
RT_ASSERT(serial != RT_NULL);
|
||||
RT_ASSERT(buf != RT_NULL);
|
||||
|
||||
rt_kprintf("%s\n",__func__);
|
||||
|
||||
msg.buf = buf;
|
||||
msg.serial = serial;
|
||||
msg.size = size;
|
||||
|
||||
if (rt_mq_send(&vcom_tx_thread_mq, (void*)&msg,
|
||||
sizeof(struct vcom_tx_msg)) != RT_EOK)
|
||||
if (rt_mq_send(&vcom_tx_thread_mq, (void*)&msg, sizeof(struct vcom_tx_msg)) != RT_EOK)
|
||||
{
|
||||
rt_kprintf("vcom send msg fail\n");
|
||||
return 0;
|
||||
|
@ -651,48 +658,89 @@ static rt_size_t _vcom_tx(struct rt_serial_device *serial,
|
|||
|
||||
return size;
|
||||
}
|
||||
#else
|
||||
static int _vcom_putc(struct rt_serial_device *serial, char c)
|
||||
{
|
||||
static struct vcom_tx_msg msg;
|
||||
|
||||
RT_ASSERT(serial != RT_NULL);
|
||||
|
||||
msg.buf = (void *)((rt_uint32_t)c);
|
||||
msg.serial = serial;
|
||||
msg.size = 1;
|
||||
if (rt_mq_send(&vcom_tx_thread_mq, (void*)&msg, sizeof(struct vcom_tx_msg)) != RT_EOK)
|
||||
{
|
||||
// rt_kprintf("vcom send msg fail\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 1;
|
||||
}
|
||||
#endif
|
||||
|
||||
static const struct rt_uart_ops usb_vcom_ops =
|
||||
{
|
||||
_vcom_configure,
|
||||
_vcom_control,
|
||||
#ifndef VCOM_TX_USE_DMA
|
||||
_vcom_putc,
|
||||
_vcom_getc,
|
||||
RT_NULL
|
||||
#else
|
||||
RT_NULL,
|
||||
_vcom_getc,
|
||||
RT_NULL,
|
||||
//_vcom_tx,
|
||||
_vcom_tx
|
||||
#endif
|
||||
|
||||
};
|
||||
|
||||
/* Vcom Tx Thread */
|
||||
static void vcom_tx_thread_entry(void* parameter)
|
||||
{
|
||||
struct vcom_tx_msg msg;
|
||||
|
||||
rt_uint8_t ch;
|
||||
while (1)
|
||||
{
|
||||
if (rt_mq_recv(&vcom_tx_thread_mq, (void*)&msg,
|
||||
sizeof(struct vcom_tx_msg), RT_WAITING_FOREVER) == RT_EOK)
|
||||
if (rt_mq_recv(&vcom_tx_thread_mq, (void*)&msg, sizeof(struct vcom_tx_msg), RT_WAITING_FOREVER) == RT_EOK)
|
||||
{
|
||||
struct ufunction *func;
|
||||
struct vcom *data;
|
||||
|
||||
func = (struct ufunction*)msg.serial->parent.user_data;
|
||||
data = (struct vcom*)func->user_data;
|
||||
|
||||
if (!data->connected)
|
||||
{
|
||||
/* drop msg */
|
||||
#ifndef VCOM_TX_USE_DMA
|
||||
rt_hw_serial_isr(&data->serial,RT_SERIAL_EVENT_TX_DONE);
|
||||
#else
|
||||
rt_hw_serial_isr(&data->serial,RT_SERIAL_EVENT_TX_DMADONE);
|
||||
#endif
|
||||
continue;
|
||||
}
|
||||
|
||||
rt_completion_init(&data->wait);
|
||||
|
||||
data->ep_in->request.buffer = (void*)msg.buf;
|
||||
#ifndef VCOM_TX_USE_DMA
|
||||
ch = (rt_uint8_t)((rt_uint32_t)msg.buf);
|
||||
data->ep_in->request.buffer = (rt_uint8_t*)&ch;
|
||||
#else
|
||||
data->ep_in->request.buffer = (rt_uint8_t*)msg.buf;
|
||||
#endif
|
||||
data->ep_in->request.size = msg.size;
|
||||
data->ep_in->request.req_type = UIO_REQUEST_WRITE;
|
||||
|
||||
rt_usbd_io_request(func->device, data->ep_in, &data->ep_in->request);
|
||||
|
||||
if (rt_completion_wait(&data->wait, TX_TIMEOUT) != RT_EOK)
|
||||
{
|
||||
rt_kprintf("vcom tx timeout\n");
|
||||
}
|
||||
#ifndef VCOM_TX_USE_DMA
|
||||
rt_hw_serial_isr(&data->serial,RT_SERIAL_EVENT_TX_DONE);
|
||||
#else
|
||||
rt_hw_serial_isr(&data->serial,RT_SERIAL_EVENT_TX_DMADONE);
|
||||
#endif
|
||||
}
|
||||
}
|
||||
}
|
||||
|
@ -707,28 +755,40 @@ static void rt_usb_vcom_init(struct ufunction *func)
|
|||
rt_ringbuffer_init(&data->rx_ringbuffer, data->rx_rbp, CDC_RX_BUFSIZE);
|
||||
|
||||
config.baud_rate = BAUD_RATE_115200;
|
||||
config.bit_order = BIT_ORDER_LSB;
|
||||
config.data_bits = DATA_BITS_8;
|
||||
config.parity = PARITY_NONE;
|
||||
config.stop_bits = STOP_BITS_1;
|
||||
config.parity = PARITY_NONE;
|
||||
config.bit_order = BIT_ORDER_LSB;
|
||||
config.invert = NRZ_NORMAL;
|
||||
config.bufsz = CDC_RX_BUFSIZE;
|
||||
|
||||
data->serial.ops = &usb_vcom_ops;
|
||||
data->serial.int_rx = &data->vcom_int_rx;
|
||||
data->serial.serial_rx = RT_NULL;
|
||||
data->serial.config = config;
|
||||
|
||||
/* register vcom device */
|
||||
rt_hw_serial_register(&data->serial, VCOM_DEVICE,
|
||||
#ifndef VCOM_TX_USE_DMA
|
||||
RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_INT_TX,
|
||||
#else
|
||||
RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_DMA_TX,
|
||||
#endif
|
||||
func);
|
||||
|
||||
/* create an vcom message queue */
|
||||
rt_mq_init(&vcom_tx_thread_mq, "vcomq", vcom_tx_thread_mq_pool, VCOM_MQ_MSG_SZ,
|
||||
sizeof(vcom_tx_thread_mq_pool), RT_IPC_FLAG_FIFO);
|
||||
rt_mq_init(&vcom_tx_thread_mq,
|
||||
"vcomq",
|
||||
vcom_tx_thread_mq_pool,
|
||||
VCOM_MQ_MSG_SZ,
|
||||
sizeof(vcom_tx_thread_mq_pool),
|
||||
RT_IPC_FLAG_FIFO);
|
||||
|
||||
|
||||
/* init usb device thread */
|
||||
rt_thread_init(&vcom_thread, "vcom", vcom_tx_thread_entry, RT_NULL,
|
||||
vcom_thread_stack, 512, 8, 20);
|
||||
rt_thread_init(&vcom_thread, "vcom",
|
||||
vcom_tx_thread_entry, RT_NULL,
|
||||
vcom_thread_stack, VCOM_TASK_STK_SIZE,
|
||||
8, 20);
|
||||
result = rt_thread_startup(&vcom_thread);
|
||||
RT_ASSERT(result == RT_EOK);
|
||||
}
|
||||
|
|
|
@ -0,0 +1,552 @@
|
|||
/*
|
||||
* File : hid.c
|
||||
* COPYRIGHT (C) 2008 - 2016, RT-Thread Development Team
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2017Äê3ÔÂ13ÈÕ Urey the first version
|
||||
*/
|
||||
|
||||
#include <rthw.h>
|
||||
#include <rtthread.h>
|
||||
#include <rtservice.h>
|
||||
#include <rtdevice.h>
|
||||
|
||||
#include "drivers/usb_common.h"
|
||||
#include "drivers/usb_device.h"
|
||||
|
||||
#include "hid.h"
|
||||
|
||||
#ifdef RT_USB_DEVICE_HID
|
||||
|
||||
struct hid_s
|
||||
{
|
||||
uep_t ep_in;
|
||||
uep_t ep_out;
|
||||
int status;
|
||||
|
||||
rt_uint16_t protocol;
|
||||
|
||||
rt_uint8_t report_buf[MAX_REPORT_SIZE];
|
||||
};
|
||||
|
||||
/* CustomHID_ConfigDescriptor */
|
||||
const rt_uint8_t _report_desc[] __attribute__ ((packed))=
|
||||
{
|
||||
0x06, 0xFF, 0x00, /* USAGE_PAGE (Vendor Page: 0xFF00) */
|
||||
0x09, 0x01, /* USAGE (Demo Kit) */
|
||||
0xa1, 0x01, /* COLLECTION (Application) */
|
||||
/* 6 */
|
||||
|
||||
/* Led 1 */
|
||||
0x85, 0x01, /* REPORT_ID (1) */
|
||||
0x09, 0x01, /* USAGE (LED 1) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
|
||||
0x75, 0x08, /* REPORT_SIZE (8) */
|
||||
0x95, 0x01, /* REPORT_COUNT (1) */
|
||||
0xB1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
|
||||
0x85, 0x01, /* REPORT_ID (1) */
|
||||
0x09, 0x01, /* USAGE (LED 1) */
|
||||
0x91, 0x82, /* OUTPUT (Data,Var,Abs,Vol) */
|
||||
/* 26 */
|
||||
|
||||
/* Led 2 */
|
||||
0x85, 0x02, /* REPORT_ID 2 */
|
||||
0x09, 0x02, /* USAGE (LED 2) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
|
||||
0x75, 0x08, /* REPORT_SIZE (8) */
|
||||
0x95, 0x01, /* REPORT_COUNT (1) */
|
||||
0xB1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
|
||||
0x85, 0x02, /* REPORT_ID (2) */
|
||||
0x09, 0x02, /* USAGE (LED 2) */
|
||||
0x91, 0x82, /* OUTPUT (Data,Var,Abs,Vol) */
|
||||
/* 46 */
|
||||
|
||||
/* Led 3 */
|
||||
0x85, 0x03, /* REPORT_ID (3) */
|
||||
0x09, 0x03, /* USAGE (LED 3) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
|
||||
0x75, 0x08, /* REPORT_SIZE (8) */
|
||||
0x95, 0x01, /* REPORT_COUNT (1) */
|
||||
0xB1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
|
||||
0x85, 0x03, /* REPORT_ID (3) */
|
||||
0x09, 0x03, /* USAGE (LED 3) */
|
||||
0x91, 0x82, /* OUTPUT (Data,Var,Abs,Vol) */
|
||||
/* 66 */
|
||||
|
||||
/* Led 4 */
|
||||
0x85, 0x04, /* REPORT_ID 4) */
|
||||
0x09, 0x04, /* USAGE (LED 4) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
|
||||
0x75, 0x08, /* REPORT_SIZE (8) */
|
||||
0x95, 0x01, /* REPORT_COUNT (1) */
|
||||
0xB1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
|
||||
0x85, 0x04, /* REPORT_ID (4) */
|
||||
0x09, 0x04, /* USAGE (LED 4) */
|
||||
0x91, 0x82, /* OUTPUT (Data,Var,Abs,Vol) */
|
||||
/* 86 */
|
||||
|
||||
/* key Push Button */
|
||||
0x85, 0x05, /* REPORT_ID (5) */
|
||||
0x09, 0x05, /* USAGE (Push Button) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
|
||||
0x75, 0x01, /* REPORT_SIZE (1) */
|
||||
0x81, 0x82, /* INPUT (Data,Var,Abs,Vol) */
|
||||
|
||||
0x09, 0x05, /* USAGE (Push Button) */
|
||||
0x75, 0x01, /* REPORT_SIZE (1) */
|
||||
0xb1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
|
||||
0x75, 0x07, /* REPORT_SIZE (7) */
|
||||
0x81, 0x83, /* INPUT (Cnst,Var,Abs,Vol) */
|
||||
0x85, 0x05, /* REPORT_ID (2) */
|
||||
|
||||
0x75, 0x07, /* REPORT_SIZE (7) */
|
||||
0xb1, 0x83, /* FEATURE (Cnst,Var,Abs,Vol) */
|
||||
/* 114 */
|
||||
|
||||
/* Tamper Push Button */
|
||||
0x85, 0x06, /* REPORT_ID (6) */
|
||||
0x09, 0x06, /* USAGE (Tamper Push Button) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
|
||||
0x75, 0x01, /* REPORT_SIZE (1) */
|
||||
0x81, 0x82, /* INPUT (Data,Var,Abs,Vol) */
|
||||
|
||||
0x09, 0x06, /* USAGE (Tamper Push Button) */
|
||||
0x75, 0x01, /* REPORT_SIZE (1) */
|
||||
0xb1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
|
||||
0x75, 0x07, /* REPORT_SIZE (7) */
|
||||
0x81, 0x83, /* INPUT (Cnst,Var,Abs,Vol) */
|
||||
0x85, 0x06, /* REPORT_ID (6) */
|
||||
|
||||
0x75, 0x07, /* REPORT_SIZE (7) */
|
||||
0xb1, 0x83, /* FEATURE (Cnst,Var,Abs,Vol) */
|
||||
/* 142 */
|
||||
|
||||
/* ADC IN */
|
||||
0x85, 0x07, /* REPORT_ID (7) */
|
||||
0x09, 0x07, /* USAGE (ADC IN) */
|
||||
0x15, 0x00, /* LOGICAL_MINIMUM (0) */
|
||||
0x26, 0xff, 0x00, /* LOGICAL_MAXIMUM (255) */
|
||||
0x75, 0x08, /* REPORT_SIZE (8) */
|
||||
0x81, 0x82, /* INPUT (Data,Var,Abs,Vol) */
|
||||
0x85, 0x07, /* REPORT_ID (7) */
|
||||
0x09, 0x07, /* USAGE (ADC in) */
|
||||
0xb1, 0x82, /* FEATURE (Data,Var,Abs,Vol) */
|
||||
/* 161 */
|
||||
|
||||
0xc0 /* END_COLLECTION */
|
||||
}; /* CustomHID_ReportDescriptor */
|
||||
|
||||
static struct udevice_descriptor _dev_desc =
|
||||
{
|
||||
USB_DESC_LENGTH_DEVICE, //bLength;
|
||||
USB_DESC_TYPE_DEVICE, //type;
|
||||
USB_BCD_VERSION, //bcdUSB;
|
||||
USB_CLASS_HID, //bDeviceClass;
|
||||
0x00, //bDeviceSubClass;
|
||||
0x00, //bDeviceProtocol;
|
||||
64, //bMaxPacketSize0;
|
||||
_VENDOR_ID, //idVendor;
|
||||
_PRODUCT_ID, //idProduct;
|
||||
USB_BCD_DEVICE, //bcdDevice;
|
||||
USB_STRING_MANU_INDEX, //iManufacturer;
|
||||
USB_STRING_PRODUCT_INDEX, //iProduct;
|
||||
USB_STRING_SERIAL_INDEX, //iSerialNumber;
|
||||
USB_DYNAMIC, //bNumConfigurations;
|
||||
};
|
||||
|
||||
static struct usb_qualifier_descriptor _dev_qualifier =
|
||||
{
|
||||
sizeof(_dev_qualifier),
|
||||
USB_DESC_TYPE_DEVICEQUALIFIER,
|
||||
0x0200,
|
||||
USB_CLASS_HID,
|
||||
0x00,
|
||||
64,
|
||||
0x01,
|
||||
0,
|
||||
};
|
||||
|
||||
/* hid interface descriptor */
|
||||
const static struct uhid_comm_descriptor _hid_comm_desc =
|
||||
{
|
||||
#ifdef RT_USB_DEVICE_COMPOSITE
|
||||
/* Interface Association Descriptor */
|
||||
USB_DESC_LENGTH_IAD,
|
||||
USB_DESC_TYPE_IAD,
|
||||
USB_DYNAMIC,
|
||||
0x02,
|
||||
0x03, /* bInterfaceClass: HID */
|
||||
USB_HID_SUBCLASS_NOBOOT, /* bInterfaceSubClass : 1=BOOT, 0=no boot */
|
||||
USB_HID_PROTOCOL_NONE, /* nInterfaceProtocol : 0=none, 1=keyboard, 2=mouse */
|
||||
0x00,
|
||||
#endif
|
||||
|
||||
/* Interface Descriptor */
|
||||
USB_DESC_LENGTH_INTERFACE,
|
||||
USB_DESC_TYPE_INTERFACE,
|
||||
USB_DYNAMIC, /* bInterfaceNumber: Number of Interface */
|
||||
0x00, /* bAlternateSetting: Alternate setting */
|
||||
0x02, /* bNumEndpoints */
|
||||
0x03, /* bInterfaceClass: HID */
|
||||
USB_HID_SUBCLASS_NOBOOT, /* bInterfaceSubClass : 1=BOOT, 0=no boot */
|
||||
USB_HID_PROTOCOL_NONE, /* nInterfaceProtocol : 0=none, 1=keyboard, 2=mouse */
|
||||
0, /* iInterface: Index of string descriptor */
|
||||
|
||||
/* HID Descriptor */
|
||||
HID_DESCRIPTOR_SIZE, /* bLength: HID Descriptor size */
|
||||
HID_DESCRIPTOR_TYPE, /* bDescriptorType: HID */
|
||||
0x0110, /* bcdHID: HID Class Spec release number */
|
||||
0x00, /* bCountryCode: Hardware target country */
|
||||
0x01, /* bNumDescriptors: Number of HID class descriptors to follow */
|
||||
0x22, /* bDescriptorType */
|
||||
sizeof(_report_desc), /* wItemLength: Total length of Report descriptor */
|
||||
|
||||
/* Endpoint Descriptor IN */
|
||||
USB_DESC_LENGTH_ENDPOINT,
|
||||
USB_DESC_TYPE_ENDPOINT,
|
||||
USB_DYNAMIC | USB_DIR_IN,
|
||||
USB_EP_ATTR_INT,
|
||||
0x08,
|
||||
0x20,
|
||||
|
||||
/* Endpoint Descriptor OUT */
|
||||
USB_DESC_LENGTH_ENDPOINT,
|
||||
USB_DESC_TYPE_ENDPOINT,
|
||||
USB_DYNAMIC | USB_DIR_OUT,
|
||||
USB_EP_ATTR_INT,
|
||||
0x08,
|
||||
0x20,
|
||||
};
|
||||
|
||||
|
||||
const static char* _ustring[] =
|
||||
{
|
||||
"Language",
|
||||
"RT-Thread Team.",
|
||||
"RTT HID-Device",
|
||||
"32021919830108",
|
||||
"Configuration",
|
||||
"Interface",
|
||||
};
|
||||
|
||||
#define __is_print(ch) ((unsigned int)((ch) - ' ') < 127u - ' ')
|
||||
static void dump_hex(const rt_uint8_t *ptr, rt_size_t buflen)
|
||||
{
|
||||
unsigned char *buf = (unsigned char*)ptr;
|
||||
int i, j;
|
||||
for (i=0; i<buflen; i+=16)
|
||||
{
|
||||
rt_kprintf("%06x: ", i);
|
||||
for (j=0; j<16; j++)
|
||||
if (i+j < buflen)
|
||||
rt_kprintf("%02x ", buf[i+j]);
|
||||
else
|
||||
rt_kprintf(" ");
|
||||
rt_kprintf(" ");
|
||||
for (j=0; j<16; j++)
|
||||
if (i+j < buflen)
|
||||
rt_kprintf("%c", __is_print(buf[i+j]) ? buf[i+j] : '.');
|
||||
rt_kprintf("\n");
|
||||
}
|
||||
}
|
||||
|
||||
static rt_err_t _ep_out_handler(ufunction_t func, rt_size_t size)
|
||||
{
|
||||
struct hid_s *data;
|
||||
RT_ASSERT(func != RT_NULL);
|
||||
RT_ASSERT(func->device != RT_NULL);
|
||||
|
||||
rt_kprintf("%s size = %d\n",__func__,size);
|
||||
data = (struct hid_s *) func->user_data;
|
||||
|
||||
if(size != 0)
|
||||
{
|
||||
dump_hex(data->ep_out->buffer,size);
|
||||
}
|
||||
|
||||
data->ep_out->request.buffer = data->ep_out->buffer;
|
||||
data->ep_out->request.size = EP_MAXPACKET(data->ep_out);
|
||||
data->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
|
||||
rt_usbd_io_request(func->device, data->ep_out, &data->ep_out->request);
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t _ep_in_handler(ufunction_t func, rt_size_t size)
|
||||
{
|
||||
struct hid_s *data;
|
||||
RT_ASSERT(func != RT_NULL);
|
||||
RT_ASSERT(func->device != RT_NULL);
|
||||
|
||||
data = (struct hid_s *) func->user_data;
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t _hid_set_report_callback(udevice_t device, rt_size_t size)
|
||||
{
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_hid_set_report_callback\n"));
|
||||
|
||||
if(size != 0)
|
||||
{
|
||||
rt_kprintf("HID set report callback:\n");
|
||||
dump_hex(device->dcd->ep0.request.buffer - size,size);
|
||||
}
|
||||
|
||||
dcd_ep0_send_status(device->dcd);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will handle hid interface bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
static rt_err_t _interface_handler(ufunction_t func, ureq_t setup)
|
||||
{
|
||||
RT_ASSERT(func != RT_NULL);
|
||||
RT_ASSERT(func->device != RT_NULL);
|
||||
RT_ASSERT(setup != RT_NULL);
|
||||
|
||||
struct hid_s *data = (struct hid_s *) func->user_data;
|
||||
|
||||
if(setup->wIndex != 0)
|
||||
return -RT_EIO;
|
||||
|
||||
switch (setup->bRequest)
|
||||
{
|
||||
case USB_REQ_GET_DESCRIPTOR:
|
||||
if((setup->wValue >> 8) == USB_DESC_TYPE_REPORT)
|
||||
{
|
||||
rt_kprintf("HID get report descriptor\n");
|
||||
rt_kprintf("sizeof _report_desc = %d bytes\n",sizeof(_report_desc));
|
||||
rt_usbd_ep0_write(func->device, (void *)(&_report_desc[0]), sizeof(_report_desc));
|
||||
}
|
||||
else if((setup->wValue >> 8) == USB_DESC_TYPE_HID)
|
||||
{
|
||||
rt_kprintf("HID get hid descriptor\n");
|
||||
|
||||
rt_usbd_ep0_write(func->device, (void *)(&_hid_comm_desc.hid_desc), sizeof(struct uhid_descriptor));
|
||||
}
|
||||
break;
|
||||
case USB_HID_REQ_GET_REPORT:
|
||||
rt_kprintf("HID get report \n");
|
||||
rt_kprintf("wLength = %d\n",setup->wLength);
|
||||
if(setup->wLength == 0)
|
||||
{
|
||||
rt_usbd_ep0_set_stall(func->device);
|
||||
break;
|
||||
}
|
||||
if((setup->wLength == 0) || (setup->wLength > MAX_REPORT_SIZE))
|
||||
setup->wLength = MAX_REPORT_SIZE;
|
||||
rt_usbd_ep0_write(func->device, data->report_buf,setup->wLength);
|
||||
break;
|
||||
case USB_HID_REQ_GET_IDLE:
|
||||
rt_kprintf("HID get idle \n");
|
||||
|
||||
dcd_ep0_send_status(func->device->dcd);
|
||||
break;
|
||||
case USB_HID_REQ_GET_PROTOCOL:
|
||||
rt_kprintf("HID get protocol \n");
|
||||
rt_usbd_ep0_write(func->device, &data->protocol,2);
|
||||
break;
|
||||
case USB_HID_REQ_SET_REPORT:
|
||||
rt_kprintf("HID set report \n");
|
||||
rt_kprintf("set report size = %d\n",setup->wLength);
|
||||
|
||||
if((setup->wLength == 0) || (setup->wLength > MAX_REPORT_SIZE))
|
||||
rt_usbd_ep0_set_stall(func->device);
|
||||
|
||||
rt_usbd_ep0_read(func->device, data->report_buf, setup->wLength, _hid_set_report_callback);
|
||||
break;
|
||||
case USB_HID_REQ_SET_IDLE:
|
||||
{
|
||||
int duration = (setup->wValue >> 8);
|
||||
int report_id = (setup->wValue & 0xFF);
|
||||
rt_kprintf("HID set idle \n");
|
||||
rt_kprintf("duration = %d,report_id = %d\n",duration,report_id);
|
||||
|
||||
dcd_ep0_send_status(func->device->dcd);
|
||||
}
|
||||
break;
|
||||
case USB_HID_REQ_SET_PROTOCOL:
|
||||
rt_kprintf("HID set protocol \n");
|
||||
data->protocol = setup->wValue;
|
||||
|
||||
dcd_ep0_send_status(func->device->dcd);
|
||||
break;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* This function will run cdc function, it will be called on handle set configuration bRequest.
|
||||
*
|
||||
* @param func the usb function object.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
static rt_err_t _function_enable(ufunction_t func)
|
||||
{
|
||||
struct hid_s *data;
|
||||
|
||||
RT_ASSERT(func != RT_NULL);
|
||||
RT_ASSERT(func->device != RT_NULL);
|
||||
data = (struct hid_s *) func->user_data;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("hid function enable\n"));
|
||||
//
|
||||
// _vcom_reset_state(func);
|
||||
//
|
||||
data->ep_out->buffer = rt_malloc(HID_RX_BUFSIZE);
|
||||
data->ep_out->request.buffer = data->ep_out->buffer;
|
||||
data->ep_out->request.size = EP_MAXPACKET(data->ep_out);
|
||||
data->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
|
||||
|
||||
rt_usbd_io_request(func->device, data->ep_out, &data->ep_out->request);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will stop cdc function, it will be called on handle set configuration bRequest.
|
||||
*
|
||||
* @param func the usb function object.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
static rt_err_t _function_disable(ufunction_t func)
|
||||
{
|
||||
struct hid_s *data;
|
||||
|
||||
RT_ASSERT(func != RT_NULL);
|
||||
RT_ASSERT(func->device != RT_NULL);
|
||||
data = (struct hid_s *) func->user_data;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("hid function disable\n"));
|
||||
|
||||
if(data->ep_out->buffer != RT_NULL)
|
||||
{
|
||||
rt_free(data->ep_out->buffer);
|
||||
data->ep_out->buffer = RT_NULL;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static struct ufunction_ops ops =
|
||||
{
|
||||
_function_enable,
|
||||
_function_disable,
|
||||
RT_NULL,
|
||||
};
|
||||
|
||||
|
||||
|
||||
|
||||
/**
|
||||
* This function will configure hid descriptor.
|
||||
*
|
||||
* @param comm the communication interface number.
|
||||
* @param data the data interface number.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
static rt_err_t _hid_descriptor_config(uhid_comm_desc_t hid, rt_uint8_t cintf_nr)
|
||||
{
|
||||
#ifdef RT_USB_DEVICE_COMPOSITE
|
||||
hid->iad_desc.bFirstInterface = cintf_nr;
|
||||
#endif
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static void rt_usb_hid_init(struct ufunction *func)
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* This function will create a hid function instance.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
ufunction_t rt_usbd_function_hid_create(udevice_t device)
|
||||
{
|
||||
ufunction_t func;
|
||||
struct hid_s *data;
|
||||
|
||||
uintf_t hid_intf;
|
||||
ualtsetting_t hid_setting;
|
||||
uhid_comm_desc_t hid_desc;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(device != RT_NULL);
|
||||
|
||||
/* set usb device string description */
|
||||
rt_usbd_device_set_string(device, _ustring);
|
||||
|
||||
/* create a cdc function */
|
||||
func = rt_usbd_function_new(device, &_dev_desc, &ops);
|
||||
rt_usbd_device_set_qualifier(device, &_dev_qualifier);
|
||||
|
||||
/* allocate memory for cdc vcom data */
|
||||
data = (struct hid_s*)rt_malloc(sizeof(struct hid_s));
|
||||
rt_memset(data, 0, sizeof(struct hid_s));
|
||||
func->user_data = (void*)data;
|
||||
|
||||
/* initilize hid */
|
||||
rt_usb_hid_init(func);
|
||||
|
||||
/* create an interface object */
|
||||
hid_intf = rt_usbd_interface_new(device, _interface_handler);
|
||||
|
||||
/* create an alternate setting object */
|
||||
hid_setting = rt_usbd_altsetting_new(sizeof(struct uhid_comm_descriptor));
|
||||
|
||||
/* config desc in alternate setting */
|
||||
rt_usbd_altsetting_config_descriptor(hid_setting, &_hid_comm_desc, (rt_off_t)&((uhid_comm_desc_t)0)->intf_desc);
|
||||
|
||||
/* configure the hid interface descriptor */
|
||||
_hid_descriptor_config(hid_setting->desc, hid_intf->intf_num);
|
||||
|
||||
/* create endpoint */
|
||||
hid_desc = (uhid_comm_desc_t)hid_setting->desc;
|
||||
data->ep_out = rt_usbd_endpoint_new(&hid_desc->ep_out_desc, _ep_out_handler);
|
||||
data->ep_in = rt_usbd_endpoint_new(&hid_desc->ep_in_desc, _ep_in_handler);
|
||||
|
||||
/* add the int out and int in endpoint to the alternate setting */
|
||||
rt_usbd_altsetting_add_endpoint(hid_setting, data->ep_out);
|
||||
rt_usbd_altsetting_add_endpoint(hid_setting, data->ep_in);
|
||||
|
||||
/* add the alternate setting to the interface, then set default setting */
|
||||
rt_usbd_interface_add_altsetting(hid_intf, hid_setting);
|
||||
rt_usbd_set_altsetting(hid_intf, 0);
|
||||
|
||||
/* add the interface to the mass storage function */
|
||||
rt_usbd_function_add_interface(func, hid_intf);
|
||||
return func;
|
||||
}
|
||||
|
||||
#endif /* RT_USB_DEVICE_HID */
|
|
@ -0,0 +1,55 @@
|
|||
/*
|
||||
* File : hid.h
|
||||
* COPYRIGHT (C) 2008 - 2016, RT-Thread Development Team
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2017Äê3ÔÂ13ÈÕ Urey the first version
|
||||
*/
|
||||
#ifndef _USBDEVICE_CLASS_HID_H_
|
||||
#define _USBDEVICE_CLASS_HID_H_
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
#define HID_DESCRIPTOR_TYPE 0x21
|
||||
#define HID_DESCRIPTOR_SIZE 0x09
|
||||
#define HID_OFF_HID_DESC 0x12
|
||||
|
||||
#define USB_HID_SUBCLASS_BOOT 0x01
|
||||
#define USB_HID_SUBCLASS_NOBOOT 0x00
|
||||
|
||||
#define USB_HID_PROTOCOL_NONE 0x00
|
||||
#define USB_HID_PROTOCOL_KEYBOARD 0x01
|
||||
#define USB_HID_PROTOCOL_MOUSE 0x02
|
||||
|
||||
|
||||
#define USB_HID_REQ_GET_REPORT 0x01
|
||||
#define USB_HID_REQ_GET_IDLE 0x02
|
||||
#define USB_HID_REQ_GET_PROTOCOL 0x03
|
||||
#define USB_HID_REQ_SET_REPORT 0x09
|
||||
#define USB_HID_REQ_SET_IDLE 0x0a
|
||||
#define USB_HID_REQ_SET_PROTOCOL 0x0b
|
||||
|
||||
#define MAX_REPORT_SIZE 8
|
||||
#define HID_RX_BUFSIZE 64
|
||||
|
||||
struct uhid_comm_descriptor
|
||||
{
|
||||
#ifdef RT_USB_DEVICE_COMPOSITE
|
||||
struct uiad_descriptor iad_desc;
|
||||
#endif
|
||||
struct uinterface_descriptor intf_desc;
|
||||
struct uhid_descriptor hid_desc;
|
||||
struct uendpoint_descriptor ep_in_desc;
|
||||
struct uendpoint_descriptor ep_out_desc;
|
||||
};
|
||||
typedef struct uhid_comm_descriptor* uhid_comm_desc_t;
|
||||
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* _USBDEVICE_CLASS_HID_H_ */
|
|
@ -27,7 +27,7 @@
|
|||
|
||||
#include <rtthread.h>
|
||||
#include <rtservice.h>
|
||||
#include <rtdevice.h>
|
||||
#include "drivers/usb_device.h"
|
||||
#include "mstorage.h"
|
||||
|
||||
#ifdef RT_USB_DEVICE_MSTORAGE
|
||||
|
@ -112,6 +112,8 @@ static struct usb_qualifier_descriptor dev_qualifier =
|
|||
0,
|
||||
};
|
||||
|
||||
|
||||
|
||||
const static struct umass_descriptor _mass_desc =
|
||||
{
|
||||
USB_DESC_LENGTH_INTERFACE, //bLength;
|
||||
|
|
|
@ -27,7 +27,8 @@
|
|||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <rtdevice.h>
|
||||
#include "drivers/usb_common.h"
|
||||
#include "drivers/usb_device.h"
|
||||
|
||||
static rt_list_t device_list;
|
||||
|
||||
|
@ -37,10 +38,10 @@ static rt_err_t rt_usbd_ep_assign(udevice_t device, uep_t ep);
|
|||
static rt_err_t rt_usbd_ep_unassign(udevice_t device, uep_t ep);
|
||||
|
||||
/**
|
||||
* This function will handle get_device_descriptor request.
|
||||
* This function will handle get_device_descriptor bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -54,22 +55,21 @@ static rt_err_t _get_device_descriptor(struct udevice* device, ureq_t setup)
|
|||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_get_device_descriptor\n"));
|
||||
|
||||
/* device descriptor length should less than USB_DESC_LENGTH_DEVICE*/
|
||||
size = (setup->length > USB_DESC_LENGTH_DEVICE) ?
|
||||
USB_DESC_LENGTH_DEVICE : setup->length;
|
||||
/* device descriptor wLength should less than USB_DESC_LENGTH_DEVICE*/
|
||||
size = (setup->wLength > USB_DESC_LENGTH_DEVICE) ?
|
||||
USB_DESC_LENGTH_DEVICE : setup->wLength;
|
||||
|
||||
/* send device descriptor to endpoint 0 */
|
||||
rt_usbd_ep0_write(device, (rt_uint8_t*)&device->dev_desc,
|
||||
size);
|
||||
rt_usbd_ep0_write(device, (rt_uint8_t*) &device->dev_desc, size);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will handle get_config_descriptor request.
|
||||
* This function will handle get_config_descriptor bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -85,8 +85,8 @@ static rt_err_t _get_config_descriptor(struct udevice* device, ureq_t setup)
|
|||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_get_config_descriptor\n"));
|
||||
|
||||
cfg_desc = &device->curr_cfg->cfg_desc;
|
||||
size = (setup->length > cfg_desc->wTotalLength) ?
|
||||
cfg_desc->wTotalLength : setup->length;
|
||||
size = (setup->wLength > cfg_desc->wTotalLength) ?
|
||||
cfg_desc->wTotalLength : setup->wLength;
|
||||
|
||||
/* send configuration descriptor to endpoint 0 */
|
||||
rt_usbd_ep0_write(device, (rt_uint8_t*)cfg_desc, size);
|
||||
|
@ -95,12 +95,12 @@ static rt_err_t _get_config_descriptor(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle get_string_descriptor request.
|
||||
* This function will handle get_string_descriptor bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful, -RT_ERROR on invalid request.
|
||||
* @return RT_EOK on successful, -RT_ERROR on invalid bRequest.
|
||||
*/
|
||||
static rt_err_t _get_string_descriptor(struct udevice* device, ureq_t setup)
|
||||
{
|
||||
|
@ -115,7 +115,7 @@ static rt_err_t _get_string_descriptor(struct udevice* device, ureq_t setup)
|
|||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_get_string_descriptor\n"));
|
||||
|
||||
str_desc.type = USB_DESC_TYPE_STRING;
|
||||
index = setup->value & 0xFF;
|
||||
index = setup->wValue & 0xFF;
|
||||
|
||||
if(index > USB_STRING_INTERFACE_INDEX)
|
||||
{
|
||||
|
@ -141,10 +141,10 @@ static rt_err_t _get_string_descriptor(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
}
|
||||
|
||||
if (setup->length > str_desc.bLength)
|
||||
if (setup->wLength > str_desc.bLength)
|
||||
len = str_desc.bLength;
|
||||
else
|
||||
len = setup->length;
|
||||
len = setup->wLength;
|
||||
|
||||
/* send string descriptor to endpoint 0 */
|
||||
rt_usbd_ep0_write(device, (rt_uint8_t*)&str_desc, len);
|
||||
|
@ -175,10 +175,10 @@ static rt_err_t _get_qualifier_descriptor(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle get_descriptor request.
|
||||
* This function will handle get_descriptor bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -190,7 +190,7 @@ static rt_err_t _get_descriptor(struct udevice* device, ureq_t setup)
|
|||
|
||||
if(setup->request_type == USB_REQ_TYPE_DIR_IN)
|
||||
{
|
||||
switch(setup->value >> 8)
|
||||
switch(setup->wValue >> 8)
|
||||
{
|
||||
case USB_DESC_TYPE_DEVICE:
|
||||
_get_device_descriptor(device, setup);
|
||||
|
@ -220,10 +220,10 @@ static rt_err_t _get_descriptor(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle get_interface request.
|
||||
* This function will handle get_interface bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -245,7 +245,7 @@ static rt_err_t _get_interface(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/* find the specified interface and its alternate setting */
|
||||
intf = rt_usbd_find_interface(device, setup->index & 0xFF, RT_NULL);
|
||||
intf = rt_usbd_find_interface(device, setup->wIndex & 0xFF, RT_NULL);
|
||||
value = intf->curr_setting->intf_desc->bAlternateSetting;
|
||||
|
||||
/* send the interface alternate setting to endpoint 0*/
|
||||
|
@ -255,10 +255,10 @@ static rt_err_t _get_interface(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle set_interface request.
|
||||
* This function will handle set_interface bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -282,10 +282,10 @@ static rt_err_t _set_interface(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/* find the specified interface */
|
||||
intf = rt_usbd_find_interface(device, setup->index & 0xFF, RT_NULL);
|
||||
intf = rt_usbd_find_interface(device, setup->wIndex & 0xFF, RT_NULL);
|
||||
|
||||
/* set alternate setting to the interface */
|
||||
rt_usbd_set_altsetting(intf, setup->value & 0xFF);
|
||||
rt_usbd_set_altsetting(intf, setup->wValue & 0xFF);
|
||||
setting = intf->curr_setting;
|
||||
|
||||
/* start all endpoints of the interface alternate setting */
|
||||
|
@ -301,10 +301,10 @@ static rt_err_t _set_interface(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle get_config request.
|
||||
* This function will handle get_config bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -335,10 +335,10 @@ static rt_err_t _get_config(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle set_config request.
|
||||
* This function will handle set_config bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -356,13 +356,13 @@ static rt_err_t _set_config(struct udevice* device, ureq_t setup)
|
|||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_set_config\n"));
|
||||
|
||||
if (setup->value > device->dev_desc.bNumConfigurations)
|
||||
if (setup->wValue > device->dev_desc.bNumConfigurations)
|
||||
{
|
||||
rt_usbd_ep0_set_stall(device);
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
if (setup->value == 0)
|
||||
if (setup->wValue == 0)
|
||||
{
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("address state\n"));
|
||||
device->state = USB_STATE_ADDRESS;
|
||||
|
@ -371,8 +371,7 @@ static rt_err_t _set_config(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/* set current configuration */
|
||||
rt_usbd_set_config(device, setup->value);
|
||||
dcd_set_config(device->dcd, setup->value);
|
||||
rt_usbd_set_config(device, setup->wValue);
|
||||
cfg = device->curr_cfg;
|
||||
|
||||
for (i=cfg->func_list.next; i!=&cfg->func_list; i=i->next)
|
||||
|
@ -406,10 +405,10 @@ _exit:
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle set_address request.
|
||||
* This function will handle set_address bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -419,12 +418,12 @@ static rt_err_t _set_address(struct udevice* device, ureq_t setup)
|
|||
RT_ASSERT(device != RT_NULL);
|
||||
RT_ASSERT(setup != RT_NULL);
|
||||
|
||||
/* set address in device control driver */
|
||||
dcd_set_address(device->dcd, setup->wValue);
|
||||
|
||||
/* issue status stage */
|
||||
dcd_ep0_send_status(device->dcd);
|
||||
|
||||
/* set address in device control driver */
|
||||
dcd_set_address(device->dcd, setup->value);
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_set_address\n"));
|
||||
|
||||
device->state = USB_STATE_ADDRESS;
|
||||
|
@ -433,11 +432,11 @@ static rt_err_t _set_address(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle standard request to
|
||||
* This function will handle standard bRequest to
|
||||
* interface that defined in function-specifics
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -453,7 +452,7 @@ static rt_err_t _request_interface(struct udevice* device, ureq_t setup)
|
|||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("_request_interface\n"));
|
||||
|
||||
intf = rt_usbd_find_interface(device, setup->index & 0xFF, &func);
|
||||
intf = rt_usbd_find_interface(device, setup->wIndex & 0xFF, &func);
|
||||
if (intf != RT_NULL)
|
||||
{
|
||||
ret = intf->handler(func, setup);
|
||||
|
@ -467,10 +466,10 @@ static rt_err_t _request_interface(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle standard request.
|
||||
* This function will handle standard bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful.
|
||||
*/
|
||||
|
@ -488,17 +487,17 @@ static rt_err_t _standard_request(struct udevice* device, ureq_t setup)
|
|||
switch(setup->request_type & USB_REQ_TYPE_RECIPIENT_MASK)
|
||||
{
|
||||
case USB_REQ_TYPE_DEVICE:
|
||||
switch(setup->request)
|
||||
switch(setup->bRequest)
|
||||
{
|
||||
case USB_REQ_GET_STATUS:
|
||||
rt_usbd_ep0_write(device, &value, 2);
|
||||
break;
|
||||
case USB_REQ_CLEAR_FEATURE:
|
||||
rt_usbd_clear_feature(device, setup->value, setup->index);
|
||||
rt_usbd_clear_feature(device, setup->wValue, setup->wIndex);
|
||||
dcd_ep0_send_status(dcd);
|
||||
break;
|
||||
case USB_REQ_SET_FEATURE:
|
||||
rt_usbd_set_feature(device, setup->value, setup->index);
|
||||
rt_usbd_set_feature(device, setup->wValue, setup->wIndex);
|
||||
break;
|
||||
case USB_REQ_SET_ADDRESS:
|
||||
_set_address(device, setup);
|
||||
|
@ -522,7 +521,7 @@ static rt_err_t _standard_request(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
break;
|
||||
case USB_REQ_TYPE_INTERFACE:
|
||||
switch(setup->request)
|
||||
switch(setup->bRequest)
|
||||
{
|
||||
case USB_REQ_GET_INTERFACE:
|
||||
_get_interface(device, setup);
|
||||
|
@ -542,13 +541,13 @@ static rt_err_t _standard_request(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
break;
|
||||
case USB_REQ_TYPE_ENDPOINT:
|
||||
switch(setup->request)
|
||||
switch(setup->bRequest)
|
||||
{
|
||||
case USB_REQ_GET_STATUS:
|
||||
{
|
||||
uep_t ep;
|
||||
|
||||
ep = rt_usbd_find_endpoint(device, RT_NULL, setup->index);
|
||||
ep = rt_usbd_find_endpoint(device, RT_NULL, setup->wIndex);
|
||||
value = ep->stalled;
|
||||
rt_usbd_ep0_write(device, &value, 2);
|
||||
}
|
||||
|
@ -559,10 +558,10 @@ static rt_err_t _standard_request(struct udevice* device, ureq_t setup)
|
|||
uio_request_t req;
|
||||
struct rt_list_node *node;
|
||||
|
||||
ep = rt_usbd_find_endpoint(device, RT_NULL, setup->index);
|
||||
if(USB_EP_HALT == setup->value && ep->stalled == RT_TRUE)
|
||||
ep = rt_usbd_find_endpoint(device, RT_NULL, setup->wIndex);
|
||||
if(USB_EP_HALT == setup->wValue && ep->stalled == RT_TRUE)
|
||||
{
|
||||
rt_usbd_clear_feature(device, setup->value, setup->index);
|
||||
rt_usbd_clear_feature(device, setup->wValue, setup->wIndex);
|
||||
dcd_ep0_send_status(dcd);
|
||||
ep->stalled = RT_FALSE;
|
||||
|
||||
|
@ -581,11 +580,11 @@ static rt_err_t _standard_request(struct udevice* device, ureq_t setup)
|
|||
{
|
||||
uep_t ep;
|
||||
|
||||
if(USB_EP_HALT == setup->value)
|
||||
if(USB_EP_HALT == setup->wValue)
|
||||
{
|
||||
ep = rt_usbd_find_endpoint(device, RT_NULL, setup->index);
|
||||
ep = rt_usbd_find_endpoint(device, RT_NULL, setup->wIndex);
|
||||
ep->stalled = RT_TRUE;
|
||||
rt_usbd_set_feature(device, setup->value, setup->index);
|
||||
rt_usbd_set_feature(device, setup->wValue, setup->wIndex);
|
||||
dcd_ep0_send_status(dcd);
|
||||
}
|
||||
}
|
||||
|
@ -612,12 +611,12 @@ static rt_err_t _standard_request(struct udevice* device, ureq_t setup)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will handle function request.
|
||||
* This function will handle function bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful, -RT_ERROR on invalid request.
|
||||
* @return RT_EOK on successful, -RT_ERROR on invalid bRequest.
|
||||
*/
|
||||
static rt_err_t _function_request(udevice_t device, ureq_t setup)
|
||||
{
|
||||
|
@ -628,8 +627,8 @@ static rt_err_t _function_request(udevice_t device, ureq_t setup)
|
|||
RT_ASSERT(device != RT_NULL);
|
||||
RT_ASSERT(setup != RT_NULL);
|
||||
|
||||
/* verify request value */
|
||||
if(setup->index > device->curr_cfg->cfg_desc.bNumInterfaces)
|
||||
/* verify bRequest wValue */
|
||||
if(setup->wIndex > device->curr_cfg->cfg_desc.bNumInterfaces)
|
||||
{
|
||||
rt_usbd_ep0_set_stall(device);
|
||||
return -RT_ERROR;
|
||||
|
@ -638,7 +637,7 @@ static rt_err_t _function_request(udevice_t device, ureq_t setup)
|
|||
switch(setup->request_type & USB_REQ_TYPE_RECIPIENT_MASK)
|
||||
{
|
||||
case USB_REQ_TYPE_INTERFACE:
|
||||
intf = rt_usbd_find_interface(device, setup->index & 0xFF, &func);
|
||||
intf = rt_usbd_find_interface(device, setup->wIndex & 0xFF, &func);
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("unkwown interface request\n");
|
||||
|
@ -663,24 +662,24 @@ static rt_err_t _function_request(udevice_t device, ureq_t setup)
|
|||
static rt_err_t _dump_setup_packet(ureq_t setup)
|
||||
{
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("[\n"));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("setup_request 0x%x\n",
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, (" setup_request : 0x%x\n",
|
||||
setup->request_type));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("value 0x%x\n", setup->value));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("length 0x%x\n", setup->length));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("index 0x%x\n", setup->index));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("request 0x%x\n", setup->request));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, (" value : 0x%x\n", setup->wValue));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, (" length : 0x%x\n", setup->wLength));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, (" index : 0x%x\n", setup->wIndex));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, (" request : 0x%x\n", setup->bRequest));
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("]\n"));
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will handle setup request.
|
||||
* This function will handle setup bRequest.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param setup the setup request.
|
||||
* @param setup the setup bRequest.
|
||||
*
|
||||
* @return RT_EOK on successful, -RT_ERROR on invalid request.
|
||||
* @return RT_EOK on successful, -RT_ERROR on invalid bRequest.
|
||||
*/
|
||||
static rt_err_t _setup_request(udevice_t device, ureq_t setup)
|
||||
{
|
||||
|
@ -741,17 +740,16 @@ static rt_err_t _data_notify(udevice_t device, struct ep_msg* ep_msg)
|
|||
|
||||
if(EP_ADDRESS(ep) & USB_DIR_IN)
|
||||
{
|
||||
size = ep_msg->size;
|
||||
if(ep->request.remain_size >= EP_MAXPACKET(ep))
|
||||
{
|
||||
dcd_ep_write(device->dcd, EP_ADDRESS(ep),
|
||||
ep->request.buffer, EP_MAXPACKET(ep));
|
||||
dcd_ep_write(device->dcd, EP_ADDRESS(ep), ep->request.buffer, EP_MAXPACKET(ep));
|
||||
ep->request.remain_size -= EP_MAXPACKET(ep);
|
||||
ep->request.buffer += EP_MAXPACKET(ep);
|
||||
}
|
||||
else if(ep->request.remain_size > 0)
|
||||
{
|
||||
dcd_ep_write(device->dcd, EP_ADDRESS(ep),
|
||||
ep->request.buffer, ep->request.remain_size);
|
||||
dcd_ep_write(device->dcd, EP_ADDRESS(ep), ep->request.buffer, ep->request.remain_size);
|
||||
ep->request.remain_size = 0;
|
||||
}
|
||||
else
|
||||
|
@ -769,21 +767,12 @@ static rt_err_t _data_notify(udevice_t device, struct ep_msg* ep_msg)
|
|||
|
||||
if(size == 0)
|
||||
{
|
||||
size = dcd_ep_read(device->dcd, EP_ADDRESS(ep),
|
||||
ep->request.buffer);
|
||||
size = dcd_ep_read(device->dcd, EP_ADDRESS(ep), ep->request.buffer);
|
||||
}
|
||||
|
||||
if(size > ep->request.remain_size)
|
||||
{
|
||||
ep->request.remain_size = 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
ep->request.remain_size -= size;
|
||||
ep->request.buffer += size;
|
||||
}
|
||||
|
||||
if(ep->request.req_type == UIO_REQUEST_READ_MOST)
|
||||
if(ep->request.req_type == UIO_REQUEST_READ_BEST)
|
||||
{
|
||||
EP_HANDLER(ep, func, size);
|
||||
}
|
||||
|
@ -807,6 +796,7 @@ static rt_err_t _ep0_out_notify(udevice_t device, struct ep_msg* ep_msg)
|
|||
|
||||
ep0 = &device->dcd->ep0;
|
||||
size = ep_msg->size;
|
||||
|
||||
if(ep0->request.remain_size == 0)
|
||||
{
|
||||
return RT_EOK;
|
||||
|
@ -889,7 +879,6 @@ static rt_err_t _stop_notify(udevice_t device)
|
|||
static rt_size_t rt_usbd_ep_write(udevice_t device, uep_t ep, void *buffer, rt_size_t size)
|
||||
{
|
||||
rt_uint16_t maxpacket;
|
||||
rt_size_t sent_size;
|
||||
|
||||
RT_ASSERT(device != RT_NULL);
|
||||
RT_ASSERT(device->dcd != RT_NULL);
|
||||
|
@ -898,18 +887,18 @@ static rt_size_t rt_usbd_ep_write(udevice_t device, uep_t ep, void *buffer, rt_s
|
|||
maxpacket = EP_MAXPACKET(ep);
|
||||
if(ep->request.remain_size >= maxpacket)
|
||||
{
|
||||
sent_size = dcd_ep_write(device->dcd, EP_ADDRESS(ep), ep->request.buffer, maxpacket);
|
||||
ep->request.remain_size -= sent_size;
|
||||
dcd_ep_write(device->dcd, EP_ADDRESS(ep), ep->request.buffer, maxpacket);
|
||||
ep->request.remain_size -= maxpacket;
|
||||
ep->request.buffer += maxpacket;
|
||||
}
|
||||
else
|
||||
{
|
||||
sent_size = dcd_ep_write(device->dcd, EP_ADDRESS(ep), ep->request.buffer,
|
||||
dcd_ep_write(device->dcd, EP_ADDRESS(ep), ep->request.buffer,
|
||||
ep->request.remain_size);
|
||||
ep->request.remain_size -= sent_size;
|
||||
ep->request.remain_size = 0;
|
||||
}
|
||||
|
||||
return sent_size;
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t rt_usbd_ep_read_prepare(udevice_t device, uep_t ep, void *buffer, rt_size_t size)
|
||||
|
@ -1047,7 +1036,7 @@ uconfig_t rt_usbd_config_new(void)
|
|||
}
|
||||
rt_memset(cfg, 0, sizeof(struct uconfig));
|
||||
|
||||
/* set default value */
|
||||
/* set default wValue */
|
||||
cfg->cfg_desc.bLength = USB_DESC_LENGTH_CONFIG;
|
||||
cfg->cfg_desc.type = USB_DESC_TYPE_CONFIGURATION;
|
||||
cfg->cfg_desc.wTotalLength = USB_DESC_LENGTH_CONFIG;
|
||||
|
@ -1258,7 +1247,7 @@ udevice_t rt_usbd_find_device(udcd_t dcd)
|
|||
* This function will find an usb configuration object.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param value the configuration number.
|
||||
* @param wValue the configuration number.
|
||||
*
|
||||
* @return an usb configuration object on found or RT_NULL on not found.
|
||||
*/
|
||||
|
@ -1291,7 +1280,7 @@ uconfig_t rt_usbd_find_config(udevice_t device, rt_uint8_t value)
|
|||
* This function will find an usb interface object.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param value the interface number.
|
||||
* @param wValue the interface number.
|
||||
*
|
||||
* @return an usb configuration object on found or RT_NULL on not found.
|
||||
*/
|
||||
|
@ -1332,7 +1321,7 @@ uintf_t rt_usbd_find_interface(udevice_t device, rt_uint8_t value, ufunction_t *
|
|||
* This function will find an usb interface alternate setting object.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param value the alternate setting number.
|
||||
* @param wValue the alternate setting number.
|
||||
*
|
||||
* @return an usb interface alternate setting object on found or RT_NULL on not found.
|
||||
*/
|
||||
|
@ -1348,7 +1337,7 @@ ualtsetting_t rt_usbd_find_altsetting(uintf_t intf, rt_uint8_t value)
|
|||
|
||||
if(intf->curr_setting != RT_NULL)
|
||||
{
|
||||
/* if the value equal to the current alternate setting, then do not search */
|
||||
/* if the wValue equal to the current alternate setting, then do not search */
|
||||
if(intf->curr_setting->intf_desc->bAlternateSetting == value)
|
||||
return intf->curr_setting;
|
||||
}
|
||||
|
@ -1384,8 +1373,7 @@ uep_t rt_usbd_find_endpoint(udevice_t device, ufunction_t* pfunc, rt_uint8_t ep_
|
|||
RT_ASSERT(device != RT_NULL);
|
||||
|
||||
/* search a endpoint in the current configuration */
|
||||
for (i=device->curr_cfg->func_list.next;
|
||||
i!=&device->curr_cfg->func_list; i=i->next)
|
||||
for (i=device->curr_cfg->func_list.next; i!=&device->curr_cfg->func_list; i=i->next)
|
||||
{
|
||||
func = (ufunction_t)rt_list_entry(i, struct ufunction, list);
|
||||
for(j=func->intf_list.next; j!=&func->intf_list; j=j->next)
|
||||
|
@ -1563,7 +1551,7 @@ rt_err_t rt_usbd_altsetting_add_endpoint(ualtsetting_t setting, uep_t ep)
|
|||
* This function will set an alternate setting for an interface.
|
||||
*
|
||||
* @param intf_desc the interface descriptor.
|
||||
* @param value the alternate setting number.
|
||||
* @param wValue the alternate setting number.
|
||||
*
|
||||
* @return RT_EOK.
|
||||
*/
|
||||
|
@ -1589,7 +1577,7 @@ rt_err_t rt_usbd_set_altsetting(uintf_t intf, rt_uint8_t value)
|
|||
* This function will set a configuration for an usb device.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param value the configuration number.
|
||||
* @param wValue the configuration number.
|
||||
*
|
||||
* @return RT_EOK.
|
||||
*/
|
||||
|
@ -1609,15 +1597,17 @@ rt_err_t rt_usbd_set_config(udevice_t device, rt_uint8_t value)
|
|||
/* set as current configuration */
|
||||
device->curr_cfg = cfg;
|
||||
|
||||
dcd_set_config(device->dcd, value);
|
||||
|
||||
return RT_TRUE;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will request an IO transaction.
|
||||
* This function will bRequest an IO transaction.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param ep the endpoint object.
|
||||
* @param req IO request.
|
||||
* @param req IO bRequest.
|
||||
*
|
||||
* @return RT_EOK.
|
||||
*/
|
||||
|
@ -1632,7 +1622,7 @@ rt_size_t rt_usbd_io_request(udevice_t device, uep_t ep, uio_request_t req)
|
|||
{
|
||||
switch(req->req_type)
|
||||
{
|
||||
case UIO_REQUEST_READ_MOST:
|
||||
case UIO_REQUEST_READ_BEST:
|
||||
case UIO_REQUEST_READ_FULL:
|
||||
ep->request.remain_size = ep->request.size;
|
||||
size = rt_usbd_ep_read_prepare(device, ep, req->buffer, req->size);
|
||||
|
@ -1659,7 +1649,7 @@ rt_size_t rt_usbd_io_request(udevice_t device, uep_t ep, uio_request_t req)
|
|||
* This function will set feature for an usb device.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param value the configuration number.
|
||||
* @param wValue the configuration number.
|
||||
*
|
||||
* @return RT_EOK.
|
||||
*/
|
||||
|
@ -1684,7 +1674,7 @@ rt_err_t rt_usbd_set_feature(udevice_t device, rt_uint16_t value, rt_uint16_t in
|
|||
* This function will clear feature for an usb device.
|
||||
*
|
||||
* @param device the usb device object.
|
||||
* @param value the configuration number.
|
||||
* @param wValue the configuration number.
|
||||
*
|
||||
* @return RT_EOK.
|
||||
*/
|
||||
|
@ -1766,8 +1756,7 @@ static rt_err_t rt_usbd_ep_assign(udevice_t device, uep_t ep)
|
|||
while(device->dcd->ep_pool[i].addr != 0xFF)
|
||||
{
|
||||
if(device->dcd->ep_pool[i].status == ID_UNASSIGNED &&
|
||||
ep->ep_desc->bmAttributes == device->dcd->ep_pool[i].type &&
|
||||
ep->ep_desc->bEndpointAddress == device->dcd->ep_pool[i].dir)
|
||||
ep->ep_desc->bmAttributes == device->dcd->ep_pool[i].type)
|
||||
{
|
||||
EP_ADDRESS(ep) |= device->dcd->ep_pool[i].addr;
|
||||
ep->id = &device->dcd->ep_pool[i];
|
||||
|
@ -1832,6 +1821,7 @@ rt_err_t rt_usbd_ep0_in_handler(udcd_t dcd)
|
|||
{
|
||||
dcd_ep_write(dcd, EP0_IN_ADDR, dcd->ep0.request.buffer, dcd->ep0.id->maxpacket);
|
||||
dcd->ep0.request.remain_size -= dcd->ep0.id->maxpacket;
|
||||
dcd->ep0.request.buffer += dcd->ep0.id->maxpacket;
|
||||
}
|
||||
else if(dcd->ep0.request.remain_size > 0)
|
||||
{
|
||||
|
@ -1860,7 +1850,7 @@ rt_err_t rt_usbd_ep0_out_handler(udcd_t dcd, rt_size_t size)
|
|||
return RT_EOK;
|
||||
}
|
||||
|
||||
rt_err_t rt_usbd_ep_in_handler(udcd_t dcd, rt_uint8_t address)
|
||||
rt_err_t rt_usbd_ep_in_handler(udcd_t dcd, rt_uint8_t address, rt_size_t size)
|
||||
{
|
||||
struct udev_msg msg;
|
||||
|
||||
|
@ -1869,7 +1859,7 @@ rt_err_t rt_usbd_ep_in_handler(udcd_t dcd, rt_uint8_t address)
|
|||
msg.type = USB_MSG_DATA_NOTIFY;
|
||||
msg.dcd = dcd;
|
||||
msg.content.ep_msg.ep_addr = address;
|
||||
msg.content.ep_msg.size = 0;
|
||||
msg.content.ep_msg.size = size;
|
||||
rt_usbd_event_signal(&msg);
|
||||
|
||||
return RT_EOK;
|
||||
|
@ -1945,7 +1935,6 @@ rt_err_t rt_usbd_sof_handler(udcd_t dcd)
|
|||
rt_size_t rt_usbd_ep0_write(udevice_t device, void *buffer, rt_size_t size)
|
||||
{
|
||||
uep_t ep0;
|
||||
rt_size_t sent_size = 0;
|
||||
|
||||
RT_ASSERT(device != RT_NULL);
|
||||
RT_ASSERT(device->dcd != RT_NULL);
|
||||
|
@ -1956,19 +1945,20 @@ rt_size_t rt_usbd_ep0_write(udevice_t device, void *buffer, rt_size_t size)
|
|||
ep0->request.size = size;
|
||||
ep0->request.buffer = buffer;
|
||||
ep0->request.remain_size = size;
|
||||
|
||||
if(ep0->request.remain_size >= ep0->id->maxpacket)
|
||||
{
|
||||
sent_size = dcd_ep_write(device->dcd, EP0_IN_ADDR, ep0->request.buffer, ep0->id->maxpacket);
|
||||
ep0->request.remain_size -= sent_size;
|
||||
dcd_ep_write(device->dcd, EP0_IN_ADDR, ep0->request.buffer, ep0->id->maxpacket);
|
||||
ep0->request.remain_size -= ep0->id->maxpacket;
|
||||
ep0->request.buffer += ep0->id->maxpacket;
|
||||
}
|
||||
else
|
||||
{
|
||||
sent_size = dcd_ep_write(device->dcd, EP0_IN_ADDR, ep0->request.buffer, ep0->request.remain_size);
|
||||
ep0->request.remain_size -= sent_size;
|
||||
dcd_ep_write(device->dcd, EP0_IN_ADDR, ep0->request.buffer, ep0->request.remain_size);
|
||||
ep0->request.remain_size = 0;
|
||||
}
|
||||
|
||||
return sent_size;
|
||||
return size;
|
||||
}
|
||||
|
||||
rt_size_t rt_usbd_ep0_read(udevice_t device, void *buffer, rt_size_t size,
|
||||
|
@ -2094,12 +2084,18 @@ rt_err_t rt_usbd_core_init(void)
|
|||
rt_list_init(&device_list);
|
||||
|
||||
/* create an usb message queue */
|
||||
rt_mq_init(&usb_mq, "usbd", usb_mq_pool, USBD_MQ_MSG_SZ,
|
||||
sizeof(usb_mq_pool), RT_IPC_FLAG_FIFO);
|
||||
rt_mq_init(&usb_mq,
|
||||
"usbd",
|
||||
usb_mq_pool, USBD_MQ_MSG_SZ,
|
||||
sizeof(usb_mq_pool),
|
||||
RT_IPC_FLAG_FIFO);
|
||||
|
||||
/* init usb device thread */
|
||||
rt_thread_init(&usb_thread, "usbd", rt_usbd_thread_entry, RT_NULL,
|
||||
usb_thread_stack, RT_USBD_THREAD_STACK_SZ, RT_USBD_THREAD_PRIO, 20);
|
||||
rt_thread_init(&usb_thread,
|
||||
"usbd",
|
||||
rt_usbd_thread_entry, RT_NULL,
|
||||
usb_thread_stack, RT_USBD_THREAD_STACK_SZ,
|
||||
RT_USBD_THREAD_PRIO, 20);
|
||||
/* rt_thread_init should always be OK, so start the thread without further
|
||||
* checking. */
|
||||
return rt_thread_startup(&usb_thread);
|
||||
|
|
|
@ -89,27 +89,47 @@ rt_err_t rt_usb_device_init(void)
|
|||
cfg = rt_usbd_config_new();
|
||||
|
||||
#ifdef RT_USB_DEVICE_MSTORAGE
|
||||
{
|
||||
extern ufunction_t rt_usbd_function_mstorage_create(udevice_t device);
|
||||
/* create a mass storage function object */
|
||||
func = rt_usbd_function_mstorage_create(udevice);
|
||||
|
||||
/* add the function to the configuration */
|
||||
rt_usbd_config_add_function(cfg, func);
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef RT_USB_DEVICE_CDC
|
||||
{
|
||||
extern ufunction_t rt_usbd_function_cdc_create(udevice_t device);
|
||||
/* create a cdc function object */
|
||||
func = rt_usbd_function_cdc_create(udevice);
|
||||
|
||||
/* add the function to the configuration */
|
||||
rt_usbd_config_add_function(cfg, func);
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef RT_USB_DEVICE_HID
|
||||
{
|
||||
extern ufunction_t rt_usbd_function_hid_create(udevice_t device);
|
||||
/* create a cdc function object */
|
||||
func = rt_usbd_function_hid_create(udevice);
|
||||
|
||||
/* add the function to the configuration */
|
||||
rt_usbd_config_add_function(cfg, func);
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef RT_USB_DEVICE_RNDIS
|
||||
{
|
||||
extern ufunction_t rt_usbd_function_rndis_create(udevice_t device);
|
||||
/* create a rndis function object */
|
||||
func = rt_usbd_function_rndis_create(udevice);
|
||||
|
||||
/* add the function to the configuration */
|
||||
rt_usbd_config_add_function(cfg, func);
|
||||
}
|
||||
#endif
|
||||
|
||||
/* set device descriptor to the device */
|
||||
|
@ -131,5 +151,4 @@ rt_err_t rt_usb_device_init(void)
|
|||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
|
@ -29,6 +29,6 @@ if GetDepend('RT_USBH_HID_KEYBOARD'):
|
|||
CPPPATH = [cwd, cwd + '/class', cwd + '/core', \
|
||||
cwd + '/include', cwd + '../../../include']
|
||||
|
||||
group = DefineGroup('DeviceDrivers', src, depend = ['RT_USING_USB_HOST'], CPPPATH = CPPPATH)
|
||||
group = DefineGroup('rt_usbh', src, depend = ['RT_USING_USBH'], CPPPATH = CPPPATH)
|
||||
|
||||
Return('group')
|
||||
|
|
|
@ -0,0 +1,397 @@
|
|||
/*
|
||||
* File : hid.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-12 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/usb_host.h>
|
||||
#include "hid.h"
|
||||
|
||||
#ifdef RT_USBH_HID
|
||||
|
||||
static struct uclass_driver hid_driver;
|
||||
static rt_list_t _protocal_list;
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_SET_IDLE request to set idle period to the usb hid device
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @duration the idle period of requesting data.
|
||||
* @report_id the report id
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_hid_set_idle(struct uintf* intf, int duration, int report_id)
|
||||
{
|
||||
struct urequest setup;
|
||||
struct uinstance* device;
|
||||
int timeout = 100;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
device = intf->device;
|
||||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USB_REQ_SET_IDLE;
|
||||
setup.index = 0;
|
||||
setup.length = 0;
|
||||
setup.value = (duration << 8 )| report_id;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) == 0) return RT_EOK;
|
||||
else return -RT_FALSE;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_GET_REPORT request to get report from the usb hid device
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @buffer the data buffer to save usb report descriptor.
|
||||
* @param nbytes the size of buffer
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_hid_get_report(struct uintf* intf, rt_uint8_t type,
|
||||
rt_uint8_t id, rt_uint8_t *buffer, rt_size_t size)
|
||||
{
|
||||
struct urequest setup;
|
||||
struct uinstance* device;
|
||||
int timeout = 100;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
device = intf->device;
|
||||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USB_REQ_GET_REPORT;
|
||||
setup.index = intf->intf_desc->bInterfaceNumber;
|
||||
setup.length = size;
|
||||
setup.value = (type << 8 ) + id;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, buffer, size,
|
||||
timeout) == size) return RT_EOK;
|
||||
else return -RT_FALSE;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_SET_REPORT request to set report to the usb hid device
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @buffer the data buffer to save usb report descriptor.
|
||||
* @param nbytes the size of buffer
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_hid_set_report(struct uintf* intf, rt_uint8_t *buffer, rt_size_t size)
|
||||
{
|
||||
struct urequest setup;
|
||||
struct uinstance* device;
|
||||
int timeout = 100;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
device = intf->device;
|
||||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USB_REQ_SET_REPORT;
|
||||
setup.index = intf->intf_desc->bInterfaceNumber;
|
||||
setup.length = size;
|
||||
setup.value = 0x02 << 8;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, buffer, size,
|
||||
timeout) == size) return RT_EOK;
|
||||
else return -RT_FALSE;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_SET_PROTOCOL request to set protocal to the usb hid device.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param protocol the protocol id.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_hid_set_protocal(struct uintf* intf, int protocol)
|
||||
{
|
||||
struct urequest setup;
|
||||
struct uinstance* device;
|
||||
int timeout = 100;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
device = intf->device;
|
||||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USB_REQ_SET_PROTOCOL;
|
||||
setup.index = 0;
|
||||
setup.length = 0;
|
||||
setup.value = protocol;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) == 0) return RT_EOK;
|
||||
else return -RT_FALSE;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_GET_DESCRIPTOR request for the device instance
|
||||
* to set feature of the hub port.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @buffer the data buffer to save usb report descriptor.
|
||||
* @param nbytes the size of buffer
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_hid_get_report_descriptor(struct uintf* intf,
|
||||
rt_uint8_t *buffer, rt_size_t size)
|
||||
{
|
||||
struct urequest setup;
|
||||
struct uinstance* device;
|
||||
int timeout = 100;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
device = intf->device;
|
||||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_STANDARD|
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USB_REQ_GET_DESCRIPTOR;
|
||||
setup.index = 0;
|
||||
setup.length = size;
|
||||
setup.value = USB_DESC_TYPE_REPORT << 8;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, buffer, size,
|
||||
timeout) == size) return RT_EOK;
|
||||
else return -RT_FALSE;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will register specified hid protocal to protocal list
|
||||
*
|
||||
* @param protocal the specified protocal.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_hid_protocal_register(uprotocal_t protocal)
|
||||
{
|
||||
RT_ASSERT(protocal != RT_NULL);
|
||||
|
||||
if (protocal == RT_NULL) return -RT_ERROR;
|
||||
|
||||
/* insert class driver into driver list */
|
||||
rt_list_insert_after(&_protocal_list, &(protocal->list));
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function is the callback function of hid's int endpoint, it is invoked when data comes.
|
||||
*
|
||||
* @param context the context of the callback function.
|
||||
*
|
||||
* @return none.
|
||||
*/
|
||||
static void rt_usbh_hid_callback(void* context)
|
||||
{
|
||||
upipe_t pipe;
|
||||
struct uhid* hid;
|
||||
int timeout = 300;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(context != RT_NULL);
|
||||
|
||||
pipe = (upipe_t)context;
|
||||
hid = (struct uhid*)pipe->intf->user_data;
|
||||
|
||||
/* invoke protocal callback function */
|
||||
hid->protocal->callback((void*)hid);
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(pipe->intf->device->hcd != RT_NULL);
|
||||
|
||||
rt_usb_hcd_int_xfer(pipe->intf->device->hcd, pipe, hid->buffer,
|
||||
pipe->ep.wMaxPacketSize, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will find specified hid protocal from protocal list
|
||||
*
|
||||
* @param pro_id the protocal id.
|
||||
*
|
||||
* @return the found protocal or RT_NULL if there is no this protocal.
|
||||
*/
|
||||
static uprotocal_t rt_usbh_hid_protocal_find(int pro_id)
|
||||
{
|
||||
struct rt_list_node *node;
|
||||
|
||||
/* try to find protocal object */
|
||||
for (node = _protocal_list.next; node != &_protocal_list; node = node->next)
|
||||
{
|
||||
uprotocal_t protocal =
|
||||
(uprotocal_t)rt_list_entry(node, struct uprotocal, list);
|
||||
if (protocal->pro_id == pro_id) return protocal;
|
||||
}
|
||||
|
||||
/* not found */
|
||||
return RT_NULL;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will run hid class driver when usb device is detected and identified
|
||||
* as a hid class device, it will continue the enumulate process.
|
||||
*
|
||||
* @param arg the argument.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t rt_usbh_hid_enable(void* arg)
|
||||
{
|
||||
int i = 0, pro_id;
|
||||
uprotocal_t protocal;
|
||||
struct uhid* hid;
|
||||
struct uintf* intf = (struct uintf*)arg;
|
||||
int timeout = 100;
|
||||
upipe_t pipe;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
pro_id = intf->intf_desc->bInterfaceProtocol;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB,
|
||||
("HID device enable, protocal id %d\n", pro_id));
|
||||
|
||||
protocal = rt_usbh_hid_protocal_find(pro_id);
|
||||
if(protocal == RT_NULL)
|
||||
{
|
||||
rt_kprintf("can't find hid protocal %d\n", pro_id);
|
||||
intf->user_data = RT_NULL;
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
hid = rt_malloc(sizeof(struct uhid));
|
||||
RT_ASSERT(hid != RT_NULL);
|
||||
|
||||
/* initilize the data structure */
|
||||
rt_memset(hid, 0, sizeof(struct uhid));
|
||||
intf->user_data = (void*)hid;
|
||||
hid->protocal = protocal;
|
||||
|
||||
for(i=0; i<intf->intf_desc->bNumEndpoints; i++)
|
||||
{
|
||||
rt_err_t ret;
|
||||
uep_desc_t ep_desc;
|
||||
|
||||
/* get endpoint descriptor */
|
||||
rt_usbh_get_endpoint_descriptor(intf->intf_desc, i, &ep_desc);
|
||||
if(ep_desc == RT_NULL)
|
||||
{
|
||||
rt_kprintf("rt_usbh_get_endpoint_descriptor error\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
if(USB_EP_ATTR(ep_desc->bmAttributes) != USB_EP_ATTR_INT)
|
||||
continue;
|
||||
|
||||
if(!(ep_desc->bEndpointAddress & USB_DIR_IN)) continue;
|
||||
|
||||
ret = rt_usb_hcd_alloc_pipe(intf->device->hcd, &hid->pipe_in,
|
||||
intf, ep_desc, rt_usbh_hid_callback);
|
||||
if(ret != RT_EOK) return ret;
|
||||
}
|
||||
|
||||
/* initialize hid protocal */
|
||||
hid->protocal->init((void*)intf);
|
||||
pipe = hid->pipe_in;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(pipe->intf->device->hcd != RT_NULL);
|
||||
|
||||
rt_usb_hcd_int_xfer(pipe->intf->device->hcd, hid->pipe_in,
|
||||
hid->buffer, hid->pipe_in->ep.wMaxPacketSize, timeout);
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will be invoked when usb device plug out is detected and it would clean
|
||||
* and release all hub class related resources.
|
||||
*
|
||||
* @param arg the argument.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t rt_usbh_hid_disable(void* arg)
|
||||
{
|
||||
struct uhid* hid;
|
||||
struct uintf* intf = (struct uintf*)arg;
|
||||
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_hid_disable\n"));
|
||||
|
||||
hid = (struct uhid*)intf->user_data;
|
||||
if(hid != RT_NULL)
|
||||
{
|
||||
if(hid->pipe_in != RT_NULL)
|
||||
{
|
||||
/* free the HID in pipe */
|
||||
rt_usb_hcd_free_pipe(intf->device->hcd, hid->pipe_in);
|
||||
}
|
||||
|
||||
/* free the hid instance */
|
||||
rt_free(hid);
|
||||
}
|
||||
|
||||
/* free the instance */
|
||||
rt_free(intf);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will register hid class driver to the usb class driver manager.
|
||||
* and it should be invoked in the usb system initialization.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
ucd_t rt_usbh_class_driver_hid(void)
|
||||
{
|
||||
rt_list_init(&_protocal_list);
|
||||
|
||||
hid_driver.class_code = USB_CLASS_HID;
|
||||
|
||||
hid_driver.enable = rt_usbh_hid_enable;
|
||||
hid_driver.disable = rt_usbh_hid_disable;
|
||||
|
||||
return &hid_driver;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,45 @@
|
|||
/*
|
||||
* File : hid.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-12 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#ifndef __HID_H__
|
||||
#define __HID_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
struct uhid
|
||||
{
|
||||
upipe_t pipe_in;
|
||||
rt_uint8_t buffer[8];
|
||||
uprotocal_t protocal;
|
||||
};
|
||||
typedef struct uhid uhid_t;
|
||||
|
||||
#define USB_REQ_GET_REPORT 0x01
|
||||
#define USB_REQ_GET_IDLE 0x02
|
||||
#define USB_REQ_GET_PROTOCOL 0x03
|
||||
#define USB_REQ_SET_REPORT 0x09
|
||||
#define USB_REQ_SET_IDLE 0x0a
|
||||
#define USB_REQ_SET_PROTOCOL 0x0b
|
||||
|
||||
#define USB_HID_KEYBOARD 1
|
||||
#define USB_HID_MOUSE 2
|
||||
|
||||
rt_err_t rt_usbh_hid_set_idle(struct uintf* intf, int duration, int report_id);
|
||||
rt_err_t rt_usbh_hid_get_report(struct uintf* intf, rt_uint8_t type, rt_uint8_t id, rt_uint8_t *buffer, rt_size_t size);
|
||||
rt_err_t rt_usbh_hid_set_report(struct uintf* intf, rt_uint8_t *buffer, rt_size_t size);
|
||||
rt_err_t rt_usbh_hid_set_protocal(struct uintf* intf, int protocol);
|
||||
rt_err_t rt_usbh_hid_get_report_descriptor(struct uintf* intf, rt_uint8_t *buffer, rt_size_t size);
|
||||
rt_err_t rt_usbh_hid_protocal_register(uprotocal_t protocal);
|
||||
|
||||
#endif
|
|
@ -0,0 +1,648 @@
|
|||
/*
|
||||
* File : mass.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-12 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/usb_host.h>
|
||||
#include "mass.h"
|
||||
|
||||
#ifdef RT_USBH_MSTORAGE
|
||||
|
||||
extern rt_err_t rt_udisk_run(struct uintf* intf);
|
||||
extern rt_err_t rt_udisk_stop(struct uintf* intf);
|
||||
|
||||
static struct uclass_driver storage_driver;
|
||||
|
||||
/**
|
||||
* This function will do USBREQ_GET_MAX_LUN request for the usb interface instance.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param max_lun the buffer to save max_lun.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t _pipe_check(struct uintf* intf, upipe_t pipe)
|
||||
{
|
||||
struct uinstance* device;
|
||||
rt_err_t ret;
|
||||
ustor_t stor;
|
||||
int size = 0;
|
||||
struct ustorage_csw csw;
|
||||
|
||||
if(intf == RT_NULL || pipe == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
/* get usb device instance from the interface instance */
|
||||
device = intf->device;
|
||||
|
||||
/* get storage instance from the interface instance */
|
||||
stor = (ustor_t)intf->user_data;
|
||||
|
||||
/* check pipe status */
|
||||
if(pipe->status == UPIPE_STATUS_OK) return RT_EOK;
|
||||
|
||||
if(pipe->status == UPIPE_STATUS_ERROR)
|
||||
{
|
||||
rt_kprintf("pipe status error\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
/* clear the pipe stall status */
|
||||
ret = rt_usbh_clear_feature(device, pipe->ep.bEndpointAddress,
|
||||
USB_FEATURE_ENDPOINT_HALT);
|
||||
if(ret != RT_EOK) return ret;
|
||||
|
||||
rt_thread_delay(50);
|
||||
|
||||
rt_kprintf("pipes1 0x%x, 0x%x\n", stor->pipe_in, stor->pipe_out);
|
||||
|
||||
stor->pipe_in->status = UPIPE_STATUS_OK;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("clean storage in pipe stall\n"));
|
||||
|
||||
/* it should receive csw after clear the stall feature */
|
||||
size = rt_usb_hcd_bulk_xfer(stor->pipe_in->intf->device->hcd,
|
||||
stor->pipe_in, &csw, SIZEOF_CSW, 100);
|
||||
if(size != SIZEOF_CSW)
|
||||
{
|
||||
rt_kprintf("receive the csw after stall failed\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USBREQ_GET_MAX_LUN request for the usb interface instance.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param max_lun the buffer to save max_lun.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t rt_usb_bulk_only_xfer(struct uintf* intf,
|
||||
ustorage_cbw_t cmd, rt_uint8_t* buffer, int timeout)
|
||||
{
|
||||
rt_size_t size;
|
||||
rt_err_t ret;
|
||||
upipe_t pipe;
|
||||
struct ustorage_csw csw;
|
||||
ustor_t stor;
|
||||
|
||||
RT_ASSERT(cmd != RT_NULL);
|
||||
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
/* get storage instance from the interface instance */
|
||||
stor = (ustor_t)intf->user_data;
|
||||
|
||||
do
|
||||
{
|
||||
/* send the cbw */
|
||||
size = rt_usb_hcd_bulk_xfer(intf->device->hcd, stor->pipe_out,
|
||||
cmd, SIZEOF_CBW, timeout);
|
||||
if(size != SIZEOF_CBW)
|
||||
{
|
||||
rt_kprintf("CBW size error\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
if(cmd->xfer_len != 0)
|
||||
{
|
||||
pipe = (cmd->dflags == CBWFLAGS_DIR_IN) ? stor->pipe_in :
|
||||
stor->pipe_out;
|
||||
size = rt_usb_hcd_bulk_xfer(intf->device->hcd, pipe, (void*)buffer,
|
||||
cmd->xfer_len, timeout);
|
||||
if(size != cmd->xfer_len)
|
||||
{
|
||||
rt_kprintf("request size %d, transfer size %d\n",
|
||||
cmd->xfer_len, size);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* receive the csw */
|
||||
size = rt_usb_hcd_bulk_xfer(intf->device->hcd, stor->pipe_in,
|
||||
&csw, SIZEOF_CSW, timeout);
|
||||
if(size != SIZEOF_CSW)
|
||||
{
|
||||
rt_kprintf("csw size error\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
}while(0);
|
||||
|
||||
/* check in pipes status */
|
||||
ret = _pipe_check(intf, stor->pipe_in);
|
||||
if(ret != RT_EOK)
|
||||
{
|
||||
rt_kprintf("in pipe error\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* check out pipes status */
|
||||
ret = _pipe_check(intf, stor->pipe_out);
|
||||
if(ret != RT_EOK)
|
||||
{
|
||||
rt_kprintf("out pipe error\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* check csw status */
|
||||
if(csw.signature != CSW_SIGNATURE || csw.tag != CBW_TAG_VALUE)
|
||||
{
|
||||
rt_kprintf("csw signature error\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
if(csw.status != 0)
|
||||
{
|
||||
rt_kprintf("csw status error\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USBREQ_GET_MAX_LUN request for the usb interface instance.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param max_lun the buffer to save max_lun.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_get_max_lun(struct uintf* intf, rt_uint8_t* max_lun)
|
||||
{
|
||||
struct uinstance* device;
|
||||
struct urequest setup;
|
||||
int timeout = 100;
|
||||
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_get_max_lun\n"));
|
||||
|
||||
/* get usb device instance from the interface instance */
|
||||
device = intf->device;
|
||||
|
||||
/* construct the request */
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USBREQ_GET_MAX_LUN;
|
||||
setup.index = intf->intf_desc->bInterfaceNumber;
|
||||
setup.length = 1;
|
||||
setup.value = 0;
|
||||
|
||||
/* do control transfer request */
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, max_lun, 1,
|
||||
timeout) != 1) return -RT_EIO;
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will do USBREQ_MASS_STORAGE_RESET request for the usb interface instance.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_reset(struct uintf* intf)
|
||||
{
|
||||
struct urequest setup;
|
||||
struct uinstance* device;
|
||||
int timeout = 100;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_reset\n"));
|
||||
|
||||
/* get usb device instance from the interface instance */
|
||||
device = intf->device;
|
||||
|
||||
/* construct the request */
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USBREQ_MASS_STORAGE_RESET;
|
||||
setup.index = intf->intf_desc->bInterfaceNumber;
|
||||
setup.length = 0;
|
||||
setup.value = 0;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) != 0) return -RT_EIO;
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_READ_10 command to read data from the usb device.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param buffer the data buffer to save read data
|
||||
* @param sector the start sector address to read.
|
||||
* @param sector the sector count to read.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_read10(struct uintf* intf, rt_uint8_t *buffer,
|
||||
rt_uint32_t sector, rt_size_t count, int timeout)
|
||||
{
|
||||
struct ustorage_cbw cmd;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_read10\n"));
|
||||
|
||||
/* construct the command block wrapper */
|
||||
rt_memset(&cmd, 0, sizeof(struct ustorage_cbw));
|
||||
cmd.signature = CBW_SIGNATURE;
|
||||
cmd.tag = CBW_TAG_VALUE;
|
||||
cmd.xfer_len = SECTOR_SIZE * count;
|
||||
cmd.dflags = CBWFLAGS_DIR_IN;
|
||||
cmd.lun = 0;
|
||||
cmd.cb_len = 10;
|
||||
cmd.cb[0] = SCSI_READ_10;
|
||||
cmd.cb[1] = 0;
|
||||
cmd.cb[2] = (rt_uint8_t)(sector >> 24);
|
||||
cmd.cb[3] = (rt_uint8_t)(sector >> 16);
|
||||
cmd.cb[4] = (rt_uint8_t)(sector >> 8);
|
||||
cmd.cb[5] = (rt_uint8_t)sector;
|
||||
cmd.cb[6] = 0;
|
||||
cmd.cb[7] = (count & 0xff00) >> 8;
|
||||
cmd.cb[8] = (rt_uint8_t) count & 0xff;
|
||||
|
||||
return rt_usb_bulk_only_xfer(intf, &cmd, buffer, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_WRITE_10 command to write data to the usb device.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param buffer the data buffer to save write data
|
||||
* @param sector the start sector address to write.
|
||||
* @param sector the sector count to write.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_write10(struct uintf* intf, rt_uint8_t *buffer,
|
||||
rt_uint32_t sector, rt_size_t count, int timeout)
|
||||
{
|
||||
struct ustorage_cbw cmd;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_write10\n"));
|
||||
|
||||
/* construct the command block wrapper */
|
||||
rt_memset(&cmd, 0, sizeof(struct ustorage_cbw));
|
||||
cmd.signature = CBW_SIGNATURE;
|
||||
cmd.tag = CBW_TAG_VALUE;
|
||||
cmd.xfer_len = SECTOR_SIZE * count;
|
||||
cmd.dflags = CBWFLAGS_DIR_OUT;
|
||||
cmd.lun = 0;
|
||||
cmd.cb_len = 10;
|
||||
cmd.cb[0] = SCSI_WRITE_10;
|
||||
cmd.cb[1] = 0;
|
||||
cmd.cb[2] = (rt_uint8_t)(sector >> 24);
|
||||
cmd.cb[3] = (rt_uint8_t)(sector >> 16);
|
||||
cmd.cb[4] = (rt_uint8_t)(sector >> 8);
|
||||
cmd.cb[5] = (rt_uint8_t)sector;
|
||||
cmd.cb[6] = 0;
|
||||
cmd.cb[7] = (count & 0xff00) >> 8;
|
||||
cmd.cb[8] = (rt_uint8_t) count & 0xff;
|
||||
|
||||
return rt_usb_bulk_only_xfer(intf, &cmd, buffer, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_REQUEST_SENSE command to get sense data.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param buffer the data buffer to save sense data
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_request_sense(struct uintf* intf, rt_uint8_t* buffer)
|
||||
{
|
||||
struct ustorage_cbw cmd;
|
||||
int timeout = 200;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_request_sense\n"));
|
||||
|
||||
/* construct the command block wrapper */
|
||||
rt_memset(&cmd, 0, sizeof(struct ustorage_cbw));
|
||||
cmd.signature = CBW_SIGNATURE;
|
||||
cmd.tag = CBW_TAG_VALUE;
|
||||
cmd.xfer_len = 18;
|
||||
cmd.dflags = CBWFLAGS_DIR_IN;
|
||||
cmd.lun = 0;
|
||||
cmd.cb_len = 6;
|
||||
cmd.cb[0] = SCSI_REQUEST_SENSE;
|
||||
cmd.cb[4] = 18;
|
||||
|
||||
return rt_usb_bulk_only_xfer(intf, &cmd, buffer, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_TEST_UNIT_READY command to get unit ready status.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_test_unit_ready(struct uintf* intf)
|
||||
{
|
||||
struct ustorage_cbw cmd;
|
||||
int timeout = 200;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_test_unit_ready\n"));
|
||||
|
||||
/* construct the command block wrapper */
|
||||
rt_memset(&cmd, 0, sizeof(struct ustorage_cbw));
|
||||
cmd.signature = CBW_SIGNATURE;
|
||||
cmd.tag = CBW_TAG_VALUE;
|
||||
cmd.xfer_len = 0;
|
||||
cmd.dflags = CBWFLAGS_DIR_OUT;
|
||||
cmd.lun = 0;
|
||||
cmd.cb_len = 12;
|
||||
cmd.cb[0] = SCSI_TEST_UNIT_READY;
|
||||
|
||||
return rt_usb_bulk_only_xfer(intf, &cmd, RT_NULL, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_INQUIRY_CMD command to get inquiry data.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param buffer the data buffer to save inquiry data
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_inquiry(struct uintf* intf, rt_uint8_t* buffer)
|
||||
{
|
||||
struct ustorage_cbw cmd;
|
||||
int timeout = 200;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_inquiry\n"));
|
||||
|
||||
/* construct the command block wrapper */
|
||||
rt_memset(&cmd, 0, sizeof(struct ustorage_cbw));
|
||||
cmd.signature = CBW_SIGNATURE;
|
||||
cmd.tag = CBW_TAG_VALUE;
|
||||
cmd.xfer_len = 36;
|
||||
cmd.dflags = CBWFLAGS_DIR_IN;
|
||||
cmd.lun = 0;
|
||||
cmd.cb_len = 12;
|
||||
cmd.cb[0] = SCSI_INQUIRY_CMD;
|
||||
cmd.cb[4] = 36;
|
||||
|
||||
return rt_usb_bulk_only_xfer(intf, &cmd, buffer, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_READ_CAPACITY command to get capacity data.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param buffer the data buffer to save capacity data
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_usbh_storage_get_capacity(struct uintf* intf, rt_uint8_t* buffer)
|
||||
{
|
||||
struct ustorage_cbw cmd;
|
||||
int timeout = 200;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_get_capacity\n"));
|
||||
|
||||
/* construct the command block wrapper */
|
||||
rt_memset(&cmd, 0, sizeof(struct ustorage_cbw));
|
||||
cmd.signature = CBW_SIGNATURE;
|
||||
cmd.tag = CBW_TAG_VALUE;
|
||||
cmd.xfer_len = 8;
|
||||
cmd.dflags = CBWFLAGS_DIR_IN;
|
||||
cmd.lun = 0;
|
||||
cmd.cb_len = 12;
|
||||
cmd.cb[0] = SCSI_READ_CAPACITY;
|
||||
|
||||
return rt_usb_bulk_only_xfer(intf, &cmd, buffer, timeout);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will run mass storage class driver when usb device is detected
|
||||
* and identified as a mass storage class device, it will continue to do the enumulate
|
||||
* process.
|
||||
*
|
||||
* @param arg the argument.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t rt_usbh_storage_enable(void* arg)
|
||||
{
|
||||
int i = 0;
|
||||
rt_err_t ret;
|
||||
ustor_t stor;
|
||||
struct uintf* intf = (struct uintf*)arg;
|
||||
|
||||
/* parameter check */
|
||||
if(intf == RT_NULL)
|
||||
{
|
||||
rt_kprintf("the interface is not available\n");
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("subclass %d, protocal %d\n",
|
||||
intf->intf_desc->bInterfaceSubClass,
|
||||
intf->intf_desc->bInterfaceProtocol));
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_run\n"));
|
||||
|
||||
/* only support SCSI subclass and bulk only protocal */
|
||||
|
||||
stor = rt_malloc(sizeof(struct ustor));
|
||||
RT_ASSERT(stor != RT_NULL);
|
||||
|
||||
/* initilize the data structure */
|
||||
rt_memset(stor, 0, sizeof(struct ustor));
|
||||
intf->user_data = (void*)stor;
|
||||
|
||||
for(i=0; i<intf->intf_desc->bNumEndpoints; i++)
|
||||
{
|
||||
uep_desc_t ep_desc;
|
||||
|
||||
/* get endpoint descriptor from interface descriptor */
|
||||
rt_usbh_get_endpoint_descriptor(intf->intf_desc, i, &ep_desc);
|
||||
if(ep_desc == RT_NULL)
|
||||
{
|
||||
rt_kprintf("rt_usb_get_endpoint_descriptor error\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
/* the endpoint type of mass storage class should be BULK */
|
||||
if((ep_desc->bmAttributes & USB_EP_ATTR_TYPE_MASK) != USB_EP_ATTR_BULK)
|
||||
continue;
|
||||
|
||||
/* allocate pipes according to the endpoint type */
|
||||
if(ep_desc->bEndpointAddress & USB_DIR_IN)
|
||||
{
|
||||
/* alloc an in pipe for the storage instance */
|
||||
ret = rt_usb_hcd_alloc_pipe(intf->device->hcd, &stor->pipe_in,
|
||||
intf, ep_desc, RT_NULL);
|
||||
if(ret != RT_EOK) return ret;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* alloc an output pipe for the storage instance */
|
||||
ret = rt_usb_hcd_alloc_pipe(intf->device->hcd, &stor->pipe_out,
|
||||
intf, ep_desc, RT_NULL);
|
||||
if(ret != RT_EOK) return ret;
|
||||
}
|
||||
}
|
||||
|
||||
/* check pipes infomation */
|
||||
if(stor->pipe_in == RT_NULL || stor->pipe_out == RT_NULL)
|
||||
{
|
||||
rt_kprintf("pipe error, unsupported device\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
/* should implement as callback */
|
||||
ret = rt_udisk_run(intf);
|
||||
if(ret != RT_EOK) return ret;
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will be invoked when usb device plug out is detected and it would clean
|
||||
* and release all mass storage class related resources.
|
||||
*
|
||||
* @param arg the argument.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t rt_usbh_storage_disable(void* arg)
|
||||
{
|
||||
ustor_t stor;
|
||||
struct uintf* intf = (struct uintf*)arg;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->user_data != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("rt_usbh_storage_stop\n"));
|
||||
|
||||
/* get storage instance from interface instance */
|
||||
stor = (ustor_t)intf->user_data;
|
||||
|
||||
rt_udisk_stop(intf);
|
||||
|
||||
rt_kprintf("in 0x%x, out 0x%x\n", stor->pipe_in,
|
||||
stor->pipe_out);
|
||||
|
||||
/* free in pipe */
|
||||
if(stor->pipe_in != RT_NULL)
|
||||
rt_usb_hcd_free_pipe(intf->device->hcd, stor->pipe_in);
|
||||
|
||||
/* free out pipe */
|
||||
if(stor->pipe_out != RT_NULL)
|
||||
rt_usb_hcd_free_pipe(intf->device->hcd, stor->pipe_out);
|
||||
|
||||
/* free storage instance */
|
||||
if(stor != RT_NULL) rt_free(stor);
|
||||
|
||||
/* free interface instance */
|
||||
if(intf != RT_NULL) rt_free(intf);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will register mass storage class driver to the usb class driver manager.
|
||||
* and it should be invoked in the usb system initialization.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
ucd_t rt_usbh_class_driver_storage(void)
|
||||
{
|
||||
storage_driver.class_code = USB_CLASS_MASS_STORAGE;
|
||||
|
||||
storage_driver.enable = rt_usbh_storage_enable;
|
||||
storage_driver.disable = rt_usbh_storage_disable;
|
||||
|
||||
return &storage_driver;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,54 @@
|
|||
/*
|
||||
* File : mass.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-12 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#ifndef __MASS_H__
|
||||
#define __MASS_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
#include "dfs_fs.h"
|
||||
|
||||
#define MAX_PARTITION_COUNT 4
|
||||
#define SECTOR_SIZE 512
|
||||
|
||||
struct ustor_data
|
||||
{
|
||||
struct dfs_partition part;
|
||||
struct uintf* intf;
|
||||
int udisk_id;
|
||||
const char path;
|
||||
};
|
||||
|
||||
struct ustor
|
||||
{
|
||||
upipe_t pipe_in;
|
||||
upipe_t pipe_out;
|
||||
rt_uint32_t capicity[2];
|
||||
|
||||
struct rt_device dev[MAX_PARTITION_COUNT];
|
||||
rt_uint8_t dev_cnt;
|
||||
};
|
||||
typedef struct ustor* ustor_t;
|
||||
|
||||
rt_err_t rt_usbh_storage_get_max_lun(struct uintf* intf, rt_uint8_t* max_lun);
|
||||
rt_err_t rt_usbh_storage_reset(struct uintf* intf);
|
||||
rt_err_t rt_usbh_storage_read10(struct uintf* intf, rt_uint8_t *buffer,
|
||||
rt_uint32_t sector, rt_size_t count, int timeout);
|
||||
rt_err_t rt_usbh_storage_write10(struct uintf* intf, rt_uint8_t *buffer,
|
||||
rt_uint32_t sector, rt_size_t count, int timeout);
|
||||
rt_err_t rt_usbh_storage_request_sense(struct uintf* intf, rt_uint8_t* buffer);
|
||||
rt_err_t rt_usbh_storage_test_unit_ready(struct uintf* intf);
|
||||
rt_err_t rt_usbh_storage_inquiry(struct uintf* intf, rt_uint8_t* buffer);
|
||||
rt_err_t rt_usbh_storage_get_capacity(struct uintf* intf, rt_uint8_t* buffer);
|
||||
|
||||
#endif
|
|
@ -0,0 +1,419 @@
|
|||
/*
|
||||
* File : udisk.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-12 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <dfs_fs.h>
|
||||
#include <drivers/usb_host.h>
|
||||
#include "mass.h"
|
||||
|
||||
#ifdef RT_USBH_MSTORAGE
|
||||
|
||||
#define UDISK_MAX_COUNT 8
|
||||
static rt_uint8_t _udisk_idset = 0;
|
||||
|
||||
static int udisk_get_id(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
for(i=0; i< UDISK_MAX_COUNT; i++)
|
||||
{
|
||||
if((_udisk_idset & (1 << i)) != 0) continue;
|
||||
else break;
|
||||
}
|
||||
|
||||
/* it should not happen */
|
||||
if(i == UDISK_MAX_COUNT) RT_ASSERT(0);
|
||||
|
||||
_udisk_idset |= (1 << i);
|
||||
return i;
|
||||
}
|
||||
|
||||
static void udisk_free_id(int id)
|
||||
{
|
||||
RT_ASSERT(id < UDISK_MAX_COUNT)
|
||||
|
||||
_udisk_idset &= ~(1 << id);
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will initialize the udisk device
|
||||
*
|
||||
* @param dev the pointer of device driver structure
|
||||
*
|
||||
* @return RT_EOK
|
||||
*/
|
||||
static rt_err_t rt_udisk_init(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will read some data from a device.
|
||||
*
|
||||
* @param dev the pointer of device driver structure
|
||||
* @param pos the position of reading
|
||||
* @param buffer the data buffer to save read data
|
||||
* @param size the size of buffer
|
||||
*
|
||||
* @return the actually read size on successful, otherwise negative returned.
|
||||
*/
|
||||
static rt_size_t rt_udisk_read(rt_device_t dev, rt_off_t pos, void* buffer,
|
||||
rt_size_t size)
|
||||
{
|
||||
rt_err_t ret;
|
||||
struct uintf* intf;
|
||||
struct ustor_data* data;
|
||||
int timeout = 500;
|
||||
|
||||
/* check parameter */
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
|
||||
if(size > 4096) timeout = 800;
|
||||
|
||||
data = (struct ustor_data*)dev->user_data;
|
||||
intf = data->intf;
|
||||
|
||||
ret = rt_usbh_storage_read10(intf, (rt_uint8_t*)buffer, pos, size, timeout);
|
||||
|
||||
if (ret != RT_EOK)
|
||||
{
|
||||
rt_kprintf("usb mass_storage read failed\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will write some data to a device.
|
||||
*
|
||||
* @param dev the pointer of device driver structure
|
||||
* @param pos the position of written
|
||||
* @param buffer the data buffer to be written to device
|
||||
* @param size the size of buffer
|
||||
*
|
||||
* @return the actually written size on successful, otherwise negative returned.
|
||||
*/
|
||||
static rt_size_t rt_udisk_write (rt_device_t dev, rt_off_t pos, const void* buffer,
|
||||
rt_size_t size)
|
||||
{
|
||||
rt_err_t ret;
|
||||
struct uintf* intf;
|
||||
struct ustor_data* data;
|
||||
int timeout = 500;
|
||||
|
||||
/* check parameter */
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
|
||||
if(size * SECTOR_SIZE > 4096) timeout = 800;
|
||||
|
||||
data = (struct ustor_data*)dev->user_data;
|
||||
intf = data->intf;
|
||||
|
||||
ret = rt_usbh_storage_write10(intf, (rt_uint8_t*)buffer, pos, size, timeout);
|
||||
if (ret != RT_EOK)
|
||||
{
|
||||
rt_kprintf("usb mass_storage write %d sector failed\n", size);
|
||||
return 0;
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will execute SCSI_INQUIRY_CMD command to get inquiry data.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
* @param buffer the data buffer to save inquiry data
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
static rt_err_t rt_udisk_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||
{
|
||||
ustor_t stor;
|
||||
struct ustor_data* data;
|
||||
|
||||
/* check parameter */
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
|
||||
data = (struct ustor_data*)dev->user_data;
|
||||
stor = (ustor_t)data->intf->user_data;
|
||||
|
||||
if (cmd == RT_DEVICE_CTRL_BLK_GETGEOME)
|
||||
{
|
||||
struct rt_device_blk_geometry *geometry;
|
||||
|
||||
geometry = (struct rt_device_blk_geometry *)args;
|
||||
if (geometry == RT_NULL) return -RT_ERROR;
|
||||
|
||||
geometry->bytes_per_sector = SECTOR_SIZE;
|
||||
geometry->block_size = stor->capicity[1];
|
||||
geometry->sector_count = stor->capicity[0];
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will run udisk driver when usb disk is detected.
|
||||
*
|
||||
* @param intf the usb interface instance.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_udisk_run(struct uintf* intf)
|
||||
{
|
||||
int i = 0;
|
||||
rt_err_t ret;
|
||||
char dname[4];
|
||||
char sname[8];
|
||||
rt_uint8_t max_lun, *sector, sense[18], inquiry[36];
|
||||
struct dfs_partition part[MAX_PARTITION_COUNT];
|
||||
ustor_t stor;
|
||||
|
||||
/* check parameter */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
|
||||
/* set interface */
|
||||
// ret = rt_usbh_set_interface(intf->device, intf->intf_desc->bInterfaceNumber);
|
||||
// if(ret != RT_EOK)
|
||||
// rt_usbh_clear_feature(intf->device, 0, USB_FEATURE_ENDPOINT_HALT);
|
||||
/* reset mass storage class device */
|
||||
ret = rt_usbh_storage_reset(intf);
|
||||
if(ret != RT_EOK) return ret;
|
||||
|
||||
stor = (ustor_t)intf->user_data;
|
||||
|
||||
/* get max logic unit number */
|
||||
ret = rt_usbh_storage_get_max_lun(intf, &max_lun);
|
||||
if(ret != RT_EOK)
|
||||
rt_usbh_clear_feature(intf->device, 0, USB_FEATURE_ENDPOINT_HALT);
|
||||
|
||||
/* reset pipe in endpoint */
|
||||
ret = rt_usbh_clear_feature(intf->device,
|
||||
stor->pipe_in->ep.bEndpointAddress, USB_FEATURE_ENDPOINT_HALT);
|
||||
if(ret != RT_EOK) return ret;
|
||||
|
||||
/* reset pipe out endpoint */
|
||||
ret = rt_usbh_clear_feature(intf->device,
|
||||
stor->pipe_out->ep.bEndpointAddress, USB_FEATURE_ENDPOINT_HALT);
|
||||
if(ret != RT_EOK) return ret;
|
||||
|
||||
while((ret = rt_usbh_storage_inquiry(intf, inquiry)) != RT_EOK)
|
||||
{
|
||||
if(ret == -RT_EIO) return ret;
|
||||
|
||||
rt_thread_delay(5);
|
||||
if(i++ < 10) continue;
|
||||
rt_kprintf("rt_usbh_storage_inquiry error\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
i = 0;
|
||||
|
||||
/* wait device ready */
|
||||
while((ret = rt_usbh_storage_test_unit_ready(intf)) != RT_EOK)
|
||||
{
|
||||
if(ret == -RT_EIO) return ret;
|
||||
|
||||
ret = rt_usbh_storage_request_sense(intf, sense);
|
||||
if(ret == -RT_EIO) return ret;
|
||||
|
||||
rt_thread_delay(10);
|
||||
if(i++ < 10) continue;
|
||||
|
||||
rt_kprintf("rt_usbh_storage_test_unit_ready error\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
i = 0;
|
||||
rt_memset(stor->capicity, 0, sizeof(stor->capicity));
|
||||
|
||||
/* get storage capacity */
|
||||
while((ret = rt_usbh_storage_get_capacity(intf,
|
||||
(rt_uint8_t*)stor->capicity)) != RT_EOK)
|
||||
{
|
||||
if(ret == -RT_EIO) return ret;
|
||||
|
||||
rt_thread_delay(50);
|
||||
if(i++ < 10) continue;
|
||||
|
||||
stor->capicity[0] = 2880;
|
||||
stor->capicity[1] = 0x200;
|
||||
|
||||
rt_kprintf("rt_usbh_storage_get_capacity error\n");
|
||||
break;
|
||||
}
|
||||
|
||||
stor->capicity[0] = uswap_32(stor->capicity[0]);
|
||||
stor->capicity[1] = uswap_32(stor->capicity[1]);
|
||||
stor->capicity[0] += 1;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("capicity %d, block size %d\n",
|
||||
stor->capicity[0], stor->capicity[1]));
|
||||
|
||||
/* get the first sector to read partition table */
|
||||
sector = (rt_uint8_t*) rt_malloc (SECTOR_SIZE);
|
||||
if (sector == RT_NULL)
|
||||
{
|
||||
rt_kprintf("allocate partition sector buffer failed\n");
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
rt_memset(sector, 0, SECTOR_SIZE);
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("read partition table\n"));
|
||||
|
||||
/* get the partition table */
|
||||
ret = rt_usbh_storage_read10(intf, sector, 0, 1, 500);
|
||||
if(ret != RT_EOK)
|
||||
{
|
||||
rt_kprintf("read parition table error\n");
|
||||
|
||||
rt_free(sector);
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("finished reading partition\n"));
|
||||
|
||||
for(i=0; i<MAX_PARTITION_COUNT; i++)
|
||||
{
|
||||
/* get the first partition */
|
||||
ret = dfs_filesystem_get_partition(&part[i], sector, i);
|
||||
if (ret == RT_EOK)
|
||||
{
|
||||
struct ustor_data* data = rt_malloc(sizeof(struct ustor_data));
|
||||
rt_memset(data, 0, sizeof(struct ustor_data));
|
||||
data->intf = intf;
|
||||
data->udisk_id = udisk_get_id();
|
||||
data->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
||||
rt_snprintf(dname, 6, "ud%d-%d", data->udisk_id, i);
|
||||
rt_snprintf(sname, 8, "sem_ud%d", i);
|
||||
|
||||
/* register sdcard device */
|
||||
stor->dev[i].type = RT_Device_Class_Block;
|
||||
stor->dev[i].init = rt_udisk_init;
|
||||
stor->dev[i].read = rt_udisk_read;
|
||||
stor->dev[i].write = rt_udisk_write;
|
||||
stor->dev[i].control = rt_udisk_control;
|
||||
stor->dev[i].user_data = (void*)data;
|
||||
|
||||
rt_device_register(&stor->dev[i], dname, RT_DEVICE_FLAG_RDWR |
|
||||
RT_DEVICE_FLAG_REMOVABLE | RT_DEVICE_FLAG_STANDALONE);
|
||||
|
||||
stor->dev_cnt++;
|
||||
if (dfs_mount(stor->dev[i].parent.name, UDISK_MOUNTPOINT, "elm",
|
||||
0, 0) == 0)
|
||||
{
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("udisk part %d mount successfully\n", i));
|
||||
}
|
||||
else
|
||||
{
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("udisk part %d mount failed\n", i));
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
if(i == 0)
|
||||
{
|
||||
struct ustor_data* data = rt_malloc(sizeof(struct ustor_data));
|
||||
rt_memset(data, 0, sizeof(struct ustor_data));
|
||||
data->udisk_id = udisk_get_id();
|
||||
|
||||
/* there is no partition table */
|
||||
data->part.offset = 0;
|
||||
data->part.size = 0;
|
||||
data->intf = intf;
|
||||
data->part.lock = rt_sem_create("sem_ud", 1, RT_IPC_FLAG_FIFO);
|
||||
|
||||
rt_snprintf(dname, 7, "udisk%d", data->udisk_id);
|
||||
|
||||
/* register sdcard device */
|
||||
stor->dev[0].type = RT_Device_Class_Block;
|
||||
stor->dev[0].init = rt_udisk_init;
|
||||
stor->dev[0].read = rt_udisk_read;
|
||||
stor->dev[0].write = rt_udisk_write;
|
||||
stor->dev[0].control = rt_udisk_control;
|
||||
stor->dev[0].user_data = (void*)data;
|
||||
|
||||
rt_device_register(&stor->dev[0], dname,
|
||||
RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_REMOVABLE
|
||||
| RT_DEVICE_FLAG_STANDALONE);
|
||||
|
||||
stor->dev_cnt++;
|
||||
if (dfs_mount(stor->dev[0].parent.name, UDISK_MOUNTPOINT,
|
||||
"elm", 0, 0) == 0)
|
||||
{
|
||||
rt_kprintf("Mount FAT on Udisk successful.\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
rt_kprintf("Mount FAT on Udisk failed.\n");
|
||||
}
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
rt_free(sector);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will be invoked when usb disk plug out is detected and it would clean
|
||||
* and release all udisk related resources.
|
||||
*
|
||||
* @param intf the usb interface instance.
|
||||
*
|
||||
* @return the error code, RT_EOK on successfully.
|
||||
*/
|
||||
rt_err_t rt_udisk_stop(struct uintf* intf)
|
||||
{
|
||||
int i;
|
||||
ustor_t stor;
|
||||
struct ustor_data* data;
|
||||
|
||||
/* check parameter */
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
RT_ASSERT(intf->device != RT_NULL);
|
||||
|
||||
stor = (ustor_t)intf->user_data;
|
||||
RT_ASSERT(stor != RT_NULL);
|
||||
|
||||
for(i=0; i<stor->dev_cnt; i++)
|
||||
{
|
||||
rt_device_t dev = &stor->dev[i];
|
||||
data = (struct ustor_data*)dev->user_data;
|
||||
|
||||
/* unmount filesystem */
|
||||
dfs_unmount(UDISK_MOUNTPOINT);
|
||||
|
||||
/* delete semaphore */
|
||||
rt_sem_delete(data->part.lock);
|
||||
udisk_free_id(data->udisk_id);
|
||||
rt_free(data);
|
||||
|
||||
/* unregister device */
|
||||
rt_device_unregister(&stor->dev[i]);
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,72 @@
|
|||
/*
|
||||
* File : ukbd.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2012-01-03 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/usb_host.h>
|
||||
#include "hid.h"
|
||||
|
||||
#if defined(RT_USBH_HID) && defined(RT_USBH_HID_KEYBOARD)
|
||||
|
||||
static struct uprotocal kbd_protocal;
|
||||
|
||||
static rt_err_t rt_usbh_hid_kbd_callback(void* arg)
|
||||
{
|
||||
int int1, int2;
|
||||
struct uhid* hid;
|
||||
|
||||
hid = (struct uhid*)arg;
|
||||
|
||||
int1 = *(rt_uint32_t*)hid->buffer;
|
||||
int2 = *(rt_uint32_t*)(&hid->buffer[4]);
|
||||
|
||||
if(int1 != 0 || int2 != 0)
|
||||
{
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("key down 0x%x, 0x%x\n", int1, int2));
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t rt_usbh_hid_kbd_init(void* arg)
|
||||
{
|
||||
struct uintf* intf = (struct uintf*)arg;
|
||||
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
|
||||
rt_usbh_hid_set_protocal(intf, 0);
|
||||
|
||||
rt_usbh_hid_set_idle(intf, 10, 0);
|
||||
|
||||
//RT_DEBUG_LOG(RT_DEBUG_USB, ("start usb keyboard\n"));
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will define the hid keyboard protocal, it will be register to the protocal list.
|
||||
*
|
||||
* @return the keyboard protocal structure.
|
||||
*/
|
||||
uprotocal_t rt_usbh_hid_protocal_kbd(void)
|
||||
{
|
||||
kbd_protocal.pro_id = USB_HID_KEYBOARD;
|
||||
|
||||
kbd_protocal.init = rt_usbh_hid_kbd_init;
|
||||
kbd_protocal.callback = rt_usbh_hid_kbd_callback;
|
||||
|
||||
return &kbd_protocal;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,157 @@
|
|||
/*
|
||||
* File : umouse.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2012-01-03 Yi Qiu first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/usb_host.h>
|
||||
#include "hid.h"
|
||||
#ifdef RT_USING_RTGUI
|
||||
#include <rtgui/event.h>
|
||||
#include <rtgui/rtgui_server.h>
|
||||
#include "drv_lcd.h"
|
||||
#endif
|
||||
#if defined(RT_USBH_HID) && defined(RT_USBH_HID_MOUSE)
|
||||
static struct uprotocal mouse_protocal;
|
||||
|
||||
#ifdef RT_USING_RTGUI
|
||||
#define LKEY_PRESS 0x01
|
||||
#define RKEY_PRESS 0x02
|
||||
#define MKEY_PRESS 0x04
|
||||
#define MOUSE_SCALING 0x02
|
||||
static rt_bool_t lkey_down=RT_FALSE;
|
||||
//static rt_bool_t rkey_down=RT_FALSE;
|
||||
//static rt_bool_t mkey_down=RT_FALSE;
|
||||
static struct rtgui_event_mouse emouse;
|
||||
#endif
|
||||
|
||||
static rt_err_t rt_usbh_hid_mouse_callback(void* arg)
|
||||
{
|
||||
struct uhid* hid;
|
||||
#ifdef RT_USING_RTGUI
|
||||
rt_uint16_t xoffset=0;
|
||||
rt_uint16_t yoffset=0;
|
||||
#endif
|
||||
hid = (struct uhid*)arg;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("hid 0x%x 0x%x\n",
|
||||
*(rt_uint32_t*)hid->buffer,
|
||||
*(rt_uint32_t*)(&hid->buffer[4])));
|
||||
#ifdef RT_USING_RTGUI
|
||||
if(hid->buffer[1]!=0)
|
||||
{
|
||||
if(hid->buffer[1]>127)
|
||||
{
|
||||
xoffset=(256-hid->buffer[1])*MOUSE_SCALING;
|
||||
if(emouse.x>xoffset)
|
||||
{
|
||||
emouse.x-=xoffset;
|
||||
}else
|
||||
{
|
||||
emouse.x=0;
|
||||
}
|
||||
}else
|
||||
{
|
||||
xoffset=(hid->buffer[1])*MOUSE_SCALING;
|
||||
if((emouse.x+xoffset)<480)
|
||||
{
|
||||
emouse.x+=xoffset;
|
||||
}else
|
||||
{
|
||||
emouse.x=480;
|
||||
}
|
||||
}
|
||||
}
|
||||
if(hid->buffer[2]!=0)
|
||||
{
|
||||
|
||||
if(hid->buffer[2]>127)
|
||||
{
|
||||
yoffset=(256-hid->buffer[2])*MOUSE_SCALING;
|
||||
if(emouse.y>yoffset)
|
||||
{
|
||||
emouse.y-=yoffset;
|
||||
}else
|
||||
{
|
||||
emouse.y=0;
|
||||
}
|
||||
}else
|
||||
{
|
||||
yoffset=hid->buffer[2]*MOUSE_SCALING;
|
||||
if(emouse.y+yoffset<272)
|
||||
{
|
||||
emouse.y+=yoffset;
|
||||
}else
|
||||
{
|
||||
emouse.y=272;
|
||||
}
|
||||
}
|
||||
}
|
||||
if(xoffset!=0||yoffset!=0)
|
||||
{
|
||||
cursor_set_position(emouse.x,emouse.y);
|
||||
}
|
||||
if(hid->buffer[0]&LKEY_PRESS)
|
||||
{
|
||||
if(lkey_down==RT_FALSE){
|
||||
// rt_kprintf("mouse left key press down\n");
|
||||
emouse.button = (RTGUI_MOUSE_BUTTON_LEFT | RTGUI_MOUSE_BUTTON_DOWN);
|
||||
rtgui_server_post_event(&emouse.parent, sizeof(struct rtgui_event_mouse));
|
||||
lkey_down=RT_TRUE;
|
||||
}
|
||||
}else if(lkey_down==RT_TRUE)
|
||||
{
|
||||
// rt_kprintf("mouse left key press up\n");
|
||||
emouse.button = (RTGUI_MOUSE_BUTTON_LEFT | RTGUI_MOUSE_BUTTON_UP);
|
||||
rtgui_server_post_event(&emouse.parent, sizeof(struct rtgui_event_mouse));
|
||||
lkey_down=RT_FALSE;
|
||||
}
|
||||
#endif
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t rt_usbh_hid_mouse_init(void* arg)
|
||||
{
|
||||
struct uintf* intf = (struct uintf*)arg;
|
||||
|
||||
RT_ASSERT(intf != RT_NULL);
|
||||
|
||||
rt_usbh_hid_set_protocal(intf, 0);
|
||||
|
||||
rt_usbh_hid_set_idle(intf, 10, 0);
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("start usb mouse\n"));
|
||||
#ifdef RT_USING_RTGUI
|
||||
RTGUI_EVENT_MOUSE_BUTTON_INIT(&emouse);
|
||||
emouse.wid = RT_NULL;
|
||||
cursor_display(RT_TRUE);
|
||||
#endif
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
/**
|
||||
* This function will define the hid mouse protocal, it will be register to the protocal list.
|
||||
*
|
||||
* @return the keyboard protocal structure.
|
||||
*/
|
||||
uprotocal_t rt_usbh_hid_protocal_mouse(void)
|
||||
{
|
||||
mouse_protocal.pro_id = USB_HID_MOUSE;
|
||||
|
||||
mouse_protocal.init = rt_usbh_hid_mouse_init;
|
||||
mouse_protocal.callback = rt_usbh_hid_mouse_callback;
|
||||
|
||||
return &mouse_protocal;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
@ -234,10 +234,10 @@ rt_err_t rt_usbh_detach_instance(uinst_t device)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_GET_DESCRIPTO' request for the usb device instance,
|
||||
* This function will do USB_REQ_GET_DESCRIPTO' bRequest for the usb device instance,
|
||||
*
|
||||
* @param device the usb device instance.
|
||||
* @param type the type of descriptor request.
|
||||
* @param type the type of descriptor bRequest.
|
||||
* @param buffer the data buffer to save requested data
|
||||
* @param nbytes the size of buffer
|
||||
*
|
||||
|
@ -253,10 +253,10 @@ rt_err_t rt_usbh_get_descriptor(uinst_t device, rt_uint8_t type, void* buffer,
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_STANDARD |
|
||||
USB_REQ_TYPE_DEVICE;
|
||||
setup.request = USB_REQ_GET_DESCRIPTOR;
|
||||
setup.index = 0;
|
||||
setup.length = nbytes;
|
||||
setup.value = type << 8;
|
||||
setup.bRequest = USB_REQ_GET_DESCRIPTOR;
|
||||
setup.wIndex = 0;
|
||||
setup.wLength = nbytes;
|
||||
setup.wValue = type << 8;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, buffer, nbytes,
|
||||
timeout) != nbytes) return -RT_EIO;
|
||||
|
@ -281,10 +281,10 @@ rt_err_t rt_usbh_set_address(uinst_t device)
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_STANDARD |
|
||||
USB_REQ_TYPE_DEVICE;
|
||||
setup.request = USB_REQ_SET_ADDRESS;
|
||||
setup.index = 0;
|
||||
setup.length = 0;
|
||||
setup.value = device->index;
|
||||
setup.bRequest = USB_REQ_SET_ADDRESS;
|
||||
setup.wIndex = 0;
|
||||
setup.wLength = 0;
|
||||
setup.wValue = device->index;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) != 0) return -RT_EIO;
|
||||
|
@ -314,10 +314,10 @@ rt_err_t rt_usbh_set_configure(uinst_t device, int config)
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_STANDARD |
|
||||
USB_REQ_TYPE_DEVICE;
|
||||
setup.request = USB_REQ_SET_CONFIGURATION;
|
||||
setup.index = 0;
|
||||
setup.length = 0;
|
||||
setup.value = config;
|
||||
setup.bRequest = USB_REQ_SET_CONFIGURATION;
|
||||
setup.wIndex = 0;
|
||||
setup.wLength = 0;
|
||||
setup.wValue = config;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) != 0) return -RT_EIO;
|
||||
|
@ -343,10 +343,10 @@ rt_err_t rt_usbh_set_interface(uinst_t device, int intf)
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_STANDARD |
|
||||
USB_REQ_TYPE_INTERFACE;
|
||||
setup.request = USB_REQ_SET_INTERFACE;
|
||||
setup.index = 0;
|
||||
setup.length = 0;
|
||||
setup.value = intf;
|
||||
setup.bRequest = USB_REQ_SET_INTERFACE;
|
||||
setup.wIndex = 0;
|
||||
setup.wLength = 0;
|
||||
setup.wValue = intf;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) != 0) return -RT_EIO;
|
||||
|
@ -372,10 +372,10 @@ rt_err_t rt_usbh_clear_feature(uinst_t device, int endpoint, int feature)
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_STANDARD |
|
||||
USB_REQ_TYPE_ENDPOINT;
|
||||
setup.request = USB_REQ_CLEAR_FEATURE;
|
||||
setup.index = endpoint;
|
||||
setup.length = 0;
|
||||
setup.value = feature;
|
||||
setup.bRequest = USB_REQ_CLEAR_FEATURE;
|
||||
setup.wIndex = endpoint;
|
||||
setup.wLength = 0;
|
||||
setup.wValue = feature;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, RT_NULL, 0,
|
||||
timeout) != 0) return -RT_EIO;
|
||||
|
|
|
@ -24,7 +24,7 @@
|
|||
|
||||
#include <rtthread.h>
|
||||
#include <rtservice.h>
|
||||
#include <rtdevice.h>
|
||||
#include <drivers/usb_host.h>
|
||||
|
||||
static rt_list_t _driver_list;
|
||||
|
||||
|
|
|
@ -31,7 +31,7 @@ static struct rt_messagequeue *usb_mq;
|
|||
static struct uclass_driver hub_driver;
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_GET_DESCRIPTOR request for the device instance
|
||||
* This function will do USB_REQ_GET_DESCRIPTOR bRequest for the device instance
|
||||
* to get usb hub descriptor.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
|
@ -51,10 +51,10 @@ rt_err_t rt_usbh_hub_get_descriptor(struct uinstance* device, rt_uint8_t *buffer
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_DEVICE;
|
||||
setup.request = USB_REQ_GET_DESCRIPTOR;
|
||||
setup.index = 0;
|
||||
setup.length = nbytes;
|
||||
setup.value = USB_DESC_TYPE_HUB << 8;
|
||||
setup.bRequest = USB_REQ_GET_DESCRIPTOR;
|
||||
setup.wIndex = 0;
|
||||
setup.wLength = nbytes;
|
||||
setup.wValue = USB_DESC_TYPE_HUB << 8;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, buffer, nbytes,
|
||||
timeout) == nbytes) return RT_EOK;
|
||||
|
@ -62,7 +62,7 @@ rt_err_t rt_usbh_hub_get_descriptor(struct uinstance* device, rt_uint8_t *buffer
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_GET_STATUS request for the device instance
|
||||
* This function will do USB_REQ_GET_STATUS bRequest for the device instance
|
||||
* to get usb hub status.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
|
@ -81,10 +81,10 @@ rt_err_t rt_usbh_hub_get_status(struct uinstance* device, rt_uint8_t* buffer)
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_DEVICE;
|
||||
setup.request = USB_REQ_GET_STATUS;
|
||||
setup.index = 0;
|
||||
setup.length = length;
|
||||
setup.value = 0;
|
||||
setup.bRequest = USB_REQ_GET_STATUS;
|
||||
setup.wIndex = 0;
|
||||
setup.wLength = length;
|
||||
setup.wValue = 0;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(device->hcd, device, &setup, buffer, length,
|
||||
timeout) == length) return RT_EOK;
|
||||
|
@ -92,7 +92,7 @@ rt_err_t rt_usbh_hub_get_status(struct uinstance* device, rt_uint8_t* buffer)
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_GET_STATUS request for the device instance
|
||||
* This function will do USB_REQ_GET_STATUS bRequest for the device instance
|
||||
* to get hub port status.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
|
@ -121,10 +121,10 @@ rt_err_t rt_usbh_hub_get_port_status(uhub_t hub, rt_uint16_t port,
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_IN | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_OTHER;
|
||||
setup.request = USB_REQ_GET_STATUS;
|
||||
setup.index = port;
|
||||
setup.length = 4;
|
||||
setup.value = 0;
|
||||
setup.bRequest = USB_REQ_GET_STATUS;
|
||||
setup.wIndex = port;
|
||||
setup.wLength = 4;
|
||||
setup.wValue = 0;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(hub->hcd, hub->self, &setup, buffer,
|
||||
length, timeout) == timeout) return RT_EOK;
|
||||
|
@ -132,7 +132,7 @@ rt_err_t rt_usbh_hub_get_port_status(uhub_t hub, rt_uint16_t port,
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_CLEAR_FEATURE request for the device instance
|
||||
* This function will do USB_REQ_CLEAR_FEATURE bRequest for the device instance
|
||||
* to clear feature of the hub port.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
|
@ -160,10 +160,10 @@ rt_err_t rt_usbh_hub_clear_port_feature(uhub_t hub, rt_uint16_t port,
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_OTHER;
|
||||
setup.request = USB_REQ_CLEAR_FEATURE;
|
||||
setup.index = port;
|
||||
setup.length = 0;
|
||||
setup.value = feature;
|
||||
setup.bRequest = USB_REQ_CLEAR_FEATURE;
|
||||
setup.wIndex = port;
|
||||
setup.wLength = 0;
|
||||
setup.wValue = feature;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(hub->hcd, hub->self, &setup, RT_NULL, 0,
|
||||
timeout) == 0) return RT_EOK;
|
||||
|
@ -171,7 +171,7 @@ rt_err_t rt_usbh_hub_clear_port_feature(uhub_t hub, rt_uint16_t port,
|
|||
}
|
||||
|
||||
/**
|
||||
* This function will do USB_REQ_SET_FEATURE request for the device instance
|
||||
* This function will do USB_REQ_SET_FEATURE bRequest for the device instance
|
||||
* to set feature of the hub port.
|
||||
*
|
||||
* @param intf the interface instance.
|
||||
|
@ -199,10 +199,10 @@ rt_err_t rt_usbh_hub_set_port_feature(uhub_t hub, rt_uint16_t port,
|
|||
|
||||
setup.request_type = USB_REQ_TYPE_DIR_OUT | USB_REQ_TYPE_CLASS |
|
||||
USB_REQ_TYPE_OTHER;
|
||||
setup.request = USB_REQ_SET_FEATURE;
|
||||
setup.index = port;
|
||||
setup.length = 0;
|
||||
setup.value = feature;
|
||||
setup.bRequest = USB_REQ_SET_FEATURE;
|
||||
setup.wIndex = port;
|
||||
setup.wLength = 0;
|
||||
setup.wValue = feature;
|
||||
|
||||
if(rt_usb_hcd_control_xfer(hub->hcd, hub->self, &setup, RT_NULL, 0,
|
||||
timeout) == 0) return RT_EOK;
|
||||
|
@ -561,7 +561,7 @@ static void rt_usbh_hub_thread_entry(void* parameter)
|
|||
if(rt_mq_recv(usb_mq, &msg, sizeof(struct uhost_msg), RT_WAITING_FOREVER)
|
||||
!= RT_EOK ) continue;
|
||||
|
||||
RT_DEBUG_LOG(RT_DEBUG_USB, ("msg type %d\n", msg.type));
|
||||
//RT_DEBUG_LOG(RT_DEBUG_USB, ("msg type %d\n", msg.type));
|
||||
|
||||
switch (msg.type)
|
||||
{
|
||||
|
|
Loading…
Reference in New Issue