69 lines
1.5 KiB
C
69 lines
1.5 KiB
C
/*
|
|
* Copyright (c) 2018 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define SYS_LOG_LEVEL CONFIG_SYS_LOG_USB_DEVICE_LEVEL
|
|
#define SYS_LOG_DOMAIN "usb/bos"
|
|
#include <logging/sys_log.h>
|
|
|
|
#include <zephyr.h>
|
|
|
|
#include <usb/usb_device.h>
|
|
#include <usb/usb_common.h>
|
|
|
|
#include <usb/bos.h>
|
|
|
|
extern const u8_t __usb_bos_desc_start[];
|
|
extern const u8_t __usb_bos_desc_end[];
|
|
|
|
USB_DEVICE_BOS_DESC_DEFINE_HDR struct usb_bos_descriptor hdr = {
|
|
.bLength = sizeof(struct usb_bos_descriptor),
|
|
.bDescriptorType = USB_BINARY_OBJECT_STORE_DESC,
|
|
.wTotalLength = 0, /* should be corrected with register */
|
|
.bNumDeviceCaps = 0, /* should be set with register */
|
|
};
|
|
|
|
size_t usb_bos_get_length(void)
|
|
{
|
|
return __usb_bos_desc_end - __usb_bos_desc_start;
|
|
}
|
|
|
|
const void *usb_bos_get_header(void)
|
|
{
|
|
return __usb_bos_desc_start;
|
|
}
|
|
|
|
void usb_bos_fix_total_length(void)
|
|
{
|
|
struct usb_bos_descriptor *hdr = (void *)__usb_bos_desc_start;
|
|
|
|
hdr->wTotalLength = usb_bos_get_length();
|
|
}
|
|
|
|
void usb_bos_register_cap(struct usb_bos_platform_descriptor *desc)
|
|
{
|
|
struct usb_bos_descriptor *hdr = (void *)__usb_bos_desc_start;
|
|
|
|
/* Has effect only on first register */
|
|
hdr->wTotalLength = usb_bos_get_length();
|
|
|
|
hdr->bNumDeviceCaps += 1;
|
|
}
|
|
|
|
int usb_handle_bos(struct usb_setup_packet *setup,
|
|
s32_t *len, u8_t **data)
|
|
{
|
|
SYS_LOG_DBG("wValue 0x%x", setup->wValue);
|
|
|
|
if (GET_DESC_TYPE(setup->wValue) == DESCRIPTOR_TYPE_BOS) {
|
|
*data = (u8_t *)usb_bos_get_header();
|
|
*len = usb_bos_get_length();
|
|
|
|
return 0;
|
|
}
|
|
|
|
return -ENOTSUP;
|
|
}
|