| /* | |
| * SPDX-FileCopyrightText: Copyright (c) 2019 Ha Thach (tinyusb.org) | |
| * SPDX-License-Identifier: MIT | |
| * | |
| * This file is part of the TinyUSB stack. | |
| */ | |
| #include "tusb_option.h" | |
| #if (CFG_TUH_ENABLED && CFG_TUH_HID) | |
| #include "host/usbh.h" | |
| #include "host/usbh_pvt.h" | |
| #include "hid_host.h" | |
| // Level where CFG_TUSB_DEBUG must be at least for this driver is logged | |
| #ifndef CFG_TUH_HID_LOG_LEVEL | |
| #define CFG_TUH_HID_LOG_LEVEL CFG_TUH_LOG_LEVEL | |
| #endif | |
| #define TU_LOG_DRV(...) TU_LOG(CFG_TUH_HID_LOG_LEVEL, __VA_ARGS__) | |
| //--------------------------------------------------------------------+ | |
| // MACRO CONSTANT TYPEDEF | |
| //--------------------------------------------------------------------+ | |
| typedef struct { | |
| uint8_t daddr; | |
| uint8_t itf_num; | |
| uint8_t ep_in; | |
| uint8_t ep_out; | |
| bool mounted; // Enumeration is complete | |
| uint8_t itf_protocol; // None, Keyboard, Mouse | |
| uint8_t protocol_mode; // Boot (0) or Report protocol (1) | |
| uint8_t report_desc_type; | |
| uint16_t report_desc_len; | |
| uint16_t epin_size; | |
| uint16_t epout_size; | |
| } hidh_interface_t; | |
| typedef struct { | |
| TUH_EPBUF_DEF(epin, CFG_TUH_HID_EPIN_BUFSIZE); | |
| TUH_EPBUF_DEF(epout, CFG_TUH_HID_EPOUT_BUFSIZE); | |
| } hidh_epbuf_t; | |
| static hidh_interface_t _hidh_itf[CFG_TUH_HID]; | |
| CFG_TUH_MEM_SECTION static hidh_epbuf_t _hidh_epbuf[CFG_TUH_HID]; | |
| static uint8_t _hidh_default_protocol = HID_PROTOCOL_BOOT; | |
| //--------------------------------------------------------------------+ | |
| // Weak stubs: invoked if no strong implementation is available | |
| //--------------------------------------------------------------------+ | |
| TU_ATTR_WEAK void tuh_hid_mount_cb(uint8_t dev_addr, uint8_t idx, uint8_t const* report_desc, uint16_t desc_len) { | |
| (void) dev_addr; (void) idx; (void) report_desc; (void) desc_len; | |
| } | |
| TU_ATTR_WEAK void tuh_hid_umount_cb(uint8_t dev_addr, uint8_t idx) { | |
| (void) dev_addr; (void) idx; | |
| } | |
| TU_ATTR_WEAK void tuh_hid_report_received_cb(uint8_t dev_addr, uint8_t idx, const uint8_t *report, uint16_t len) { | |
| (void) dev_addr; (void) idx; (void) report; (void) len; | |
| } | |
| TU_ATTR_WEAK void tuh_hid_report_sent_cb(uint8_t dev_addr, uint8_t idx, uint8_t const* report, uint16_t len) { | |
| (void) dev_addr; (void) idx; (void) report; (void) len; | |
| } | |
| TU_ATTR_WEAK void tuh_hid_get_report_complete_cb(uint8_t dev_addr, uint8_t idx, uint8_t report_id, uint8_t report_type, uint16_t len) { | |
| (void) dev_addr; (void) idx; (void) report_id; (void) report_type; (void) len; | |
| } | |
| TU_ATTR_WEAK void tuh_hid_set_report_complete_cb(uint8_t dev_addr, uint8_t idx, uint8_t report_id, uint8_t report_type, uint16_t len) { | |
| (void) dev_addr; (void) idx; (void) report_id; (void) report_type; (void) len; | |
| } | |
| TU_ATTR_WEAK void tuh_hid_set_protocol_complete_cb(uint8_t dev_addr, uint8_t idx, uint8_t protocol) { | |
| (void) dev_addr; (void) idx; (void) protocol; | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Helper | |
| //--------------------------------------------------------------------+ | |
| TU_ATTR_ALWAYS_INLINE static inline hidh_interface_t* get_hid_itf(uint8_t daddr, uint8_t idx) { | |
| TU_ASSERT(daddr > 0 && idx < CFG_TUH_HID, NULL); | |
| hidh_interface_t* p_hid = &_hidh_itf[idx]; | |
| return (p_hid->daddr == daddr) ? p_hid : NULL; | |
| } | |
| TU_ATTR_ALWAYS_INLINE static inline hidh_epbuf_t* get_hid_epbuf(uint8_t idx) { | |
| return &_hidh_epbuf[idx]; | |
| } | |
| // Get instance ID by endpoint address | |
| static uint8_t get_idx_by_epaddr(uint8_t daddr, uint8_t ep_addr) { | |
| for (uint8_t idx = 0; idx < CFG_TUH_HID; idx++) { | |
| hidh_interface_t const* p_hid = &_hidh_itf[idx]; | |
| if (p_hid->daddr == daddr && | |
| (p_hid->ep_in == ep_addr || p_hid->ep_out == ep_addr)) { | |
| return idx; | |
| } | |
| } | |
| return TUSB_INDEX_INVALID_8; | |
| } | |
| static hidh_interface_t* find_new_itf(void) { | |
| for (uint8_t i = 0; i < CFG_TUH_HID; i++) { | |
| if (_hidh_itf[i].daddr == 0) { | |
| return &_hidh_itf[i]; | |
| } | |
| } | |
| return NULL; | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Interface API | |
| //--------------------------------------------------------------------+ | |
| uint8_t tuh_hid_itf_get_count(uint8_t daddr) { | |
| uint8_t count = 0; | |
| for (uint8_t i = 0; i < CFG_TUH_HID; i++) { | |
| if (_hidh_itf[i].daddr == daddr) { | |
| count++; | |
| } | |
| } | |
| return count; | |
| } | |
| uint8_t tuh_hid_itf_get_total_count(void) { | |
| uint8_t count = 0; | |
| for (uint8_t i = 0; i < CFG_TUH_HID; i++) { | |
| if (_hidh_itf[i].daddr != 0) { | |
| count++; | |
| } | |
| } | |
| return count; | |
| } | |
| bool tuh_hid_mounted(uint8_t daddr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid); | |
| return p_hid->mounted; | |
| } | |
| bool tuh_hid_itf_get_info(uint8_t daddr, uint8_t idx, tuh_itf_info_t* info) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid && info); | |
| info->daddr = daddr; | |
| // re-construct descriptor | |
| tusb_desc_interface_t* desc = &info->desc; | |
| desc->bLength = sizeof(tusb_desc_interface_t); | |
| desc->bDescriptorType = TUSB_DESC_INTERFACE; | |
| desc->bInterfaceNumber = p_hid->itf_num; | |
| desc->bAlternateSetting = 0; | |
| desc->bNumEndpoints = (uint8_t) ((p_hid->ep_in ? 1u : 0u) + (p_hid->ep_out ? 1u : 0u)); | |
| desc->bInterfaceClass = TUSB_CLASS_HID; | |
| desc->bInterfaceSubClass = (p_hid->itf_protocol ? HID_SUBCLASS_BOOT : HID_SUBCLASS_NONE); | |
| desc->bInterfaceProtocol = p_hid->itf_protocol; | |
| desc->iInterface = 0; // not used yet | |
| return true; | |
| } | |
| uint8_t tuh_hid_itf_get_index(uint8_t daddr, uint8_t itf_num) { | |
| for (uint8_t idx = 0; idx < CFG_TUH_HID; idx++) { | |
| hidh_interface_t const* p_hid = &_hidh_itf[idx]; | |
| if (p_hid->daddr == daddr && p_hid->itf_num == itf_num) return idx; | |
| } | |
| return TUSB_INDEX_INVALID_8; | |
| } | |
| uint8_t tuh_hid_interface_protocol(uint8_t daddr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| return p_hid ? p_hid->itf_protocol : 0; | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Control Endpoint API | |
| //--------------------------------------------------------------------+ | |
| uint8_t tuh_hid_get_protocol(uint8_t daddr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| return p_hid ? p_hid->protocol_mode : 0; | |
| } | |
| static void set_protocol_complete(tuh_xfer_t* xfer) { | |
| uint8_t const itf_num = (uint8_t) tu_le16toh(xfer->setup->wIndex); | |
| uint8_t const daddr = xfer->daddr; | |
| uint8_t const idx = tuh_hid_itf_get_index(daddr, itf_num); | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid,); | |
| if (XFER_RESULT_SUCCESS == xfer->result) { | |
| p_hid->protocol_mode = (uint8_t) tu_le16toh(xfer->setup->wValue); | |
| } | |
| tuh_hid_set_protocol_complete_cb(daddr, idx, p_hid->protocol_mode); | |
| } | |
| void tuh_hid_set_default_protocol(uint8_t protocol) { | |
| _hidh_default_protocol = protocol; | |
| } | |
| static bool hidh_set_protocol(uint8_t daddr, uint8_t itf_num, uint8_t protocol, | |
| tuh_xfer_cb_t complete_cb, uintptr_t user_data) { | |
| TU_LOG_DRV("HID Set Protocol = %d\r\n", protocol); | |
| tusb_control_request_t const request = { | |
| .bmRequestType_bit = { | |
| .recipient = TUSB_REQ_RCPT_INTERFACE, | |
| .type = TUSB_REQ_TYPE_CLASS, | |
| .direction = TUSB_DIR_OUT | |
| }, | |
| .bRequest = HID_REQ_CONTROL_SET_PROTOCOL, | |
| .wValue = protocol, | |
| .wIndex = itf_num, | |
| .wLength = 0 | |
| }; | |
| tuh_xfer_t xfer = { | |
| .daddr = daddr, | |
| .ep_addr = 0, | |
| .setup = &request, | |
| .buffer = NULL, | |
| .complete_cb = complete_cb, | |
| .user_data = user_data | |
| }; | |
| return tuh_control_xfer(&xfer); | |
| } | |
| bool tuh_hid_set_protocol(uint8_t daddr, uint8_t idx, uint8_t protocol) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid && p_hid->itf_protocol != HID_ITF_PROTOCOL_NONE); | |
| return hidh_set_protocol(daddr, p_hid->itf_num, protocol, set_protocol_complete, 0); | |
| } | |
| static void get_report_complete(tuh_xfer_t* xfer) { | |
| TU_LOG_DRV("HID Get Report complete\r\n"); | |
| uint8_t const itf_num = (uint8_t) tu_le16toh(xfer->setup->wIndex); | |
| uint8_t const idx = tuh_hid_itf_get_index(xfer->daddr, itf_num); | |
| uint8_t const report_type = tu_u16_high(xfer->setup->wValue); | |
| uint8_t const report_id = tu_u16_low(xfer->setup->wValue); | |
| tuh_hid_get_report_complete_cb(xfer->daddr, idx, report_id, report_type, | |
| (xfer->result == XFER_RESULT_SUCCESS) ? xfer->setup->wLength : 0); | |
| } | |
| bool tuh_hid_get_report(uint8_t daddr, uint8_t idx, uint8_t report_id, uint8_t report_type, void* report, uint16_t len) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid); | |
| TU_LOG_DRV("HID Get Report: id = %u, type = %u, len = %u\r\n", report_id, report_type, len); | |
| tusb_control_request_t const request = { | |
| .bmRequestType_bit = { | |
| .recipient = TUSB_REQ_RCPT_INTERFACE, | |
| .type = TUSB_REQ_TYPE_CLASS, | |
| .direction = TUSB_DIR_IN | |
| }, | |
| .bRequest = HID_REQ_CONTROL_GET_REPORT, | |
| .wValue = tu_htole16(tu_u16(report_type, report_id)), | |
| .wIndex = tu_htole16((uint16_t) p_hid->itf_num), | |
| .wLength = len | |
| }; | |
| tuh_xfer_t xfer = { | |
| .daddr = daddr, | |
| .ep_addr = 0, | |
| .setup = &request, | |
| .buffer = report, | |
| .complete_cb = get_report_complete, | |
| .user_data = 0 | |
| }; | |
| return tuh_control_xfer(&xfer); | |
| } | |
| static void set_report_complete(tuh_xfer_t* xfer) { | |
| TU_LOG_DRV("HID Set Report complete\r\n"); | |
| uint8_t const itf_num = (uint8_t) tu_le16toh(xfer->setup->wIndex); | |
| uint8_t const idx = tuh_hid_itf_get_index(xfer->daddr, itf_num); | |
| uint8_t const report_type = tu_u16_high(xfer->setup->wValue); | |
| uint8_t const report_id = tu_u16_low(xfer->setup->wValue); | |
| tuh_hid_set_report_complete_cb(xfer->daddr, idx, report_id, report_type, | |
| (xfer->result == XFER_RESULT_SUCCESS) ? xfer->setup->wLength : 0); | |
| } | |
| bool tuh_hid_set_report(uint8_t daddr, uint8_t idx, uint8_t report_id, uint8_t report_type, void* report, uint16_t len) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid); | |
| TU_LOG_DRV("HID Set Report: id = %u, type = %u, len = %u\r\n", report_id, report_type, len); | |
| tusb_control_request_t const request = { | |
| .bmRequestType_bit = { | |
| .recipient = TUSB_REQ_RCPT_INTERFACE, | |
| .type = TUSB_REQ_TYPE_CLASS, | |
| .direction = TUSB_DIR_OUT | |
| }, | |
| .bRequest = HID_REQ_CONTROL_SET_REPORT, | |
| .wValue = tu_htole16(tu_u16(report_type, report_id)), | |
| .wIndex = tu_htole16((uint16_t) p_hid->itf_num), | |
| .wLength = len | |
| }; | |
| tuh_xfer_t xfer = { | |
| .daddr = daddr, | |
| .ep_addr = 0, | |
| .setup = &request, | |
| .buffer = report, | |
| .complete_cb = set_report_complete, | |
| .user_data = 0 | |
| }; | |
| return tuh_control_xfer(&xfer); | |
| } | |
| static bool hidh_set_idle(uint8_t daddr, uint8_t itf_num, uint16_t idle_rate, | |
| tuh_xfer_cb_t complete_cb, uintptr_t user_data) { | |
| // SET IDLE request, device can stall if not support this request | |
| TU_LOG_DRV("HID Set Idle \r\n"); | |
| tusb_control_request_t const request = { | |
| .bmRequestType_bit = { | |
| .recipient = TUSB_REQ_RCPT_INTERFACE, | |
| .type = TUSB_REQ_TYPE_CLASS, | |
| .direction = TUSB_DIR_OUT | |
| }, | |
| .bRequest = HID_REQ_CONTROL_SET_IDLE, | |
| .wValue = tu_htole16(idle_rate), | |
| .wIndex = tu_htole16((uint16_t) itf_num), | |
| .wLength = 0 | |
| }; | |
| tuh_xfer_t xfer = { | |
| .daddr = daddr, | |
| .ep_addr = 0, | |
| .setup = &request, | |
| .buffer = NULL, | |
| .complete_cb = complete_cb, | |
| .user_data = user_data | |
| }; | |
| return tuh_control_xfer(&xfer); | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Interrupt Endpoint API | |
| //--------------------------------------------------------------------+ | |
| // Check if HID interface is ready to receive report | |
| bool tuh_hid_receive_ready(uint8_t dev_addr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(dev_addr, idx); | |
| TU_VERIFY(p_hid); | |
| return !usbh_edpt_busy(dev_addr, p_hid->ep_in); | |
| } | |
| bool tuh_hid_receive_report(uint8_t daddr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid); | |
| hidh_epbuf_t* epbuf = get_hid_epbuf(idx); | |
| // claim endpoint | |
| TU_VERIFY(usbh_edpt_claim(daddr, p_hid->ep_in)); | |
| if (!usbh_edpt_xfer(daddr, p_hid->ep_in, epbuf->epin, p_hid->epin_size)) { | |
| usbh_edpt_release(daddr, p_hid->ep_in); | |
| return false; | |
| } | |
| return true; | |
| } | |
| bool tuh_hid_receive_abort(uint8_t dev_addr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(dev_addr, idx); | |
| TU_VERIFY(p_hid); | |
| return tuh_edpt_abort_xfer(dev_addr, p_hid->ep_in); | |
| } | |
| bool tuh_hid_send_ready(uint8_t dev_addr, uint8_t idx) { | |
| hidh_interface_t* p_hid = get_hid_itf(dev_addr, idx); | |
| TU_VERIFY(p_hid); | |
| return !usbh_edpt_busy(dev_addr, p_hid->ep_out); | |
| } | |
| bool tuh_hid_send_report(uint8_t daddr, uint8_t idx, uint8_t report_id, const void* report, uint16_t len) { | |
| TU_LOG_DRV("HID Send Report %d\r\n", report_id); | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid); | |
| hidh_epbuf_t* epbuf = get_hid_epbuf(idx); | |
| if (p_hid->ep_out == 0) { | |
| // This HID does not have an out endpoint (other than control) | |
| return false; | |
| } else if (len > CFG_TUH_HID_EPOUT_BUFSIZE || | |
| (report_id != 0 && len > (CFG_TUH_HID_EPOUT_BUFSIZE - 1))) { | |
| // ep_out buffer is not large enough to hold contents | |
| return false; | |
| } | |
| // claim endpoint | |
| TU_VERIFY(usbh_edpt_claim(daddr, p_hid->ep_out)); | |
| if (report_id == 0) { | |
| // No report ID in transmission | |
| memcpy(&epbuf->epout[0], report, len); | |
| } else { | |
| epbuf->epout[0] = report_id; | |
| memcpy(&epbuf->epout[1], report, len); | |
| ++len; // 1 more byte for report_id | |
| } | |
| TU_LOG3_MEM(epbuf->epout, len, 2); | |
| if (!usbh_edpt_xfer(daddr, p_hid->ep_out, epbuf->epout, len)) { | |
| usbh_edpt_release(daddr, p_hid->ep_out); | |
| return false; | |
| } | |
| return true; | |
| } | |
| //--------------------------------------------------------------------+ | |
| // USBH API | |
| //--------------------------------------------------------------------+ | |
| bool hidh_init(void) { | |
| TU_LOG_DRV("sizeof(hidh_interface_t) = %u\r\n", sizeof(hidh_interface_t)); | |
| tu_memclr(_hidh_itf, sizeof(_hidh_itf)); | |
| return true; | |
| } | |
| bool hidh_deinit(void) { | |
| return true; | |
| } | |
| bool hidh_xfer_cb(uint8_t daddr, uint8_t ep_addr, xfer_result_t result, uint32_t xferred_bytes) { | |
| (void) result; | |
| uint8_t const dir = tu_edpt_dir(ep_addr); | |
| uint8_t const idx = get_idx_by_epaddr(daddr, ep_addr); | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid); | |
| hidh_epbuf_t* epbuf = get_hid_epbuf(idx); | |
| if (dir == TUSB_DIR_IN) { | |
| TU_LOG_DRV(" [idx=%u] Get Report callback\r\n", idx); | |
| TU_LOG3_MEM(epbuf->epin, xferred_bytes, 2); | |
| tuh_hid_report_received_cb(daddr, idx, epbuf->epin, (uint16_t) xferred_bytes); | |
| } else { | |
| tuh_hid_report_sent_cb(daddr, idx, epbuf->epout, (uint16_t) xferred_bytes); | |
| } | |
| return true; | |
| } | |
| void hidh_close(uint8_t daddr) { | |
| for (uint8_t i = 0; i < CFG_TUH_HID; i++) { | |
| hidh_interface_t* p_hid = &_hidh_itf[i]; | |
| if (p_hid->daddr == daddr) { | |
| TU_LOG_DRV(" HIDh close addr = %u index = %u\r\n", daddr, i); | |
| tuh_hid_umount_cb(daddr, i); | |
| tu_memclr(p_hid, sizeof(hidh_interface_t)); | |
| } | |
| } | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Enumeration | |
| //--------------------------------------------------------------------+ | |
| uint16_t hidh_open(uint8_t rhport, uint8_t daddr, const tusb_desc_interface_t *desc_itf, uint16_t max_len) { | |
| (void) rhport; | |
| (void) max_len; | |
| TU_VERIFY(TUSB_CLASS_HID == desc_itf->bInterfaceClass, 0); | |
| TU_LOG_DRV("[%u] HID opening Interface %u\r\n", daddr, desc_itf->bInterfaceNumber); | |
| // len = interface + hid + n*endpoints | |
| const uint16_t drv_len = (uint16_t)(sizeof(tusb_desc_interface_t) + sizeof(tusb_hid_descriptor_hid_t) + | |
| desc_itf->bNumEndpoints * sizeof(tusb_desc_endpoint_t)); | |
| TU_ASSERT(drv_len <= max_len, 0); | |
| const uint8_t *p_desc = (const uint8_t *)desc_itf; | |
| // HID descriptor: mostly right after interface descriptor, in some rare case it might be after endpoint descriptors | |
| p_desc = tu_desc_next(p_desc); | |
| const tusb_hid_descriptor_hid_t *desc_hid; | |
| if (tu_desc_type(p_desc) == HID_DESC_TYPE_HID) { | |
| // HID after interface | |
| desc_hid = (const tusb_hid_descriptor_hid_t *)p_desc; | |
| p_desc = tu_desc_next(p_desc); | |
| } else { | |
| // HID after endpoint | |
| desc_hid = (const tusb_hid_descriptor_hid_t *)(p_desc + sizeof(tusb_desc_endpoint_t) * desc_itf->bNumEndpoints); | |
| TU_ASSERT(tu_desc_type(desc_hid) == HID_DESC_TYPE_HID, 0); | |
| } | |
| // Allocate new interface | |
| hidh_interface_t *p_hid = find_new_itf(); | |
| TU_ASSERT(p_hid, 0); // not enough interface, try to increase CFG_TUH_HID | |
| p_hid->daddr = daddr; | |
| p_hid->itf_num = desc_itf->bInterfaceNumber; | |
| // Endpoint Descriptors | |
| for (uint8_t i = 0; i < desc_itf->bNumEndpoints; i++) { | |
| const tusb_desc_endpoint_t *desc_ep = (const tusb_desc_endpoint_t *)p_desc; | |
| TU_ASSERT(TUSB_DESC_ENDPOINT == desc_ep->bDescriptorType, 0); | |
| TU_ASSERT(tuh_edpt_open(daddr, desc_ep), 0); | |
| if (tu_edpt_dir(desc_ep->bEndpointAddress) == TUSB_DIR_IN) { | |
| p_hid->ep_in = desc_ep->bEndpointAddress; | |
| p_hid->epin_size = tu_edpt_packet_size(desc_ep); | |
| } else { | |
| p_hid->ep_out = desc_ep->bEndpointAddress; | |
| p_hid->epout_size = tu_edpt_packet_size(desc_ep); | |
| } | |
| p_desc = tu_desc_next(p_desc); | |
| } | |
| // Assume bNumDescriptors = 1 | |
| p_hid->report_desc_type = desc_hid->bReportType; | |
| // Use offsetof to avoid pointer to the odd/misaligned address | |
| p_hid->report_desc_len = tu_unaligned_read16((uint8_t const*)desc_hid + offsetof(tusb_hid_descriptor_hid_t, wReportLength)); | |
| // Per HID Specs: default is Report protocol | |
| p_hid->protocol_mode = HID_PROTOCOL_REPORT; | |
| if (HID_SUBCLASS_BOOT == desc_itf->bInterfaceSubClass) { | |
| p_hid->itf_protocol = desc_itf->bInterfaceProtocol; | |
| } | |
| return drv_len; | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Set Configure | |
| //--------------------------------------------------------------------+ | |
| enum { | |
| CONFG_SET_IDLE, | |
| CONFIG_SET_PROTOCOL, | |
| CONFIG_GET_REPORT_DESC, | |
| CONFIG_COMPLETE | |
| }; | |
| static void config_driver_mount_complete(uint8_t daddr, uint8_t idx, uint8_t const* desc_report, uint16_t desc_len); | |
| static void process_set_config(tuh_xfer_t* xfer); | |
| bool hidh_set_config(uint8_t daddr, uint8_t itf_num) { | |
| tusb_control_request_t request; | |
| request.wIndex = tu_htole16((uint16_t) itf_num); | |
| tuh_xfer_t xfer; | |
| xfer.daddr = daddr; | |
| xfer.result = XFER_RESULT_SUCCESS; | |
| xfer.setup = &request; | |
| xfer.user_data = CONFG_SET_IDLE; | |
| // fake request to kick-off the set config process | |
| process_set_config(&xfer); | |
| return true; | |
| } | |
| static void process_set_config(tuh_xfer_t* xfer) { | |
| // Stall is a valid response for SET_IDLE, sometime SET_PROTOCOL as well | |
| // therefore we could ignore its result | |
| if (!(xfer->setup->bRequest == HID_REQ_CONTROL_SET_IDLE || | |
| xfer->setup->bRequest == HID_REQ_CONTROL_SET_PROTOCOL)) { | |
| TU_ASSERT(xfer->result == XFER_RESULT_SUCCESS,); | |
| } | |
| uintptr_t const state = xfer->user_data; | |
| uint8_t const itf_num = (uint8_t) tu_le16toh(xfer->setup->wIndex); | |
| uint8_t const daddr = xfer->daddr; | |
| uint8_t const idx = tuh_hid_itf_get_index(daddr, itf_num); | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid,); | |
| switch (state) { | |
| case CONFG_SET_IDLE: { | |
| // Idle rate = 0 mean only report when there are changes | |
| const uint16_t idle_rate = 0; | |
| const uintptr_t next_state = (p_hid->itf_protocol != HID_ITF_PROTOCOL_NONE) | |
| ? CONFIG_SET_PROTOCOL : CONFIG_GET_REPORT_DESC; | |
| hidh_set_idle(daddr, itf_num, idle_rate, process_set_config, next_state); | |
| break; | |
| } | |
| case CONFIG_SET_PROTOCOL: | |
| #if CFG_TUH_HID_SET_PROTOCOL_ON_ENUM | |
| hidh_set_protocol(daddr, p_hid->itf_num, _hidh_default_protocol, process_set_config, CONFIG_GET_REPORT_DESC); | |
| break; | |
| #else | |
| TU_ATTR_FALLTHROUGH; | |
| #endif | |
| case CONFIG_GET_REPORT_DESC: | |
| if (xfer->setup->bRequest == HID_REQ_CONTROL_SET_PROTOCOL && xfer->result == XFER_RESULT_SUCCESS) { | |
| p_hid->protocol_mode = (uint8_t) tu_le16toh(xfer->setup->wValue); | |
| } | |
| // Get Report Descriptor if possible | |
| // using usbh enumeration buffer since the report descriptor can be very long | |
| if (p_hid->report_desc_len > CFG_TUH_ENUMERATION_BUFSIZE) { | |
| TU_LOG_DRV("HID Skip Report Descriptor since it is too large %u bytes\r\n", p_hid->report_desc_len); | |
| config_driver_mount_complete(daddr, idx, NULL, 0); | |
| } else { | |
| tuh_descriptor_get_hid_report(daddr, itf_num, p_hid->report_desc_type, 0, | |
| usbh_get_enum_buf(), p_hid->report_desc_len, | |
| process_set_config, CONFIG_COMPLETE); | |
| } | |
| break; | |
| case CONFIG_COMPLETE: { | |
| const uint8_t *desc_report = usbh_get_enum_buf(); | |
| const uint16_t desc_len = tu_le16toh(xfer->setup->wLength); | |
| config_driver_mount_complete(daddr, idx, desc_report, desc_len); | |
| break; | |
| } | |
| default: | |
| break; | |
| } | |
| } | |
| static void config_driver_mount_complete(uint8_t daddr, uint8_t idx, uint8_t const* desc_report, uint16_t desc_len) { | |
| hidh_interface_t* p_hid = get_hid_itf(daddr, idx); | |
| TU_VERIFY(p_hid,); | |
| p_hid->mounted = true; | |
| // enumeration is complete | |
| tuh_hid_mount_cb(daddr, idx, desc_report, desc_len); | |
| // notify usbh that driver enumeration is complete | |
| usbh_driver_set_config_complete(daddr, p_hid->itf_num); | |
| } | |
| //--------------------------------------------------------------------+ | |
| // Report Descriptor Parser | |
| //--------------------------------------------------------------------+ | |
| uint8_t tuh_hid_parse_report_descriptor(tuh_hid_report_info_t* report_info_arr, uint8_t arr_count, | |
| uint8_t const* desc_report, uint16_t desc_len) { | |
| // Report Item 6.2.2.2 USB HID 1.11 | |
| union TU_ATTR_PACKED { | |
| uint8_t byte; | |
| struct TU_ATTR_PACKED { | |
| uint8_t size : 2; | |
| uint8_t type : 2; | |
| uint8_t tag : 4; | |
| }; | |
| } header; | |
| tu_memclr(report_info_arr, arr_count * sizeof(tuh_hid_report_info_t)); | |
| uint8_t report_num = 0; | |
| tuh_hid_report_info_t* info = report_info_arr; | |
| // current parsed report count & size from descriptor | |
| // uint8_t ri_report_count = 0; | |
| // uint8_t ri_report_size = 0; | |
| uint8_t ri_collection_depth = 0; | |
| while (desc_len && report_num < arr_count) { | |
| header.byte = *desc_report++; | |
| desc_len--; | |
| uint8_t const tag = header.tag; | |
| uint8_t const type = header.type; | |
| uint8_t size = header.size; | |
| if (size == 3) { | |
| size = 4; // HID 1.11 6.2.2.2 3 is 4 bytes | |
| } | |
| // item data must fit in the remaining descriptor; a truncated item would | |
| // read past the buffer and underflow desc_len below | |
| if (size > desc_len) break; | |
| uint8_t const data8 = (size > 0) ? desc_report[0] : 0; | |
| TU_LOG(3, "tag = %d, type = %d, size = %d, data = ", tag, type, size); | |
| for (uint32_t i = 0; i < size; i++) { | |
| TU_LOG(3, "%02X ", desc_report[i]); | |
| } | |
| TU_LOG(3, "\r\n"); | |
| switch (type) { | |
| case RI_TYPE_MAIN: | |
| switch (tag) { | |
| case RI_MAIN_INPUT: break; | |
| case RI_MAIN_OUTPUT: break; | |
| case RI_MAIN_FEATURE: break; | |
| case RI_MAIN_COLLECTION: | |
| ri_collection_depth++; | |
| break; | |
| case RI_MAIN_COLLECTION_END: | |
| ri_collection_depth--; | |
| if (ri_collection_depth == 0) { | |
| info++; | |
| report_num++; | |
| } | |
| break; | |
| default:break; | |
| } | |
| break; | |
| case RI_TYPE_GLOBAL: | |
| switch (tag) { | |
| case RI_GLOBAL_USAGE_PAGE: | |
| // only take in account the "usage page" before REPORT ID | |
| if (ri_collection_depth == 0) { | |
| // zero-extend: a shorter payload must not leave a stale high byte | |
| // from a previous usage page item in the same report | |
| info->usage_page = 0; | |
| memcpy(&info->usage_page, desc_report, TU_MIN(size, sizeof(info->usage_page))); | |
| } | |
| break; | |
| case RI_GLOBAL_LOGICAL_MIN: break; | |
| case RI_GLOBAL_LOGICAL_MAX: break; | |
| case RI_GLOBAL_PHYSICAL_MIN: break; | |
| case RI_GLOBAL_PHYSICAL_MAX: break; | |
| case RI_GLOBAL_REPORT_ID: | |
| info->report_id = data8; | |
| break; | |
| case RI_GLOBAL_REPORT_SIZE: | |
| // ri_report_size = data8; | |
| break; | |
| case RI_GLOBAL_REPORT_COUNT: | |
| // ri_report_count = data8; | |
| break; | |
| case RI_GLOBAL_UNIT_EXPONENT: break; | |
| case RI_GLOBAL_UNIT: break; | |
| case RI_GLOBAL_PUSH: break; | |
| case RI_GLOBAL_POP: break; | |
| default: break; | |
| } | |
| break; | |
| case RI_TYPE_LOCAL: | |
| switch (tag) { | |
| case RI_LOCAL_USAGE: | |
| // only take in account the "usage" before starting REPORT ID | |
| if (ri_collection_depth == 0) info->usage = data8; | |
| break; | |
| case RI_LOCAL_USAGE_MIN: break; | |
| case RI_LOCAL_USAGE_MAX: break; | |
| case RI_LOCAL_DESIGNATOR_INDEX: break; | |
| case RI_LOCAL_DESIGNATOR_MIN: break; | |
| case RI_LOCAL_DESIGNATOR_MAX: break; | |
| case RI_LOCAL_STRING_INDEX: break; | |
| case RI_LOCAL_STRING_MIN: break; | |
| case RI_LOCAL_STRING_MAX: break; | |
| case RI_LOCAL_DELIMITER: break; | |
| default: break; | |
| } | |
| break; | |
| // error | |
| default: break; | |
| } | |
| desc_report += size; | |
| desc_len -= size; | |
| } | |
| for (uint8_t i = 0; i < report_num; i++) { | |
| info = report_info_arr + i; | |
| TU_LOG_DRV("%u: id = %u, usage_page = %u, usage = %u\r\n", i, info->report_id, info->usage_page, info->usage); | |
| } | |
| return report_num; | |
| } | |
| #endif |