|
|
|
@ -7,7 +7,6 @@
|
|
|
|
|
|
|
|
|
|
|
|
/* #define VERBOSE_DEBUG */
|
|
|
|
/* #define VERBOSE_DEBUG */
|
|
|
|
|
|
|
|
|
|
|
|
#include "linux/types.h"
|
|
|
|
|
|
|
|
#include <linux/kallsyms.h>
|
|
|
|
#include <linux/kallsyms.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
@ -21,6 +20,59 @@
|
|
|
|
|
|
|
|
|
|
|
|
#include "u_os_desc.h"
|
|
|
|
#include "u_os_desc.h"
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//#if defined (CONFIG_GAOYANG)
|
|
|
|
|
|
|
|
// (struct usb_descriptor_header *) &WINUSB_WCIDDescriptor,
|
|
|
|
|
|
|
|
//#endif // defined (CONFIG_GAOYANG)
|
|
|
|
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define WINUSB_IF0_WCID_PROPERTIES_SIZE (162)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
const uint8_t WINUSB20_WCIDDescriptorSet [162] = {
|
|
|
|
|
|
|
|
///////////////////////////////////////
|
|
|
|
|
|
|
|
/// WCID20 descriptor set descriptor
|
|
|
|
|
|
|
|
///////////////////////////////////////
|
|
|
|
|
|
|
|
0x0a, 0x00, /* wLength */
|
|
|
|
|
|
|
|
0x00, 0x00, /* wDescriptorType */
|
|
|
|
|
|
|
|
0x00, 0x00, 0x03, 0x06, /* dwWindowsVersion */
|
|
|
|
|
|
|
|
0xa2, 0x00, /* wDescriptorSetTotalLength */
|
|
|
|
|
|
|
|
///////////////////////////////////////
|
|
|
|
|
|
|
|
/// WCID20 compatible ID descriptor
|
|
|
|
|
|
|
|
///////////////////////////////////////
|
|
|
|
|
|
|
|
0x14, 0x00, /* wLength */
|
|
|
|
|
|
|
|
0x03, 0x00, /* wDescriptorType */
|
|
|
|
|
|
|
|
/* WINUSB */
|
|
|
|
|
|
|
|
'W', 'I', 'N', 'U', 'S', 'B', 0x00, 0x00, /* cCID_8 */
|
|
|
|
|
|
|
|
/* */
|
|
|
|
|
|
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* cSubCID_8 */
|
|
|
|
|
|
|
|
///////////////////////////////////////
|
|
|
|
|
|
|
|
/// WCID20 registry property descriptor
|
|
|
|
|
|
|
|
///////////////////////////////////////
|
|
|
|
|
|
|
|
0x84, 0x00, /* wLength */
|
|
|
|
|
|
|
|
0x04, 0x00, /* wDescriptorType */
|
|
|
|
|
|
|
|
0x07, 0x00, /* wPropertyDataType */
|
|
|
|
|
|
|
|
0x2a, 0x00, /* wPropertyNameLength */
|
|
|
|
|
|
|
|
/* DeviceInterfaceGUIDs */
|
|
|
|
|
|
|
|
'D', 0x00, 'e', 0x00, 'v', 0x00, 'i', 0x00, /* wcPropertyName_21 */
|
|
|
|
|
|
|
|
'c', 0x00, 'e', 0x00, 'I', 0x00, 'n', 0x00, /* wcPropertyName_21 */
|
|
|
|
|
|
|
|
't', 0x00, 'e', 0x00, 'r', 0x00, 'f', 0x00, /* wcPropertyName_21 */
|
|
|
|
|
|
|
|
'a', 0x00, 'c', 0x00, 'e', 0x00, 'G', 0x00, /* wcPropertyName_21 */
|
|
|
|
|
|
|
|
'U', 0x00, 'I', 0x00, 'D', 0x00, 's', 0x00, /* wcPropertyName_21 */
|
|
|
|
|
|
|
|
0x00, 0x00, /* wcPropertyName_21 */
|
|
|
|
|
|
|
|
0x50, 0x00, /* wPropertyDataLength */
|
|
|
|
|
|
|
|
/* {1D4B2365-4749-48EA-B38A-7C6FDDDD7E26} */
|
|
|
|
|
|
|
|
'{', 0x00, '1', 0x00, 'D', 0x00, '4', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'B', 0x00, '2', 0x00, '3', 0x00, '6', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'5', 0x00, '-', 0x00, '4', 0x00, '7', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'4', 0x00, '9', 0x00, '-', 0x00, '4', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'8', 0x00, 'E', 0x00, 'A', 0x00, '-', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'B', 0x00, '3', 0x00, '8', 0x00, 'A', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'-', 0x00, '7', 0x00, 'C', 0x00, '6', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'F', 0x00, 'D', 0x00, 'D', 0x00, 'D', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'D', 0x00, '7', 0x00, 'E', 0x00, '2', 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
'6', 0x00, '}', 0x00, 0x00, 0x00, 0x00, 0x00, /* wcPropertyData_40 */
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
#endif // defined (CONFIG_GAOYANG)
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* struct usb_os_string - represents OS String to be reported by a gadget
|
|
|
|
* struct usb_os_string - represents OS String to be reported by a gadget
|
|
|
|
* @bLength: total length of the entire descritor, always 0x12
|
|
|
|
* @bLength: total length of the entire descritor, always 0x12
|
|
|
|
@ -666,7 +718,6 @@ static int bos_desc(struct usb_composite_dev *cdev)
|
|
|
|
struct usb_dcd_config_params dcd_config_params;
|
|
|
|
struct usb_dcd_config_params dcd_config_params;
|
|
|
|
struct usb_bos_descriptor *bos = cdev->req->buf;
|
|
|
|
struct usb_bos_descriptor *bos = cdev->req->buf;
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
#if defined (CONFIG_GAOYANG_WCID20)
|
|
|
|
|
|
|
|
/* WCID20 device capability descriptor */
|
|
|
|
/* WCID20 device capability descriptor */
|
|
|
|
#define USB_CAP_TYPE_WCID 5
|
|
|
|
#define USB_CAP_TYPE_WCID 5
|
|
|
|
#define USB_CAP_WCID_SIZE 0x1C
|
|
|
|
#define USB_CAP_WCID_SIZE 0x1C
|
|
|
|
@ -693,29 +744,7 @@ static int bos_desc(struct usb_composite_dev *cdev)
|
|
|
|
uint32_t winusb20_wcidbos_version = 0x06030000;
|
|
|
|
uint32_t winusb20_wcidbos_version = 0x06030000;
|
|
|
|
|
|
|
|
|
|
|
|
struct usb_cap_wcid20_descriptor *usb_cap_wcid;
|
|
|
|
struct usb_cap_wcid20_descriptor *usb_cap_wcid;
|
|
|
|
#endif // !defined (CONFIG_GAOYANG_WCID20)
|
|
|
|
|
|
|
|
/* WCID10 device capability descriptor */
|
|
|
|
|
|
|
|
#define USB_OS_SIZE 0x12
|
|
|
|
|
|
|
|
#define USB_DT_OS USB_DT_STRING
|
|
|
|
|
|
|
|
#define WCID_VENDOR_CODE 0x00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
struct usb_cap_wcid10_descriptor {
|
|
|
|
|
|
|
|
__u8 bLength;
|
|
|
|
|
|
|
|
__u8 bDescriptorType;
|
|
|
|
|
|
|
|
__u16 MicrosoftString[7];
|
|
|
|
|
|
|
|
__u8 bVendorCode;
|
|
|
|
|
|
|
|
union {
|
|
|
|
|
|
|
|
__u8 bPad;
|
|
|
|
|
|
|
|
__u8 bFlags;
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
} __attribute__((packed));
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t os_string[] = {
|
|
|
|
|
|
|
|
0x4D, 0x00, 0x53, 0x00, 0x46, 0x00, 0x54,
|
|
|
|
|
|
|
|
0x00, 0x31, 0x00, 0x30, 0x00, 0x30, 0x00
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
struct usb_cap_wcid10_descriptor *usb_os = cdev->req->buf;
|
|
|
|
|
|
|
|
#endif // defined (CONFIG_GAOYANG)
|
|
|
|
#endif // defined (CONFIG_GAOYANG)
|
|
|
|
unsigned int besl = 0;
|
|
|
|
unsigned int besl = 0;
|
|
|
|
|
|
|
|
|
|
|
|
@ -724,15 +753,6 @@ static int bos_desc(struct usb_composite_dev *cdev)
|
|
|
|
|
|
|
|
|
|
|
|
bos->wTotalLength = cpu_to_le16(USB_DT_BOS_SIZE);
|
|
|
|
bos->wTotalLength = cpu_to_le16(USB_DT_BOS_SIZE);
|
|
|
|
bos->bNumDeviceCaps = 0;
|
|
|
|
bos->bNumDeviceCaps = 0;
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
|
|
|
|
usb_os->bLength = USB_OS_SIZE;
|
|
|
|
|
|
|
|
usb_os->bDescriptorType = USB_DT_OS;
|
|
|
|
|
|
|
|
usb_os->bVendorCode = WCID_VENDOR_CODE;
|
|
|
|
|
|
|
|
memcpy(usb_os->MicrosoftString, os_string, sizeof(os_string));
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bos->wTotalLength = cpu_to_le16(USB_OS_SIZE);
|
|
|
|
|
|
|
|
bos->bNumDeviceCaps = 0;
|
|
|
|
|
|
|
|
#endif // defined (CONFIG_GAOYANG_WCID20)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Get Controller configuration */
|
|
|
|
/* Get Controller configuration */
|
|
|
|
if (cdev->gadget->ops->get_config_params) {
|
|
|
|
if (cdev->gadget->ops->get_config_params) {
|
|
|
|
@ -770,7 +790,6 @@ static int bos_desc(struct usb_composite_dev *cdev)
|
|
|
|
USB_BESL_SUPPORT | besl);
|
|
|
|
USB_BESL_SUPPORT | besl);
|
|
|
|
|
|
|
|
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
#if defined (CONFIG_GAOYANG_WCID20)
|
|
|
|
|
|
|
|
usb_cap_wcid = cdev->req->buf + le16_to_cpu(bos->wTotalLength);
|
|
|
|
usb_cap_wcid = cdev->req->buf + le16_to_cpu(bos->wTotalLength);
|
|
|
|
le16_add_cpu(&bos->wTotalLength, USB_CAP_WCID_SIZE);
|
|
|
|
le16_add_cpu(&bos->wTotalLength, USB_CAP_WCID_SIZE);
|
|
|
|
bos->bNumDeviceCaps++;
|
|
|
|
bos->bNumDeviceCaps++;
|
|
|
|
@ -782,7 +801,6 @@ static int bos_desc(struct usb_composite_dev *cdev)
|
|
|
|
usb_cap_wcid->wDescriptorSetTotalLength = cpu_to_le32(WINUSB20_WCID_DESC_SET_SIZE);
|
|
|
|
usb_cap_wcid->wDescriptorSetTotalLength = cpu_to_le32(WINUSB20_WCID_DESC_SET_SIZE);
|
|
|
|
usb_cap_wcid->bVendorCode = WINUSB20_WCID_VENDOR_CODE;
|
|
|
|
usb_cap_wcid->bVendorCode = WINUSB20_WCID_VENDOR_CODE;
|
|
|
|
memcpy(usb_cap_wcid->bPlatformCapabilityUUID_16, winusb20_wcidbos_uuid, sizeof(winusb20_wcidbos_uuid));
|
|
|
|
memcpy(usb_cap_wcid->bPlatformCapabilityUUID_16, winusb20_wcidbos_uuid, sizeof(winusb20_wcidbos_uuid));
|
|
|
|
#endif // !defined (CONFIG_GAOYANG_WCID20)
|
|
|
|
|
|
|
|
#endif // defined (CONFIG_GAOYANG)
|
|
|
|
#endif // defined (CONFIG_GAOYANG)
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* The Superspeed USB Capability descriptor shall be implemented by all
|
|
|
|
* The Superspeed USB Capability descriptor shall be implemented by all
|
|
|
|
@ -1972,6 +1990,14 @@ unknown:
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
* OS descriptors handling
|
|
|
|
* OS descriptors handling
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
|
|
|
|
#if defined (CONFIG_GAOYANG)
|
|
|
|
|
|
|
|
if (ctrl->bRequestType == 0xC0) {
|
|
|
|
|
|
|
|
value = min_t(int, w_length, sizeof(WINUSB20_WCIDDescriptorSet));
|
|
|
|
|
|
|
|
memcpy(req->buf, WINUSB20_WCIDDescriptorSet, value);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
goto check_value;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif // defined (CONFIG_GAOYANG)
|
|
|
|
if (cdev->use_os_string && cdev->os_desc_config &&
|
|
|
|
if (cdev->use_os_string && cdev->os_desc_config &&
|
|
|
|
(ctrl->bRequestType & USB_TYPE_VENDOR) &&
|
|
|
|
(ctrl->bRequestType & USB_TYPE_VENDOR) &&
|
|
|
|
ctrl->bRequest == cdev->b_vendor_code) {
|
|
|
|
ctrl->bRequest == cdev->b_vendor_code) {
|
|
|
|
|