blob: d896adf7315902b338cd1a9e44c6b72f948eefaa [file] [log] [blame]
/*
* Copyright (c) 2018 Intel Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#define LOG_LEVEL CONFIG_USB_DEVICE_LOG_LEVEL
#include <logging/log.h>
LOG_MODULE_REGISTER(usb_bos);
#include <zephyr.h>
#include <usb/usb_device.h>
#include <usb/usb_common.h>
#include <usb/bos.h>
extern const uint8_t __usb_bos_desc_start[];
extern const uint8_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 += 1U;
}
int usb_handle_bos(struct usb_setup_packet *setup,
int32_t *len, uint8_t **data)
{
if (GET_DESC_TYPE(setup->wValue) == DESCRIPTOR_TYPE_BOS) {
LOG_DBG("Read BOS descriptor");
*data = (uint8_t *)usb_bos_get_header();
*len = usb_bos_get_length();
return 0;
}
return -ENOTSUP;
}