315 lines
13 KiB
C
315 lines
13 KiB
C
/*
|
|
* This file is part of the MicroPython project, http://micropython.org/
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2018 hathach for Adafruit Industries
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#include <string.h>
|
|
|
|
#include "py/gc.h"
|
|
#include "py/runtime.h"
|
|
#include "shared-bindings/usb_hid/Device.h"
|
|
#include "shared-module/usb_hid/__init__.h"
|
|
#include "shared-module/usb_hid/Device.h"
|
|
#include "supervisor/shared/translate.h"
|
|
#include "supervisor/shared/tick.h"
|
|
#include "tusb.h"
|
|
|
|
static const uint8_t keyboard_report_descriptor[] = {
|
|
0x05, 0x01, // Usage Page (Generic Desktop Ctrls)
|
|
0x09, 0x06, // Usage (Keyboard)
|
|
0xA1, 0x01, // Collection (Application)
|
|
0x85, 0x01, // Report ID (1)
|
|
0x05, 0x07, // Usage Page (Kbrd/Keypad)
|
|
0x19, 0xE0, // Usage Minimum (0xE0)
|
|
0x29, 0xE7, // Usage Maximum (0xE7)
|
|
0x15, 0x00, // Logical Minimum (0)
|
|
0x25, 0x01, // Logical Maximum (1)
|
|
0x75, 0x01, // Report Size (1)
|
|
0x95, 0x08, // Report Count (8)
|
|
0x81, 0x02, // Input (Data,Var,Abs,No Wrap,Linear,Preferred State,No Null Position)
|
|
0x95, 0x01, // Report Count (1)
|
|
0x75, 0x08, // Report Size (8)
|
|
0x81, 0x01, // Input (Const,Array,Abs,No Wrap,Linear,Preferred State,No Null Position)
|
|
0x95, 0x03, // Report Count (3)
|
|
0x75, 0x01, // Report Size (1)
|
|
0x05, 0x08, // Usage Page (LEDs)
|
|
0x19, 0x01, // Usage Minimum (Num Lock)
|
|
0x29, 0x05, // Usage Maximum (Kana)
|
|
0x91, 0x02, // Output (Data,Var,Abs,No Wrap,Linear,Preferred State,No Null Position,Non-volatile)
|
|
0x95, 0x01, // Report Count (1)
|
|
0x75, 0x05, // Report Size (5)
|
|
0x91, 0x01, // Output (Const,Array,Abs,No Wrap,Linear,Preferred State,No Null Position,Non-volatile)
|
|
0x95, 0x06, // Report Count (6)
|
|
0x75, 0x08, // Report Size (8)
|
|
0x15, 0x00, // Logical Minimum (0)
|
|
0x26, 0xFF, 0x00, // Logical Maximum (255)
|
|
0x05, 0x07, // Usage Page (Kbrd/Keypad)
|
|
0x19, 0x00, // Usage Minimum (0x00)
|
|
0x2A, 0xFF, 0x00, // Usage Maximum (0xFF)
|
|
0x81, 0x00, // Input (Data,Array,Abs,No Wrap,Linear,Preferred State,No Null Position)
|
|
0xC0, // End Collection
|
|
};
|
|
|
|
const usb_hid_device_obj_t usb_hid_device_keyboard_obj = {
|
|
.base = {
|
|
.type = &usb_hid_device_type,
|
|
},
|
|
.report_descriptor = keyboard_report_descriptor,
|
|
.report_descriptor_length = sizeof(keyboard_report_descriptor),
|
|
.usage_page = 0x01,
|
|
.usage = 0x06,
|
|
.num_report_ids = 1,
|
|
.report_ids = { 0x01, },
|
|
.in_report_lengths = { 8, 0, 0, 0, 0, 0, },
|
|
.out_report_lengths = { 1, },
|
|
};
|
|
|
|
static const uint8_t mouse_report_descriptor[] = {
|
|
0x05, 0x01, // Usage Page (Generic Desktop Ctrls)
|
|
0x09, 0x02, // Usage (Mouse)
|
|
0xA1, 0x01, // Collection (Application)
|
|
0x09, 0x01, // Usage (Pointer)
|
|
0xA1, 0x00, // Collection (Physical)
|
|
0x85, 0x02, // 10, 11 Report ID (2)
|
|
0x05, 0x09, // Usage Page (Button)
|
|
0x19, 0x01, // Usage Minimum (0x01)
|
|
0x29, 0x05, // Usage Maximum (0x05)
|
|
0x15, 0x00, // Logical Minimum (0)
|
|
0x25, 0x01, // Logical Maximum (1)
|
|
0x95, 0x05, // Report Count (5)
|
|
0x75, 0x01, // Report Size (1)
|
|
0x81, 0x02, // Input (Data,Var,Abs,No Wrap,Linear,Preferred State,No Null Position)
|
|
0x95, 0x01, // Report Count (1)
|
|
0x75, 0x03, // Report Size (3)
|
|
0x81, 0x01, // Input (Const,Array,Abs,No Wrap,Linear,Preferred State,No Null Position)
|
|
0x05, 0x01, // Usage Page (Generic Desktop Ctrls)
|
|
0x09, 0x30, // Usage (X)
|
|
0x09, 0x31, // Usage (Y)
|
|
0x15, 0x81, // Logical Minimum (-127)
|
|
0x25, 0x7F, // Logical Maximum (127)
|
|
0x75, 0x08, // Report Size (8)
|
|
0x95, 0x02, // Report Count (2)
|
|
0x81, 0x06, // Input (Data,Var,Rel,No Wrap,Linear,Preferred State,No Null Position)
|
|
0x09, 0x38, // Usage (Wheel)
|
|
0x15, 0x81, // Logical Minimum (-127)
|
|
0x25, 0x7F, // Logical Maximum (127)
|
|
0x75, 0x08, // Report Size (8)
|
|
0x95, 0x01, // Report Count (1)
|
|
0x81, 0x06, // Input (Data,Var,Rel,No Wrap,Linear,Preferred State,No Null Position)
|
|
0xC0, // End Collection
|
|
0xC0, // End Collection
|
|
};
|
|
|
|
const usb_hid_device_obj_t usb_hid_device_mouse_obj = {
|
|
.base = {
|
|
.type = &usb_hid_device_type,
|
|
},
|
|
.report_descriptor = mouse_report_descriptor,
|
|
.report_descriptor_length = sizeof(mouse_report_descriptor),
|
|
.usage_page = 0x01,
|
|
.usage = 0x02,
|
|
.num_report_ids = 1,
|
|
.report_ids = { 0x02, },
|
|
.in_report_lengths = { 4, 0, 0, 0, 0, 0, },
|
|
.out_report_lengths = { 0, },
|
|
};
|
|
|
|
static const uint8_t consumer_control_report_descriptor[] = {
|
|
0x05, 0x0C, // Usage Page (Consumer)
|
|
0x09, 0x01, // Usage (Consumer Control)
|
|
0xA1, 0x01, // Collection (Application)
|
|
0x85, 0x03, // Report ID (3)
|
|
0x75, 0x10, // Report Size (16)
|
|
0x95, 0x01, // Report Count (1)
|
|
0x15, 0x01, // Logical Minimum (1)
|
|
0x26, 0x8C, 0x02, // Logical Maximum (652)
|
|
0x19, 0x01, // Usage Minimum (Consumer Control)
|
|
0x2A, 0x8C, 0x02, // Usage Maximum (AC Send)
|
|
0x81, 0x00, // Input (Data,Array,Abs,No Wrap,Linear,Preferred State,No Null Position)
|
|
0xC0, // End Collection
|
|
};
|
|
|
|
const usb_hid_device_obj_t usb_hid_device_consumer_control_obj = {
|
|
.base = {
|
|
.type = &usb_hid_device_type,
|
|
},
|
|
.report_descriptor = consumer_control_report_descriptor,
|
|
.report_descriptor_length = sizeof(consumer_control_report_descriptor),
|
|
.usage_page = 0x0C,
|
|
.usage = 0x01,
|
|
.num_report_ids = 1,
|
|
.report_ids = { 0x03 },
|
|
.in_report_lengths = { 2, 0, 0, 0, 0, 0, },
|
|
.out_report_lengths = { 0, },
|
|
};
|
|
|
|
STATIC size_t get_report_id_idx(usb_hid_device_obj_t *self, size_t report_id) {
|
|
for (size_t i = 0; i < self->num_report_ids; i++) {
|
|
if (report_id == self->report_ids[i]) {
|
|
return i;
|
|
}
|
|
}
|
|
return MAX_REPORT_IDS_PER_DESCRIPTOR;
|
|
}
|
|
|
|
// See if report_id is used by this device. If it is -1, then return the sole report id used by this device,
|
|
// which might be 0 if no report_id was supplied.
|
|
uint8_t common_hal_usb_hid_device_validate_report_id(usb_hid_device_obj_t *self, mp_int_t report_id_arg) {
|
|
if (report_id_arg == -1 && self->num_report_ids == 1) {
|
|
return self->report_ids[0];
|
|
}
|
|
if (!(report_id_arg >= 0 &&
|
|
get_report_id_idx(self, (size_t)report_id_arg) < MAX_REPORT_IDS_PER_DESCRIPTOR)) {
|
|
mp_raise_ValueError_varg(translate("Invalid %q"), MP_QSTR_report_id);
|
|
}
|
|
return (uint8_t)report_id_arg;
|
|
}
|
|
|
|
void common_hal_usb_hid_device_construct(usb_hid_device_obj_t *self, mp_obj_t report_descriptor, uint8_t usage_page, uint8_t usage, size_t num_report_ids, uint8_t *report_ids, uint8_t *in_report_lengths, uint8_t *out_report_lengths) {
|
|
if (num_report_ids > MAX_REPORT_IDS_PER_DESCRIPTOR) {
|
|
mp_raise_ValueError_varg(translate("More than %d report ids not supported"),
|
|
MAX_REPORT_IDS_PER_DESCRIPTOR);
|
|
}
|
|
|
|
// report buffer pointers are NULL at start, and are created when USB is initialized.
|
|
mp_buffer_info_t bufinfo;
|
|
mp_get_buffer_raise(report_descriptor, &bufinfo, MP_BUFFER_READ);
|
|
self->report_descriptor_length = bufinfo.len;
|
|
|
|
// Copy the raw descriptor bytes into a heap obj. We don't keep the Python descriptor object.
|
|
|
|
uint8_t *descriptor_bytes = gc_alloc(bufinfo.len, false, false);
|
|
memcpy(descriptor_bytes, bufinfo.buf, bufinfo.len);
|
|
self->report_descriptor = descriptor_bytes;
|
|
|
|
self->usage_page = usage_page;
|
|
self->usage = usage;
|
|
self->num_report_ids = num_report_ids;
|
|
memcpy(self->report_ids, report_ids, num_report_ids);
|
|
memcpy(self->in_report_lengths, in_report_lengths, num_report_ids);
|
|
memcpy(self->out_report_lengths, out_report_lengths, num_report_ids);
|
|
}
|
|
|
|
uint8_t common_hal_usb_hid_device_get_usage_page(usb_hid_device_obj_t *self) {
|
|
return self->usage_page;
|
|
}
|
|
|
|
uint8_t common_hal_usb_hid_device_get_usage(usb_hid_device_obj_t *self) {
|
|
return self->usage;
|
|
}
|
|
|
|
void common_hal_usb_hid_device_send_report(usb_hid_device_obj_t *self, uint8_t *report, uint8_t len, uint8_t report_id) {
|
|
// report_id and len have already been validated for this device.
|
|
size_t id_idx = get_report_id_idx(self, report_id);
|
|
|
|
if (len != self->in_report_lengths[id_idx]) {
|
|
mp_raise_ValueError_varg(translate("Buffer incorrect size. Should be %d bytes."),
|
|
self->in_report_lengths[id_idx]);
|
|
}
|
|
|
|
// Wait until interface is ready, timeout = 2 seconds
|
|
uint64_t end_ticks = supervisor_ticks_ms64() + 2000;
|
|
while ((supervisor_ticks_ms64() < end_ticks) && !tud_hid_ready()) {
|
|
RUN_BACKGROUND_TASKS;
|
|
}
|
|
|
|
if (!tud_hid_ready()) {
|
|
mp_raise_msg(&mp_type_OSError, translate("USB busy"));
|
|
}
|
|
|
|
if (!tud_hid_report(report_id, report, len)) {
|
|
mp_raise_msg(&mp_type_OSError, translate("USB error"));
|
|
}
|
|
}
|
|
|
|
mp_obj_t common_hal_usb_hid_device_get_last_received_report(usb_hid_device_obj_t *self, uint8_t report_id) {
|
|
// report_id has already been validated for this deveice.
|
|
size_t id_idx = get_report_id_idx(self, report_id);
|
|
return mp_obj_new_bytes(self->out_report_buffers[id_idx], self->out_report_lengths[id_idx]);
|
|
}
|
|
|
|
void usb_hid_device_create_report_buffers(usb_hid_device_obj_t *self) {
|
|
for (size_t i = 0; i < self->num_report_ids; i++) {
|
|
// The IN buffers are used only for tud_hid_get_report_cb(),
|
|
// which is an unusual case. Normally we can just pass the data directly with tud_hid_report().
|
|
self->in_report_buffers[i] =
|
|
self->in_report_lengths[i] > 0
|
|
? gc_alloc(self->in_report_lengths[i], false, true /*long-lived*/)
|
|
: NULL;
|
|
|
|
self->out_report_buffers[i] =
|
|
self->out_report_lengths[i] > 0
|
|
? gc_alloc(self->out_report_lengths[i], false, true /*long-lived*/)
|
|
: NULL;
|
|
}
|
|
}
|
|
|
|
|
|
// Callbacks invoked when we received Get_Report request through control endpoint
|
|
uint16_t tud_hid_get_report_cb(uint8_t itf, uint8_t report_id, hid_report_type_t report_type, uint8_t *buffer, uint16_t reqlen) {
|
|
(void)itf;
|
|
// only support Input Report
|
|
if (report_type != HID_REPORT_TYPE_INPUT) {
|
|
return 0;
|
|
}
|
|
|
|
// fill buffer with current report
|
|
|
|
usb_hid_device_obj_t *hid_device;
|
|
size_t id_idx;
|
|
// Find device with this report id, and get the report id index.
|
|
if (usb_hid_get_device_with_report_id(report_id, &hid_device, &id_idx)) {
|
|
// Make sure buffer exists before trying to copy into it.
|
|
if (hid_device->in_report_buffers[id_idx]) {
|
|
memcpy(buffer, hid_device->in_report_buffers[id_idx], reqlen);
|
|
return reqlen;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
// Callbacks invoked when we received Set_Report request through control endpoint
|
|
void tud_hid_set_report_cb(uint8_t itf, uint8_t report_id, hid_report_type_t report_type, uint8_t const *buffer, uint16_t bufsize) {
|
|
(void)itf;
|
|
if (report_type == HID_REPORT_TYPE_INVALID) {
|
|
report_id = buffer[0];
|
|
buffer++;
|
|
bufsize--;
|
|
} else if (report_type != HID_REPORT_TYPE_OUTPUT) {
|
|
return;
|
|
}
|
|
|
|
usb_hid_device_obj_t *hid_device;
|
|
size_t id_idx;
|
|
// Find device with this report id, and get the report id index.
|
|
if (usb_hid_get_device_with_report_id(report_id, &hid_device, &id_idx)) {
|
|
// If a report of the correct size has been read, save it in the proper OUT report buffer.
|
|
if (hid_device &&
|
|
hid_device->out_report_buffers[id_idx] &&
|
|
hid_device->out_report_lengths[id_idx] >= bufsize) {
|
|
memcpy(hid_device->out_report_buffers[id_idx], buffer, bufsize);
|
|
}
|
|
}
|
|
}
|