ardour/libs/hidapi/linux/hid.c

1371 lines
36 KiB
C
Raw Normal View History

2016-10-23 22:53:10 +02:00
/*******************************************************
HIDAPI - Multi-Platform library for
communication with HID devices.
Alan Ott
Signal 11 Software
2024-09-03 19:34:44 +02:00
libusb/hidapi Team
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
Copyright 2022, All Rights Reserved.
2016-10-23 22:53:10 +02:00
At the discretion of the user of this library,
this software may be licensed under the terms of the
GNU General Public License v3, a BSD-Style license, or the
original HIDAPI license as outlined in the LICENSE.txt,
LICENSE-gpl3.txt, LICENSE-bsd.txt, and LICENSE-orig.txt
files located at the root of the source distribution.
These files may also be found in the public source
code repository located at:
2024-09-03 19:34:44 +02:00
https://github.com/libusb/hidapi .
2016-10-23 22:53:10 +02:00
********************************************************/
/* C */
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <locale.h>
#include <errno.h>
/* Unix */
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <sys/utsname.h>
#include <fcntl.h>
#include <poll.h>
/* Linux */
#include <linux/hidraw.h>
#include <linux/version.h>
#include <linux/input.h>
#include <libudev.h>
#include "hidapi.h"
2024-09-03 19:34:44 +02:00
#ifdef HIDAPI_ALLOW_BUILD_WORKAROUND_KERNEL_2_6_39
/* This definitions first appeared in Linux Kernel 2.6.39 in linux/hidraw.h.
hidapi doesn't support kernels older than that,
so we don't define macros below explicitly, to fail builds on old kernels.
For those who really need this as a workaround (e.g. to be able to build on old build machines),
can workaround by defining the macro above.
*/
2016-10-23 22:53:10 +02:00
#ifndef HIDIOCSFEATURE
#define HIDIOCSFEATURE(len) _IOC(_IOC_WRITE|_IOC_READ, 'H', 0x06, len)
#endif
#ifndef HIDIOCGFEATURE
#define HIDIOCGFEATURE(len) _IOC(_IOC_WRITE|_IOC_READ, 'H', 0x07, len)
#endif
2024-09-03 19:34:44 +02:00
#endif
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
// HIDIOCGINPUT and HIDIOCSOUTPUT are not defined in Linux kernel headers < 5.11.
// These definitions are from hidraw.h in Linux >= 5.11.
// https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git/commit/?id=f43d3870cafa2a0f3854c1819c8385733db8f9ae
#ifndef HIDIOCGINPUT
#define HIDIOCGINPUT(len) _IOC(_IOC_WRITE|_IOC_READ, 'H', 0x0A, len)
#endif
#ifndef HIDIOCSOUTPUT
#define HIDIOCSOUTPUT(len) _IOC(_IOC_WRITE|_IOC_READ, 'H', 0x0B, len)
#endif
2016-10-23 22:53:10 +02:00
struct hid_device_ {
int device_handle;
int blocking;
2024-09-03 19:34:44 +02:00
wchar_t *last_error_str;
struct hid_device_info* device_info;
2016-10-23 22:53:10 +02:00
};
2024-09-03 19:34:44 +02:00
static struct hid_api_version api_version = {
.major = HID_API_VERSION_MAJOR,
.minor = HID_API_VERSION_MINOR,
.patch = HID_API_VERSION_PATCH
};
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
static wchar_t *last_global_error_str = NULL;
2016-10-23 22:53:10 +02:00
static hid_device *new_hid_device(void)
{
2024-09-03 19:34:44 +02:00
hid_device *dev = (hid_device*) calloc(1, sizeof(hid_device));
if (dev == NULL) {
return NULL;
}
2016-10-23 22:53:10 +02:00
dev->device_handle = -1;
dev->blocking = 1;
2024-09-03 19:34:44 +02:00
dev->last_error_str = NULL;
dev->device_info = NULL;
2016-10-23 22:53:10 +02:00
return dev;
}
/* The caller must free the returned string with free(). */
static wchar_t *utf8_to_wchar_t(const char *utf8)
{
wchar_t *ret = NULL;
if (utf8) {
size_t wlen = mbstowcs(NULL, utf8, 0);
if ((size_t) -1 == wlen) {
return wcsdup(L"");
}
2024-09-03 19:34:44 +02:00
ret = (wchar_t*) calloc(wlen+1, sizeof(wchar_t));
if (ret == NULL) {
/* as much as we can do at this point */
return NULL;
}
2016-10-23 22:53:10 +02:00
mbstowcs(ret, utf8, wlen+1);
ret[wlen] = 0x0000;
}
return ret;
}
2024-09-03 19:34:44 +02:00
/* Makes a copy of the given error message (and decoded according to the
* currently locale) into the wide string pointer pointed by error_str.
* The last stored error string is freed.
* Use register_error_str(NULL) to free the error message completely. */
static void register_error_str(wchar_t **error_str, const char *msg)
{
free(*error_str);
*error_str = utf8_to_wchar_t(msg);
}
/* Semilar to register_error_str, but allows passing a format string with va_list args into this function. */
static void register_error_str_vformat(wchar_t **error_str, const char *format, va_list args)
{
char msg[256];
vsnprintf(msg, sizeof(msg), format, args);
register_error_str(error_str, msg);
}
/* Set the last global error to be reported by hid_error(NULL).
* The given error message will be copied (and decoded according to the
* currently locale, so do not pass in string constants).
* The last stored global error message is freed.
* Use register_global_error(NULL) to indicate "no error". */
static void register_global_error(const char *msg)
{
register_error_str(&last_global_error_str, msg);
}
/* Similar to register_global_error, but allows passing a format string into this function. */
static void register_global_error_format(const char *format, ...)
{
va_list args;
va_start(args, format);
register_error_str_vformat(&last_global_error_str, format, args);
va_end(args);
}
/* Set the last error for a device to be reported by hid_error(dev).
* The given error message will be copied (and decoded according to the
* currently locale, so do not pass in string constants).
* The last stored device error message is freed.
* Use register_device_error(dev, NULL) to indicate "no error". */
static void register_device_error(hid_device *dev, const char *msg)
{
register_error_str(&dev->last_error_str, msg);
}
/* Similar to register_device_error, but you can pass a format string into this function. */
static void register_device_error_format(hid_device *dev, const char *format, ...)
{
va_list args;
va_start(args, format);
register_error_str_vformat(&dev->last_error_str, format, args);
va_end(args);
}
2016-10-23 22:53:10 +02:00
/* Get an attribute value from a udev_device and return it as a whar_t
string. The returned string must be freed with free() when done.*/
static wchar_t *copy_udev_string(struct udev_device *dev, const char *udev_name)
{
return utf8_to_wchar_t(udev_device_get_sysattr_value(dev, udev_name));
}
2024-09-03 19:34:44 +02:00
/*
* Gets the size of the HID item at the given position
* Returns 1 if successful, 0 if an invalid key
* Sets data_len and key_size when successful
*/
static int get_hid_item_size(const __u8 *report_descriptor, __u32 size, unsigned int pos, int *data_len, int *key_size)
{
int key = report_descriptor[pos];
2016-10-23 22:53:10 +02:00
int size_code;
2024-09-03 19:34:44 +02:00
/*
* This is a Long Item. The next byte contains the
* length of the data section (value) for this key.
* See the HID specification, version 1.11, section
* 6.2.2.3, titled "Long Items."
*/
if ((key & 0xf0) == 0xf0) {
if (pos + 1 < size)
{
*data_len = report_descriptor[pos + 1];
*key_size = 3;
return 1;
}
*data_len = 0; /* malformed report */
*key_size = 0;
}
/*
* This is a Short Item. The bottom two bits of the
* key contain the size code for the data section
* (value) for this key. Refer to the HID
* specification, version 1.11, section 6.2.2.2,
* titled "Short Items."
*/
size_code = key & 0x3;
switch (size_code) {
case 0:
case 1:
case 2:
*data_len = size_code;
*key_size = 1;
return 1;
case 3:
*data_len = 4;
*key_size = 1;
return 1;
default:
/* Can't ever happen since size_code is & 0x3 */
*data_len = 0;
*key_size = 0;
break;
};
/* malformed report */
return 0;
}
/*
* Get bytes from a HID Report Descriptor.
* Only call with a num_bytes of 0, 1, 2, or 4.
*/
static __u32 get_hid_report_bytes(const __u8 *rpt, size_t len, size_t num_bytes, size_t cur)
{
/* Return if there aren't enough bytes. */
if (cur + num_bytes >= len)
return 0;
if (num_bytes == 0)
return 0;
else if (num_bytes == 1)
return rpt[cur + 1];
else if (num_bytes == 2)
return (rpt[cur + 2] * 256 + rpt[cur + 1]);
else if (num_bytes == 4)
return (
rpt[cur + 4] * 0x01000000 +
rpt[cur + 3] * 0x00010000 +
rpt[cur + 2] * 0x00000100 +
rpt[cur + 1] * 0x00000001
);
else
return 0;
}
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
/*
* Iterates until the end of a Collection.
* Assumes that *pos is exactly at the beginning of a Collection.
* Skips all nested Collection, i.e. iterates until the end of current level Collection.
*
* The return value is non-0 when an end of current Collection is found,
* 0 when error is occured (broken Descriptor, end of a Collection is found before its begin,
* or no Collection is found at all).
*/
static int hid_iterate_over_collection(const __u8 *report_descriptor, __u32 size, unsigned int *pos, int *data_len, int *key_size)
{
int collection_level = 0;
while (*pos < size) {
int key = report_descriptor[*pos];
int key_cmd = key & 0xfc;
/* Determine data_len and key_size */
if (!get_hid_item_size(report_descriptor, size, *pos, data_len, key_size))
return 0; /* malformed report */
switch (key_cmd) {
case 0xa0: /* Collection 6.2.2.4 (Main) */
collection_level++;
break;
case 0xc0: /* End Collection 6.2.2.4 (Main) */
collection_level--;
break;
}
if (collection_level < 0) {
/* Broken descriptor or someone is using this function wrong,
* i.e. should be called exactly at the collection start */
return 0;
}
if (collection_level == 0) {
/* Found it!
* Also possible when called not at the collection start, but should not happen if used correctly */
2016-10-23 22:53:10 +02:00
return 1;
}
2024-09-03 19:34:44 +02:00
*pos += *data_len + *key_size;
}
return 0; /* Did not find the end of a Collection */
}
struct hid_usage_iterator {
unsigned int pos;
int usage_page_found;
unsigned short usage_page;
};
/*
* Retrieves the device's Usage Page and Usage from the report descriptor.
* The algorithm returns the current Usage Page/Usage pair whenever a new
* Collection is found and a Usage Local Item is currently in scope.
* Usage Local Items are consumed by each Main Item (See. 6.2.2.8).
* The algorithm should give similar results as Apple's:
* https://developer.apple.com/documentation/iokit/kiohiddeviceusagepairskey?language=objc
* Physical Collections are also matched (macOS does the same).
*
* This function can be called repeatedly until it returns non-0
* Usage is found. pos is the starting point (initially 0) and will be updated
* to the next search position.
*
* The return value is 0 when a pair is found.
* 1 when finished processing descriptor.
* -1 on a malformed report.
*/
static int get_next_hid_usage(const __u8 *report_descriptor, __u32 size, struct hid_usage_iterator *ctx, unsigned short *usage_page, unsigned short *usage)
{
int data_len, key_size;
int initial = ctx->pos == 0; /* Used to handle case where no top-level application collection is defined */
int usage_found = 0;
while (ctx->pos < size) {
int key = report_descriptor[ctx->pos];
int key_cmd = key & 0xfc;
/* Determine data_len and key_size */
if (!get_hid_item_size(report_descriptor, size, ctx->pos, &data_len, &key_size))
return -1; /* malformed report */
switch (key_cmd) {
case 0x4: /* Usage Page 6.2.2.7 (Global) */
ctx->usage_page = get_hid_report_bytes(report_descriptor, size, data_len, ctx->pos);
ctx->usage_page_found = 1;
break;
case 0x8: /* Usage 6.2.2.8 (Local) */
if (data_len == 4) { /* Usages 5.5 / Usage Page 6.2.2.7 */
ctx->usage_page = get_hid_report_bytes(report_descriptor, size, 2, ctx->pos + 2);
ctx->usage_page_found = 1;
*usage = get_hid_report_bytes(report_descriptor, size, 2, ctx->pos);
usage_found = 1;
}
else {
*usage = get_hid_report_bytes(report_descriptor, size, data_len, ctx->pos);
usage_found = 1;
}
break;
case 0xa0: /* Collection 6.2.2.4 (Main) */
if (!hid_iterate_over_collection(report_descriptor, size, &ctx->pos, &data_len, &key_size)) {
return -1;
}
/* A pair is valid - to be reported when Collection is found */
if (usage_found && ctx->usage_page_found) {
*usage_page = ctx->usage_page;
return 0;
}
break;
2016-10-23 22:53:10 +02:00
}
2024-09-03 19:34:44 +02:00
/* Skip over this key and its associated data */
ctx->pos += data_len + key_size;
}
/* If no top-level application collection is found and usage page/usage pair is found, pair is valid
https://docs.microsoft.com/en-us/windows-hardware/drivers/hid/top-level-collections */
if (initial && usage_found && ctx->usage_page_found) {
*usage_page = ctx->usage_page;
return 0; /* success */
}
return 1; /* finished processing */
}
/*
* Retrieves the hidraw report descriptor from a file.
* When using this form, <sysfs_path>/device/report_descriptor, elevated privileges are not required.
*/
static int get_hid_report_descriptor(const char *rpt_path, struct hidraw_report_descriptor *rpt_desc)
{
int rpt_handle;
ssize_t res;
rpt_handle = open(rpt_path, O_RDONLY | FD_CLOEXEC);
if (rpt_handle < 0) {
register_global_error_format("open failed (%s): %s", rpt_path, strerror(errno));
return -1;
}
/*
* Read in the Report Descriptor
* The sysfs file has a maximum size of 4096 (which is the same as HID_MAX_DESCRIPTOR_SIZE) so we should always
* be ok when reading the descriptor.
* In practice if the HID descriptor is any larger I suspect many other things will break.
*/
memset(rpt_desc, 0x0, sizeof(*rpt_desc));
res = read(rpt_handle, rpt_desc->value, HID_MAX_DESCRIPTOR_SIZE);
if (res < 0) {
register_global_error_format("read failed (%s): %s", rpt_path, strerror(errno));
}
rpt_desc->size = (__u32) res;
close(rpt_handle);
return (int) res;
}
/* return size of the descriptor, or -1 on failure */
static int get_hid_report_descriptor_from_sysfs(const char *sysfs_path, struct hidraw_report_descriptor *rpt_desc)
{
int res = -1;
/* Construct <sysfs_path>/device/report_descriptor */
size_t rpt_path_len = strlen(sysfs_path) + 25 + 1;
char* rpt_path = (char*) calloc(1, rpt_path_len);
snprintf(rpt_path, rpt_path_len, "%s/device/report_descriptor", sysfs_path);
res = get_hid_report_descriptor(rpt_path, rpt_desc);
free(rpt_path);
return res;
}
/* return non-zero if successfully parsed */
static int parse_hid_vid_pid_from_uevent(const char *uevent, unsigned *bus_type, unsigned short *vendor_id, unsigned short *product_id)
{
char tmp[1024];
size_t uevent_len = strlen(uevent);
if (uevent_len > sizeof(tmp) - 1)
uevent_len = sizeof(tmp) - 1;
memcpy(tmp, uevent, uevent_len);
tmp[uevent_len] = '\0';
char *saveptr = NULL;
char *line;
char *key;
char *value;
line = strtok_r(tmp, "\n", &saveptr);
while (line != NULL) {
/* line: "KEY=value" */
key = line;
value = strchr(line, '=');
if (!value) {
goto next_line;
}
*value = '\0';
value++;
if (strcmp(key, "HID_ID") == 0) {
/**
* type vendor product
* HID_ID=0003:000005AC:00008242
**/
int ret = sscanf(value, "%x:%hx:%hx", bus_type, vendor_id, product_id);
if (ret == 3) {
return 1;
}
2016-10-23 22:53:10 +02:00
}
2024-09-03 19:34:44 +02:00
next_line:
line = strtok_r(NULL, "\n", &saveptr);
2016-10-23 22:53:10 +02:00
}
2024-09-03 19:34:44 +02:00
register_global_error("Couldn't find/parse HID_ID");
2016-10-23 22:53:10 +02:00
return 0;
}
2024-09-03 19:34:44 +02:00
/* return non-zero if successfully parsed */
static int parse_hid_vid_pid_from_uevent_path(const char *uevent_path, unsigned *bus_type, unsigned short *vendor_id, unsigned short *product_id)
{
int handle;
ssize_t res;
handle = open(uevent_path, O_RDONLY | FD_CLOEXEC);
if (handle < 0) {
register_global_error_format("open failed (%s): %s", uevent_path, strerror(errno));
return 0;
}
char buf[1024];
res = read(handle, buf, sizeof(buf) - 1); /* -1 for '\0' at the end */
close(handle);
if (res < 0) {
register_global_error_format("read failed (%s): %s", uevent_path, strerror(errno));
return 0;
}
buf[res] = '\0';
return parse_hid_vid_pid_from_uevent(buf, bus_type, vendor_id, product_id);
}
/* return non-zero if successfully read/parsed */
static int parse_hid_vid_pid_from_sysfs(const char *sysfs_path, unsigned *bus_type, unsigned short *vendor_id, unsigned short *product_id)
{
int res = 0;
/* Construct <sysfs_path>/device/uevent */
size_t uevent_path_len = strlen(sysfs_path) + 14 + 1;
char* uevent_path = (char*) calloc(1, uevent_path_len);
snprintf(uevent_path, uevent_path_len, "%s/device/uevent", sysfs_path);
res = parse_hid_vid_pid_from_uevent_path(uevent_path, bus_type, vendor_id, product_id);
free(uevent_path);
return res;
}
static int get_hid_report_descriptor_from_hidraw(hid_device *dev, struct hidraw_report_descriptor *rpt_desc)
{
int desc_size = 0;
/* Get Report Descriptor Size */
int res = ioctl(dev->device_handle, HIDIOCGRDESCSIZE, &desc_size);
if (res < 0) {
register_device_error_format(dev, "ioctl(GRDESCSIZE): %s", strerror(errno));
return res;
}
/* Get Report Descriptor */
memset(rpt_desc, 0x0, sizeof(*rpt_desc));
rpt_desc->size = desc_size;
res = ioctl(dev->device_handle, HIDIOCGRDESC, rpt_desc);
if (res < 0) {
register_device_error_format(dev, "ioctl(GRDESC): %s", strerror(errno));
}
return res;
}
2016-10-23 22:53:10 +02:00
/*
* The caller is responsible for free()ing the (newly-allocated) character
* strings pointed to by serial_number_utf8 and product_name_utf8 after use.
*/
2024-09-03 19:34:44 +02:00
static int parse_uevent_info(const char *uevent, unsigned *bus_type,
2016-10-23 22:53:10 +02:00
unsigned short *vendor_id, unsigned short *product_id,
char **serial_number_utf8, char **product_name_utf8)
{
2024-09-03 19:34:44 +02:00
char tmp[1024];
if (!uevent) {
return 0;
}
size_t uevent_len = strlen(uevent);
if (uevent_len > sizeof(tmp) - 1)
uevent_len = sizeof(tmp) - 1;
memcpy(tmp, uevent, uevent_len);
tmp[uevent_len] = '\0';
2016-10-23 22:53:10 +02:00
char *saveptr = NULL;
char *line;
char *key;
char *value;
int found_id = 0;
int found_serial = 0;
int found_name = 0;
line = strtok_r(tmp, "\n", &saveptr);
while (line != NULL) {
/* line: "KEY=value" */
key = line;
value = strchr(line, '=');
if (!value) {
goto next_line;
}
*value = '\0';
value++;
if (strcmp(key, "HID_ID") == 0) {
/**
* type vendor product
* HID_ID=0003:000005AC:00008242
**/
int ret = sscanf(value, "%x:%hx:%hx", bus_type, vendor_id, product_id);
if (ret == 3) {
found_id = 1;
}
} else if (strcmp(key, "HID_NAME") == 0) {
/* The caller has to free the product name */
*product_name_utf8 = strdup(value);
found_name = 1;
} else if (strcmp(key, "HID_UNIQ") == 0) {
/* The caller has to free the serial number */
*serial_number_utf8 = strdup(value);
found_serial = 1;
}
next_line:
line = strtok_r(NULL, "\n", &saveptr);
}
return (found_id && found_name && found_serial);
}
2024-09-03 19:34:44 +02:00
static struct hid_device_info * create_device_info_for_device(struct udev_device *raw_dev)
2016-10-23 22:53:10 +02:00
{
2024-09-03 19:34:44 +02:00
struct hid_device_info *root = NULL;
struct hid_device_info *cur_dev = NULL;
const char *sysfs_path;
const char *dev_path;
const char *str;
struct udev_device *hid_dev; /* The device's HID udev node. */
struct udev_device *usb_dev; /* The device's USB udev node. */
struct udev_device *intf_dev; /* The device's interface (in the USB sense). */
unsigned short dev_vid;
unsigned short dev_pid;
char *serial_number_utf8 = NULL;
char *product_name_utf8 = NULL;
unsigned bus_type;
int result;
struct hidraw_report_descriptor report_desc;
sysfs_path = udev_device_get_syspath(raw_dev);
dev_path = udev_device_get_devnode(raw_dev);
hid_dev = udev_device_get_parent_with_subsystem_devtype(
raw_dev,
"hid",
NULL);
if (!hid_dev) {
/* Unable to find parent hid device. */
goto end;
}
result = parse_uevent_info(
udev_device_get_sysattr_value(hid_dev, "uevent"),
&bus_type,
&dev_vid,
&dev_pid,
&serial_number_utf8,
&product_name_utf8);
if (!result) {
/* parse_uevent_info() failed for at least one field. */
goto end;
}
/* Filter out unhandled devices right away */
switch (bus_type) {
case BUS_BLUETOOTH:
case BUS_I2C:
case BUS_USB:
case BUS_SPI:
break;
default:
goto end;
}
/* Create the record. */
root = (struct hid_device_info*) calloc(1, sizeof(struct hid_device_info));
if (!root)
goto end;
cur_dev = root;
/* Fill out the record */
cur_dev->next = NULL;
cur_dev->path = dev_path? strdup(dev_path): NULL;
/* VID/PID */
cur_dev->vendor_id = dev_vid;
cur_dev->product_id = dev_pid;
/* Serial Number */
cur_dev->serial_number = utf8_to_wchar_t(serial_number_utf8);
/* Release Number */
cur_dev->release_number = 0x0;
/* Interface Number */
cur_dev->interface_number = -1;
switch (bus_type) {
case BUS_USB:
/* The device pointed to by raw_dev contains information about
the hidraw device. In order to get information about the
USB device, get the parent device with the
subsystem/devtype pair of "usb"/"usb_device". This will
be several levels up the tree, but the function will find
it. */
usb_dev = udev_device_get_parent_with_subsystem_devtype(
raw_dev,
"usb",
"usb_device");
/* uhid USB devices
* Since this is a virtual hid interface, no USB information will
* be available. */
if (!usb_dev) {
/* Manufacturer and Product strings */
cur_dev->manufacturer_string = wcsdup(L"");
cur_dev->product_string = utf8_to_wchar_t(product_name_utf8);
break;
}
cur_dev->manufacturer_string = copy_udev_string(usb_dev, "manufacturer");
cur_dev->product_string = copy_udev_string(usb_dev, "product");
cur_dev->bus_type = HID_API_BUS_USB;
str = udev_device_get_sysattr_value(usb_dev, "bcdDevice");
cur_dev->release_number = (str)? strtol(str, NULL, 16): 0x0;
/* Get a handle to the interface's udev node. */
intf_dev = udev_device_get_parent_with_subsystem_devtype(
raw_dev,
"usb",
"usb_interface");
if (intf_dev) {
str = udev_device_get_sysattr_value(intf_dev, "bInterfaceNumber");
cur_dev->interface_number = (str)? strtol(str, NULL, 16): -1;
}
break;
case BUS_BLUETOOTH:
cur_dev->manufacturer_string = wcsdup(L"");
cur_dev->product_string = utf8_to_wchar_t(product_name_utf8);
cur_dev->bus_type = HID_API_BUS_BLUETOOTH;
break;
case BUS_I2C:
cur_dev->manufacturer_string = wcsdup(L"");
cur_dev->product_string = utf8_to_wchar_t(product_name_utf8);
cur_dev->bus_type = HID_API_BUS_I2C;
break;
case BUS_SPI:
cur_dev->manufacturer_string = wcsdup(L"");
cur_dev->product_string = utf8_to_wchar_t(product_name_utf8);
cur_dev->bus_type = HID_API_BUS_SPI;
break;
default:
/* Unknown device type - this should never happen, as we
* check for USB and Bluetooth devices above */
break;
}
/* Usage Page and Usage */
result = get_hid_report_descriptor_from_sysfs(sysfs_path, &report_desc);
if (result >= 0) {
unsigned short page = 0, usage = 0;
struct hid_usage_iterator usage_iterator;
memset(&usage_iterator, 0, sizeof(usage_iterator));
/*
* Parse the first usage and usage page
* out of the report descriptor.
*/
if (!get_next_hid_usage(report_desc.value, report_desc.size, &usage_iterator, &page, &usage)) {
cur_dev->usage_page = page;
cur_dev->usage = usage;
}
/*
* Parse any additional usage and usage pages
* out of the report descriptor.
*/
while (!get_next_hid_usage(report_desc.value, report_desc.size, &usage_iterator, &page, &usage)) {
/* Create new record for additional usage pairs */
struct hid_device_info *tmp = (struct hid_device_info*) calloc(1, sizeof(struct hid_device_info));
struct hid_device_info *prev_dev = cur_dev;
if (!tmp)
continue;
cur_dev->next = tmp;
cur_dev = tmp;
/* Update fields */
cur_dev->path = dev_path? strdup(dev_path): NULL;
cur_dev->vendor_id = dev_vid;
cur_dev->product_id = dev_pid;
cur_dev->serial_number = prev_dev->serial_number? wcsdup(prev_dev->serial_number): NULL;
cur_dev->release_number = prev_dev->release_number;
cur_dev->interface_number = prev_dev->interface_number;
cur_dev->manufacturer_string = prev_dev->manufacturer_string? wcsdup(prev_dev->manufacturer_string): NULL;
cur_dev->product_string = prev_dev->product_string? wcsdup(prev_dev->product_string): NULL;
cur_dev->usage_page = page;
cur_dev->usage = usage;
cur_dev->bus_type = prev_dev->bus_type;
}
}
end:
free(serial_number_utf8);
free(product_name_utf8);
return root;
}
static struct hid_device_info * create_device_info_for_hid_device(hid_device *dev) {
2016-10-23 22:53:10 +02:00
struct udev *udev;
2024-09-03 19:34:44 +02:00
struct udev_device *udev_dev;
2016-10-23 22:53:10 +02:00
struct stat s;
int ret = -1;
2024-09-03 19:34:44 +02:00
struct hid_device_info *root = NULL;
register_device_error(dev, NULL);
/* Get the dev_t (major/minor numbers) from the file handle. */
ret = fstat(dev->device_handle, &s);
if (-1 == ret) {
register_device_error(dev, "Failed to stat device handle");
return NULL;
}
2016-10-23 22:53:10 +02:00
/* Create the udev object */
udev = udev_new();
if (!udev) {
2024-09-03 19:34:44 +02:00
register_device_error(dev, "Couldn't create udev context");
return NULL;
2016-10-23 22:53:10 +02:00
}
/* Open a udev device from the dev_t. 'c' means character device. */
udev_dev = udev_device_new_from_devnum(udev, 'c', s.st_rdev);
if (udev_dev) {
2024-09-03 19:34:44 +02:00
root = create_device_info_for_device(udev_dev);
2016-10-23 22:53:10 +02:00
}
2024-09-03 19:34:44 +02:00
if (!root) {
/* TODO: have a better error reporting via create_device_info_for_device */
register_device_error(dev, "Couldn't create hid_device_info");
}
2016-10-23 22:53:10 +02:00
udev_device_unref(udev_dev);
udev_unref(udev);
2024-09-03 19:34:44 +02:00
return root;
}
HID_API_EXPORT const struct hid_api_version* HID_API_CALL hid_version(void)
{
return &api_version;
}
HID_API_EXPORT const char* HID_API_CALL hid_version_str(void)
{
return HID_API_VERSION_STR;
2016-10-23 22:53:10 +02:00
}
int HID_API_EXPORT hid_init(void)
{
const char *locale;
2024-09-03 19:34:44 +02:00
/* indicate no error */
register_global_error(NULL);
2016-10-23 22:53:10 +02:00
/* Set the locale if it's not set. */
locale = setlocale(LC_CTYPE, NULL);
if (!locale)
setlocale(LC_CTYPE, "");
return 0;
}
int HID_API_EXPORT hid_exit(void)
{
2024-09-03 19:34:44 +02:00
/* Free global error message */
register_global_error(NULL);
2016-10-23 22:53:10 +02:00
return 0;
}
struct hid_device_info HID_API_EXPORT *hid_enumerate(unsigned short vendor_id, unsigned short product_id)
{
struct udev *udev;
struct udev_enumerate *enumerate;
struct udev_list_entry *devices, *dev_list_entry;
struct hid_device_info *root = NULL; /* return object */
struct hid_device_info *cur_dev = NULL;
hid_init();
2024-09-03 19:34:44 +02:00
/* register_global_error: global error is reset by hid_init */
2016-10-23 22:53:10 +02:00
/* Create the udev object */
udev = udev_new();
if (!udev) {
2024-09-03 19:34:44 +02:00
register_global_error("Couldn't create udev context");
2016-10-23 22:53:10 +02:00
return NULL;
}
/* Create a list of the devices in the 'hidraw' subsystem. */
enumerate = udev_enumerate_new(udev);
udev_enumerate_add_match_subsystem(enumerate, "hidraw");
udev_enumerate_scan_devices(enumerate);
devices = udev_enumerate_get_list_entry(enumerate);
/* For each item, see if it matches the vid/pid, and if so
create a udev_device record for it */
udev_list_entry_foreach(dev_list_entry, devices) {
const char *sysfs_path;
2024-09-03 19:34:44 +02:00
unsigned short dev_vid = 0;
unsigned short dev_pid = 0;
unsigned bus_type = 0;
2016-10-23 22:53:10 +02:00
struct udev_device *raw_dev; /* The device's hidraw udev node. */
2024-09-03 19:34:44 +02:00
struct hid_device_info * tmp;
2016-10-23 22:53:10 +02:00
/* Get the filename of the /sys entry for the device
and create a udev_device object (dev) representing it */
sysfs_path = udev_list_entry_get_name(dev_list_entry);
2024-09-03 19:34:44 +02:00
if (!sysfs_path)
continue;
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
if (vendor_id != 0 || product_id != 0) {
if (!parse_hid_vid_pid_from_sysfs(sysfs_path, &bus_type, &dev_vid, &dev_pid))
continue;
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
if (vendor_id != 0 && vendor_id != dev_vid)
continue;
if (product_id != 0 && product_id != dev_pid)
continue;
2016-10-23 22:53:10 +02:00
}
2024-09-03 19:34:44 +02:00
raw_dev = udev_device_new_from_syspath(udev, sysfs_path);
if (!raw_dev)
continue;
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
tmp = create_device_info_for_device(raw_dev);
if (tmp) {
2016-10-23 22:53:10 +02:00
if (cur_dev) {
cur_dev->next = tmp;
}
else {
root = tmp;
}
cur_dev = tmp;
2024-09-03 19:34:44 +02:00
/* move the pointer to the tail of returned list */
while (cur_dev->next != NULL) {
cur_dev = cur_dev->next;
2016-10-23 22:53:10 +02:00
}
}
udev_device_unref(raw_dev);
}
/* Free the enumerator and udev objects. */
udev_enumerate_unref(enumerate);
udev_unref(udev);
2024-09-03 19:34:44 +02:00
if (root == NULL) {
if (vendor_id == 0 && product_id == 0) {
register_global_error("No HID devices found in the system.");
} else {
register_global_error("No HID devices with requested VID/PID found in the system.");
}
}
2016-10-23 22:53:10 +02:00
return root;
}
void HID_API_EXPORT hid_free_enumeration(struct hid_device_info *devs)
{
struct hid_device_info *d = devs;
while (d) {
struct hid_device_info *next = d->next;
free(d->path);
free(d->serial_number);
free(d->manufacturer_string);
free(d->product_string);
free(d);
d = next;
}
}
hid_device * hid_open(unsigned short vendor_id, unsigned short product_id, const wchar_t *serial_number)
{
struct hid_device_info *devs, *cur_dev;
const char *path_to_open = NULL;
hid_device *handle = NULL;
2024-09-03 19:34:44 +02:00
/* register_global_error: global error is reset by hid_enumerate/hid_init */
2016-10-23 22:53:10 +02:00
devs = hid_enumerate(vendor_id, product_id);
2024-09-03 19:34:44 +02:00
if (devs == NULL) {
/* register_global_error: global error is already set by hid_enumerate */
return NULL;
}
2016-10-23 22:53:10 +02:00
cur_dev = devs;
while (cur_dev) {
if (cur_dev->vendor_id == vendor_id &&
cur_dev->product_id == product_id) {
if (serial_number) {
if (wcscmp(serial_number, cur_dev->serial_number) == 0) {
path_to_open = cur_dev->path;
break;
}
}
else {
path_to_open = cur_dev->path;
break;
}
}
cur_dev = cur_dev->next;
}
if (path_to_open) {
/* Open the device */
handle = hid_open_path(path_to_open);
2024-09-03 19:34:44 +02:00
} else {
register_global_error("Device with requested VID/PID/(SerialNumber) not found");
2016-10-23 22:53:10 +02:00
}
hid_free_enumeration(devs);
return handle;
}
hid_device * HID_API_EXPORT hid_open_path(const char *path)
{
hid_device *dev = NULL;
hid_init();
2024-09-03 19:34:44 +02:00
/* register_global_error: global error is reset by hid_init */
2016-10-23 22:53:10 +02:00
dev = new_hid_device();
2024-09-03 19:34:44 +02:00
if (!dev) {
register_global_error("Couldn't allocate memory");
return NULL;
}
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
dev->device_handle = open(path, O_RDWR | FD_CLOEXEC);
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
if (dev->device_handle >= 0) {
2016-10-23 22:53:10 +02:00
int res, desc_size = 0;
2024-09-03 19:34:44 +02:00
/* Make sure this is a HIDRAW device - responds to HIDIOCGRDESCSIZE */
2016-10-23 22:53:10 +02:00
res = ioctl(dev->device_handle, HIDIOCGRDESCSIZE, &desc_size);
if (res < 0) {
2024-09-03 19:34:44 +02:00
hid_close(dev);
register_global_error_format("ioctl(GRDESCSIZE) error for '%s', not a HIDRAW device?: %s", path, strerror(errno));
return NULL;
2016-10-23 22:53:10 +02:00
}
return dev;
}
else {
2024-09-03 19:34:44 +02:00
/* Unable to open a device. */
2016-10-23 22:53:10 +02:00
free(dev);
2024-09-03 19:34:44 +02:00
register_global_error_format("Failed to open a device with path '%s': %s", path, strerror(errno));
2016-10-23 22:53:10 +02:00
return NULL;
}
}
int HID_API_EXPORT hid_write(hid_device *dev, const unsigned char *data, size_t length)
{
int bytes_written;
2024-09-03 19:34:44 +02:00
if (!data || (length == 0)) {
errno = EINVAL;
register_device_error(dev, strerror(errno));
return -1;
}
2016-10-23 22:53:10 +02:00
bytes_written = write(dev->device_handle, data, length);
2024-09-03 19:34:44 +02:00
register_device_error(dev, (bytes_written == -1)? strerror(errno): NULL);
2016-10-23 22:53:10 +02:00
return bytes_written;
}
int HID_API_EXPORT hid_read_timeout(hid_device *dev, unsigned char *data, size_t length, int milliseconds)
{
2024-09-03 19:34:44 +02:00
/* Set device error to none */
register_device_error(dev, NULL);
2016-10-23 22:53:10 +02:00
int bytes_read;
if (milliseconds >= 0) {
/* Milliseconds is either 0 (non-blocking) or > 0 (contains
a valid timeout). In both cases we want to call poll()
and wait for data to arrive. Don't rely on non-blocking
operation (O_NONBLOCK) since some kernels don't seem to
properly report device disconnection through read() when
in non-blocking mode. */
int ret;
struct pollfd fds;
fds.fd = dev->device_handle;
fds.events = POLLIN;
fds.revents = 0;
ret = poll(&fds, 1, milliseconds);
2024-09-03 19:34:44 +02:00
if (ret == 0) {
/* Timeout */
return ret;
}
if (ret == -1) {
/* Error */
register_device_error(dev, strerror(errno));
2016-10-23 22:53:10 +02:00
return ret;
}
else {
/* Check for errors on the file descriptor. This will
indicate a device disconnection. */
2024-09-03 19:34:44 +02:00
if (fds.revents & (POLLERR | POLLHUP | POLLNVAL)) {
// We cannot use strerror() here as no -1 was returned from poll().
register_device_error(dev, "hid_read_timeout: unexpected poll error (device disconnected)");
2016-10-23 22:53:10 +02:00
return -1;
2024-09-03 19:34:44 +02:00
}
2016-10-23 22:53:10 +02:00
}
}
bytes_read = read(dev->device_handle, data, length);
2024-09-03 19:34:44 +02:00
if (bytes_read < 0) {
if (errno == EAGAIN || errno == EINPROGRESS)
bytes_read = 0;
else
register_device_error(dev, strerror(errno));
2016-10-23 22:53:10 +02:00
}
return bytes_read;
}
int HID_API_EXPORT hid_read(hid_device *dev, unsigned char *data, size_t length)
{
return hid_read_timeout(dev, data, length, (dev->blocking)? -1: 0);
}
int HID_API_EXPORT hid_set_nonblocking(hid_device *dev, int nonblock)
{
/* Do all non-blocking in userspace using poll(), since it looks
like there's a bug in the kernel in some versions where
read() will not return -1 on disconnection of the USB device */
dev->blocking = !nonblock;
return 0; /* Success */
}
int HID_API_EXPORT hid_send_feature_report(hid_device *dev, const unsigned char *data, size_t length)
{
int res;
2024-09-03 19:34:44 +02:00
register_device_error(dev, NULL);
2016-10-23 22:53:10 +02:00
res = ioctl(dev->device_handle, HIDIOCSFEATURE(length), data);
if (res < 0)
2024-09-03 19:34:44 +02:00
register_device_error_format(dev, "ioctl (SFEATURE): %s", strerror(errno));
2016-10-23 22:53:10 +02:00
return res;
}
int HID_API_EXPORT hid_get_feature_report(hid_device *dev, unsigned char *data, size_t length)
{
int res;
2024-09-03 19:34:44 +02:00
register_device_error(dev, NULL);
2016-10-23 22:53:10 +02:00
res = ioctl(dev->device_handle, HIDIOCGFEATURE(length), data);
if (res < 0)
2024-09-03 19:34:44 +02:00
register_device_error_format(dev, "ioctl (GFEATURE): %s", strerror(errno));
return res;
}
int HID_API_EXPORT HID_API_CALL hid_send_output_report(hid_device *dev, const unsigned char *data, size_t length)
{
int res;
register_device_error(dev, NULL);
2016-10-23 22:53:10 +02:00
2024-09-03 19:34:44 +02:00
res = ioctl(dev->device_handle, HIDIOCSOUTPUT(length), data);
if (res < 0)
register_device_error_format(dev, "ioctl (SOUTPUT): %s", strerror(errno));
2016-10-23 22:53:10 +02:00
return res;
}
2024-09-03 19:34:44 +02:00
int HID_API_EXPORT HID_API_CALL hid_get_input_report(hid_device *dev, unsigned char *data, size_t length)
{
int res;
register_device_error(dev, NULL);
res = ioctl(dev->device_handle, HIDIOCGINPUT(length), data);
if (res < 0)
register_device_error_format(dev, "ioctl (GINPUT): %s", strerror(errno));
return res;
}
2016-10-23 22:53:10 +02:00
void HID_API_EXPORT hid_close(hid_device *dev)
{
if (!dev)
return;
2024-09-03 19:34:44 +02:00
2016-10-23 22:53:10 +02:00
close(dev->device_handle);
2024-09-03 19:34:44 +02:00
/* Free the device error message */
register_device_error(dev, NULL);
hid_free_enumeration(dev->device_info);
2016-10-23 22:53:10 +02:00
free(dev);
}
int HID_API_EXPORT_CALL hid_get_manufacturer_string(hid_device *dev, wchar_t *string, size_t maxlen)
{
2024-09-03 19:34:44 +02:00
if (!string || !maxlen) {
register_device_error(dev, "Zero buffer/length");
return -1;
}
struct hid_device_info *info = hid_get_device_info(dev);
if (!info) {
// hid_get_device_info will have set an error already
return -1;
}
if (info->manufacturer_string) {
wcsncpy(string, info->manufacturer_string, maxlen);
string[maxlen - 1] = L'\0';
}
else {
string[0] = L'\0';
}
return 0;
2016-10-23 22:53:10 +02:00
}
int HID_API_EXPORT_CALL hid_get_product_string(hid_device *dev, wchar_t *string, size_t maxlen)
{
2024-09-03 19:34:44 +02:00
if (!string || !maxlen) {
register_device_error(dev, "Zero buffer/length");
return -1;
}
struct hid_device_info *info = hid_get_device_info(dev);
if (!info) {
// hid_get_device_info will have set an error already
return -1;
}
if (info->product_string) {
wcsncpy(string, info->product_string, maxlen);
string[maxlen - 1] = L'\0';
}
else {
string[0] = L'\0';
}
return 0;
2016-10-23 22:53:10 +02:00
}
int HID_API_EXPORT_CALL hid_get_serial_number_string(hid_device *dev, wchar_t *string, size_t maxlen)
{
2024-09-03 19:34:44 +02:00
if (!string || !maxlen) {
register_device_error(dev, "Zero buffer/length");
return -1;
}
struct hid_device_info *info = hid_get_device_info(dev);
if (!info) {
// hid_get_device_info will have set an error already
return -1;
}
if (info->serial_number) {
wcsncpy(string, info->serial_number, maxlen);
string[maxlen - 1] = L'\0';
}
else {
string[0] = L'\0';
}
return 0;
}
HID_API_EXPORT struct hid_device_info *HID_API_CALL hid_get_device_info(hid_device *dev) {
if (!dev->device_info) {
// Lazy initialize device_info
dev->device_info = create_device_info_for_hid_device(dev);
}
// create_device_info_for_hid_device will set an error if needed
return dev->device_info;
2016-10-23 22:53:10 +02:00
}
int HID_API_EXPORT_CALL hid_get_indexed_string(hid_device *dev, int string_index, wchar_t *string, size_t maxlen)
{
2024-09-03 19:34:44 +02:00
(void)string_index;
(void)string;
(void)maxlen;
register_device_error(dev, "hid_get_indexed_string: not supported by hidraw");
2016-10-23 22:53:10 +02:00
return -1;
}
2024-09-03 19:34:44 +02:00
int HID_API_EXPORT_CALL hid_get_report_descriptor(hid_device *dev, unsigned char *buf, size_t buf_size)
{
struct hidraw_report_descriptor rpt_desc;
int res = get_hid_report_descriptor_from_hidraw(dev, &rpt_desc);
if (res < 0) {
/* error already registered */
return res;
}
if (rpt_desc.size < buf_size) {
buf_size = (size_t) rpt_desc.size;
}
memcpy(buf, rpt_desc.value, buf_size);
return (int) buf_size;
}
/* Passing in NULL means asking for the last global error message. */
2016-10-23 22:53:10 +02:00
HID_API_EXPORT const wchar_t * HID_API_CALL hid_error(hid_device *dev)
{
2024-09-03 19:34:44 +02:00
if (dev) {
if (dev->last_error_str == NULL)
return L"Success";
return dev->last_error_str;
}
if (last_global_error_str == NULL)
return L"Success";
return last_global_error_str;
2016-10-23 22:53:10 +02:00
}