| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141 |
- /*******************************************************
- HIDAPI - Multi-Platform library for
- communication with HID devices.
- Alan Ott
- Signal 11 Software
- libusb/hidapi Team
- Copyright 2022, All Rights Reserved.
- 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:
- https://github.com/libusb/hidapi .
- ********************************************************/
- #ifndef HIDAPI_USING_SDL_RUNTIME
- #define _GNU_SOURCE /* needed for wcsdup() before glibc 2.10 */
- /* C */
- #include <stdio.h>
- #include <string.h>
- #include <stdlib.h>
- #include <ctype.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 <wchar.h>
- /* GNU / LibUSB */
- #include <libusb.h>
- #if !defined(__ANDROID__) && !defined(NO_ICONV)
- #include <iconv.h>
- #ifndef ICONV_CONST
- #define ICONV_CONST
- #endif
- #endif
- #endif /* HIDAPI_USING_SDL_RUNTIME */
- #include "hidapi_libusb.h"
- #ifndef HIDAPI_THREAD_MODEL_INCLUDE
- #define HIDAPI_THREAD_MODEL_INCLUDE "hidapi_thread_pthread.h"
- #endif
- #include HIDAPI_THREAD_MODEL_INCLUDE
- #ifdef __cplusplus
- extern "C" {
- #endif
- #ifdef DEBUG_PRINTF
- #define LOG(...) fprintf(stderr, __VA_ARGS__)
- #else
- #define LOG(...) do {} while (0)
- #endif
- #ifndef __FreeBSD__
- #define DETACH_KERNEL_DRIVER
- #endif
- /* Uncomment to enable the retrieval of Usage and Usage Page in
- hid_enumerate(). Warning, on platforms different from FreeBSD
- this is very invasive as it requires the detach
- and re-attach of the kernel driver. See comments inside hid_enumerate().
- libusb HIDAPI programs are encouraged to use the interface number
- instead to differentiate between interfaces on a composite HID device. */
- /*#define INVASIVE_GET_USAGE*/
- /* Linked List of input reports received from the device. */
- struct input_report {
- uint8_t *data;
- size_t len;
- struct input_report *next;
- };
- struct hid_device_ {
- /* Handle to the actual device. */
- libusb_device_handle *device_handle;
- /* USB Configuration Number of the device */
- int config_number;
- /* The interface number of the HID */
- int interface;
- int interface_class;
- int interface_subclass;
- int interface_protocol;
- uint16_t report_descriptor_size;
- /* Endpoint information */
- int input_endpoint;
- int output_endpoint;
- int input_ep_max_packet_size;
- /* Indexes of Strings */
- int manufacturer_index;
- int product_index;
- int serial_index;
- struct hid_device_info* device_info;
- /* Whether blocking reads are used */
- int blocking; /* boolean */
- /* Read thread objects */
- hidapi_thread_state thread_state;
- int shutdown_thread;
- int transfer_loop_finished;
- struct libusb_transfer *transfer;
- /* Quirks */
- int skip_output_report_id;
- int no_output_reports_on_intr_ep;
- /* List of received input reports. */
- struct input_report *input_reports;
- /* Was kernel driver detached by libusb */
- #ifdef DETACH_KERNEL_DRIVER
- int is_driver_detached;
- #endif
- };
- static struct hid_api_version api_version = {
- .major = HID_API_VERSION_MAJOR,
- .minor = HID_API_VERSION_MINOR,
- .patch = HID_API_VERSION_PATCH
- };
- static libusb_context *usb_context = NULL;
- uint16_t get_usb_code_for_current_locale(void);
- static int return_data(hid_device *dev, unsigned char *data, size_t length);
- static hid_device *new_hid_device(void)
- {
- hid_device *dev = (hid_device*) calloc(1, sizeof(hid_device));
- dev->blocking = 1;
- hidapi_thread_state_init(&dev->thread_state);
- return dev;
- }
- static void free_hid_device(hid_device *dev)
- {
- /* Clean up the thread objects */
- hidapi_thread_state_destroy(&dev->thread_state);
- hid_free_enumeration(dev->device_info);
- /* Free the device itself */
- free(dev);
- }
- #if 0
- /*TODO: Implement this function on hidapi/libusb.. */
- static void register_error(hid_device *dev, const char *op)
- {
- }
- #endif
- /* Get bytes from a HID Report Descriptor.
- Only call with a num_bytes of 0, 1, 2, or 4. */
- static uint32_t get_bytes(uint8_t *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;
- }
- /* Retrieves the device's Usage Page and Usage from the report
- descriptor. The algorithm is simple, as it just returns the first
- Usage and Usage Page that it finds in the descriptor.
- The return value is 0 on success and -1 on failure. */
- static int get_usage(uint8_t *report_descriptor, size_t size,
- unsigned short *usage_page, unsigned short *usage)
- {
- unsigned int i = 0;
- int size_code;
- int data_len, key_size;
- int usage_found = 0, usage_page_found = 0;
- while (i < size) {
- int key = report_descriptor[i];
- int key_cmd = key & 0xfc;
- //printf("key: %02hhx\n", key);
- if ((key & 0xf0) == 0xf0) {
- /* 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 (i+1 < size)
- data_len = report_descriptor[i+1];
- else
- data_len = 0; /* malformed report */
- key_size = 3;
- }
- else {
- /* 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;
- break;
- case 3:
- data_len = 4;
- break;
- default:
- /* Can't ever happen since size_code is & 0x3 */
- data_len = 0;
- break;
- };
- key_size = 1;
- }
- if (key_cmd == 0x4) {
- *usage_page = get_bytes(report_descriptor, size, data_len, i);
- usage_page_found = 1;
- //printf("Usage Page: %x\n", (uint32_t)*usage_page);
- }
- if (key_cmd == 0x8) {
- if (data_len == 4) { /* Usages 5.5 / Usage Page 6.2.2.7 */
- *usage_page = get_bytes(report_descriptor, size, 2, i + 2);
- usage_page_found = 1;
- *usage = get_bytes(report_descriptor, size, 2, i);
- usage_found = 1;
- }
- else {
- *usage = get_bytes(report_descriptor, size, data_len, i);
- usage_found = 1;
- }
- //printf("Usage: %x\n", (uint32_t)*usage);
- }
- if (usage_page_found && usage_found)
- return 0; /* success */
- /* Skip over this key and it's associated data */
- i += data_len + key_size;
- }
- return -1; /* failure */
- }
- #if defined(__FreeBSD__) && __FreeBSD__ < 10
- /* The libusb version included in FreeBSD < 10 doesn't have this function. In
- mainline libusb, it's inlined in libusb.h. This function will bear a striking
- resemblance to that one, because there's about one way to code it.
- Note that the data parameter is Unicode in UTF-16LE encoding.
- Return value is the number of bytes in data, or LIBUSB_ERROR_*.
- */
- static inline int libusb_get_string_descriptor(libusb_device_handle *dev,
- uint8_t descriptor_index, uint16_t lang_id,
- unsigned char *data, int length)
- {
- return libusb_control_transfer(dev,
- LIBUSB_ENDPOINT_IN | 0x0, /* Endpoint 0 IN */
- LIBUSB_REQUEST_GET_DESCRIPTOR,
- (LIBUSB_DT_STRING << 8) | descriptor_index,
- lang_id, data, (uint16_t) length, 1000);
- }
- #endif
- /* Get the first language the device says it reports. This comes from
- USB string #0. */
- static uint16_t get_first_language(libusb_device_handle *dev)
- {
- uint16_t buf[32];
- int len;
- /* Get the string from libusb. */
- len = libusb_get_string_descriptor(dev,
- 0x0, /* String ID */
- 0x0, /* Language */
- (unsigned char*)buf,
- sizeof(buf));
- if (len < 4)
- return 0x0;
- return buf[1]; /* First two bytes are len and descriptor type. */
- }
- static int is_language_supported(libusb_device_handle *dev, uint16_t lang)
- {
- uint16_t buf[32];
- int len;
- int i;
- /* Get the string from libusb. */
- len = libusb_get_string_descriptor(dev,
- 0x0, /* String ID */
- 0x0, /* Language */
- (unsigned char*)buf,
- sizeof(buf));
- if (len < 4)
- return 0x0;
- len /= 2; /* language IDs are two-bytes each. */
- /* Start at index 1 because there are two bytes of protocol data. */
- for (i = 1; i < len; i++) {
- if (buf[i] == lang)
- return 1;
- }
- return 0;
- }
- /* This function returns a newly allocated wide string containing the USB
- device string numbered by the index. The returned string must be freed
- by using free(). */
- static wchar_t *get_usb_string(libusb_device_handle *dev, uint8_t idx)
- {
- char buf[512];
- int len;
- wchar_t *str = NULL;
- #if !defined(__ANDROID__) && !defined(NO_ICONV) /* we don't use iconv on Android, or when it is explicitly disabled */
- wchar_t wbuf[256];
- /* iconv variables */
- iconv_t ic;
- size_t inbytes;
- size_t outbytes;
- size_t res;
- ICONV_CONST char *inptr;
- char *outptr;
- #endif
- /* Determine which language to use. */
- uint16_t lang;
- lang = get_usb_code_for_current_locale();
- if (!is_language_supported(dev, lang))
- lang = get_first_language(dev);
- /* Get the string from libusb. */
- len = libusb_get_string_descriptor(dev,
- idx,
- lang,
- (unsigned char*)buf,
- sizeof(buf));
- if (len < 2) /* we always skip first 2 bytes */
- return NULL;
- #if defined(__ANDROID__) || defined(NO_ICONV)
- /* Bionic does not have iconv support nor wcsdup() function, so it
- has to be done manually. The following code will only work for
- code points that can be represented as a single UTF-16 character,
- and will incorrectly convert any code points which require more
- than one UTF-16 character.
- Skip over the first character (2-bytes). */
- len -= 2;
- str = (wchar_t*) malloc((len / 2 + 1) * sizeof(wchar_t));
- int i;
- for (i = 0; i < len / 2; i++) {
- str[i] = buf[i * 2 + 2] | (buf[i * 2 + 3] << 8);
- }
- str[len / 2] = 0x00000000;
- #else
- /* buf does not need to be explicitly NULL-terminated because
- it is only passed into iconv() which does not need it. */
- /* Initialize iconv. */
- ic = iconv_open("WCHAR_T", "UTF-16LE");
- if (ic == (iconv_t)-1) {
- LOG("iconv_open() failed\n");
- return NULL;
- }
- /* Convert to native wchar_t (UTF-32 on glibc/BSD systems).
- Skip the first character (2-bytes). */
- inptr = buf+2;
- inbytes = len-2;
- outptr = (char*) wbuf;
- outbytes = sizeof(wbuf);
- res = iconv(ic, &inptr, &inbytes, &outptr, &outbytes);
- if (res == (size_t)-1) {
- LOG("iconv() failed\n");
- goto err;
- }
- /* Write the terminating NULL. */
- wbuf[sizeof(wbuf)/sizeof(wbuf[0])-1] = 0x00000000;
- if (outbytes >= sizeof(wbuf[0]))
- *((wchar_t*)outptr) = 0x00000000;
- /* Allocate and copy the string. */
- str = wcsdup(wbuf);
- err:
- iconv_close(ic);
- #endif
- return str;
- }
- struct usb_string_cache_entry {
- uint16_t vid;
- uint16_t pid;
- wchar_t *vendor;
- wchar_t *product;
- };
- static struct usb_string_cache_entry *usb_string_cache = NULL;
- static size_t usb_string_cache_size = 0;
- static size_t usb_string_cache_insert_pos = 0;
- static int usb_string_cache_grow()
- {
- struct usb_string_cache_entry *new_cache;
- size_t allocSize;
- size_t new_cache_size;
- new_cache_size = usb_string_cache_size + 8;
- allocSize = sizeof(struct usb_string_cache_entry) * new_cache_size;
- new_cache = (struct usb_string_cache_entry *)realloc(usb_string_cache, allocSize);
- if (!new_cache)
- return -1;
- usb_string_cache = new_cache;
- usb_string_cache_size = new_cache_size;
- return 0;
- }
- static void usb_string_cache_destroy()
- {
- size_t i;
- for (i = 0; i < usb_string_cache_insert_pos; i++) {
- free(usb_string_cache[i].vendor);
- free(usb_string_cache[i].product);
- }
- free(usb_string_cache);
- usb_string_cache = NULL;
- usb_string_cache_size = 0;
- usb_string_cache_insert_pos = 0;
- }
- static struct usb_string_cache_entry *usb_string_cache_insert()
- {
- struct usb_string_cache_entry *new_entry = NULL;
- if (usb_string_cache_insert_pos >= usb_string_cache_size) {
- if (usb_string_cache_grow() < 0)
- return NULL;
- }
- new_entry = &usb_string_cache[usb_string_cache_insert_pos];
- usb_string_cache_insert_pos++;
- return new_entry;
- }
- static int usb_string_can_cache(uint16_t vid, uint16_t pid)
- {
- if (!vid || !pid) {
- /* We can't cache these, they aren't unique */
- return 0;
- }
- if (vid == 0x0f0d && pid == 0x00dc) {
- /* HORI reuses this VID/PID for many different products */
- return 0;
- }
- /* We can cache these strings */
- return 1;
- }
- static const struct usb_string_cache_entry *usb_string_cache_find(struct libusb_device_descriptor *desc, struct libusb_device_handle *handle)
- {
- struct usb_string_cache_entry *entry = NULL;
- size_t i;
- /* Search for existing string cache entry */
- for (i = 0; i < usb_string_cache_insert_pos; i++) {
- entry = &usb_string_cache[i];
- if (entry->vid != desc->idVendor)
- continue;
- if (entry->pid != desc->idProduct)
- continue;
- return entry;
- }
- /* Not found, create one. */
- entry = usb_string_cache_insert();
- if (!entry)
- return NULL;
- entry->vid = desc->idVendor;
- entry->pid = desc->idProduct;
- if (desc->iManufacturer > 0)
- entry->vendor = get_usb_string(handle, desc->iManufacturer);
- else
- entry->vendor = NULL;
- if (desc->iProduct > 0)
- entry->product = get_usb_string(handle, desc->iProduct);
- else
- entry->product = NULL;
- return entry;
- }
- /**
- Max length of the result: "000-000.000.000.000.000.000.000:000.000" (39 chars).
- 64 is used for simplicity/alignment.
- */
- static void get_path(char (*result)[64], libusb_device *dev, int config_number, int interface_number)
- {
- char *str = *result;
- /* Note that USB3 port count limit is 7; use 8 here for alignment */
- uint8_t port_numbers[8] = {0, 0, 0, 0, 0, 0, 0, 0};
- int num_ports = libusb_get_port_numbers(dev, port_numbers, 8);
- if (num_ports > 0) {
- int n = snprintf(str, sizeof("000-000"), "%u-%u", libusb_get_bus_number(dev), port_numbers[0]);
- for (uint8_t i = 1; i < num_ports; i++) {
- n += snprintf(&str[n], sizeof(".000"), ".%u", port_numbers[i]);
- }
- n += snprintf(&str[n], sizeof(":000.000"), ":%u.%u", (uint8_t)config_number, (uint8_t)interface_number);
- str[n] = '\0';
- } else {
- /* Likely impossible, but check: USB3.0 specs limit number of ports to 7 and buffer size here is 8 */
- if (num_ports == LIBUSB_ERROR_OVERFLOW) {
- LOG("make_path() failed. buffer overflow error\n");
- } else {
- LOG("make_path() failed. unknown error\n");
- }
- str[0] = '\0';
- }
- }
- static char *make_path(libusb_device *dev, int config_number, int interface_number)
- {
- char str[64];
- get_path(&str, dev, config_number, interface_number);
- return strdup(str);
- }
- 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;
- }
- int HID_API_EXPORT hid_init(void)
- {
- if (!usb_context) {
- const char *locale;
- /* Init Libusb */
- if (libusb_init(&usb_context))
- return -1;
- /* Set the locale if it's not set. */
- locale = setlocale(LC_CTYPE, NULL);
- if (!locale)
- (void) setlocale(LC_CTYPE, "");
- }
- return 0;
- }
- int HID_API_EXPORT hid_exit(void)
- {
- usb_string_cache_destroy();
- if (usb_context) {
- libusb_exit(usb_context);
- usb_context = NULL;
- }
- return 0;
- }
- static int hid_get_report_descriptor_libusb(libusb_device_handle *handle, int interface_num, uint16_t expected_report_descriptor_size, unsigned char *buf, size_t buf_size)
- {
- unsigned char *tmp = (unsigned char *)malloc(HID_API_MAX_REPORT_DESCRIPTOR_SIZE);
- if (expected_report_descriptor_size > HID_API_MAX_REPORT_DESCRIPTOR_SIZE)
- expected_report_descriptor_size = HID_API_MAX_REPORT_DESCRIPTOR_SIZE;
- /* Get the HID Report Descriptor.
- See USB HID Specification, section 7.1.1
- */
- int res = libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_RECIPIENT_INTERFACE, LIBUSB_REQUEST_GET_DESCRIPTOR, (LIBUSB_DT_REPORT << 8), interface_num, tmp, expected_report_descriptor_size, 5000);
- if (res >= 0) {
- if (res > (int)buf_size)
- res = (int)buf_size;
- memcpy(buf, tmp, (size_t)res);
- } else {
- LOG("libusb_control_transfer() for getting the HID Report descriptor failed with %d: %s\n", res, libusb_error_name(res));
- }
- free(tmp);
- return res;
- }
- /**
- * Requires an opened device with *claimed interface*.
- */
- static void fill_device_info_usage(struct hid_device_info *cur_dev, libusb_device_handle *handle, int interface_num, uint16_t expected_report_descriptor_size)
- {
- unsigned char *hid_report_descriptor = malloc(HID_API_MAX_REPORT_DESCRIPTOR_SIZE);
- unsigned short page = 0, usage = 0;
- int res = hid_get_report_descriptor_libusb(handle, interface_num, expected_report_descriptor_size, hid_report_descriptor, HID_API_MAX_REPORT_DESCRIPTOR_SIZE);
- if (res >= 0) {
- /* Parse the usage and usage page
- out of the report descriptor. */
- get_usage(hid_report_descriptor, res, &page, &usage);
- }
- cur_dev->usage_page = page;
- cur_dev->usage = usage;
- }
- #ifdef INVASIVE_GET_USAGE
- static void invasive_fill_device_info_usage(struct hid_device_info *cur_dev, libusb_device_handle *handle, int interface_num, uint16_t report_descriptor_size)
- {
- int res = 0;
- #ifdef DETACH_KERNEL_DRIVER
- int detached = 0;
- /* Usage Page and Usage */
- res = libusb_kernel_driver_active(handle, interface_num);
- if (res == 1) {
- res = libusb_detach_kernel_driver(handle, interface_num);
- if (res < 0)
- LOG("Couldn't detach kernel driver, even though a kernel driver was attached.\n");
- else
- detached = 1;
- }
- #endif
- res = libusb_claim_interface(handle, interface_num);
- if (res >= 0) {
- fill_device_info_usage(cur_dev, handle, interface_num, report_descriptor_size);
- /* Release the interface */
- res = libusb_release_interface(handle, interface_num);
- if (res < 0)
- LOG("Can't release the interface.\n");
- }
- else
- LOG("Can't claim interface: (%d) %s\n", res, libusb_error_name(res));
- #ifdef DETACH_KERNEL_DRIVER
- /* Re-attach kernel driver if necessary. */
- if (detached) {
- res = libusb_attach_kernel_driver(handle, interface_num);
- if (res < 0)
- LOG("Couldn't re-attach kernel driver.\n");
- }
- #endif
- }
- #endif /* INVASIVE_GET_USAGE */
- /**
- * Create and fill up most of hid_device_info fields.
- * usage_page/usage is not filled up.
- */
- static struct hid_device_info * create_device_info_for_device(libusb_device *device, libusb_device_handle *handle, struct libusb_device_descriptor *desc, int config_number, int interface_num, int interface_class, int interface_subclass, int interface_protocol)
- {
- struct hid_device_info *cur_dev = calloc(1, sizeof(struct hid_device_info));
- if (cur_dev == NULL) {
- return NULL;
- }
- /* VID/PID */
- cur_dev->vendor_id = desc->idVendor;
- cur_dev->product_id = desc->idProduct;
- cur_dev->release_number = desc->bcdDevice;
- cur_dev->interface_number = interface_num;
- cur_dev->interface_class = interface_class;
- cur_dev->interface_subclass = interface_subclass;
- cur_dev->interface_protocol = interface_protocol;
- cur_dev->bus_type = HID_API_BUS_USB;
- cur_dev->path = make_path(device, config_number, interface_num);
- if (!handle) {
- return cur_dev;
- }
- if (desc->iSerialNumber > 0)
- cur_dev->serial_number = get_usb_string(handle, desc->iSerialNumber);
- /* Manufacturer and Product strings */
- const struct usb_string_cache_entry *string_cache;
- if (usb_string_can_cache(desc->idVendor, desc->idProduct) &&
- (string_cache = usb_string_cache_find(desc, handle)) != NULL) {
- if (string_cache->vendor) {
- cur_dev->manufacturer_string = wcsdup(string_cache->vendor);
- }
- if (string_cache->product) {
- cur_dev->product_string = wcsdup(string_cache->product);
- }
- } else {
- if (desc->iManufacturer > 0)
- cur_dev->manufacturer_string = get_usb_string(handle, desc->iManufacturer);
- if (desc->iProduct > 0)
- cur_dev->product_string = get_usb_string(handle, desc->iProduct);
- }
- return cur_dev;
- }
- static uint16_t get_report_descriptor_size_from_interface_descriptors(const struct libusb_interface_descriptor *intf_desc)
- {
- int i = 0;
- int found_hid_report_descriptor = 0;
- uint16_t result = HID_API_MAX_REPORT_DESCRIPTOR_SIZE;
- const unsigned char *extra = intf_desc->extra;
- int extra_length = intf_desc->extra_length;
- /*
- "extra" contains a HID descriptor
- See section 6.2.1 of HID 1.1 specification.
- */
- while (extra_length >= 2) { /* Descriptor header: bLength/bDescriptorType */
- if (extra[1] == LIBUSB_DT_HID) { /* bDescriptorType */
- if (extra_length < 6) {
- LOG("Broken HID descriptor: not enough data\n");
- break;
- }
- unsigned char bNumDescriptors = extra[5];
- if (extra_length < (6 + 3 * bNumDescriptors)) {
- LOG("Broken HID descriptor: not enough data for Report metadata\n");
- break;
- }
- for (i = 0; i < bNumDescriptors; i++) {
- if (extra[6 + 3 * i] == LIBUSB_DT_REPORT) {
- result = (uint16_t)extra[6 + 3 * i + 2] << 8 | extra[6 + 3 * i + 1];
- found_hid_report_descriptor = 1;
- break;
- }
- }
- if (!found_hid_report_descriptor) {
- /* We expect to find exactly 1 HID descriptor (LIBUSB_DT_HID)
- which should contain exactly one HID Report Descriptor metadata (LIBUSB_DT_REPORT). */
- LOG("Broken HID descriptor: missing Report descriptor\n");
- }
- break;
- }
- if (extra[0] == 0) { /* bLength */
- LOG("Broken HID Interface descriptors: zero-sized descriptor\n");
- break;
- }
- /* Iterate over to the next Descriptor */
- extra_length -= extra[0];
- extra += extra[0];
- }
- return result;
- }
- static int is_xbox360(unsigned short vendor_id, const struct libusb_interface_descriptor *intf_desc)
- {
- static const int xb360_iface_subclass = 93;
- static const int xb360_iface_protocol = 1; /* Wired */
- static const int xb360w_iface_protocol = 129; /* Wireless */
- static const int supported_vendors[] = {
- 0x0079, /* GPD Win 2 */
- 0x044f, /* Thrustmaster */
- 0x045e, /* Microsoft */
- 0x046d, /* Logitech */
- 0x056e, /* Elecom */
- 0x06a3, /* Saitek */
- 0x0738, /* Mad Catz */
- 0x07ff, /* Mad Catz */
- 0x0e6f, /* PDP */
- 0x0f0d, /* Hori */
- 0x1038, /* SteelSeries */
- 0x11c9, /* Nacon */
- 0x12ab, /* Unknown */
- 0x1430, /* RedOctane */
- 0x146b, /* BigBen */
- 0x1532, /* Razer Sabertooth */
- 0x15e4, /* Numark */
- 0x162e, /* Joytech */
- 0x1689, /* Razer Onza */
- 0x1949, /* Lab126, Inc. */
- 0x1bad, /* Harmonix */
- 0x20d6, /* PowerA */
- 0x24c6, /* PowerA */
- 0x2c22, /* Qanba */
- 0x2dc8, /* 8BitDo */
- 0x9886, /* ASTRO Gaming */
- };
- if (intf_desc->bInterfaceClass == LIBUSB_CLASS_VENDOR_SPEC &&
- intf_desc->bInterfaceSubClass == xb360_iface_subclass &&
- (intf_desc->bInterfaceProtocol == xb360_iface_protocol ||
- intf_desc->bInterfaceProtocol == xb360w_iface_protocol)) {
- size_t i;
- for (i = 0; i < sizeof(supported_vendors)/sizeof(supported_vendors[0]); ++i) {
- if (vendor_id == supported_vendors[i]) {
- return 1;
- }
- }
- }
- return 0;
- }
- static int is_xboxone(unsigned short vendor_id, const struct libusb_interface_descriptor *intf_desc)
- {
- static const int xb1_iface_subclass = 71;
- static const int xb1_iface_protocol = 208;
- static const int supported_vendors[] = {
- 0x03f0, /* HP */
- 0x044f, /* Thrustmaster */
- 0x045e, /* Microsoft */
- 0x0738, /* Mad Catz */
- 0x0e6f, /* PDP */
- 0x0f0d, /* Hori */
- 0x10f5, /* Turtle Beach */
- 0x1532, /* Razer Wildcat */
- 0x20d6, /* PowerA */
- 0x24c6, /* PowerA */
- 0x2dc8, /* 8BitDo */
- 0x2e24, /* Hyperkin */
- 0x3537, /* GameSir */
- };
- if (intf_desc->bInterfaceNumber == 0 &&
- intf_desc->bInterfaceClass == LIBUSB_CLASS_VENDOR_SPEC &&
- intf_desc->bInterfaceSubClass == xb1_iface_subclass &&
- intf_desc->bInterfaceProtocol == xb1_iface_protocol) {
- size_t i;
- for (i = 0; i < sizeof(supported_vendors)/sizeof(supported_vendors[0]); ++i) {
- if (vendor_id == supported_vendors[i]) {
- return 1;
- }
- }
- }
- return 0;
- }
- static int should_enumerate_interface(unsigned short vendor_id, const struct libusb_interface_descriptor *intf_desc)
- {
- #if 0
- printf("Checking interface 0x%x %d/%d/%d/%d\n", vendor_id, intf_desc->bInterfaceNumber, intf_desc->bInterfaceClass, intf_desc->bInterfaceSubClass, intf_desc->bInterfaceProtocol);
- #endif
- if (intf_desc->bInterfaceClass == LIBUSB_CLASS_HID)
- return 1;
- /* Also enumerate Xbox 360 controllers */
- if (is_xbox360(vendor_id, intf_desc))
- return 1;
- /* Also enumerate Xbox One controllers */
- if (is_xboxone(vendor_id, intf_desc))
- return 1;
- return 0;
- }
- struct hid_device_info HID_API_EXPORT *hid_enumerate(unsigned short vendor_id, unsigned short product_id)
- {
- libusb_device **devs;
- libusb_device *dev;
- libusb_device_handle *handle = NULL;
- ssize_t num_devs;
- int i = 0;
- struct hid_device_info *root = NULL; /* return object */
- struct hid_device_info *cur_dev = NULL;
- if(hid_init() < 0)
- return NULL;
- num_devs = libusb_get_device_list(usb_context, &devs);
- if (num_devs < 0)
- return NULL;
- while ((dev = devs[i++]) != NULL) {
- struct libusb_device_descriptor desc;
- struct libusb_config_descriptor *conf_desc = NULL;
- int j, k;
- int res = libusb_get_device_descriptor(dev, &desc);
- if (res < 0)
- continue;
- unsigned short dev_vid = desc.idVendor;
- unsigned short dev_pid = desc.idProduct;
- if ((vendor_id != 0x0 && vendor_id != dev_vid) ||
- (product_id != 0x0 && product_id != dev_pid)) {
- continue;
- }
- #ifdef HIDAPI_IGNORE_DEVICE
- /* See if there are any devices we should skip in enumeration */
- if (HIDAPI_IGNORE_DEVICE(HID_API_BUS_USB, dev_vid, dev_pid, 0, 0)) {
- continue;
- }
- #endif
- res = libusb_get_active_config_descriptor(dev, &conf_desc);
- if (res < 0)
- libusb_get_config_descriptor(dev, 0, &conf_desc);
- if (conf_desc) {
- for (j = 0; j < conf_desc->bNumInterfaces; j++) {
- const struct libusb_interface *intf = &conf_desc->interface[j];
- for (k = 0; k < intf->num_altsetting; k++) {
- const struct libusb_interface_descriptor *intf_desc;
- intf_desc = &intf->altsetting[k];
- if (should_enumerate_interface(dev_vid, intf_desc)) {
- struct hid_device_info *tmp;
- res = libusb_open(dev, &handle);
- #ifdef __ANDROID__
- if (handle) {
- /* There is (a potential) libusb Android backend, in which
- device descriptor is not accurate up until the device is opened.
- https://github.com/libusb/libusb/pull/874#discussion_r632801373
- A workaround is to re-read the descriptor again.
- Even if it is not going to be accepted into libusb master,
- having it here won't do any harm, since reading the device descriptor
- is as cheap as copy 18 bytes of data. */
- libusb_get_device_descriptor(dev, &desc);
- }
- #endif
- tmp = create_device_info_for_device(dev, handle, &desc, conf_desc->bConfigurationValue, intf_desc->bInterfaceNumber, intf_desc->bInterfaceClass, intf_desc->bInterfaceSubClass, intf_desc->bInterfaceProtocol);
- if (tmp) {
- #ifdef INVASIVE_GET_USAGE
- /* TODO: have a runtime check for this section. */
- /*
- This section is removed because it is too
- invasive on the system. Getting a Usage Page
- and Usage requires parsing the HID Report
- descriptor. Getting a HID Report descriptor
- involves claiming the interface. Claiming the
- interface involves detaching the kernel driver.
- Detaching the kernel driver is hard on the system
- because it will unclaim interfaces (if another
- app has them claimed) and the re-attachment of
- the driver will sometimes change /dev entry names.
- It is for these reasons that this section is
- optional. For composite devices, use the interface
- field in the hid_device_info struct to distinguish
- between interfaces. */
- if (handle) {
- uint16_t report_descriptor_size = get_report_descriptor_size_from_interface_descriptors(intf_desc);
- invasive_fill_device_info_usage(tmp, handle, intf_desc->bInterfaceNumber, report_descriptor_size);
- }
- #endif /* INVASIVE_GET_USAGE */
- if (cur_dev) {
- cur_dev->next = tmp;
- }
- else {
- root = tmp;
- }
- cur_dev = tmp;
- }
- if (res >= 0) {
- libusb_close(handle);
- handle = NULL;
- }
- break;
- }
- } /* altsettings */
- } /* interfaces */
- libusb_free_config_descriptor(conf_desc);
- }
- }
- libusb_free_device_list(devs, 1);
- 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;
- devs = hid_enumerate(vendor_id, product_id);
- cur_dev = devs;
- while (cur_dev) {
- if (cur_dev->vendor_id == vendor_id &&
- cur_dev->product_id == product_id) {
- if (serial_number) {
- if (cur_dev->serial_number &&
- 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);
- }
- hid_free_enumeration(devs);
- return handle;
- }
- static void LIBUSB_CALL read_callback(struct libusb_transfer *transfer)
- {
- hid_device *dev = transfer->user_data;
- int res;
- if (transfer->status == LIBUSB_TRANSFER_COMPLETED) {
- struct input_report *rpt = (struct input_report*) malloc(sizeof(*rpt));
- rpt->data = (uint8_t*) malloc(transfer->actual_length);
- memcpy(rpt->data, transfer->buffer, transfer->actual_length);
- rpt->len = transfer->actual_length;
- rpt->next = NULL;
- hidapi_thread_mutex_lock(&dev->thread_state);
- /* Attach the new report object to the end of the list. */
- if (dev->input_reports == NULL) {
- /* The list is empty. Put it at the root. */
- dev->input_reports = rpt;
- hidapi_thread_cond_signal(&dev->thread_state);
- }
- else {
- /* Find the end of the list and attach. */
- struct input_report *cur = dev->input_reports;
- int num_queued = 0;
- while (cur->next != NULL) {
- cur = cur->next;
- num_queued++;
- }
- cur->next = rpt;
- /* Pop one off if we've reached 30 in the queue. This
- way we don't grow forever if the user never reads
- anything from the device. */
- if (num_queued > 30) {
- return_data(dev, NULL, 0);
- }
- }
- hidapi_thread_mutex_unlock(&dev->thread_state);
- }
- else if (transfer->status == LIBUSB_TRANSFER_CANCELLED) {
- dev->shutdown_thread = 1;
- }
- else if (transfer->status == LIBUSB_TRANSFER_NO_DEVICE) {
- dev->shutdown_thread = 1;
- }
- else if (transfer->status == LIBUSB_TRANSFER_TIMED_OUT) {
- //LOG("Timeout (normal)\n");
- }
- else {
- LOG("Unknown transfer code: %d\n", transfer->status);
- }
- if (dev->shutdown_thread) {
- dev->transfer_loop_finished = 1;
- return;
- }
- /* Re-submit the transfer object. */
- res = libusb_submit_transfer(transfer);
- if (res != 0) {
- LOG("Unable to submit URB: (%d) %s\n", res, libusb_error_name(res));
- dev->shutdown_thread = 1;
- dev->transfer_loop_finished = 1;
- }
- }
- static void *read_thread(void *param)
- {
- int res;
- hid_device *dev = param;
- uint8_t *buf;
- const size_t length = dev->input_ep_max_packet_size;
- /* Set up the transfer object. */
- buf = (uint8_t*) malloc(length);
- dev->transfer = libusb_alloc_transfer(0);
- libusb_fill_interrupt_transfer(dev->transfer,
- dev->device_handle,
- dev->input_endpoint,
- buf,
- length,
- read_callback,
- dev,
- 5000/*timeout*/);
- /* Make the first submission. Further submissions are made
- from inside read_callback() */
- res = libusb_submit_transfer(dev->transfer);
- if(res < 0) {
- LOG("libusb_submit_transfer failed: %d %s. Stopping read_thread from running\n", res, libusb_error_name(res));
- dev->shutdown_thread = 1;
- dev->transfer_loop_finished = 1;
- }
- /* Notify the main thread that the read thread is up and running. */
- hidapi_thread_barrier_wait(&dev->thread_state);
- /* Handle all the events. */
- while (!dev->shutdown_thread) {
- res = libusb_handle_events(usb_context);
- if (res < 0) {
- /* There was an error. */
- LOG("read_thread(): (%d) %s\n", res, libusb_error_name(res));
- /* Break out of this loop only on fatal error.*/
- if (res != LIBUSB_ERROR_BUSY &&
- res != LIBUSB_ERROR_TIMEOUT &&
- res != LIBUSB_ERROR_OVERFLOW &&
- res != LIBUSB_ERROR_INTERRUPTED) {
- dev->shutdown_thread = 1;
- break;
- }
- }
- }
- /* Cancel any transfer that may be pending. This call will fail
- if no transfers are pending, but that's OK. */
- libusb_cancel_transfer(dev->transfer);
- while (!dev->transfer_loop_finished)
- libusb_handle_events_completed(usb_context, &dev->transfer_loop_finished);
- /* Now that the read thread is stopping, Wake any threads which are
- waiting on data (in hid_read_timeout()). Do this under a mutex to
- make sure that a thread which is about to go to sleep waiting on
- the condition actually will go to sleep before the condition is
- signaled. */
- hidapi_thread_mutex_lock(&dev->thread_state);
- hidapi_thread_cond_broadcast(&dev->thread_state);
- hidapi_thread_mutex_unlock(&dev->thread_state);
- /* The dev->transfer->buffer and dev->transfer objects are cleaned up
- in hid_close(). They are not cleaned up here because this thread
- could end either due to a disconnect or due to a user
- call to hid_close(). In both cases the objects can be safely
- cleaned up after the call to hidapi_thread_join() (in hid_close()), but
- since hid_close() calls libusb_cancel_transfer(), on these objects,
- they can not be cleaned up here. */
- return NULL;
- }
- static void init_xbox360(libusb_device_handle *device_handle, unsigned short idVendor, unsigned short idProduct, const struct libusb_config_descriptor *conf_desc)
- {
- (void)conf_desc;
- if ((idVendor == 0x05ac && idProduct == 0x055b) /* Gamesir-G3w */ ||
- idVendor == 0x0f0d /* Hori Xbox controllers */) {
- unsigned char data[20];
- /* The HORIPAD FPS for Nintendo Switch requires this to enable input reports.
- This VID/PID is also shared with other HORI controllers, but they all seem
- to be fine with this as well.
- */
- memset(data, 0, sizeof(data));
- libusb_control_transfer(device_handle, 0xC1, 0x01, 0x100, 0x0, data, sizeof(data), 100);
- }
- }
- static void init_xboxone(libusb_device_handle *device_handle, unsigned short idVendor, unsigned short idProduct, const struct libusb_config_descriptor *conf_desc)
- {
- static const int vendor_microsoft = 0x045e;
- static const int xb1_iface_subclass = 71;
- static const int xb1_iface_protocol = 208;
- int j, k, res;
- (void)idProduct;
- for (j = 0; j < conf_desc->bNumInterfaces; j++) {
- const struct libusb_interface *intf = &conf_desc->interface[j];
- for (k = 0; k < intf->num_altsetting; k++) {
- const struct libusb_interface_descriptor *intf_desc = &intf->altsetting[k];
- if (intf_desc->bInterfaceClass == LIBUSB_CLASS_VENDOR_SPEC &&
- intf_desc->bInterfaceSubClass == xb1_iface_subclass &&
- intf_desc->bInterfaceProtocol == xb1_iface_protocol) {
- int bSetAlternateSetting = 0;
- /* Newer Microsoft Xbox One controllers have a high speed alternate setting */
- if (idVendor == vendor_microsoft &&
- intf_desc->bInterfaceNumber == 0 && intf_desc->bAlternateSetting == 1) {
- bSetAlternateSetting = 1;
- } else if (intf_desc->bInterfaceNumber != 0 && intf_desc->bAlternateSetting == 0) {
- bSetAlternateSetting = 1;
- }
- if (bSetAlternateSetting) {
- res = libusb_claim_interface(device_handle, intf_desc->bInterfaceNumber);
- if (res < 0) {
- LOG("can't claim interface %d: %d\n", intf_desc->bInterfaceNumber, res);
- continue;
- }
- LOG("Setting alternate setting for VID/PID 0x%x/0x%x interface %d to %d\n", idVendor, idProduct, intf_desc->bInterfaceNumber, intf_desc->bAlternateSetting);
- res = libusb_set_interface_alt_setting(device_handle, intf_desc->bInterfaceNumber, intf_desc->bAlternateSetting);
- if (res < 0) {
- LOG("xbox init: can't set alt setting %d: %d\n", intf_desc->bInterfaceNumber, res);
- }
- libusb_release_interface(device_handle, intf_desc->bInterfaceNumber);
- }
- }
- }
- }
- }
- static void calculate_device_quirks(hid_device *dev, unsigned short idVendor, unsigned short idProduct)
- {
- static const int VENDOR_SONY = 0x054c;
- static const int PRODUCT_PS3_CONTROLLER = 0x0268;
- static const int PRODUCT_NAVIGATION_CONTROLLER = 0x042f;
- if (idVendor == VENDOR_SONY &&
- (idProduct == PRODUCT_PS3_CONTROLLER || idProduct == PRODUCT_NAVIGATION_CONTROLLER)) {
- dev->skip_output_report_id = 1;
- dev->no_output_reports_on_intr_ep = 1;
- }
- }
- static int hidapi_initialize_device(hid_device *dev, const struct libusb_interface_descriptor *intf_desc, const struct libusb_config_descriptor *conf_desc)
- {
- int i =0;
- int res = 0;
- struct libusb_device_descriptor desc;
- libusb_get_device_descriptor(libusb_get_device(dev->device_handle), &desc);
- #ifdef DETACH_KERNEL_DRIVER
- /* Detach the kernel driver, but only if the
- device is managed by the kernel */
- dev->is_driver_detached = 0;
- if (libusb_kernel_driver_active(dev->device_handle, intf_desc->bInterfaceNumber) == 1) {
- res = libusb_detach_kernel_driver(dev->device_handle, intf_desc->bInterfaceNumber);
- if (res < 0) {
- LOG("Unable to detach Kernel Driver: (%d) %s\n", res, libusb_error_name(res));
- return 0;
- }
- else {
- dev->is_driver_detached = 1;
- LOG("Driver successfully detached from kernel.\n");
- }
- }
- #endif
- res = libusb_claim_interface(dev->device_handle, intf_desc->bInterfaceNumber);
- if (res < 0) {
- LOG("can't claim interface %d: (%d) %s\n", intf_desc->bInterfaceNumber, res, libusb_error_name(res));
- #ifdef DETACH_KERNEL_DRIVER
- if (dev->is_driver_detached) {
- res = libusb_attach_kernel_driver(dev->device_handle, intf_desc->bInterfaceNumber);
- if (res < 0)
- LOG("Failed to reattach the driver to kernel: (%d) %s\n", res, libusb_error_name(res));
- }
- #endif
- return 0;
- }
- /* Initialize XBox 360 controllers */
- if (is_xbox360(desc.idVendor, intf_desc)) {
- init_xbox360(dev->device_handle, desc.idVendor, desc.idProduct, conf_desc);
- }
- /* Initialize XBox One controllers */
- if (is_xboxone(desc.idVendor, intf_desc)) {
- init_xboxone(dev->device_handle, desc.idVendor, desc.idProduct, conf_desc);
- }
- /* Store off the string descriptor indexes */
- dev->manufacturer_index = desc.iManufacturer;
- dev->product_index = desc.iProduct;
- dev->serial_index = desc.iSerialNumber;
- /* Store off the USB information */
- dev->config_number = conf_desc->bConfigurationValue;
- dev->interface = intf_desc->bInterfaceNumber;
- dev->interface_class = intf_desc->bInterfaceClass;
- dev->interface_subclass = intf_desc->bInterfaceSubClass;
- dev->interface_protocol = intf_desc->bInterfaceProtocol;
- dev->report_descriptor_size = get_report_descriptor_size_from_interface_descriptors(intf_desc);
- dev->input_endpoint = 0;
- dev->input_ep_max_packet_size = 0;
- dev->output_endpoint = 0;
- /* Find the INPUT and OUTPUT endpoints. An
- OUTPUT endpoint is not required. */
- for (i = 0; i < intf_desc->bNumEndpoints; i++) {
- const struct libusb_endpoint_descriptor *ep
- = &intf_desc->endpoint[i];
- /* Determine the type and direction of this
- endpoint. */
- int is_interrupt =
- (ep->bmAttributes & LIBUSB_TRANSFER_TYPE_MASK)
- == LIBUSB_TRANSFER_TYPE_INTERRUPT;
- int is_output =
- (ep->bEndpointAddress & LIBUSB_ENDPOINT_DIR_MASK)
- == LIBUSB_ENDPOINT_OUT;
- int is_input =
- (ep->bEndpointAddress & LIBUSB_ENDPOINT_DIR_MASK)
- == LIBUSB_ENDPOINT_IN;
- /* Decide whether to use it for input or output. */
- if (dev->input_endpoint == 0 &&
- is_interrupt && is_input) {
- /* Use this endpoint for INPUT */
- dev->input_endpoint = ep->bEndpointAddress;
- dev->input_ep_max_packet_size = ep->wMaxPacketSize;
- }
- if (dev->output_endpoint == 0 &&
- is_interrupt && is_output) {
- /* Use this endpoint for OUTPUT */
- dev->output_endpoint = ep->bEndpointAddress;
- }
- }
- calculate_device_quirks(dev, desc.idVendor, desc.idProduct);
- hidapi_thread_create(&dev->thread_state, read_thread, dev);
- /* Wait here for the read thread to be initialized. */
- hidapi_thread_barrier_wait(&dev->thread_state);
- return 1;
- }
- HID_API_EXPORT hid_device *hid_open_path(const char *path)
- {
- hid_device *dev = NULL;
- libusb_device **devs = NULL;
- libusb_device *usb_dev = NULL;
- int res = 0;
- int d = 0;
- int good_open = 0;
- if(hid_init() < 0)
- return NULL;
- dev = new_hid_device();
- libusb_get_device_list(usb_context, &devs);
- while ((usb_dev = devs[d++]) != NULL && !good_open) {
- struct libusb_device_descriptor desc;
- struct libusb_config_descriptor *conf_desc = NULL;
- int j,k;
- res = libusb_get_device_descriptor(usb_dev, &desc);
- if (res < 0)
- continue;
- res = libusb_get_active_config_descriptor(usb_dev, &conf_desc);
- if (res < 0)
- libusb_get_config_descriptor(usb_dev, 0, &conf_desc);
- if (!conf_desc)
- continue;
- for (j = 0; j < conf_desc->bNumInterfaces && !good_open; j++) {
- const struct libusb_interface *intf = &conf_desc->interface[j];
- for (k = 0; k < intf->num_altsetting && !good_open; k++) {
- const struct libusb_interface_descriptor *intf_desc = &intf->altsetting[k];
- if (should_enumerate_interface(desc.idVendor, intf_desc)) {
- char dev_path[64];
- get_path(&dev_path, usb_dev, conf_desc->bConfigurationValue, intf_desc->bInterfaceNumber);
- if (!strcmp(dev_path, path)) {
- /* Matched Paths. Open this device */
- /* OPEN HERE */
- res = libusb_open(usb_dev, &dev->device_handle);
- if (res < 0) {
- LOG("can't open device\n");
- break;
- }
- good_open = hidapi_initialize_device(dev, intf_desc, conf_desc);
- if (!good_open)
- libusb_close(dev->device_handle);
- }
- }
- }
- }
- libusb_free_config_descriptor(conf_desc);
- }
- libusb_free_device_list(devs, 1);
- /* If we have a good handle, return it. */
- if (good_open) {
- return dev;
- }
- else {
- /* Unable to open any devices. */
- free_hid_device(dev);
- return NULL;
- }
- }
- HID_API_EXPORT hid_device * HID_API_CALL hid_libusb_wrap_sys_device(intptr_t sys_dev, int interface_num)
- {
- /* 0x01000107 is a LIBUSB_API_VERSION for 1.0.23 - version when libusb_wrap_sys_device was introduced */
- #if (!defined(HIDAPI_TARGET_LIBUSB_API_VERSION) || HIDAPI_TARGET_LIBUSB_API_VERSION >= 0x01000107) && (LIBUSB_API_VERSION >= 0x01000107)
- hid_device *dev = NULL;
- struct libusb_config_descriptor *conf_desc = NULL;
- const struct libusb_interface_descriptor *selected_intf_desc = NULL;
- int res = 0;
- int j = 0, k = 0;
- if(hid_init() < 0)
- return NULL;
- dev = new_hid_device();
- res = libusb_wrap_sys_device(usb_context, sys_dev, &dev->device_handle);
- if (res < 0) {
- LOG("libusb_wrap_sys_device failed: %d %s\n", res, libusb_error_name(res));
- goto err;
- }
- res = libusb_get_active_config_descriptor(libusb_get_device(dev->device_handle), &conf_desc);
- if (res < 0)
- libusb_get_config_descriptor(libusb_get_device(dev->device_handle), 0, &conf_desc);
- if (!conf_desc) {
- LOG("Failed to get configuration descriptor: %d %s\n", res, libusb_error_name(res));
- goto err;
- }
- /* find matching HID interface */
- for (j = 0; j < conf_desc->bNumInterfaces && !selected_intf_desc; j++) {
- const struct libusb_interface *intf = &conf_desc->interface[j];
- for (k = 0; k < intf->num_altsetting; k++) {
- const struct libusb_interface_descriptor *intf_desc = &intf->altsetting[k];
- if (intf_desc->bInterfaceClass == LIBUSB_CLASS_HID) {
- if (interface_num < 0 || interface_num == intf_desc->bInterfaceNumber) {
- selected_intf_desc = intf_desc;
- break;
- }
- }
- }
- }
- if (!selected_intf_desc) {
- if (interface_num < 0) {
- LOG("Sys USB device doesn't contain a HID interface\n");
- }
- else {
- LOG("Sys USB device doesn't contain a HID interface with number %d\n", interface_num);
- }
- goto err;
- }
- if (!hidapi_initialize_device(dev, selected_intf_desc, conf_desc))
- goto err;
- return dev;
- err:
- if (conf_desc)
- libusb_free_config_descriptor(conf_desc);
- if (dev->device_handle)
- libusb_close(dev->device_handle);
- free_hid_device(dev);
- #else
- (void)sys_dev;
- (void)interface_num;
- LOG("libusb_wrap_sys_device is not available\n");
- #endif
- return NULL;
- }
- int HID_API_EXPORT hid_write(hid_device *dev, const unsigned char *data, size_t length)
- {
- int res;
- int report_number;
- int skipped_report_id = 0;
- if (!data || (length ==0)) {
- return -1;
- }
- report_number = data[0];
- if (report_number == 0x0 || dev->skip_output_report_id) {
- data++;
- length--;
- skipped_report_id = 1;
- }
- if (dev->output_endpoint <= 0 || dev->no_output_reports_on_intr_ep) {
- /* No interrupt out endpoint. Use the Control Endpoint */
- res = libusb_control_transfer(dev->device_handle,
- LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE|LIBUSB_ENDPOINT_OUT,
- 0x09/*HID Set_Report*/,
- (2/*HID output*/ << 8) | report_number,
- dev->interface,
- (unsigned char *)data, (uint16_t)length,
- 1000/*timeout millis*/);
- if (res < 0)
- return -1;
- if (skipped_report_id)
- length++;
- return length;
- }
- else {
- /* Use the interrupt out endpoint */
- int actual_length;
- res = libusb_interrupt_transfer(dev->device_handle,
- dev->output_endpoint,
- (unsigned char*)data,
- length,
- &actual_length, 1000);
- if (res < 0)
- return -1;
- if (skipped_report_id)
- actual_length++;
- return actual_length;
- }
- }
- /* Helper function, to simplify hid_read().
- This should be called with dev->mutex locked. */
- static int return_data(hid_device *dev, unsigned char *data, size_t length)
- {
- /* Copy the data out of the linked list item (rpt) into the
- return buffer (data), and delete the liked list item. */
- struct input_report *rpt = dev->input_reports;
- size_t len = (length < rpt->len)? length: rpt->len;
- if (len > 0)
- memcpy(data, rpt->data, len);
- dev->input_reports = rpt->next;
- free(rpt->data);
- free(rpt);
- return len;
- }
- static void cleanup_mutex(void *param)
- {
- hid_device *dev = param;
- hidapi_thread_mutex_unlock(&dev->thread_state);
- }
- int HID_API_EXPORT hid_read_timeout(hid_device *dev, unsigned char *data, size_t length, int milliseconds)
- {
- #if 0
- int transferred;
- int res = libusb_interrupt_transfer(dev->device_handle, dev->input_endpoint, data, length, &transferred, 5000);
- LOG("transferred: %d\n", transferred);
- return transferred;
- #endif
- /* by initialising this variable right here, GCC gives a compilation warning/error: */
- /* error: variable ‘bytes_read’ might be clobbered by ‘longjmp’ or ‘vfork’ [-Werror=clobbered] */
- int bytes_read; /* = -1; */
- hidapi_thread_mutex_lock(&dev->thread_state);
- hidapi_thread_cleanup_push(cleanup_mutex, dev);
- bytes_read = -1;
- /* There's an input report queued up. Return it. */
- if (dev->input_reports) {
- /* Return the first one */
- bytes_read = return_data(dev, data, length);
- goto ret;
- }
- if (dev->shutdown_thread) {
- /* This means the device has been disconnected.
- An error code of -1 should be returned. */
- bytes_read = -1;
- goto ret;
- }
- if (milliseconds == -1) {
- /* Blocking */
- while (!dev->input_reports && !dev->shutdown_thread) {
- hidapi_thread_cond_wait(&dev->thread_state);
- }
- if (dev->input_reports) {
- bytes_read = return_data(dev, data, length);
- }
- }
- else if (milliseconds > 0) {
- /* Non-blocking, but called with timeout. */
- int res;
- hidapi_timespec ts;
- hidapi_thread_gettime(&ts);
- hidapi_thread_addtime(&ts, milliseconds);
- while (!dev->input_reports && !dev->shutdown_thread) {
- res = hidapi_thread_cond_timedwait(&dev->thread_state, &ts);
- if (res == 0) {
- if (dev->input_reports) {
- bytes_read = return_data(dev, data, length);
- break;
- }
- /* If we're here, there was a spurious wake up
- or the read thread was shutdown. Run the
- loop again (ie: don't break). */
- }
- else if (res == HIDAPI_THREAD_TIMED_OUT) {
- /* Timed out. */
- bytes_read = 0;
- break;
- }
- else {
- /* Error. */
- bytes_read = -1;
- break;
- }
- }
- }
- else {
- /* Purely non-blocking */
- bytes_read = 0;
- }
- ret:
- hidapi_thread_mutex_unlock(&dev->thread_state);
- hidapi_thread_cleanup_pop(0);
- 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)
- {
- dev->blocking = !nonblock;
- return 0;
- }
- int HID_API_EXPORT hid_send_feature_report(hid_device *dev, const unsigned char *data, size_t length)
- {
- int res = -1;
- int skipped_report_id = 0;
- int report_number = data[0];
- if (report_number == 0x0) {
- data++;
- length--;
- skipped_report_id = 1;
- }
- res = libusb_control_transfer(dev->device_handle,
- LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE|LIBUSB_ENDPOINT_OUT,
- 0x09/*HID set_report*/,
- (3/*HID feature*/ << 8) | report_number,
- dev->interface,
- (unsigned char *)data, (uint16_t)length,
- 1000/*timeout millis*/);
- if (res < 0)
- return -1;
- /* Account for the report ID */
- if (skipped_report_id)
- length++;
- return length;
- }
- int HID_API_EXPORT hid_get_feature_report(hid_device *dev, unsigned char *data, size_t length)
- {
- int res = -1;
- int skipped_report_id = 0;
- int report_number = data[0];
- if (report_number == 0x0) {
- /* Offset the return buffer by 1, so that the report ID
- will remain in byte 0. */
- data++;
- length--;
- skipped_report_id = 1;
- }
- res = libusb_control_transfer(dev->device_handle,
- LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE|LIBUSB_ENDPOINT_IN,
- 0x01/*HID get_report*/,
- (3/*HID feature*/ << 8) | report_number,
- dev->interface,
- (unsigned char *)data, (uint16_t)length,
- 1000/*timeout millis*/);
- if (res < 0)
- return -1;
- if (skipped_report_id)
- res++;
- return res;
- }
- int HID_API_EXPORT HID_API_CALL hid_get_input_report(hid_device *dev, unsigned char *data, size_t length)
- {
- int res = -1;
- int skipped_report_id = 0;
- int report_number = data[0];
- if (report_number == 0x0) {
- /* Offset the return buffer by 1, so that the report ID
- will remain in byte 0. */
- data++;
- length--;
- skipped_report_id = 1;
- }
- res = libusb_control_transfer(dev->device_handle,
- LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE|LIBUSB_ENDPOINT_IN,
- 0x01/*HID get_report*/,
- (1/*HID Input*/ << 8) | report_number,
- dev->interface,
- (unsigned char *)data, (uint16_t)length,
- 1000/*timeout millis*/);
- if (res < 0)
- return -1;
- if (skipped_report_id)
- res++;
- return res;
- }
- void HID_API_EXPORT hid_close(hid_device *dev)
- {
- if (!dev)
- return;
- /* Cause read_thread() to stop. */
- dev->shutdown_thread = 1;
- libusb_cancel_transfer(dev->transfer);
- /* Wait for read_thread() to end. */
- hidapi_thread_join(&dev->thread_state);
- /* Clean up the Transfer objects allocated in read_thread(). */
- free(dev->transfer->buffer);
- dev->transfer->buffer = NULL;
- libusb_free_transfer(dev->transfer);
- /* release the interface */
- libusb_release_interface(dev->device_handle, dev->interface);
- /* reattach the kernel driver if it was detached */
- #ifdef DETACH_KERNEL_DRIVER
- if (dev->is_driver_detached) {
- int res = libusb_attach_kernel_driver(dev->device_handle, dev->interface);
- if (res < 0)
- LOG("Failed to reattach the driver to kernel.\n");
- }
- #endif
- /* Close the handle */
- libusb_close(dev->device_handle);
- /* Clear out the queue of received reports. */
- hidapi_thread_mutex_lock(&dev->thread_state);
- while (dev->input_reports) {
- return_data(dev, NULL, 0);
- }
- hidapi_thread_mutex_unlock(&dev->thread_state);
- free_hid_device(dev);
- }
- int HID_API_EXPORT_CALL hid_get_manufacturer_string(hid_device *dev, wchar_t *string, size_t maxlen)
- {
- return hid_get_indexed_string(dev, dev->manufacturer_index, string, maxlen);
- }
- int HID_API_EXPORT_CALL hid_get_product_string(hid_device *dev, wchar_t *string, size_t maxlen)
- {
- return hid_get_indexed_string(dev, dev->product_index, string, maxlen);
- }
- int HID_API_EXPORT_CALL hid_get_serial_number_string(hid_device *dev, wchar_t *string, size_t maxlen)
- {
- return hid_get_indexed_string(dev, dev->serial_index, string, maxlen);
- }
- HID_API_EXPORT struct hid_device_info *HID_API_CALL hid_get_device_info(hid_device *dev) {
- if (!dev->device_info) {
- struct libusb_device_descriptor desc;
- libusb_device *usb_device = libusb_get_device(dev->device_handle);
- libusb_get_device_descriptor(usb_device, &desc);
- dev->device_info = create_device_info_for_device(usb_device, dev->device_handle, &desc, dev->config_number, dev->interface, dev->interface_class, dev->interface_subclass, dev->interface_protocol);
- // device error already set by create_device_info_for_device, if any
- if (dev->device_info) {
- fill_device_info_usage(dev->device_info, dev->device_handle, dev->interface, dev->report_descriptor_size);
- }
- }
- return dev->device_info;
- }
- int HID_API_EXPORT_CALL hid_get_indexed_string(hid_device *dev, int string_index, wchar_t *string, size_t maxlen)
- {
- wchar_t *str;
- str = get_usb_string(dev->device_handle, string_index);
- if (str) {
- wcsncpy(string, str, maxlen);
- string[maxlen-1] = L'\0';
- free(str);
- return 0;
- }
- else
- return -1;
- }
- int HID_API_EXPORT_CALL hid_get_report_descriptor(hid_device *dev, unsigned char *buf, size_t buf_size)
- {
- return hid_get_report_descriptor_libusb(dev->device_handle, dev->interface, dev->report_descriptor_size, buf, buf_size);
- }
- HID_API_EXPORT const wchar_t * HID_API_CALL hid_error(hid_device *dev)
- {
- (void)dev;
- return L"hid_error is not implemented yet";
- }
- struct lang_map_entry {
- const char *name;
- const char *string_code;
- uint16_t usb_code;
- };
- #define LANG(name,code,usb_code) { name, code, usb_code }
- static struct lang_map_entry lang_map[] = {
- LANG("Afrikaans", "af", 0x0436),
- LANG("Albanian", "sq", 0x041C),
- LANG("Arabic - United Arab Emirates", "ar_ae", 0x3801),
- LANG("Arabic - Bahrain", "ar_bh", 0x3C01),
- LANG("Arabic - Algeria", "ar_dz", 0x1401),
- LANG("Arabic - Egypt", "ar_eg", 0x0C01),
- LANG("Arabic - Iraq", "ar_iq", 0x0801),
- LANG("Arabic - Jordan", "ar_jo", 0x2C01),
- LANG("Arabic - Kuwait", "ar_kw", 0x3401),
- LANG("Arabic - Lebanon", "ar_lb", 0x3001),
- LANG("Arabic - Libya", "ar_ly", 0x1001),
- LANG("Arabic - Morocco", "ar_ma", 0x1801),
- LANG("Arabic - Oman", "ar_om", 0x2001),
- LANG("Arabic - Qatar", "ar_qa", 0x4001),
- LANG("Arabic - Saudi Arabia", "ar_sa", 0x0401),
- LANG("Arabic - Syria", "ar_sy", 0x2801),
- LANG("Arabic - Tunisia", "ar_tn", 0x1C01),
- LANG("Arabic - Yemen", "ar_ye", 0x2401),
- LANG("Armenian", "hy", 0x042B),
- LANG("Azeri - Latin", "az_az", 0x042C),
- LANG("Azeri - Cyrillic", "az_az", 0x082C),
- LANG("Basque", "eu", 0x042D),
- LANG("Belarusian", "be", 0x0423),
- LANG("Bulgarian", "bg", 0x0402),
- LANG("Catalan", "ca", 0x0403),
- LANG("Chinese - China", "zh_cn", 0x0804),
- LANG("Chinese - Hong Kong SAR", "zh_hk", 0x0C04),
- LANG("Chinese - Macau SAR", "zh_mo", 0x1404),
- LANG("Chinese - Singapore", "zh_sg", 0x1004),
- LANG("Chinese - Taiwan", "zh_tw", 0x0404),
- LANG("Croatian", "hr", 0x041A),
- LANG("Czech", "cs", 0x0405),
- LANG("Danish", "da", 0x0406),
- LANG("Dutch - Netherlands", "nl_nl", 0x0413),
- LANG("Dutch - Belgium", "nl_be", 0x0813),
- LANG("English - Australia", "en_au", 0x0C09),
- LANG("English - Belize", "en_bz", 0x2809),
- LANG("English - Canada", "en_ca", 0x1009),
- LANG("English - Caribbean", "en_cb", 0x2409),
- LANG("English - Ireland", "en_ie", 0x1809),
- LANG("English - Jamaica", "en_jm", 0x2009),
- LANG("English - New Zealand", "en_nz", 0x1409),
- LANG("English - Philippines", "en_ph", 0x3409),
- LANG("English - Southern Africa", "en_za", 0x1C09),
- LANG("English - Trinidad", "en_tt", 0x2C09),
- LANG("English - Great Britain", "en_gb", 0x0809),
- LANG("English - United States", "en_us", 0x0409),
- LANG("Estonian", "et", 0x0425),
- LANG("Farsi", "fa", 0x0429),
- LANG("Finnish", "fi", 0x040B),
- LANG("Faroese", "fo", 0x0438),
- LANG("French - France", "fr_fr", 0x040C),
- LANG("French - Belgium", "fr_be", 0x080C),
- LANG("French - Canada", "fr_ca", 0x0C0C),
- LANG("French - Luxembourg", "fr_lu", 0x140C),
- LANG("French - Switzerland", "fr_ch", 0x100C),
- LANG("Gaelic - Ireland", "gd_ie", 0x083C),
- LANG("Gaelic - Scotland", "gd", 0x043C),
- LANG("German - Germany", "de_de", 0x0407),
- LANG("German - Austria", "de_at", 0x0C07),
- LANG("German - Liechtenstein", "de_li", 0x1407),
- LANG("German - Luxembourg", "de_lu", 0x1007),
- LANG("German - Switzerland", "de_ch", 0x0807),
- LANG("Greek", "el", 0x0408),
- LANG("Hebrew", "he", 0x040D),
- LANG("Hindi", "hi", 0x0439),
- LANG("Hungarian", "hu", 0x040E),
- LANG("Icelandic", "is", 0x040F),
- LANG("Indonesian", "id", 0x0421),
- LANG("Italian - Italy", "it_it", 0x0410),
- LANG("Italian - Switzerland", "it_ch", 0x0810),
- LANG("Japanese", "ja", 0x0411),
- LANG("Korean", "ko", 0x0412),
- LANG("Latvian", "lv", 0x0426),
- LANG("Lithuanian", "lt", 0x0427),
- LANG("F.Y.R.O. Macedonia", "mk", 0x042F),
- LANG("Malay - Malaysia", "ms_my", 0x043E),
- LANG("Malay – Brunei", "ms_bn", 0x083E),
- LANG("Maltese", "mt", 0x043A),
- LANG("Marathi", "mr", 0x044E),
- LANG("Norwegian - Bokml", "no_no", 0x0414),
- LANG("Norwegian - Nynorsk", "no_no", 0x0814),
- LANG("Polish", "pl", 0x0415),
- LANG("Portuguese - Portugal", "pt_pt", 0x0816),
- LANG("Portuguese - Brazil", "pt_br", 0x0416),
- LANG("Raeto-Romance", "rm", 0x0417),
- LANG("Romanian - Romania", "ro", 0x0418),
- LANG("Romanian - Republic of Moldova", "ro_mo", 0x0818),
- LANG("Russian", "ru", 0x0419),
- LANG("Russian - Republic of Moldova", "ru_mo", 0x0819),
- LANG("Sanskrit", "sa", 0x044F),
- LANG("Serbian - Cyrillic", "sr_sp", 0x0C1A),
- LANG("Serbian - Latin", "sr_sp", 0x081A),
- LANG("Setsuana", "tn", 0x0432),
- LANG("Slovenian", "sl", 0x0424),
- LANG("Slovak", "sk", 0x041B),
- LANG("Sorbian", "sb", 0x042E),
- LANG("Spanish - Spain (Traditional)", "es_es", 0x040A),
- LANG("Spanish - Argentina", "es_ar", 0x2C0A),
- LANG("Spanish - Bolivia", "es_bo", 0x400A),
- LANG("Spanish - Chile", "es_cl", 0x340A),
- LANG("Spanish - Colombia", "es_co", 0x240A),
- LANG("Spanish - Costa Rica", "es_cr", 0x140A),
- LANG("Spanish - Dominican Republic", "es_do", 0x1C0A),
- LANG("Spanish - Ecuador", "es_ec", 0x300A),
- LANG("Spanish - Guatemala", "es_gt", 0x100A),
- LANG("Spanish - Honduras", "es_hn", 0x480A),
- LANG("Spanish - Mexico", "es_mx", 0x080A),
- LANG("Spanish - Nicaragua", "es_ni", 0x4C0A),
- LANG("Spanish - Panama", "es_pa", 0x180A),
- LANG("Spanish - Peru", "es_pe", 0x280A),
- LANG("Spanish - Puerto Rico", "es_pr", 0x500A),
- LANG("Spanish - Paraguay", "es_py", 0x3C0A),
- LANG("Spanish - El Salvador", "es_sv", 0x440A),
- LANG("Spanish - Uruguay", "es_uy", 0x380A),
- LANG("Spanish - Venezuela", "es_ve", 0x200A),
- LANG("Southern Sotho", "st", 0x0430),
- LANG("Swahili", "sw", 0x0441),
- LANG("Swedish - Sweden", "sv_se", 0x041D),
- LANG("Swedish - Finland", "sv_fi", 0x081D),
- LANG("Tamil", "ta", 0x0449),
- LANG("Tatar", "tt", 0X0444),
- LANG("Thai", "th", 0x041E),
- LANG("Turkish", "tr", 0x041F),
- LANG("Tsonga", "ts", 0x0431),
- LANG("Ukrainian", "uk", 0x0422),
- LANG("Urdu", "ur", 0x0420),
- LANG("Uzbek - Cyrillic", "uz_uz", 0x0843),
- LANG("Uzbek – Latin", "uz_uz", 0x0443),
- LANG("Vietnamese", "vi", 0x042A),
- LANG("Xhosa", "xh", 0x0434),
- LANG("Yiddish", "yi", 0x043D),
- LANG("Zulu", "zu", 0x0435),
- LANG(NULL, NULL, 0x0),
- };
- uint16_t get_usb_code_for_current_locale(void)
- {
- char *locale;
- char search_string[64];
- char *ptr;
- struct lang_map_entry *lang;
- /* Get the current locale. */
- locale = setlocale(0, NULL);
- if (!locale)
- return 0x0;
- /* Make a copy of the current locale string. */
- strncpy(search_string, locale, sizeof(search_string));
- search_string[sizeof(search_string)-1] = '\0';
- /* Chop off the encoding part, and make it lower case. */
- ptr = search_string;
- while (*ptr) {
- *ptr = tolower(*ptr);
- if (*ptr == '.') {
- *ptr = '\0';
- break;
- }
- ptr++;
- }
- /* Find the entry which matches the string code of our locale. */
- lang = lang_map;
- while (lang->string_code) {
- if (!strcmp(lang->string_code, search_string)) {
- return lang->usb_code;
- }
- lang++;
- }
- /* There was no match. Find with just the language only. */
- /* Chop off the variant. Chop it off at the '_'. */
- ptr = search_string;
- while (*ptr) {
- *ptr = tolower(*ptr);
- if (*ptr == '_') {
- *ptr = '\0';
- break;
- }
- ptr++;
- }
- #if 0 /* TODO: Do we need this? */
- /* Find the entry which matches the string code of our language. */
- lang = lang_map;
- while (lang->string_code) {
- if (!strcmp(lang->string_code, search_string)) {
- return lang->usb_code;
- }
- lang++;
- }
- #endif
- /* Found nothing. */
- return 0x0;
- }
- #ifdef __cplusplus
- }
- #endif
|