1dde5845aSJiri Kosina /* 2229695e5SJiri Kosina * HID support for Linux 3dde5845aSJiri Kosina * 4dde5845aSJiri Kosina * Copyright (c) 1999 Andreas Gal 5dde5845aSJiri Kosina * Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz> 6dde5845aSJiri Kosina * Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc 76b1968d5SJiri Kosina * Copyright (c) 2006-2012 Jiri Kosina 8dde5845aSJiri Kosina */ 9dde5845aSJiri Kosina 10dde5845aSJiri Kosina /* 11dde5845aSJiri Kosina * This program is free software; you can redistribute it and/or modify it 12dde5845aSJiri Kosina * under the terms of the GNU General Public License as published by the Free 13dde5845aSJiri Kosina * Software Foundation; either version 2 of the License, or (at your option) 14dde5845aSJiri Kosina * any later version. 15dde5845aSJiri Kosina */ 16dde5845aSJiri Kosina 174291ee30SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 184291ee30SJoe Perches 19dde5845aSJiri Kosina #include <linux/module.h> 20dde5845aSJiri Kosina #include <linux/slab.h> 21dde5845aSJiri Kosina #include <linux/init.h> 22dde5845aSJiri Kosina #include <linux/kernel.h> 23dde5845aSJiri Kosina #include <linux/list.h> 24dde5845aSJiri Kosina #include <linux/mm.h> 25dde5845aSJiri Kosina #include <linux/spinlock.h> 26dde5845aSJiri Kosina #include <asm/unaligned.h> 27dde5845aSJiri Kosina #include <asm/byteorder.h> 28dde5845aSJiri Kosina #include <linux/input.h> 29dde5845aSJiri Kosina #include <linux/wait.h> 3047a80edbSJiri Kosina #include <linux/vmalloc.h> 31c4124c9bSJiri Kosina #include <linux/sched.h> 324ea54542SDavid Herrmann #include <linux/semaphore.h> 33dde5845aSJiri Kosina 34dde5845aSJiri Kosina #include <linux/hid.h> 35dde5845aSJiri Kosina #include <linux/hiddev.h> 36c080d89aSJiri Kosina #include <linux/hid-debug.h> 3786166b7bSJiri Kosina #include <linux/hidraw.h> 38dde5845aSJiri Kosina 395f22a799SJiri Slaby #include "hid-ids.h" 405f22a799SJiri Slaby 41dde5845aSJiri Kosina /* 42dde5845aSJiri Kosina * Version Information 43dde5845aSJiri Kosina */ 44dde5845aSJiri Kosina 4553149801SJiri Kosina #define DRIVER_DESC "HID core driver" 46dde5845aSJiri Kosina 4758037eb9SJiri Kosina int hid_debug = 0; 48377e10fbSAnssi Hannula module_param_named(debug, hid_debug, int, 0600); 49cd667ce2SJiri Kosina MODULE_PARM_DESC(debug, "toggle HID debugging messages"); 5058037eb9SJiri Kosina EXPORT_SYMBOL_GPL(hid_debug); 5158037eb9SJiri Kosina 526b1968d5SJiri Kosina static int hid_ignore_special_drivers = 0; 536b1968d5SJiri Kosina module_param_named(ignore_special_drivers, hid_ignore_special_drivers, int, 0600); 54643727a9SHans Petter Selasky MODULE_PARM_DESC(ignore_special_drivers, "Ignore any special drivers and handle all devices by generic driver"); 556b1968d5SJiri Kosina 56dde5845aSJiri Kosina /* 57dde5845aSJiri Kosina * Register a new report for a device. 58dde5845aSJiri Kosina */ 59dde5845aSJiri Kosina 60f07b3c1dSBenjamin Tissoires struct hid_report *hid_register_report(struct hid_device *device, 61f07b3c1dSBenjamin Tissoires unsigned int type, unsigned int id, 62f07b3c1dSBenjamin Tissoires unsigned int application) 63dde5845aSJiri Kosina { 64dde5845aSJiri Kosina struct hid_report_enum *report_enum = device->report_enum + type; 65dde5845aSJiri Kosina struct hid_report *report; 66dde5845aSJiri Kosina 6743622021SKees Cook if (id >= HID_MAX_IDS) 6843622021SKees Cook return NULL; 69dde5845aSJiri Kosina if (report_enum->report_id_hash[id]) 70dde5845aSJiri Kosina return report_enum->report_id_hash[id]; 71dde5845aSJiri Kosina 72a3789a17SJoe Perches report = kzalloc(sizeof(struct hid_report), GFP_KERNEL); 73a3789a17SJoe Perches if (!report) 74dde5845aSJiri Kosina return NULL; 75dde5845aSJiri Kosina 76dde5845aSJiri Kosina if (id != 0) 77dde5845aSJiri Kosina report_enum->numbered = 1; 78dde5845aSJiri Kosina 79dde5845aSJiri Kosina report->id = id; 80dde5845aSJiri Kosina report->type = type; 81dde5845aSJiri Kosina report->size = 0; 82dde5845aSJiri Kosina report->device = device; 83f07b3c1dSBenjamin Tissoires report->application = application; 84dde5845aSJiri Kosina report_enum->report_id_hash[id] = report; 85dde5845aSJiri Kosina 86dde5845aSJiri Kosina list_add_tail(&report->list, &report_enum->report_list); 87dde5845aSJiri Kosina 88dde5845aSJiri Kosina return report; 89dde5845aSJiri Kosina } 9090a006abSMichael Poole EXPORT_SYMBOL_GPL(hid_register_report); 91dde5845aSJiri Kosina 92dde5845aSJiri Kosina /* 93dde5845aSJiri Kosina * Register a new field for this report. 94dde5845aSJiri Kosina */ 95dde5845aSJiri Kosina 96dde5845aSJiri Kosina static struct hid_field *hid_register_field(struct hid_report *report, unsigned usages, unsigned values) 97dde5845aSJiri Kosina { 98dde5845aSJiri Kosina struct hid_field *field; 99dde5845aSJiri Kosina 100dde5845aSJiri Kosina if (report->maxfield == HID_MAX_FIELDS) { 1018c3d52fcSJiri Kosina hid_err(report->device, "too many fields in report\n"); 102dde5845aSJiri Kosina return NULL; 103dde5845aSJiri Kosina } 104dde5845aSJiri Kosina 105a3789a17SJoe Perches field = kzalloc((sizeof(struct hid_field) + 106a3789a17SJoe Perches usages * sizeof(struct hid_usage) + 107a3789a17SJoe Perches values * sizeof(unsigned)), GFP_KERNEL); 108a3789a17SJoe Perches if (!field) 109a3789a17SJoe Perches return NULL; 110dde5845aSJiri Kosina 111dde5845aSJiri Kosina field->index = report->maxfield++; 112dde5845aSJiri Kosina report->field[field->index] = field; 113dde5845aSJiri Kosina field->usage = (struct hid_usage *)(field + 1); 114282bfd4cSJiri Slaby field->value = (s32 *)(field->usage + usages); 115dde5845aSJiri Kosina field->report = report; 116dde5845aSJiri Kosina 117dde5845aSJiri Kosina return field; 118dde5845aSJiri Kosina } 119dde5845aSJiri Kosina 120dde5845aSJiri Kosina /* 121dde5845aSJiri Kosina * Open a collection. The type/usage is pushed on the stack. 122dde5845aSJiri Kosina */ 123dde5845aSJiri Kosina 124dde5845aSJiri Kosina static int open_collection(struct hid_parser *parser, unsigned type) 125dde5845aSJiri Kosina { 126dde5845aSJiri Kosina struct hid_collection *collection; 127dde5845aSJiri Kosina unsigned usage; 128dde5845aSJiri Kosina 129dde5845aSJiri Kosina usage = parser->local.usage[0]; 130dde5845aSJiri Kosina 131dde5845aSJiri Kosina if (parser->collection_stack_ptr == HID_COLLECTION_STACK_SIZE) { 1328c3d52fcSJiri Kosina hid_err(parser->device, "collection stack overflow\n"); 133a6fbaacfSSachin Kamat return -EINVAL; 134dde5845aSJiri Kosina } 135dde5845aSJiri Kosina 136dde5845aSJiri Kosina if (parser->device->maxcollection == parser->device->collection_size) { 137*6da2ec56SKees Cook collection = kmalloc( 138*6da2ec56SKees Cook array3_size(sizeof(struct hid_collection), 139*6da2ec56SKees Cook parser->device->collection_size, 140*6da2ec56SKees Cook 2), 141*6da2ec56SKees Cook GFP_KERNEL); 142dde5845aSJiri Kosina if (collection == NULL) { 1438c3d52fcSJiri Kosina hid_err(parser->device, "failed to reallocate collection array\n"); 144a6fbaacfSSachin Kamat return -ENOMEM; 145dde5845aSJiri Kosina } 146dde5845aSJiri Kosina memcpy(collection, parser->device->collection, 147dde5845aSJiri Kosina sizeof(struct hid_collection) * 148dde5845aSJiri Kosina parser->device->collection_size); 149dde5845aSJiri Kosina memset(collection + parser->device->collection_size, 0, 150dde5845aSJiri Kosina sizeof(struct hid_collection) * 151dde5845aSJiri Kosina parser->device->collection_size); 152dde5845aSJiri Kosina kfree(parser->device->collection); 153dde5845aSJiri Kosina parser->device->collection = collection; 154dde5845aSJiri Kosina parser->device->collection_size *= 2; 155dde5845aSJiri Kosina } 156dde5845aSJiri Kosina 157dde5845aSJiri Kosina parser->collection_stack[parser->collection_stack_ptr++] = 158dde5845aSJiri Kosina parser->device->maxcollection; 159dde5845aSJiri Kosina 160dde5845aSJiri Kosina collection = parser->device->collection + 161dde5845aSJiri Kosina parser->device->maxcollection++; 162dde5845aSJiri Kosina collection->type = type; 163dde5845aSJiri Kosina collection->usage = usage; 164dde5845aSJiri Kosina collection->level = parser->collection_stack_ptr - 1; 165dde5845aSJiri Kosina 166dde5845aSJiri Kosina if (type == HID_COLLECTION_APPLICATION) 167dde5845aSJiri Kosina parser->device->maxapplication++; 168dde5845aSJiri Kosina 169dde5845aSJiri Kosina return 0; 170dde5845aSJiri Kosina } 171dde5845aSJiri Kosina 172dde5845aSJiri Kosina /* 173dde5845aSJiri Kosina * Close a collection. 174dde5845aSJiri Kosina */ 175dde5845aSJiri Kosina 176dde5845aSJiri Kosina static int close_collection(struct hid_parser *parser) 177dde5845aSJiri Kosina { 178dde5845aSJiri Kosina if (!parser->collection_stack_ptr) { 1798c3d52fcSJiri Kosina hid_err(parser->device, "collection stack underflow\n"); 180a6fbaacfSSachin Kamat return -EINVAL; 181dde5845aSJiri Kosina } 182dde5845aSJiri Kosina parser->collection_stack_ptr--; 183dde5845aSJiri Kosina return 0; 184dde5845aSJiri Kosina } 185dde5845aSJiri Kosina 186dde5845aSJiri Kosina /* 187dde5845aSJiri Kosina * Climb up the stack, search for the specified collection type 188dde5845aSJiri Kosina * and return the usage. 189dde5845aSJiri Kosina */ 190dde5845aSJiri Kosina 191dde5845aSJiri Kosina static unsigned hid_lookup_collection(struct hid_parser *parser, unsigned type) 192dde5845aSJiri Kosina { 193504499f2SJoe Perches struct hid_collection *collection = parser->device->collection; 194dde5845aSJiri Kosina int n; 195504499f2SJoe Perches 196504499f2SJoe Perches for (n = parser->collection_stack_ptr - 1; n >= 0; n--) { 197504499f2SJoe Perches unsigned index = parser->collection_stack[n]; 198504499f2SJoe Perches if (collection[index].type == type) 199504499f2SJoe Perches return collection[index].usage; 200504499f2SJoe Perches } 201dde5845aSJiri Kosina return 0; /* we know nothing about this usage type */ 202dde5845aSJiri Kosina } 203dde5845aSJiri Kosina 204dde5845aSJiri Kosina /* 205dde5845aSJiri Kosina * Add a usage to the temporary parser table. 206dde5845aSJiri Kosina */ 207dde5845aSJiri Kosina 208dde5845aSJiri Kosina static int hid_add_usage(struct hid_parser *parser, unsigned usage) 209dde5845aSJiri Kosina { 210dde5845aSJiri Kosina if (parser->local.usage_index >= HID_MAX_USAGES) { 2118c3d52fcSJiri Kosina hid_err(parser->device, "usage index exceeded\n"); 212dde5845aSJiri Kosina return -1; 213dde5845aSJiri Kosina } 214dde5845aSJiri Kosina parser->local.usage[parser->local.usage_index] = usage; 215dde5845aSJiri Kosina parser->local.collection_index[parser->local.usage_index] = 216dde5845aSJiri Kosina parser->collection_stack_ptr ? 217dde5845aSJiri Kosina parser->collection_stack[parser->collection_stack_ptr - 1] : 0; 218dde5845aSJiri Kosina parser->local.usage_index++; 219dde5845aSJiri Kosina return 0; 220dde5845aSJiri Kosina } 221dde5845aSJiri Kosina 222dde5845aSJiri Kosina /* 223dde5845aSJiri Kosina * Register a new field for this report. 224dde5845aSJiri Kosina */ 225dde5845aSJiri Kosina 226dde5845aSJiri Kosina static int hid_add_field(struct hid_parser *parser, unsigned report_type, unsigned flags) 227dde5845aSJiri Kosina { 228dde5845aSJiri Kosina struct hid_report *report; 229dde5845aSJiri Kosina struct hid_field *field; 230f07b3c1dSBenjamin Tissoires unsigned int usages; 231f07b3c1dSBenjamin Tissoires unsigned int offset; 232f07b3c1dSBenjamin Tissoires unsigned int i; 233f07b3c1dSBenjamin Tissoires unsigned int application; 234dde5845aSJiri Kosina 235f07b3c1dSBenjamin Tissoires application = hid_lookup_collection(parser, HID_COLLECTION_APPLICATION); 236f07b3c1dSBenjamin Tissoires 237f07b3c1dSBenjamin Tissoires report = hid_register_report(parser->device, report_type, 238f07b3c1dSBenjamin Tissoires parser->global.report_id, application); 239a3789a17SJoe Perches if (!report) { 2408c3d52fcSJiri Kosina hid_err(parser->device, "hid_register_report failed\n"); 241dde5845aSJiri Kosina return -1; 242dde5845aSJiri Kosina } 243dde5845aSJiri Kosina 244bb2e1976SJiri Kosina /* Handle both signed and unsigned cases properly */ 2450cd516c2Ssrinivas pandruvada if ((parser->global.logical_minimum < 0 && 2460cd516c2Ssrinivas pandruvada parser->global.logical_maximum < 2470cd516c2Ssrinivas pandruvada parser->global.logical_minimum) || 2480cd516c2Ssrinivas pandruvada (parser->global.logical_minimum >= 0 && 2490cd516c2Ssrinivas pandruvada (__u32)parser->global.logical_maximum < 2500cd516c2Ssrinivas pandruvada (__u32)parser->global.logical_minimum)) { 2510cd516c2Ssrinivas pandruvada dbg_hid("logical range invalid 0x%x 0x%x\n", 2520cd516c2Ssrinivas pandruvada parser->global.logical_minimum, 2530cd516c2Ssrinivas pandruvada parser->global.logical_maximum); 254dde5845aSJiri Kosina return -1; 255dde5845aSJiri Kosina } 256dde5845aSJiri Kosina 257dde5845aSJiri Kosina offset = report->size; 258dde5845aSJiri Kosina report->size += parser->global.report_size * parser->global.report_count; 259dde5845aSJiri Kosina 260dde5845aSJiri Kosina if (!parser->local.usage_index) /* Ignore padding fields */ 261dde5845aSJiri Kosina return 0; 262dde5845aSJiri Kosina 263cc6b54aaSBenjamin Tissoires usages = max_t(unsigned, parser->local.usage_index, 264cc6b54aaSBenjamin Tissoires parser->global.report_count); 265dde5845aSJiri Kosina 266a3789a17SJoe Perches field = hid_register_field(report, usages, parser->global.report_count); 267a3789a17SJoe Perches if (!field) 268dde5845aSJiri Kosina return 0; 269dde5845aSJiri Kosina 270dde5845aSJiri Kosina field->physical = hid_lookup_collection(parser, HID_COLLECTION_PHYSICAL); 271dde5845aSJiri Kosina field->logical = hid_lookup_collection(parser, HID_COLLECTION_LOGICAL); 272f07b3c1dSBenjamin Tissoires field->application = application; 273dde5845aSJiri Kosina 274dde5845aSJiri Kosina for (i = 0; i < usages; i++) { 275cc6b54aaSBenjamin Tissoires unsigned j = i; 276dde5845aSJiri Kosina /* Duplicate the last usage we parsed if we have excess values */ 277dde5845aSJiri Kosina if (i >= parser->local.usage_index) 278dde5845aSJiri Kosina j = parser->local.usage_index - 1; 279dde5845aSJiri Kosina field->usage[i].hid = parser->local.usage[j]; 280dde5845aSJiri Kosina field->usage[i].collection_index = 281dde5845aSJiri Kosina parser->local.collection_index[j]; 282cc6b54aaSBenjamin Tissoires field->usage[i].usage_index = i; 283dde5845aSJiri Kosina } 284dde5845aSJiri Kosina 285dde5845aSJiri Kosina field->maxusage = usages; 286dde5845aSJiri Kosina field->flags = flags; 287dde5845aSJiri Kosina field->report_offset = offset; 288dde5845aSJiri Kosina field->report_type = report_type; 289dde5845aSJiri Kosina field->report_size = parser->global.report_size; 290dde5845aSJiri Kosina field->report_count = parser->global.report_count; 291dde5845aSJiri Kosina field->logical_minimum = parser->global.logical_minimum; 292dde5845aSJiri Kosina field->logical_maximum = parser->global.logical_maximum; 293dde5845aSJiri Kosina field->physical_minimum = parser->global.physical_minimum; 294dde5845aSJiri Kosina field->physical_maximum = parser->global.physical_maximum; 295dde5845aSJiri Kosina field->unit_exponent = parser->global.unit_exponent; 296dde5845aSJiri Kosina field->unit = parser->global.unit; 297dde5845aSJiri Kosina 298dde5845aSJiri Kosina return 0; 299dde5845aSJiri Kosina } 300dde5845aSJiri Kosina 301dde5845aSJiri Kosina /* 302dde5845aSJiri Kosina * Read data value from item. 303dde5845aSJiri Kosina */ 304dde5845aSJiri Kosina 305dde5845aSJiri Kosina static u32 item_udata(struct hid_item *item) 306dde5845aSJiri Kosina { 307dde5845aSJiri Kosina switch (item->size) { 308dde5845aSJiri Kosina case 1: return item->data.u8; 309dde5845aSJiri Kosina case 2: return item->data.u16; 310dde5845aSJiri Kosina case 4: return item->data.u32; 311dde5845aSJiri Kosina } 312dde5845aSJiri Kosina return 0; 313dde5845aSJiri Kosina } 314dde5845aSJiri Kosina 315dde5845aSJiri Kosina static s32 item_sdata(struct hid_item *item) 316dde5845aSJiri Kosina { 317dde5845aSJiri Kosina switch (item->size) { 318dde5845aSJiri Kosina case 1: return item->data.s8; 319dde5845aSJiri Kosina case 2: return item->data.s16; 320dde5845aSJiri Kosina case 4: return item->data.s32; 321dde5845aSJiri Kosina } 322dde5845aSJiri Kosina return 0; 323dde5845aSJiri Kosina } 324dde5845aSJiri Kosina 325dde5845aSJiri Kosina /* 326dde5845aSJiri Kosina * Process a global item. 327dde5845aSJiri Kosina */ 328dde5845aSJiri Kosina 329dde5845aSJiri Kosina static int hid_parser_global(struct hid_parser *parser, struct hid_item *item) 330dde5845aSJiri Kosina { 331ad0e669bSNikolai Kondrashov __s32 raw_value; 332dde5845aSJiri Kosina switch (item->tag) { 333dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PUSH: 334dde5845aSJiri Kosina 335dde5845aSJiri Kosina if (parser->global_stack_ptr == HID_GLOBAL_STACK_SIZE) { 3368c3d52fcSJiri Kosina hid_err(parser->device, "global environment stack overflow\n"); 337dde5845aSJiri Kosina return -1; 338dde5845aSJiri Kosina } 339dde5845aSJiri Kosina 340dde5845aSJiri Kosina memcpy(parser->global_stack + parser->global_stack_ptr++, 341dde5845aSJiri Kosina &parser->global, sizeof(struct hid_global)); 342dde5845aSJiri Kosina return 0; 343dde5845aSJiri Kosina 344dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_POP: 345dde5845aSJiri Kosina 346dde5845aSJiri Kosina if (!parser->global_stack_ptr) { 3478c3d52fcSJiri Kosina hid_err(parser->device, "global environment stack underflow\n"); 348dde5845aSJiri Kosina return -1; 349dde5845aSJiri Kosina } 350dde5845aSJiri Kosina 351880d29f1SJiri Slaby memcpy(&parser->global, parser->global_stack + 352880d29f1SJiri Slaby --parser->global_stack_ptr, sizeof(struct hid_global)); 353dde5845aSJiri Kosina return 0; 354dde5845aSJiri Kosina 355dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_USAGE_PAGE: 356dde5845aSJiri Kosina parser->global.usage_page = item_udata(item); 357dde5845aSJiri Kosina return 0; 358dde5845aSJiri Kosina 359dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM: 360dde5845aSJiri Kosina parser->global.logical_minimum = item_sdata(item); 361dde5845aSJiri Kosina return 0; 362dde5845aSJiri Kosina 363dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM: 364dde5845aSJiri Kosina if (parser->global.logical_minimum < 0) 365dde5845aSJiri Kosina parser->global.logical_maximum = item_sdata(item); 366dde5845aSJiri Kosina else 367dde5845aSJiri Kosina parser->global.logical_maximum = item_udata(item); 368dde5845aSJiri Kosina return 0; 369dde5845aSJiri Kosina 370dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM: 371dde5845aSJiri Kosina parser->global.physical_minimum = item_sdata(item); 372dde5845aSJiri Kosina return 0; 373dde5845aSJiri Kosina 374dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM: 375dde5845aSJiri Kosina if (parser->global.physical_minimum < 0) 376dde5845aSJiri Kosina parser->global.physical_maximum = item_sdata(item); 377dde5845aSJiri Kosina else 378dde5845aSJiri Kosina parser->global.physical_maximum = item_udata(item); 379dde5845aSJiri Kosina return 0; 380dde5845aSJiri Kosina 381dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT: 382ad0e669bSNikolai Kondrashov /* Many devices provide unit exponent as a two's complement 383ad0e669bSNikolai Kondrashov * nibble due to the common misunderstanding of HID 384ad0e669bSNikolai Kondrashov * specification 1.11, 6.2.2.7 Global Items. Attempt to handle 385ad0e669bSNikolai Kondrashov * both this and the standard encoding. */ 386ad0e669bSNikolai Kondrashov raw_value = item_sdata(item); 38777463838SBenjamin Tissoires if (!(raw_value & 0xfffffff0)) 38877463838SBenjamin Tissoires parser->global.unit_exponent = hid_snto32(raw_value, 4); 38977463838SBenjamin Tissoires else 39077463838SBenjamin Tissoires parser->global.unit_exponent = raw_value; 391dde5845aSJiri Kosina return 0; 392dde5845aSJiri Kosina 393dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_UNIT: 394dde5845aSJiri Kosina parser->global.unit = item_udata(item); 395dde5845aSJiri Kosina return 0; 396dde5845aSJiri Kosina 397dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_SIZE: 398880d29f1SJiri Slaby parser->global.report_size = item_udata(item); 39923408f95SMarek Vasut if (parser->global.report_size > 128) { 4008c3d52fcSJiri Kosina hid_err(parser->device, "invalid report_size %d\n", 401880d29f1SJiri Slaby parser->global.report_size); 402dde5845aSJiri Kosina return -1; 403dde5845aSJiri Kosina } 404dde5845aSJiri Kosina return 0; 405dde5845aSJiri Kosina 406dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_COUNT: 407880d29f1SJiri Slaby parser->global.report_count = item_udata(item); 408880d29f1SJiri Slaby if (parser->global.report_count > HID_MAX_USAGES) { 4098c3d52fcSJiri Kosina hid_err(parser->device, "invalid report_count %d\n", 410880d29f1SJiri Slaby parser->global.report_count); 411dde5845aSJiri Kosina return -1; 412dde5845aSJiri Kosina } 413dde5845aSJiri Kosina return 0; 414dde5845aSJiri Kosina 415dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_ID: 416880d29f1SJiri Slaby parser->global.report_id = item_udata(item); 41743622021SKees Cook if (parser->global.report_id == 0 || 41843622021SKees Cook parser->global.report_id >= HID_MAX_IDS) { 41943622021SKees Cook hid_err(parser->device, "report_id %u is invalid\n", 42043622021SKees Cook parser->global.report_id); 421dde5845aSJiri Kosina return -1; 422dde5845aSJiri Kosina } 423dde5845aSJiri Kosina return 0; 424dde5845aSJiri Kosina 425dde5845aSJiri Kosina default: 4268c3d52fcSJiri Kosina hid_err(parser->device, "unknown global tag 0x%x\n", item->tag); 427dde5845aSJiri Kosina return -1; 428dde5845aSJiri Kosina } 429dde5845aSJiri Kosina } 430dde5845aSJiri Kosina 431dde5845aSJiri Kosina /* 432dde5845aSJiri Kosina * Process a local item. 433dde5845aSJiri Kosina */ 434dde5845aSJiri Kosina 435dde5845aSJiri Kosina static int hid_parser_local(struct hid_parser *parser, struct hid_item *item) 436dde5845aSJiri Kosina { 437dde5845aSJiri Kosina __u32 data; 438dde5845aSJiri Kosina unsigned n; 439ba532198SBenjamin Tissoires __u32 count; 440dde5845aSJiri Kosina 441dde5845aSJiri Kosina data = item_udata(item); 442dde5845aSJiri Kosina 443dde5845aSJiri Kosina switch (item->tag) { 444dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_DELIMITER: 445dde5845aSJiri Kosina 446dde5845aSJiri Kosina if (data) { 447dde5845aSJiri Kosina /* 448dde5845aSJiri Kosina * We treat items before the first delimiter 449dde5845aSJiri Kosina * as global to all usage sets (branch 0). 450dde5845aSJiri Kosina * In the moment we process only these global 451dde5845aSJiri Kosina * items and the first delimiter set. 452dde5845aSJiri Kosina */ 453dde5845aSJiri Kosina if (parser->local.delimiter_depth != 0) { 4548c3d52fcSJiri Kosina hid_err(parser->device, "nested delimiters\n"); 455dde5845aSJiri Kosina return -1; 456dde5845aSJiri Kosina } 457dde5845aSJiri Kosina parser->local.delimiter_depth++; 458dde5845aSJiri Kosina parser->local.delimiter_branch++; 459dde5845aSJiri Kosina } else { 460dde5845aSJiri Kosina if (parser->local.delimiter_depth < 1) { 4618c3d52fcSJiri Kosina hid_err(parser->device, "bogus close delimiter\n"); 462dde5845aSJiri Kosina return -1; 463dde5845aSJiri Kosina } 464dde5845aSJiri Kosina parser->local.delimiter_depth--; 465dde5845aSJiri Kosina } 46638ead6efSPaul Chavent return 0; 467dde5845aSJiri Kosina 468dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE: 469dde5845aSJiri Kosina 470dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 47158037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 472dde5845aSJiri Kosina return 0; 473dde5845aSJiri Kosina } 474dde5845aSJiri Kosina 475dde5845aSJiri Kosina if (item->size <= 2) 476dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 477dde5845aSJiri Kosina 478dde5845aSJiri Kosina return hid_add_usage(parser, data); 479dde5845aSJiri Kosina 480dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE_MINIMUM: 481dde5845aSJiri Kosina 482dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 48358037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 484dde5845aSJiri Kosina return 0; 485dde5845aSJiri Kosina } 486dde5845aSJiri Kosina 487dde5845aSJiri Kosina if (item->size <= 2) 488dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 489dde5845aSJiri Kosina 490dde5845aSJiri Kosina parser->local.usage_minimum = data; 491dde5845aSJiri Kosina return 0; 492dde5845aSJiri Kosina 493dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM: 494dde5845aSJiri Kosina 495dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 49658037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 497dde5845aSJiri Kosina return 0; 498dde5845aSJiri Kosina } 499dde5845aSJiri Kosina 500dde5845aSJiri Kosina if (item->size <= 2) 501dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 502dde5845aSJiri Kosina 503ba532198SBenjamin Tissoires count = data - parser->local.usage_minimum; 504ba532198SBenjamin Tissoires if (count + parser->local.usage_index >= HID_MAX_USAGES) { 505ba532198SBenjamin Tissoires /* 506ba532198SBenjamin Tissoires * We do not warn if the name is not set, we are 507ba532198SBenjamin Tissoires * actually pre-scanning the device. 508ba532198SBenjamin Tissoires */ 509ba532198SBenjamin Tissoires if (dev_name(&parser->device->dev)) 510ba532198SBenjamin Tissoires hid_warn(parser->device, 511ba532198SBenjamin Tissoires "ignoring exceeding usage max\n"); 512ba532198SBenjamin Tissoires data = HID_MAX_USAGES - parser->local.usage_index + 513ba532198SBenjamin Tissoires parser->local.usage_minimum - 1; 514ba532198SBenjamin Tissoires if (data <= 0) { 515ba532198SBenjamin Tissoires hid_err(parser->device, 516ba532198SBenjamin Tissoires "no more usage index available\n"); 517ba532198SBenjamin Tissoires return -1; 518ba532198SBenjamin Tissoires } 519ba532198SBenjamin Tissoires } 520ba532198SBenjamin Tissoires 521dde5845aSJiri Kosina for (n = parser->local.usage_minimum; n <= data; n++) 522dde5845aSJiri Kosina if (hid_add_usage(parser, n)) { 52358037eb9SJiri Kosina dbg_hid("hid_add_usage failed\n"); 524dde5845aSJiri Kosina return -1; 525dde5845aSJiri Kosina } 526dde5845aSJiri Kosina return 0; 527dde5845aSJiri Kosina 528dde5845aSJiri Kosina default: 529dde5845aSJiri Kosina 53058037eb9SJiri Kosina dbg_hid("unknown local item tag 0x%x\n", item->tag); 531dde5845aSJiri Kosina return 0; 532dde5845aSJiri Kosina } 533dde5845aSJiri Kosina return 0; 534dde5845aSJiri Kosina } 535dde5845aSJiri Kosina 536dde5845aSJiri Kosina /* 537dde5845aSJiri Kosina * Process a main item. 538dde5845aSJiri Kosina */ 539dde5845aSJiri Kosina 540dde5845aSJiri Kosina static int hid_parser_main(struct hid_parser *parser, struct hid_item *item) 541dde5845aSJiri Kosina { 542dde5845aSJiri Kosina __u32 data; 543dde5845aSJiri Kosina int ret; 544dde5845aSJiri Kosina 545dde5845aSJiri Kosina data = item_udata(item); 546dde5845aSJiri Kosina 547dde5845aSJiri Kosina switch (item->tag) { 548dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION: 549dde5845aSJiri Kosina ret = open_collection(parser, data & 0xff); 550dde5845aSJiri Kosina break; 551dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_END_COLLECTION: 552dde5845aSJiri Kosina ret = close_collection(parser); 553dde5845aSJiri Kosina break; 554dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_INPUT: 555dde5845aSJiri Kosina ret = hid_add_field(parser, HID_INPUT_REPORT, data); 556dde5845aSJiri Kosina break; 557dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_OUTPUT: 558dde5845aSJiri Kosina ret = hid_add_field(parser, HID_OUTPUT_REPORT, data); 559dde5845aSJiri Kosina break; 560dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_FEATURE: 561dde5845aSJiri Kosina ret = hid_add_field(parser, HID_FEATURE_REPORT, data); 562dde5845aSJiri Kosina break; 563dde5845aSJiri Kosina default: 5647cb4774eSHans de Goede hid_warn(parser->device, "unknown main item tag 0x%x\n", item->tag); 565dde5845aSJiri Kosina ret = 0; 566dde5845aSJiri Kosina } 567dde5845aSJiri Kosina 568dde5845aSJiri Kosina memset(&parser->local, 0, sizeof(parser->local)); /* Reset the local parser environment */ 569dde5845aSJiri Kosina 570dde5845aSJiri Kosina return ret; 571dde5845aSJiri Kosina } 572dde5845aSJiri Kosina 573dde5845aSJiri Kosina /* 574dde5845aSJiri Kosina * Process a reserved item. 575dde5845aSJiri Kosina */ 576dde5845aSJiri Kosina 577dde5845aSJiri Kosina static int hid_parser_reserved(struct hid_parser *parser, struct hid_item *item) 578dde5845aSJiri Kosina { 57958037eb9SJiri Kosina dbg_hid("reserved item type, tag 0x%x\n", item->tag); 580dde5845aSJiri Kosina return 0; 581dde5845aSJiri Kosina } 582dde5845aSJiri Kosina 583dde5845aSJiri Kosina /* 584dde5845aSJiri Kosina * Free a report and all registered fields. The field->usage and 585dde5845aSJiri Kosina * field->value table's are allocated behind the field, so we need 586dde5845aSJiri Kosina * only to free(field) itself. 587dde5845aSJiri Kosina */ 588dde5845aSJiri Kosina 589dde5845aSJiri Kosina static void hid_free_report(struct hid_report *report) 590dde5845aSJiri Kosina { 591dde5845aSJiri Kosina unsigned n; 592dde5845aSJiri Kosina 593dde5845aSJiri Kosina for (n = 0; n < report->maxfield; n++) 594dde5845aSJiri Kosina kfree(report->field[n]); 595dde5845aSJiri Kosina kfree(report); 596dde5845aSJiri Kosina } 597dde5845aSJiri Kosina 598dde5845aSJiri Kosina /* 599a7197c2eSHenrik Rydberg * Close report. This function returns the device 600a7197c2eSHenrik Rydberg * state to the point prior to hid_open_report(). 601dde5845aSJiri Kosina */ 602a7197c2eSHenrik Rydberg static void hid_close_report(struct hid_device *device) 603dde5845aSJiri Kosina { 604dde5845aSJiri Kosina unsigned i, j; 605dde5845aSJiri Kosina 606dde5845aSJiri Kosina for (i = 0; i < HID_REPORT_TYPES; i++) { 607dde5845aSJiri Kosina struct hid_report_enum *report_enum = device->report_enum + i; 608dde5845aSJiri Kosina 60943622021SKees Cook for (j = 0; j < HID_MAX_IDS; j++) { 610dde5845aSJiri Kosina struct hid_report *report = report_enum->report_id_hash[j]; 611dde5845aSJiri Kosina if (report) 612dde5845aSJiri Kosina hid_free_report(report); 613dde5845aSJiri Kosina } 614a7197c2eSHenrik Rydberg memset(report_enum, 0, sizeof(*report_enum)); 615a7197c2eSHenrik Rydberg INIT_LIST_HEAD(&report_enum->report_list); 616dde5845aSJiri Kosina } 617dde5845aSJiri Kosina 618dde5845aSJiri Kosina kfree(device->rdesc); 619a7197c2eSHenrik Rydberg device->rdesc = NULL; 620a7197c2eSHenrik Rydberg device->rsize = 0; 621a7197c2eSHenrik Rydberg 622767fe787SJiri Kosina kfree(device->collection); 623a7197c2eSHenrik Rydberg device->collection = NULL; 624a7197c2eSHenrik Rydberg device->collection_size = 0; 625a7197c2eSHenrik Rydberg device->maxcollection = 0; 626a7197c2eSHenrik Rydberg device->maxapplication = 0; 627a7197c2eSHenrik Rydberg 628a7197c2eSHenrik Rydberg device->status &= ~HID_STAT_PARSED; 629a7197c2eSHenrik Rydberg } 630a7197c2eSHenrik Rydberg 631a7197c2eSHenrik Rydberg /* 632a7197c2eSHenrik Rydberg * Free a device structure, all reports, and all fields. 633a7197c2eSHenrik Rydberg */ 634a7197c2eSHenrik Rydberg 635a7197c2eSHenrik Rydberg static void hid_device_release(struct device *dev) 636a7197c2eSHenrik Rydberg { 637ee79a8f8SGeliang Tang struct hid_device *hid = to_hid_device(dev); 638a7197c2eSHenrik Rydberg 639a7197c2eSHenrik Rydberg hid_close_report(hid); 640a7197c2eSHenrik Rydberg kfree(hid->dev_rdesc); 641a7197c2eSHenrik Rydberg kfree(hid); 642dde5845aSJiri Kosina } 643dde5845aSJiri Kosina 644dde5845aSJiri Kosina /* 645dde5845aSJiri Kosina * Fetch a report description item from the data stream. We support long 646dde5845aSJiri Kosina * items, though they are not used yet. 647dde5845aSJiri Kosina */ 648dde5845aSJiri Kosina 649dde5845aSJiri Kosina static u8 *fetch_item(__u8 *start, __u8 *end, struct hid_item *item) 650dde5845aSJiri Kosina { 651dde5845aSJiri Kosina u8 b; 652dde5845aSJiri Kosina 653dde5845aSJiri Kosina if ((end - start) <= 0) 654dde5845aSJiri Kosina return NULL; 655dde5845aSJiri Kosina 656dde5845aSJiri Kosina b = *start++; 657dde5845aSJiri Kosina 658dde5845aSJiri Kosina item->type = (b >> 2) & 3; 659dde5845aSJiri Kosina item->tag = (b >> 4) & 15; 660dde5845aSJiri Kosina 661dde5845aSJiri Kosina if (item->tag == HID_ITEM_TAG_LONG) { 662dde5845aSJiri Kosina 663dde5845aSJiri Kosina item->format = HID_ITEM_FORMAT_LONG; 664dde5845aSJiri Kosina 665dde5845aSJiri Kosina if ((end - start) < 2) 666dde5845aSJiri Kosina return NULL; 667dde5845aSJiri Kosina 668dde5845aSJiri Kosina item->size = *start++; 669dde5845aSJiri Kosina item->tag = *start++; 670dde5845aSJiri Kosina 671dde5845aSJiri Kosina if ((end - start) < item->size) 672dde5845aSJiri Kosina return NULL; 673dde5845aSJiri Kosina 674dde5845aSJiri Kosina item->data.longdata = start; 675dde5845aSJiri Kosina start += item->size; 676dde5845aSJiri Kosina return start; 677dde5845aSJiri Kosina } 678dde5845aSJiri Kosina 679dde5845aSJiri Kosina item->format = HID_ITEM_FORMAT_SHORT; 680dde5845aSJiri Kosina item->size = b & 3; 681dde5845aSJiri Kosina 682dde5845aSJiri Kosina switch (item->size) { 683dde5845aSJiri Kosina case 0: 684dde5845aSJiri Kosina return start; 685dde5845aSJiri Kosina 686dde5845aSJiri Kosina case 1: 687dde5845aSJiri Kosina if ((end - start) < 1) 688dde5845aSJiri Kosina return NULL; 689dde5845aSJiri Kosina item->data.u8 = *start++; 690dde5845aSJiri Kosina return start; 691dde5845aSJiri Kosina 692dde5845aSJiri Kosina case 2: 693dde5845aSJiri Kosina if ((end - start) < 2) 694dde5845aSJiri Kosina return NULL; 695c105068fSHarvey Harrison item->data.u16 = get_unaligned_le16(start); 696dde5845aSJiri Kosina start = (__u8 *)((__le16 *)start + 1); 697dde5845aSJiri Kosina return start; 698dde5845aSJiri Kosina 699dde5845aSJiri Kosina case 3: 700dde5845aSJiri Kosina item->size++; 701dde5845aSJiri Kosina if ((end - start) < 4) 702dde5845aSJiri Kosina return NULL; 703c105068fSHarvey Harrison item->data.u32 = get_unaligned_le32(start); 704dde5845aSJiri Kosina start = (__u8 *)((__le32 *)start + 1); 705dde5845aSJiri Kosina return start; 706dde5845aSJiri Kosina } 707dde5845aSJiri Kosina 708dde5845aSJiri Kosina return NULL; 709dde5845aSJiri Kosina } 710dde5845aSJiri Kosina 7113dc8fc08SBenjamin Tissoires static void hid_scan_input_usage(struct hid_parser *parser, u32 usage) 712734c6609SHenrik Rydberg { 7133dc8fc08SBenjamin Tissoires struct hid_device *hid = parser->device; 7143dc8fc08SBenjamin Tissoires 7154fa3a583SHenrik Rydberg if (usage == HID_DG_CONTACTID) 7164fa3a583SHenrik Rydberg hid->group = HID_GROUP_MULTITOUCH; 717734c6609SHenrik Rydberg } 718734c6609SHenrik Rydberg 719f961bd35SBenjamin Tissoires static void hid_scan_feature_usage(struct hid_parser *parser, u32 usage) 720f961bd35SBenjamin Tissoires { 721f961bd35SBenjamin Tissoires if (usage == 0xff0000c5 && parser->global.report_count == 256 && 722f961bd35SBenjamin Tissoires parser->global.report_size == 8) 723f961bd35SBenjamin Tissoires parser->scan_flags |= HID_SCAN_FLAG_MT_WIN_8; 724f961bd35SBenjamin Tissoires } 725f961bd35SBenjamin Tissoires 7263dc8fc08SBenjamin Tissoires static void hid_scan_collection(struct hid_parser *parser, unsigned type) 7273dc8fc08SBenjamin Tissoires { 7283dc8fc08SBenjamin Tissoires struct hid_device *hid = parser->device; 729e39f2d59SAndrew Duggan int i; 7303dc8fc08SBenjamin Tissoires 7313dc8fc08SBenjamin Tissoires if (((parser->global.usage_page << 16) == HID_UP_SENSOR) && 7323dc8fc08SBenjamin Tissoires type == HID_COLLECTION_PHYSICAL) 7333dc8fc08SBenjamin Tissoires hid->group = HID_GROUP_SENSOR_HUB; 734be3b1634SAlan Wu 735be3b1634SAlan Wu if (hid->vendor == USB_VENDOR_ID_MICROSOFT && 7360a76ac80SDennis Chen hid->product == USB_DEVICE_ID_MS_POWER_COVER && 737be3b1634SAlan Wu hid->group == HID_GROUP_MULTITOUCH) 738be3b1634SAlan Wu hid->group = HID_GROUP_GENERIC; 739e39f2d59SAndrew Duggan 740e39f2d59SAndrew Duggan if ((parser->global.usage_page << 16) == HID_UP_GENDESK) 741e39f2d59SAndrew Duggan for (i = 0; i < parser->local.usage_index; i++) 742e39f2d59SAndrew Duggan if (parser->local.usage[i] == HID_GD_POINTER) 743e39f2d59SAndrew Duggan parser->scan_flags |= HID_SCAN_FLAG_GD_POINTER; 744e39f2d59SAndrew Duggan 745e39f2d59SAndrew Duggan if ((parser->global.usage_page << 16) >= HID_UP_MSVENDOR) 746e39f2d59SAndrew Duggan parser->scan_flags |= HID_SCAN_FLAG_VENDOR_SPECIFIC; 7473dc8fc08SBenjamin Tissoires } 7483dc8fc08SBenjamin Tissoires 7493dc8fc08SBenjamin Tissoires static int hid_scan_main(struct hid_parser *parser, struct hid_item *item) 7503dc8fc08SBenjamin Tissoires { 7513dc8fc08SBenjamin Tissoires __u32 data; 7523dc8fc08SBenjamin Tissoires int i; 7533dc8fc08SBenjamin Tissoires 7543dc8fc08SBenjamin Tissoires data = item_udata(item); 7553dc8fc08SBenjamin Tissoires 7563dc8fc08SBenjamin Tissoires switch (item->tag) { 7573dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION: 7583dc8fc08SBenjamin Tissoires hid_scan_collection(parser, data & 0xff); 7593dc8fc08SBenjamin Tissoires break; 7603dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_END_COLLECTION: 7613dc8fc08SBenjamin Tissoires break; 7623dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_INPUT: 763e24d0d39SBenjamin Tissoires /* ignore constant inputs, they will be ignored by hid-input */ 764e24d0d39SBenjamin Tissoires if (data & HID_MAIN_ITEM_CONSTANT) 765e24d0d39SBenjamin Tissoires break; 7663dc8fc08SBenjamin Tissoires for (i = 0; i < parser->local.usage_index; i++) 7673dc8fc08SBenjamin Tissoires hid_scan_input_usage(parser, parser->local.usage[i]); 7683dc8fc08SBenjamin Tissoires break; 7693dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_OUTPUT: 7703dc8fc08SBenjamin Tissoires break; 7713dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_FEATURE: 772f961bd35SBenjamin Tissoires for (i = 0; i < parser->local.usage_index; i++) 773f961bd35SBenjamin Tissoires hid_scan_feature_usage(parser, parser->local.usage[i]); 7743dc8fc08SBenjamin Tissoires break; 7753dc8fc08SBenjamin Tissoires } 7763dc8fc08SBenjamin Tissoires 7773dc8fc08SBenjamin Tissoires /* Reset the local parser environment */ 7783dc8fc08SBenjamin Tissoires memset(&parser->local, 0, sizeof(parser->local)); 7793dc8fc08SBenjamin Tissoires 7803dc8fc08SBenjamin Tissoires return 0; 7813dc8fc08SBenjamin Tissoires } 7823dc8fc08SBenjamin Tissoires 783734c6609SHenrik Rydberg /* 784734c6609SHenrik Rydberg * Scan a report descriptor before the device is added to the bus. 785734c6609SHenrik Rydberg * Sets device groups and other properties that determine what driver 786734c6609SHenrik Rydberg * to load. 787734c6609SHenrik Rydberg */ 788734c6609SHenrik Rydberg static int hid_scan_report(struct hid_device *hid) 789734c6609SHenrik Rydberg { 7903dc8fc08SBenjamin Tissoires struct hid_parser *parser; 7913dc8fc08SBenjamin Tissoires struct hid_item item; 792734c6609SHenrik Rydberg __u8 *start = hid->dev_rdesc; 793734c6609SHenrik Rydberg __u8 *end = start + hid->dev_rsize; 7943dc8fc08SBenjamin Tissoires static int (*dispatch_type[])(struct hid_parser *parser, 7953dc8fc08SBenjamin Tissoires struct hid_item *item) = { 7963dc8fc08SBenjamin Tissoires hid_scan_main, 7973dc8fc08SBenjamin Tissoires hid_parser_global, 7983dc8fc08SBenjamin Tissoires hid_parser_local, 7993dc8fc08SBenjamin Tissoires hid_parser_reserved 8003dc8fc08SBenjamin Tissoires }; 801734c6609SHenrik Rydberg 8023dc8fc08SBenjamin Tissoires parser = vzalloc(sizeof(struct hid_parser)); 8033dc8fc08SBenjamin Tissoires if (!parser) 8043dc8fc08SBenjamin Tissoires return -ENOMEM; 8053dc8fc08SBenjamin Tissoires 8063dc8fc08SBenjamin Tissoires parser->device = hid; 807734c6609SHenrik Rydberg hid->group = HID_GROUP_GENERIC; 808734c6609SHenrik Rydberg 8093dc8fc08SBenjamin Tissoires /* 8103dc8fc08SBenjamin Tissoires * The parsing is simpler than the one in hid_open_report() as we should 8113dc8fc08SBenjamin Tissoires * be robust against hid errors. Those errors will be raised by 8123dc8fc08SBenjamin Tissoires * hid_open_report() anyway. 8133dc8fc08SBenjamin Tissoires */ 8143dc8fc08SBenjamin Tissoires while ((start = fetch_item(start, end, &item)) != NULL) 8153dc8fc08SBenjamin Tissoires dispatch_type[item.type](parser, &item); 8163dc8fc08SBenjamin Tissoires 817f961bd35SBenjamin Tissoires /* 818f961bd35SBenjamin Tissoires * Handle special flags set during scanning. 819f961bd35SBenjamin Tissoires */ 820f961bd35SBenjamin Tissoires if ((parser->scan_flags & HID_SCAN_FLAG_MT_WIN_8) && 821f961bd35SBenjamin Tissoires (hid->group == HID_GROUP_MULTITOUCH)) 822f961bd35SBenjamin Tissoires hid->group = HID_GROUP_MULTITOUCH_WIN_8; 823f961bd35SBenjamin Tissoires 824ba391e5aSBenjamin Tissoires /* 825ba391e5aSBenjamin Tissoires * Vendor specific handlings 826ba391e5aSBenjamin Tissoires */ 82729b47391SBenjamin Tissoires switch (hid->vendor) { 82829b47391SBenjamin Tissoires case USB_VENDOR_ID_WACOM: 82929b47391SBenjamin Tissoires hid->group = HID_GROUP_WACOM; 83029b47391SBenjamin Tissoires break; 831c241c5eeSBenjamin Tissoires case USB_VENDOR_ID_SYNAPTICS: 83284379d83SJiri Kosina if (hid->group == HID_GROUP_GENERIC) 833e39f2d59SAndrew Duggan if ((parser->scan_flags & HID_SCAN_FLAG_VENDOR_SPECIFIC) 834e39f2d59SAndrew Duggan && (parser->scan_flags & HID_SCAN_FLAG_GD_POINTER)) 835e39f2d59SAndrew Duggan /* 836e39f2d59SAndrew Duggan * hid-rmi should take care of them, 837e39f2d59SAndrew Duggan * not hid-generic 838e39f2d59SAndrew Duggan */ 839c241c5eeSBenjamin Tissoires hid->group = HID_GROUP_RMI; 840c241c5eeSBenjamin Tissoires break; 84129b47391SBenjamin Tissoires } 84229b47391SBenjamin Tissoires 8433dc8fc08SBenjamin Tissoires vfree(parser); 844734c6609SHenrik Rydberg return 0; 845734c6609SHenrik Rydberg } 846734c6609SHenrik Rydberg 84785cdaf52SJiri Slaby /** 84885cdaf52SJiri Slaby * hid_parse_report - parse device report 84985cdaf52SJiri Slaby * 85085cdaf52SJiri Slaby * @device: hid device 85185cdaf52SJiri Slaby * @start: report start 85285cdaf52SJiri Slaby * @size: report size 85385cdaf52SJiri Slaby * 854a7197c2eSHenrik Rydberg * Allocate the device report as read by the bus driver. This function should 855a7197c2eSHenrik Rydberg * only be called from parse() in ll drivers. 856a7197c2eSHenrik Rydberg */ 857a7197c2eSHenrik Rydberg int hid_parse_report(struct hid_device *hid, __u8 *start, unsigned size) 858a7197c2eSHenrik Rydberg { 859a7197c2eSHenrik Rydberg hid->dev_rdesc = kmemdup(start, size, GFP_KERNEL); 860a7197c2eSHenrik Rydberg if (!hid->dev_rdesc) 861a7197c2eSHenrik Rydberg return -ENOMEM; 862a7197c2eSHenrik Rydberg hid->dev_rsize = size; 863a7197c2eSHenrik Rydberg return 0; 864a7197c2eSHenrik Rydberg } 865a7197c2eSHenrik Rydberg EXPORT_SYMBOL_GPL(hid_parse_report); 866a7197c2eSHenrik Rydberg 867331415ffSKees Cook static const char * const hid_report_names[] = { 868331415ffSKees Cook "HID_INPUT_REPORT", 869331415ffSKees Cook "HID_OUTPUT_REPORT", 870331415ffSKees Cook "HID_FEATURE_REPORT", 871331415ffSKees Cook }; 872331415ffSKees Cook /** 873331415ffSKees Cook * hid_validate_values - validate existing device report's value indexes 874331415ffSKees Cook * 875331415ffSKees Cook * @device: hid device 876331415ffSKees Cook * @type: which report type to examine 877331415ffSKees Cook * @id: which report ID to examine (0 for first) 878331415ffSKees Cook * @field_index: which report field to examine 879331415ffSKees Cook * @report_counts: expected number of values 880331415ffSKees Cook * 881331415ffSKees Cook * Validate the number of values in a given field of a given report, after 882331415ffSKees Cook * parsing. 883331415ffSKees Cook */ 884331415ffSKees Cook struct hid_report *hid_validate_values(struct hid_device *hid, 885331415ffSKees Cook unsigned int type, unsigned int id, 886331415ffSKees Cook unsigned int field_index, 887331415ffSKees Cook unsigned int report_counts) 888331415ffSKees Cook { 889331415ffSKees Cook struct hid_report *report; 890331415ffSKees Cook 891331415ffSKees Cook if (type > HID_FEATURE_REPORT) { 892331415ffSKees Cook hid_err(hid, "invalid HID report type %u\n", type); 893331415ffSKees Cook return NULL; 894331415ffSKees Cook } 895331415ffSKees Cook 896331415ffSKees Cook if (id >= HID_MAX_IDS) { 897331415ffSKees Cook hid_err(hid, "invalid HID report id %u\n", id); 898331415ffSKees Cook return NULL; 899331415ffSKees Cook } 900331415ffSKees Cook 901331415ffSKees Cook /* 902331415ffSKees Cook * Explicitly not using hid_get_report() here since it depends on 903331415ffSKees Cook * ->numbered being checked, which may not always be the case when 904331415ffSKees Cook * drivers go to access report values. 905331415ffSKees Cook */ 9061b15d2e5SKees Cook if (id == 0) { 9071b15d2e5SKees Cook /* 9081b15d2e5SKees Cook * Validating on id 0 means we should examine the first 9091b15d2e5SKees Cook * report in the list. 9101b15d2e5SKees Cook */ 9111b15d2e5SKees Cook report = list_entry( 9121b15d2e5SKees Cook hid->report_enum[type].report_list.next, 9131b15d2e5SKees Cook struct hid_report, list); 9141b15d2e5SKees Cook } else { 915331415ffSKees Cook report = hid->report_enum[type].report_id_hash[id]; 9161b15d2e5SKees Cook } 917331415ffSKees Cook if (!report) { 918331415ffSKees Cook hid_err(hid, "missing %s %u\n", hid_report_names[type], id); 919331415ffSKees Cook return NULL; 920331415ffSKees Cook } 921331415ffSKees Cook if (report->maxfield <= field_index) { 922331415ffSKees Cook hid_err(hid, "not enough fields in %s %u\n", 923331415ffSKees Cook hid_report_names[type], id); 924331415ffSKees Cook return NULL; 925331415ffSKees Cook } 926331415ffSKees Cook if (report->field[field_index]->report_count < report_counts) { 927331415ffSKees Cook hid_err(hid, "not enough values in %s %u field %u\n", 928331415ffSKees Cook hid_report_names[type], id, field_index); 929331415ffSKees Cook return NULL; 930331415ffSKees Cook } 931331415ffSKees Cook return report; 932331415ffSKees Cook } 933331415ffSKees Cook EXPORT_SYMBOL_GPL(hid_validate_values); 934331415ffSKees Cook 935a7197c2eSHenrik Rydberg /** 936a7197c2eSHenrik Rydberg * hid_open_report - open a driver-specific device report 937a7197c2eSHenrik Rydberg * 938a7197c2eSHenrik Rydberg * @device: hid device 939a7197c2eSHenrik Rydberg * 940dde5845aSJiri Kosina * Parse a report description into a hid_device structure. Reports are 941dde5845aSJiri Kosina * enumerated, fields are attached to these reports. 94285cdaf52SJiri Slaby * 0 returned on success, otherwise nonzero error value. 943a7197c2eSHenrik Rydberg * 944a7197c2eSHenrik Rydberg * This function (or the equivalent hid_parse() macro) should only be 945a7197c2eSHenrik Rydberg * called from probe() in drivers, before starting the device. 946dde5845aSJiri Kosina */ 947a7197c2eSHenrik Rydberg int hid_open_report(struct hid_device *device) 948dde5845aSJiri Kosina { 949dde5845aSJiri Kosina struct hid_parser *parser; 950dde5845aSJiri Kosina struct hid_item item; 951a7197c2eSHenrik Rydberg unsigned int size; 952a7197c2eSHenrik Rydberg __u8 *start; 95386e6b77eSKevin Daughtridge __u8 *buf; 954dde5845aSJiri Kosina __u8 *end; 95585cdaf52SJiri Slaby int ret; 956dde5845aSJiri Kosina static int (*dispatch_type[])(struct hid_parser *parser, 957dde5845aSJiri Kosina struct hid_item *item) = { 958dde5845aSJiri Kosina hid_parser_main, 959dde5845aSJiri Kosina hid_parser_global, 960dde5845aSJiri Kosina hid_parser_local, 961dde5845aSJiri Kosina hid_parser_reserved 962dde5845aSJiri Kosina }; 963dde5845aSJiri Kosina 964a7197c2eSHenrik Rydberg if (WARN_ON(device->status & HID_STAT_PARSED)) 965a7197c2eSHenrik Rydberg return -EBUSY; 966a7197c2eSHenrik Rydberg 967a7197c2eSHenrik Rydberg start = device->dev_rdesc; 968a7197c2eSHenrik Rydberg if (WARN_ON(!start)) 969a7197c2eSHenrik Rydberg return -ENODEV; 970a7197c2eSHenrik Rydberg size = device->dev_rsize; 971a7197c2eSHenrik Rydberg 97286e6b77eSKevin Daughtridge buf = kmemdup(start, size, GFP_KERNEL); 97386e6b77eSKevin Daughtridge if (buf == NULL) 97485cdaf52SJiri Slaby return -ENOMEM; 97586e6b77eSKevin Daughtridge 97686e6b77eSKevin Daughtridge if (device->driver->report_fixup) 97786e6b77eSKevin Daughtridge start = device->driver->report_fixup(device, buf, &size); 97886e6b77eSKevin Daughtridge else 97986e6b77eSKevin Daughtridge start = buf; 98086e6b77eSKevin Daughtridge 98186e6b77eSKevin Daughtridge start = kmemdup(start, size, GFP_KERNEL); 98286e6b77eSKevin Daughtridge kfree(buf); 98386e6b77eSKevin Daughtridge if (start == NULL) 98486e6b77eSKevin Daughtridge return -ENOMEM; 98586e6b77eSKevin Daughtridge 98686e6b77eSKevin Daughtridge device->rdesc = start; 987dde5845aSJiri Kosina device->rsize = size; 988dde5845aSJiri Kosina 989fe258020SJoe Perches parser = vzalloc(sizeof(struct hid_parser)); 99085cdaf52SJiri Slaby if (!parser) { 99185cdaf52SJiri Slaby ret = -ENOMEM; 99285cdaf52SJiri Slaby goto err; 993dde5845aSJiri Kosina } 99485cdaf52SJiri Slaby 995dde5845aSJiri Kosina parser->device = device; 996dde5845aSJiri Kosina 997dde5845aSJiri Kosina end = start + size; 998a7197c2eSHenrik Rydberg 999a7197c2eSHenrik Rydberg device->collection = kcalloc(HID_DEFAULT_NUM_COLLECTIONS, 1000a7197c2eSHenrik Rydberg sizeof(struct hid_collection), GFP_KERNEL); 1001a7197c2eSHenrik Rydberg if (!device->collection) { 1002a7197c2eSHenrik Rydberg ret = -ENOMEM; 1003a7197c2eSHenrik Rydberg goto err; 1004a7197c2eSHenrik Rydberg } 1005a7197c2eSHenrik Rydberg device->collection_size = HID_DEFAULT_NUM_COLLECTIONS; 1006a7197c2eSHenrik Rydberg 100785cdaf52SJiri Slaby ret = -EINVAL; 1008dde5845aSJiri Kosina while ((start = fetch_item(start, end, &item)) != NULL) { 1009dde5845aSJiri Kosina 1010dde5845aSJiri Kosina if (item.format != HID_ITEM_FORMAT_SHORT) { 10118c3d52fcSJiri Kosina hid_err(device, "unexpected long global item\n"); 101285cdaf52SJiri Slaby goto err; 1013dde5845aSJiri Kosina } 1014dde5845aSJiri Kosina 1015dde5845aSJiri Kosina if (dispatch_type[item.type](parser, &item)) { 10168c3d52fcSJiri Kosina hid_err(device, "item %u %u %u %u parsing failed\n", 10174291ee30SJoe Perches item.format, (unsigned)item.size, 10184291ee30SJoe Perches (unsigned)item.type, (unsigned)item.tag); 101985cdaf52SJiri Slaby goto err; 1020dde5845aSJiri Kosina } 1021dde5845aSJiri Kosina 1022dde5845aSJiri Kosina if (start == end) { 1023dde5845aSJiri Kosina if (parser->collection_stack_ptr) { 10248c3d52fcSJiri Kosina hid_err(device, "unbalanced collection at end of report description\n"); 102585cdaf52SJiri Slaby goto err; 1026dde5845aSJiri Kosina } 1027dde5845aSJiri Kosina if (parser->local.delimiter_depth) { 10288c3d52fcSJiri Kosina hid_err(device, "unbalanced delimiter at end of report description\n"); 102985cdaf52SJiri Slaby goto err; 1030dde5845aSJiri Kosina } 103147a80edbSJiri Kosina vfree(parser); 1032a7197c2eSHenrik Rydberg device->status |= HID_STAT_PARSED; 103385cdaf52SJiri Slaby return 0; 1034dde5845aSJiri Kosina } 1035dde5845aSJiri Kosina } 1036dde5845aSJiri Kosina 10378c3d52fcSJiri Kosina hid_err(device, "item fetching failed at offset %d\n", (int)(end - start)); 103885cdaf52SJiri Slaby err: 103947a80edbSJiri Kosina vfree(parser); 1040a7197c2eSHenrik Rydberg hid_close_report(device); 104185cdaf52SJiri Slaby return ret; 1042dde5845aSJiri Kosina } 1043a7197c2eSHenrik Rydberg EXPORT_SYMBOL_GPL(hid_open_report); 1044dde5845aSJiri Kosina 1045dde5845aSJiri Kosina /* 1046dde5845aSJiri Kosina * Convert a signed n-bit integer to signed 32-bit integer. Common 1047dde5845aSJiri Kosina * cases are done through the compiler, the screwed things has to be 1048dde5845aSJiri Kosina * done by hand. 1049dde5845aSJiri Kosina */ 1050dde5845aSJiri Kosina 1051dde5845aSJiri Kosina static s32 snto32(__u32 value, unsigned n) 1052dde5845aSJiri Kosina { 1053dde5845aSJiri Kosina switch (n) { 1054dde5845aSJiri Kosina case 8: return ((__s8)value); 1055dde5845aSJiri Kosina case 16: return ((__s16)value); 1056dde5845aSJiri Kosina case 32: return ((__s32)value); 1057dde5845aSJiri Kosina } 105808585e43SAndy Shevchenko return value & (1 << (n - 1)) ? value | (~0U << n) : value; 1059dde5845aSJiri Kosina } 1060dde5845aSJiri Kosina 106177463838SBenjamin Tissoires s32 hid_snto32(__u32 value, unsigned n) 106277463838SBenjamin Tissoires { 106377463838SBenjamin Tissoires return snto32(value, n); 106477463838SBenjamin Tissoires } 106577463838SBenjamin Tissoires EXPORT_SYMBOL_GPL(hid_snto32); 106677463838SBenjamin Tissoires 1067dde5845aSJiri Kosina /* 1068dde5845aSJiri Kosina * Convert a signed 32-bit integer to a signed n-bit integer. 1069dde5845aSJiri Kosina */ 1070dde5845aSJiri Kosina 1071dde5845aSJiri Kosina static u32 s32ton(__s32 value, unsigned n) 1072dde5845aSJiri Kosina { 1073dde5845aSJiri Kosina s32 a = value >> (n - 1); 1074dde5845aSJiri Kosina if (a && a != -1) 1075dde5845aSJiri Kosina return value < 0 ? 1 << (n - 1) : (1 << (n - 1)) - 1; 1076dde5845aSJiri Kosina return value & ((1 << n) - 1); 1077dde5845aSJiri Kosina } 1078dde5845aSJiri Kosina 1079dde5845aSJiri Kosina /* 1080dde5845aSJiri Kosina * Extract/implement a data field from/to a little endian report (bit array). 1081dde5845aSJiri Kosina * 1082dde5845aSJiri Kosina * Code sort-of follows HID spec: 10835137b354SDmitry Torokhov * http://www.usb.org/developers/hidpage/HID1_11.pdf 1084dde5845aSJiri Kosina * 1085dde5845aSJiri Kosina * While the USB HID spec allows unlimited length bit fields in "report 1086dde5845aSJiri Kosina * descriptors", most devices never use more than 16 bits. 1087dde5845aSJiri Kosina * One model of UPS is claimed to report "LINEV" as a 32-bit field. 1088dde5845aSJiri Kosina * Search linux-kernel and linux-usb-devel archives for "hid-core extract". 1089dde5845aSJiri Kosina */ 1090dde5845aSJiri Kosina 10915137b354SDmitry Torokhov static u32 __extract(u8 *report, unsigned offset, int n) 10925137b354SDmitry Torokhov { 10935137b354SDmitry Torokhov unsigned int idx = offset / 8; 10945137b354SDmitry Torokhov unsigned int bit_nr = 0; 10955137b354SDmitry Torokhov unsigned int bit_shift = offset % 8; 10965137b354SDmitry Torokhov int bits_to_copy = 8 - bit_shift; 10975137b354SDmitry Torokhov u32 value = 0; 10985137b354SDmitry Torokhov u32 mask = n < 32 ? (1U << n) - 1 : ~0U; 10995137b354SDmitry Torokhov 11005137b354SDmitry Torokhov while (n > 0) { 11015137b354SDmitry Torokhov value |= ((u32)report[idx] >> bit_shift) << bit_nr; 11025137b354SDmitry Torokhov n -= bits_to_copy; 11035137b354SDmitry Torokhov bit_nr += bits_to_copy; 11045137b354SDmitry Torokhov bits_to_copy = 8; 11055137b354SDmitry Torokhov bit_shift = 0; 11065137b354SDmitry Torokhov idx++; 11075137b354SDmitry Torokhov } 11085137b354SDmitry Torokhov 11095137b354SDmitry Torokhov return value & mask; 11105137b354SDmitry Torokhov } 11115137b354SDmitry Torokhov 11125137b354SDmitry Torokhov u32 hid_field_extract(const struct hid_device *hid, u8 *report, 11134291ee30SJoe Perches unsigned offset, unsigned n) 1114dde5845aSJiri Kosina { 11155137b354SDmitry Torokhov if (n > 32) { 111604fba786SGoffredo Baroncelli hid_warn(hid, "hid_field_extract() called with n (%d) > 32! (%s)\n", 1117c4124c9bSJiri Kosina n, current->comm); 11185137b354SDmitry Torokhov n = 32; 11195137b354SDmitry Torokhov } 1120dde5845aSJiri Kosina 11215137b354SDmitry Torokhov return __extract(report, offset, n); 1122dde5845aSJiri Kosina } 112304fba786SGoffredo Baroncelli EXPORT_SYMBOL_GPL(hid_field_extract); 1124dde5845aSJiri Kosina 1125dde5845aSJiri Kosina /* 1126dde5845aSJiri Kosina * "implement" : set bits in a little endian bit stream. 1127dde5845aSJiri Kosina * Same concepts as "extract" (see comments above). 1128dde5845aSJiri Kosina * The data mangled in the bit stream remains in little endian 1129dde5845aSJiri Kosina * order the whole time. It make more sense to talk about 1130dde5845aSJiri Kosina * endianness of register values by considering a register 11315137b354SDmitry Torokhov * a "cached" copy of the little endian bit stream. 1132dde5845aSJiri Kosina */ 1133dde5845aSJiri Kosina 11345137b354SDmitry Torokhov static void __implement(u8 *report, unsigned offset, int n, u32 value) 11355137b354SDmitry Torokhov { 11365137b354SDmitry Torokhov unsigned int idx = offset / 8; 11375137b354SDmitry Torokhov unsigned int bit_shift = offset % 8; 11385137b354SDmitry Torokhov int bits_to_set = 8 - bit_shift; 11395137b354SDmitry Torokhov 11405137b354SDmitry Torokhov while (n - bits_to_set >= 0) { 114195d1c895SDmitry Torokhov report[idx] &= ~(0xff << bit_shift); 11425137b354SDmitry Torokhov report[idx] |= value << bit_shift; 11435137b354SDmitry Torokhov value >>= bits_to_set; 11445137b354SDmitry Torokhov n -= bits_to_set; 11455137b354SDmitry Torokhov bits_to_set = 8; 11465137b354SDmitry Torokhov bit_shift = 0; 11475137b354SDmitry Torokhov idx++; 11485137b354SDmitry Torokhov } 11495137b354SDmitry Torokhov 11505137b354SDmitry Torokhov /* last nibble */ 11515137b354SDmitry Torokhov if (n) { 115295d1c895SDmitry Torokhov u8 bit_mask = ((1U << n) - 1); 115395d1c895SDmitry Torokhov report[idx] &= ~(bit_mask << bit_shift); 115495d1c895SDmitry Torokhov report[idx] |= value << bit_shift; 11555137b354SDmitry Torokhov } 11565137b354SDmitry Torokhov } 11575137b354SDmitry Torokhov 11585137b354SDmitry Torokhov static void implement(const struct hid_device *hid, u8 *report, 11595137b354SDmitry Torokhov unsigned offset, unsigned n, u32 value) 11605137b354SDmitry Torokhov { 116195d1c895SDmitry Torokhov if (unlikely(n > 32)) { 11624291ee30SJoe Perches hid_warn(hid, "%s() called with n (%d) > 32! (%s)\n", 11634291ee30SJoe Perches __func__, n, current->comm); 11645137b354SDmitry Torokhov n = 32; 116595d1c895SDmitry Torokhov } else if (n < 32) { 116695d1c895SDmitry Torokhov u32 m = (1U << n) - 1; 1167dde5845aSJiri Kosina 116895d1c895SDmitry Torokhov if (unlikely(value > m)) { 116995d1c895SDmitry Torokhov hid_warn(hid, 117095d1c895SDmitry Torokhov "%s() called with too large value %d (n: %d)! (%s)\n", 117195d1c895SDmitry Torokhov __func__, value, n, current->comm); 117295d1c895SDmitry Torokhov WARN_ON(1); 1173dde5845aSJiri Kosina value &= m; 117495d1c895SDmitry Torokhov } 117595d1c895SDmitry Torokhov } 1176dde5845aSJiri Kosina 11775137b354SDmitry Torokhov __implement(report, offset, n, value); 1178dde5845aSJiri Kosina } 1179dde5845aSJiri Kosina 1180dde5845aSJiri Kosina /* 1181dde5845aSJiri Kosina * Search an array for a value. 1182dde5845aSJiri Kosina */ 1183dde5845aSJiri Kosina 118416ee4cc8SJoe Perches static int search(__s32 *array, __s32 value, unsigned n) 1185dde5845aSJiri Kosina { 1186dde5845aSJiri Kosina while (n--) { 1187dde5845aSJiri Kosina if (*array++ == value) 1188dde5845aSJiri Kosina return 0; 1189dde5845aSJiri Kosina } 1190dde5845aSJiri Kosina return -1; 1191dde5845aSJiri Kosina } 1192dde5845aSJiri Kosina 119385cdaf52SJiri Slaby /** 119485cdaf52SJiri Slaby * hid_match_report - check if driver's raw_event should be called 119585cdaf52SJiri Slaby * 119685cdaf52SJiri Slaby * @hid: hid device 119785cdaf52SJiri Slaby * @report_type: type to match against 119885cdaf52SJiri Slaby * 119985cdaf52SJiri Slaby * compare hid->driver->report_table->report_type to report->type 120085cdaf52SJiri Slaby */ 120185cdaf52SJiri Slaby static int hid_match_report(struct hid_device *hid, struct hid_report *report) 1202dde5845aSJiri Kosina { 120385cdaf52SJiri Slaby const struct hid_report_id *id = hid->driver->report_table; 120485cdaf52SJiri Slaby 120585cdaf52SJiri Slaby if (!id) /* NULL means all */ 120685cdaf52SJiri Slaby return 1; 120785cdaf52SJiri Slaby 120885cdaf52SJiri Slaby for (; id->report_type != HID_TERMINATOR; id++) 120985cdaf52SJiri Slaby if (id->report_type == HID_ANY_ID || 121085cdaf52SJiri Slaby id->report_type == report->type) 121185cdaf52SJiri Slaby return 1; 121285cdaf52SJiri Slaby return 0; 121385cdaf52SJiri Slaby } 121485cdaf52SJiri Slaby 121585cdaf52SJiri Slaby /** 121685cdaf52SJiri Slaby * hid_match_usage - check if driver's event should be called 121785cdaf52SJiri Slaby * 121885cdaf52SJiri Slaby * @hid: hid device 121985cdaf52SJiri Slaby * @usage: usage to match against 122085cdaf52SJiri Slaby * 122185cdaf52SJiri Slaby * compare hid->driver->usage_table->usage_{type,code} to 122285cdaf52SJiri Slaby * usage->usage_{type,code} 122385cdaf52SJiri Slaby */ 122485cdaf52SJiri Slaby static int hid_match_usage(struct hid_device *hid, struct hid_usage *usage) 122585cdaf52SJiri Slaby { 122685cdaf52SJiri Slaby const struct hid_usage_id *id = hid->driver->usage_table; 122785cdaf52SJiri Slaby 122885cdaf52SJiri Slaby if (!id) /* NULL means all */ 122985cdaf52SJiri Slaby return 1; 123085cdaf52SJiri Slaby 123185cdaf52SJiri Slaby for (; id->usage_type != HID_ANY_ID - 1; id++) 123285cdaf52SJiri Slaby if ((id->usage_hid == HID_ANY_ID || 123385cdaf52SJiri Slaby id->usage_hid == usage->hid) && 123485cdaf52SJiri Slaby (id->usage_type == HID_ANY_ID || 123585cdaf52SJiri Slaby id->usage_type == usage->type) && 123685cdaf52SJiri Slaby (id->usage_code == HID_ANY_ID || 123785cdaf52SJiri Slaby id->usage_code == usage->code)) 123885cdaf52SJiri Slaby return 1; 123985cdaf52SJiri Slaby return 0; 124085cdaf52SJiri Slaby } 124185cdaf52SJiri Slaby 124285cdaf52SJiri Slaby static void hid_process_event(struct hid_device *hid, struct hid_field *field, 124385cdaf52SJiri Slaby struct hid_usage *usage, __s32 value, int interrupt) 124485cdaf52SJiri Slaby { 124585cdaf52SJiri Slaby struct hid_driver *hdrv = hid->driver; 124685cdaf52SJiri Slaby int ret; 124785cdaf52SJiri Slaby 12489bfc8da0SHenrik Rydberg if (!list_empty(&hid->debug_list)) 1249cd667ce2SJiri Kosina hid_dump_input(hid, usage, value); 125085cdaf52SJiri Slaby 125185cdaf52SJiri Slaby if (hdrv && hdrv->event && hid_match_usage(hid, usage)) { 125285cdaf52SJiri Slaby ret = hdrv->event(hid, field, usage, value); 125385cdaf52SJiri Slaby if (ret != 0) { 125485cdaf52SJiri Slaby if (ret < 0) 12558c3d52fcSJiri Kosina hid_err(hid, "%s's event failed with %d\n", 125685cdaf52SJiri Slaby hdrv->name, ret); 125785cdaf52SJiri Slaby return; 125885cdaf52SJiri Slaby } 125985cdaf52SJiri Slaby } 126085cdaf52SJiri Slaby 1261dde5845aSJiri Kosina if (hid->claimed & HID_CLAIMED_INPUT) 1262dde5845aSJiri Kosina hidinput_hid_event(hid, field, usage, value); 1263aa938f79SJiri Kosina if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt && hid->hiddev_hid_event) 1264aa938f79SJiri Kosina hid->hiddev_hid_event(hid, field, usage, value); 1265dde5845aSJiri Kosina } 1266dde5845aSJiri Kosina 1267dde5845aSJiri Kosina /* 1268dde5845aSJiri Kosina * Analyse a received field, and fetch the data from it. The field 1269dde5845aSJiri Kosina * content is stored for next report processing (we do differential 1270dde5845aSJiri Kosina * reporting to the layer). 1271dde5845aSJiri Kosina */ 1272dde5845aSJiri Kosina 1273abdff0f7SAdrian Bunk static void hid_input_field(struct hid_device *hid, struct hid_field *field, 1274abdff0f7SAdrian Bunk __u8 *data, int interrupt) 1275dde5845aSJiri Kosina { 1276dde5845aSJiri Kosina unsigned n; 1277dde5845aSJiri Kosina unsigned count = field->report_count; 1278dde5845aSJiri Kosina unsigned offset = field->report_offset; 1279dde5845aSJiri Kosina unsigned size = field->report_size; 1280dde5845aSJiri Kosina __s32 min = field->logical_minimum; 1281dde5845aSJiri Kosina __s32 max = field->logical_maximum; 1282dde5845aSJiri Kosina __s32 *value; 1283dde5845aSJiri Kosina 1284*6da2ec56SKees Cook value = kmalloc_array(count, sizeof(__s32), GFP_ATOMIC); 1285a3789a17SJoe Perches if (!value) 1286dde5845aSJiri Kosina return; 1287dde5845aSJiri Kosina 1288dde5845aSJiri Kosina for (n = 0; n < count; n++) { 1289dde5845aSJiri Kosina 12904291ee30SJoe Perches value[n] = min < 0 ? 129104fba786SGoffredo Baroncelli snto32(hid_field_extract(hid, data, offset + n * size, 129204fba786SGoffredo Baroncelli size), size) : 129304fba786SGoffredo Baroncelli hid_field_extract(hid, data, offset + n * size, size); 1294dde5845aSJiri Kosina 12954291ee30SJoe Perches /* Ignore report if ErrorRollOver */ 12964291ee30SJoe Perches if (!(field->flags & HID_MAIN_ITEM_VARIABLE) && 12974291ee30SJoe Perches value[n] >= min && value[n] <= max && 129850220deaSBenjamin Tissoires value[n] - min < field->maxusage && 12994291ee30SJoe Perches field->usage[value[n] - min].hid == HID_UP_KEYBOARD + 1) 1300dde5845aSJiri Kosina goto exit; 1301dde5845aSJiri Kosina } 1302dde5845aSJiri Kosina 1303dde5845aSJiri Kosina for (n = 0; n < count; n++) { 1304dde5845aSJiri Kosina 1305dde5845aSJiri Kosina if (HID_MAIN_ITEM_VARIABLE & field->flags) { 1306dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[n], value[n], interrupt); 1307dde5845aSJiri Kosina continue; 1308dde5845aSJiri Kosina } 1309dde5845aSJiri Kosina 1310dde5845aSJiri Kosina if (field->value[n] >= min && field->value[n] <= max 131150220deaSBenjamin Tissoires && field->value[n] - min < field->maxusage 1312dde5845aSJiri Kosina && field->usage[field->value[n] - min].hid 1313dde5845aSJiri Kosina && search(value, field->value[n], count)) 1314dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[field->value[n] - min], 0, interrupt); 1315dde5845aSJiri Kosina 1316dde5845aSJiri Kosina if (value[n] >= min && value[n] <= max 131750220deaSBenjamin Tissoires && value[n] - min < field->maxusage 1318dde5845aSJiri Kosina && field->usage[value[n] - min].hid 1319dde5845aSJiri Kosina && search(field->value, value[n], count)) 1320dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[value[n] - min], 1, interrupt); 1321dde5845aSJiri Kosina } 1322dde5845aSJiri Kosina 1323dde5845aSJiri Kosina memcpy(field->value, value, count * sizeof(__s32)); 1324dde5845aSJiri Kosina exit: 1325dde5845aSJiri Kosina kfree(value); 1326dde5845aSJiri Kosina } 1327dde5845aSJiri Kosina 1328dde5845aSJiri Kosina /* 1329dde5845aSJiri Kosina * Output the field into the report. 1330dde5845aSJiri Kosina */ 1331dde5845aSJiri Kosina 13324291ee30SJoe Perches static void hid_output_field(const struct hid_device *hid, 13334291ee30SJoe Perches struct hid_field *field, __u8 *data) 1334dde5845aSJiri Kosina { 1335dde5845aSJiri Kosina unsigned count = field->report_count; 1336dde5845aSJiri Kosina unsigned offset = field->report_offset; 1337dde5845aSJiri Kosina unsigned size = field->report_size; 1338dde5845aSJiri Kosina unsigned n; 1339dde5845aSJiri Kosina 1340dde5845aSJiri Kosina for (n = 0; n < count; n++) { 1341dde5845aSJiri Kosina if (field->logical_minimum < 0) /* signed values */ 13424291ee30SJoe Perches implement(hid, data, offset + n * size, size, 13434291ee30SJoe Perches s32ton(field->value[n], size)); 1344dde5845aSJiri Kosina else /* unsigned values */ 13454291ee30SJoe Perches implement(hid, data, offset + n * size, size, 13464291ee30SJoe Perches field->value[n]); 1347dde5845aSJiri Kosina } 1348dde5845aSJiri Kosina } 1349dde5845aSJiri Kosina 1350dde5845aSJiri Kosina /* 135127ce4050SJiri Kosina * Create a report. 'data' has to be allocated using 135227ce4050SJiri Kosina * hid_alloc_report_buf() so that it has proper size. 1353dde5845aSJiri Kosina */ 1354dde5845aSJiri Kosina 1355229695e5SJiri Kosina void hid_output_report(struct hid_report *report, __u8 *data) 1356dde5845aSJiri Kosina { 1357dde5845aSJiri Kosina unsigned n; 1358dde5845aSJiri Kosina 1359dde5845aSJiri Kosina if (report->id > 0) 1360dde5845aSJiri Kosina *data++ = report->id; 1361dde5845aSJiri Kosina 136275c28df8SPete Zaitcev memset(data, 0, ((report->size - 1) >> 3) + 1); 1363dde5845aSJiri Kosina for (n = 0; n < report->maxfield; n++) 13644291ee30SJoe Perches hid_output_field(report->device, report->field[n], data); 1365dde5845aSJiri Kosina } 1366229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_output_report); 1367dde5845aSJiri Kosina 1368dde5845aSJiri Kosina /* 136927ce4050SJiri Kosina * Allocator for buffer that is going to be passed to hid_output_report() 137027ce4050SJiri Kosina */ 137127ce4050SJiri Kosina u8 *hid_alloc_report_buf(struct hid_report *report, gfp_t flags) 137227ce4050SJiri Kosina { 137327ce4050SJiri Kosina /* 137427ce4050SJiri Kosina * 7 extra bytes are necessary to achieve proper functionality 137527ce4050SJiri Kosina * of implement() working on 8 byte chunks 137627ce4050SJiri Kosina */ 137727ce4050SJiri Kosina 13786de0b13cSAaron Ma u32 len = hid_report_len(report) + 7; 137927ce4050SJiri Kosina 138027ce4050SJiri Kosina return kmalloc(len, flags); 138127ce4050SJiri Kosina } 138227ce4050SJiri Kosina EXPORT_SYMBOL_GPL(hid_alloc_report_buf); 138327ce4050SJiri Kosina 138427ce4050SJiri Kosina /* 1385dde5845aSJiri Kosina * Set a field value. The report this field belongs to has to be 1386dde5845aSJiri Kosina * created and transferred to the device, to set this value in the 1387dde5845aSJiri Kosina * device. 1388dde5845aSJiri Kosina */ 1389dde5845aSJiri Kosina 1390dde5845aSJiri Kosina int hid_set_field(struct hid_field *field, unsigned offset, __s32 value) 1391dde5845aSJiri Kosina { 1392be67b68dSKees Cook unsigned size; 1393be67b68dSKees Cook 1394be67b68dSKees Cook if (!field) 1395be67b68dSKees Cook return -1; 1396be67b68dSKees Cook 1397be67b68dSKees Cook size = field->report_size; 1398dde5845aSJiri Kosina 1399cd667ce2SJiri Kosina hid_dump_input(field->report->device, field->usage + offset, value); 1400dde5845aSJiri Kosina 1401dde5845aSJiri Kosina if (offset >= field->report_count) { 14028c3d52fcSJiri Kosina hid_err(field->report->device, "offset (%d) exceeds report_count (%d)\n", 14038c3d52fcSJiri Kosina offset, field->report_count); 1404dde5845aSJiri Kosina return -1; 1405dde5845aSJiri Kosina } 1406dde5845aSJiri Kosina if (field->logical_minimum < 0) { 1407dde5845aSJiri Kosina if (value != snto32(s32ton(value, size), size)) { 14088c3d52fcSJiri Kosina hid_err(field->report->device, "value %d is out of range\n", value); 1409dde5845aSJiri Kosina return -1; 1410dde5845aSJiri Kosina } 1411dde5845aSJiri Kosina } 1412dde5845aSJiri Kosina field->value[offset] = value; 1413dde5845aSJiri Kosina return 0; 1414dde5845aSJiri Kosina } 1415229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_set_field); 1416dde5845aSJiri Kosina 141785cdaf52SJiri Slaby static struct hid_report *hid_get_report(struct hid_report_enum *report_enum, 141885cdaf52SJiri Slaby const u8 *data) 141985cdaf52SJiri Slaby { 142085cdaf52SJiri Slaby struct hid_report *report; 142185cdaf52SJiri Slaby unsigned int n = 0; /* Normally report number is 0 */ 142285cdaf52SJiri Slaby 142385cdaf52SJiri Slaby /* Device uses numbered reports, data[0] is report number */ 142485cdaf52SJiri Slaby if (report_enum->numbered) 142585cdaf52SJiri Slaby n = *data; 142685cdaf52SJiri Slaby 142785cdaf52SJiri Slaby report = report_enum->report_id_hash[n]; 142885cdaf52SJiri Slaby if (report == NULL) 142985cdaf52SJiri Slaby dbg_hid("undefined report_id %u received\n", n); 143085cdaf52SJiri Slaby 143185cdaf52SJiri Slaby return report; 143285cdaf52SJiri Slaby } 143385cdaf52SJiri Slaby 14344fa5a7f7SBenjamin Tissoires /* 14354fa5a7f7SBenjamin Tissoires * Implement a generic .request() callback, using .raw_request() 14364fa5a7f7SBenjamin Tissoires * DO NOT USE in hid drivers directly, but through hid_hw_request instead. 14374fa5a7f7SBenjamin Tissoires */ 14384fa5a7f7SBenjamin Tissoires void __hid_request(struct hid_device *hid, struct hid_report *report, 14394fa5a7f7SBenjamin Tissoires int reqtype) 14404fa5a7f7SBenjamin Tissoires { 14414fa5a7f7SBenjamin Tissoires char *buf; 14424fa5a7f7SBenjamin Tissoires int ret; 14436de0b13cSAaron Ma u32 len; 14444fa5a7f7SBenjamin Tissoires 14454fa5a7f7SBenjamin Tissoires buf = hid_alloc_report_buf(report, GFP_KERNEL); 14464fa5a7f7SBenjamin Tissoires if (!buf) 14474fa5a7f7SBenjamin Tissoires return; 14484fa5a7f7SBenjamin Tissoires 14494fa5a7f7SBenjamin Tissoires len = hid_report_len(report); 14504fa5a7f7SBenjamin Tissoires 14514fa5a7f7SBenjamin Tissoires if (reqtype == HID_REQ_SET_REPORT) 14524fa5a7f7SBenjamin Tissoires hid_output_report(report, buf); 14534fa5a7f7SBenjamin Tissoires 14544fa5a7f7SBenjamin Tissoires ret = hid->ll_driver->raw_request(hid, report->id, buf, len, 14554fa5a7f7SBenjamin Tissoires report->type, reqtype); 14564fa5a7f7SBenjamin Tissoires if (ret < 0) { 14574fa5a7f7SBenjamin Tissoires dbg_hid("unable to complete request: %d\n", ret); 14584fa5a7f7SBenjamin Tissoires goto out; 14594fa5a7f7SBenjamin Tissoires } 14604fa5a7f7SBenjamin Tissoires 14614fa5a7f7SBenjamin Tissoires if (reqtype == HID_REQ_GET_REPORT) 14624fa5a7f7SBenjamin Tissoires hid_input_report(hid, report->type, buf, ret, 0); 14634fa5a7f7SBenjamin Tissoires 14644fa5a7f7SBenjamin Tissoires out: 14654fa5a7f7SBenjamin Tissoires kfree(buf); 14664fa5a7f7SBenjamin Tissoires } 14674fa5a7f7SBenjamin Tissoires EXPORT_SYMBOL_GPL(__hid_request); 14684fa5a7f7SBenjamin Tissoires 14696de0b13cSAaron Ma int hid_report_raw_event(struct hid_device *hid, int type, u8 *data, u32 size, 147085cdaf52SJiri Slaby int interrupt) 1471aa8de2f0SJiri Kosina { 1472aa8de2f0SJiri Kosina struct hid_report_enum *report_enum = hid->report_enum + type; 1473aa8de2f0SJiri Kosina struct hid_report *report; 14746d85d037SBenjamin Tissoires struct hid_driver *hdrv; 147585cdaf52SJiri Slaby unsigned int a; 14766de0b13cSAaron Ma u32 rsize, csize = size; 147785cdaf52SJiri Slaby u8 *cdata = data; 1478b6787242SJiri Kosina int ret = 0; 1479aa8de2f0SJiri Kosina 148085cdaf52SJiri Slaby report = hid_get_report(report_enum, data); 148185cdaf52SJiri Slaby if (!report) 1482b6787242SJiri Kosina goto out; 1483aa8de2f0SJiri Kosina 148485cdaf52SJiri Slaby if (report_enum->numbered) { 148585cdaf52SJiri Slaby cdata++; 148685cdaf52SJiri Slaby csize--; 1487aa8de2f0SJiri Kosina } 1488aa8de2f0SJiri Kosina 1489aa8de2f0SJiri Kosina rsize = ((report->size - 1) >> 3) + 1; 1490aa8de2f0SJiri Kosina 1491966922f2SArmando Visconti if (rsize > HID_MAX_BUFFER_SIZE) 1492966922f2SArmando Visconti rsize = HID_MAX_BUFFER_SIZE; 1493966922f2SArmando Visconti 149485cdaf52SJiri Slaby if (csize < rsize) { 149585cdaf52SJiri Slaby dbg_hid("report %d is too short, (%d < %d)\n", report->id, 149685cdaf52SJiri Slaby csize, rsize); 149785cdaf52SJiri Slaby memset(cdata + csize, 0, rsize - csize); 1498aa8de2f0SJiri Kosina } 1499aa8de2f0SJiri Kosina 1500aa8de2f0SJiri Kosina if ((hid->claimed & HID_CLAIMED_HIDDEV) && hid->hiddev_report_event) 1501aa8de2f0SJiri Kosina hid->hiddev_report_event(hid, report); 1502b6787242SJiri Kosina if (hid->claimed & HID_CLAIMED_HIDRAW) { 1503b6787242SJiri Kosina ret = hidraw_report_event(hid, data, size); 1504b6787242SJiri Kosina if (ret) 1505b6787242SJiri Kosina goto out; 1506b6787242SJiri Kosina } 1507aa8de2f0SJiri Kosina 1508cc6b54aaSBenjamin Tissoires if (hid->claimed != HID_CLAIMED_HIDRAW && report->maxfield) { 150985cdaf52SJiri Slaby for (a = 0; a < report->maxfield; a++) 151085cdaf52SJiri Slaby hid_input_field(hid, report->field[a], cdata, interrupt); 15116d85d037SBenjamin Tissoires hdrv = hid->driver; 15126d85d037SBenjamin Tissoires if (hdrv && hdrv->report) 15136d85d037SBenjamin Tissoires hdrv->report(hid, report); 1514b94e3c94SMatthieu CASTET } 1515aa8de2f0SJiri Kosina 1516aa8de2f0SJiri Kosina if (hid->claimed & HID_CLAIMED_INPUT) 1517aa8de2f0SJiri Kosina hidinput_report_event(hid, report); 1518b6787242SJiri Kosina out: 1519b6787242SJiri Kosina return ret; 152085cdaf52SJiri Slaby } 152185cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_report_raw_event); 152285cdaf52SJiri Slaby 152385cdaf52SJiri Slaby /** 152485cdaf52SJiri Slaby * hid_input_report - report data from lower layer (usb, bt...) 152585cdaf52SJiri Slaby * 152685cdaf52SJiri Slaby * @hid: hid device 152785cdaf52SJiri Slaby * @type: HID report type (HID_*_REPORT) 152885cdaf52SJiri Slaby * @data: report contents 152985cdaf52SJiri Slaby * @size: size of data parameter 1530ff9b00a2SJiri Kosina * @interrupt: distinguish between interrupt and control transfers 153185cdaf52SJiri Slaby * 153285cdaf52SJiri Slaby * This is data entry for lower layers. 153385cdaf52SJiri Slaby */ 15346de0b13cSAaron Ma int hid_input_report(struct hid_device *hid, int type, u8 *data, u32 size, int interrupt) 153585cdaf52SJiri Slaby { 153676c317d6SJulia Lawall struct hid_report_enum *report_enum; 153776c317d6SJulia Lawall struct hid_driver *hdrv; 153885cdaf52SJiri Slaby struct hid_report *report; 153945dc1ac7SJiri Kosina int ret = 0; 154085cdaf52SJiri Slaby 15414ea54542SDavid Herrmann if (!hid) 154285cdaf52SJiri Slaby return -ENODEV; 15434ea54542SDavid Herrmann 1544c849a614SAndrew de los Reyes if (down_trylock(&hid->driver_input_lock)) 15454ea54542SDavid Herrmann return -EBUSY; 15464ea54542SDavid Herrmann 15474ea54542SDavid Herrmann if (!hid->driver) { 15484ea54542SDavid Herrmann ret = -ENODEV; 15494ea54542SDavid Herrmann goto unlock; 15504ea54542SDavid Herrmann } 155176c317d6SJulia Lawall report_enum = hid->report_enum + type; 155276c317d6SJulia Lawall hdrv = hid->driver; 155385cdaf52SJiri Slaby 155485cdaf52SJiri Slaby if (!size) { 155585cdaf52SJiri Slaby dbg_hid("empty report\n"); 15564ea54542SDavid Herrmann ret = -1; 15574ea54542SDavid Herrmann goto unlock; 155885cdaf52SJiri Slaby } 155985cdaf52SJiri Slaby 1560b94e3c94SMatthieu CASTET /* Avoid unnecessary overhead if debugfs is disabled */ 1561a5f04b9dSBenjamin Tissoires if (!list_empty(&hid->debug_list)) 1562a5f04b9dSBenjamin Tissoires hid_dump_report(hid, type, data, size); 1563b94e3c94SMatthieu CASTET 1564f77e347bSJiri Kosina report = hid_get_report(report_enum, data); 1565f77e347bSJiri Kosina 15664ea54542SDavid Herrmann if (!report) { 15674ea54542SDavid Herrmann ret = -1; 15684ea54542SDavid Herrmann goto unlock; 15694ea54542SDavid Herrmann } 1570f77e347bSJiri Kosina 157185cdaf52SJiri Slaby if (hdrv && hdrv->raw_event && hid_match_report(hid, report)) { 157285cdaf52SJiri Slaby ret = hdrv->raw_event(hid, report, data, size); 1573556483e2SFelix Rueegg if (ret < 0) 15744ea54542SDavid Herrmann goto unlock; 15754ea54542SDavid Herrmann } 157685cdaf52SJiri Slaby 1577b6787242SJiri Kosina ret = hid_report_raw_event(hid, type, data, size, interrupt); 1578aa8de2f0SJiri Kosina 15794ea54542SDavid Herrmann unlock: 1580c849a614SAndrew de los Reyes up(&hid->driver_input_lock); 158145dc1ac7SJiri Kosina return ret; 1582aa8de2f0SJiri Kosina } 1583aa8de2f0SJiri Kosina EXPORT_SYMBOL_GPL(hid_input_report); 1584aa8de2f0SJiri Kosina 1585d5d3e202SBenjamin Tissoires bool hid_match_one_id(const struct hid_device *hdev, 15860f37cd03SJiri Kosina const struct hid_device_id *id) 15870f37cd03SJiri Kosina { 15887431fb76SHenrik Rydberg return (id->bus == HID_BUS_ANY || id->bus == hdev->bus) && 15894d53b801SHenrik Rydberg (id->group == HID_GROUP_ANY || id->group == hdev->group) && 15900f37cd03SJiri Kosina (id->vendor == HID_ANY_ID || id->vendor == hdev->vendor) && 15910f37cd03SJiri Kosina (id->product == HID_ANY_ID || id->product == hdev->product); 15920f37cd03SJiri Kosina } 15930f37cd03SJiri Kosina 1594d5d3e202SBenjamin Tissoires const struct hid_device_id *hid_match_id(const struct hid_device *hdev, 15950f37cd03SJiri Kosina const struct hid_device_id *id) 15960f37cd03SJiri Kosina { 15970f37cd03SJiri Kosina for (; id->bus; id++) 15980f37cd03SJiri Kosina if (hid_match_one_id(hdev, id)) 15990f37cd03SJiri Kosina return id; 16000f37cd03SJiri Kosina 16010f37cd03SJiri Kosina return NULL; 16020f37cd03SJiri Kosina } 16030f37cd03SJiri Kosina 16040f37cd03SJiri Kosina static const struct hid_device_id hid_hiddev_list[] = { 1605c0bd6a42SRichard Hughes { HID_USB_DEVICE(USB_VENDOR_ID_MGE, USB_DEVICE_ID_MGE_UPS) }, 1606c0bd6a42SRichard Hughes { HID_USB_DEVICE(USB_VENDOR_ID_MGE, USB_DEVICE_ID_MGE_UPS1) }, 16070f37cd03SJiri Kosina { } 16080f37cd03SJiri Kosina }; 16090f37cd03SJiri Kosina 16100f37cd03SJiri Kosina static bool hid_hiddev(struct hid_device *hdev) 16110f37cd03SJiri Kosina { 16120f37cd03SJiri Kosina return !!hid_match_id(hdev, hid_hiddev_list); 16130f37cd03SJiri Kosina } 16140f37cd03SJiri Kosina 16156d3bfb74SAlan Ott 16166d3bfb74SAlan Ott static ssize_t 16176d3bfb74SAlan Ott read_report_descriptor(struct file *filp, struct kobject *kobj, 16186d3bfb74SAlan Ott struct bin_attribute *attr, 16196d3bfb74SAlan Ott char *buf, loff_t off, size_t count) 16206d3bfb74SAlan Ott { 16212cf83833SGeliang Tang struct device *dev = kobj_to_dev(kobj); 1622ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 16236d3bfb74SAlan Ott 16246d3bfb74SAlan Ott if (off >= hdev->rsize) 16256d3bfb74SAlan Ott return 0; 16266d3bfb74SAlan Ott 16276d3bfb74SAlan Ott if (off + count > hdev->rsize) 16286d3bfb74SAlan Ott count = hdev->rsize - off; 16296d3bfb74SAlan Ott 16306d3bfb74SAlan Ott memcpy(buf, hdev->rdesc + off, count); 16316d3bfb74SAlan Ott 16326d3bfb74SAlan Ott return count; 16336d3bfb74SAlan Ott } 16346d3bfb74SAlan Ott 1635a877417eSOlivier Gay static ssize_t 1636a877417eSOlivier Gay show_country(struct device *dev, struct device_attribute *attr, 1637a877417eSOlivier Gay char *buf) 1638a877417eSOlivier Gay { 1639ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 1640a877417eSOlivier Gay 1641a877417eSOlivier Gay return sprintf(buf, "%02x\n", hdev->country & 0xff); 1642a877417eSOlivier Gay } 1643a877417eSOlivier Gay 16446d3bfb74SAlan Ott static struct bin_attribute dev_bin_attr_report_desc = { 16456d3bfb74SAlan Ott .attr = { .name = "report_descriptor", .mode = 0444 }, 16466d3bfb74SAlan Ott .read = read_report_descriptor, 16476d3bfb74SAlan Ott .size = HID_MAX_DESCRIPTOR_SIZE, 16486d3bfb74SAlan Ott }; 16496d3bfb74SAlan Ott 1650ad8378edSBhumika Goyal static const struct device_attribute dev_attr_country = { 1651a877417eSOlivier Gay .attr = { .name = "country", .mode = 0444 }, 1652a877417eSOlivier Gay .show = show_country, 1653a877417eSOlivier Gay }; 1654a877417eSOlivier Gay 165593c10132SJiri Slaby int hid_connect(struct hid_device *hdev, unsigned int connect_mask) 165693c10132SJiri Slaby { 165793c10132SJiri Slaby static const char *types[] = { "Device", "Pointer", "Mouse", "Device", 165893c10132SJiri Slaby "Joystick", "Gamepad", "Keyboard", "Keypad", 165993c10132SJiri Slaby "Multi-Axis Controller" 166093c10132SJiri Slaby }; 166193c10132SJiri Slaby const char *type, *bus; 166279b568b9SRichard Purdie char buf[64] = ""; 166393c10132SJiri Slaby unsigned int i; 166493c10132SJiri Slaby int len; 16656d3bfb74SAlan Ott int ret; 166693c10132SJiri Slaby 1667b5e5a37eSBastien Nocera if (hdev->quirks & HID_QUIRK_HIDDEV_FORCE) 1668b5e5a37eSBastien Nocera connect_mask |= (HID_CONNECT_HIDDEV_FORCE | HID_CONNECT_HIDDEV); 16693a343ee4SDaniel Mack if (hdev->quirks & HID_QUIRK_HIDINPUT_FORCE) 16703a343ee4SDaniel Mack connect_mask |= HID_CONNECT_HIDINPUT_FORCE; 167193c10132SJiri Slaby if (hdev->bus != BUS_USB) 167293c10132SJiri Slaby connect_mask &= ~HID_CONNECT_HIDDEV; 16730f37cd03SJiri Kosina if (hid_hiddev(hdev)) 16740f37cd03SJiri Kosina connect_mask |= HID_CONNECT_HIDDEV_FORCE; 167593c10132SJiri Slaby 167693c10132SJiri Slaby if ((connect_mask & HID_CONNECT_HIDINPUT) && !hidinput_connect(hdev, 167793c10132SJiri Slaby connect_mask & HID_CONNECT_HIDINPUT_FORCE)) 167893c10132SJiri Slaby hdev->claimed |= HID_CLAIMED_INPUT; 1679b77c3920SBenjamin Tissoires 168093c10132SJiri Slaby if ((connect_mask & HID_CONNECT_HIDDEV) && hdev->hiddev_connect && 168193c10132SJiri Slaby !hdev->hiddev_connect(hdev, 168293c10132SJiri Slaby connect_mask & HID_CONNECT_HIDDEV_FORCE)) 168393c10132SJiri Slaby hdev->claimed |= HID_CLAIMED_HIDDEV; 168493c10132SJiri Slaby if ((connect_mask & HID_CONNECT_HIDRAW) && !hidraw_connect(hdev)) 168593c10132SJiri Slaby hdev->claimed |= HID_CLAIMED_HIDRAW; 168693c10132SJiri Slaby 16877704ac93SBenjamin Tissoires if (connect_mask & HID_CONNECT_DRIVER) 16887704ac93SBenjamin Tissoires hdev->claimed |= HID_CLAIMED_DRIVER; 16897704ac93SBenjamin Tissoires 16904bc19f62SDavid Herrmann /* Drivers with the ->raw_event callback set are not required to connect 16914bc19f62SDavid Herrmann * to any other listener. */ 16924bc19f62SDavid Herrmann if (!hdev->claimed && !hdev->driver->raw_event) { 16934bc19f62SDavid Herrmann hid_err(hdev, "device has no listeners, quitting\n"); 169493c10132SJiri Slaby return -ENODEV; 169593c10132SJiri Slaby } 169693c10132SJiri Slaby 169793c10132SJiri Slaby if ((hdev->claimed & HID_CLAIMED_INPUT) && 169893c10132SJiri Slaby (connect_mask & HID_CONNECT_FF) && hdev->ff_init) 169993c10132SJiri Slaby hdev->ff_init(hdev); 170093c10132SJiri Slaby 170193c10132SJiri Slaby len = 0; 170293c10132SJiri Slaby if (hdev->claimed & HID_CLAIMED_INPUT) 170393c10132SJiri Slaby len += sprintf(buf + len, "input"); 170493c10132SJiri Slaby if (hdev->claimed & HID_CLAIMED_HIDDEV) 170593c10132SJiri Slaby len += sprintf(buf + len, "%shiddev%d", len ? "," : "", 1706733aca90SJaejoong Kim ((struct hiddev *)hdev->hiddev)->minor); 170793c10132SJiri Slaby if (hdev->claimed & HID_CLAIMED_HIDRAW) 170893c10132SJiri Slaby len += sprintf(buf + len, "%shidraw%d", len ? "," : "", 170993c10132SJiri Slaby ((struct hidraw *)hdev->hidraw)->minor); 171093c10132SJiri Slaby 171193c10132SJiri Slaby type = "Device"; 171293c10132SJiri Slaby for (i = 0; i < hdev->maxcollection; i++) { 171393c10132SJiri Slaby struct hid_collection *col = &hdev->collection[i]; 171493c10132SJiri Slaby if (col->type == HID_COLLECTION_APPLICATION && 171593c10132SJiri Slaby (col->usage & HID_USAGE_PAGE) == HID_UP_GENDESK && 171693c10132SJiri Slaby (col->usage & 0xffff) < ARRAY_SIZE(types)) { 171793c10132SJiri Slaby type = types[col->usage & 0xffff]; 171893c10132SJiri Slaby break; 171993c10132SJiri Slaby } 172093c10132SJiri Slaby } 172193c10132SJiri Slaby 172293c10132SJiri Slaby switch (hdev->bus) { 172393c10132SJiri Slaby case BUS_USB: 172493c10132SJiri Slaby bus = "USB"; 172593c10132SJiri Slaby break; 172693c10132SJiri Slaby case BUS_BLUETOOTH: 172793c10132SJiri Slaby bus = "BLUETOOTH"; 172893c10132SJiri Slaby break; 172906780727SDaniel Martin case BUS_I2C: 173006780727SDaniel Martin bus = "I2C"; 173106780727SDaniel Martin break; 173293c10132SJiri Slaby default: 173393c10132SJiri Slaby bus = "<UNKNOWN>"; 173493c10132SJiri Slaby } 173593c10132SJiri Slaby 1736a877417eSOlivier Gay ret = device_create_file(&hdev->dev, &dev_attr_country); 1737a877417eSOlivier Gay if (ret) 1738a877417eSOlivier Gay hid_warn(hdev, 1739a877417eSOlivier Gay "can't create sysfs country code attribute err: %d\n", ret); 1740a877417eSOlivier Gay 17414291ee30SJoe Perches hid_info(hdev, "%s: %s HID v%x.%02x %s [%s] on %s\n", 174293c10132SJiri Slaby buf, bus, hdev->version >> 8, hdev->version & 0xff, 174393c10132SJiri Slaby type, hdev->name, hdev->phys); 174493c10132SJiri Slaby 174593c10132SJiri Slaby return 0; 174693c10132SJiri Slaby } 174793c10132SJiri Slaby EXPORT_SYMBOL_GPL(hid_connect); 174893c10132SJiri Slaby 1749c4c259bcSJiri Kosina void hid_disconnect(struct hid_device *hdev) 1750c4c259bcSJiri Kosina { 1751a877417eSOlivier Gay device_remove_file(&hdev->dev, &dev_attr_country); 1752c4c259bcSJiri Kosina if (hdev->claimed & HID_CLAIMED_INPUT) 1753c4c259bcSJiri Kosina hidinput_disconnect(hdev); 1754c4c259bcSJiri Kosina if (hdev->claimed & HID_CLAIMED_HIDDEV) 1755c4c259bcSJiri Kosina hdev->hiddev_disconnect(hdev); 1756c4c259bcSJiri Kosina if (hdev->claimed & HID_CLAIMED_HIDRAW) 1757c4c259bcSJiri Kosina hidraw_disconnect(hdev); 17589c5c6ed7SBenjamin Tissoires hdev->claimed = 0; 1759c4c259bcSJiri Kosina } 1760c4c259bcSJiri Kosina EXPORT_SYMBOL_GPL(hid_disconnect); 1761c4c259bcSJiri Kosina 1762aaac082dSDmitry Torokhov /** 1763aaac082dSDmitry Torokhov * hid_hw_start - start underlying HW 1764aaac082dSDmitry Torokhov * @hdev: hid device 1765aaac082dSDmitry Torokhov * @connect_mask: which outputs to connect, see HID_CONNECT_* 1766aaac082dSDmitry Torokhov * 1767aaac082dSDmitry Torokhov * Call this in probe function *after* hid_parse. This will setup HW 1768aaac082dSDmitry Torokhov * buffers and start the device (if not defeirred to device open). 1769aaac082dSDmitry Torokhov * hid_hw_stop must be called if this was successful. 1770aaac082dSDmitry Torokhov */ 1771aaac082dSDmitry Torokhov int hid_hw_start(struct hid_device *hdev, unsigned int connect_mask) 1772aaac082dSDmitry Torokhov { 1773aaac082dSDmitry Torokhov int error; 1774aaac082dSDmitry Torokhov 1775aaac082dSDmitry Torokhov error = hdev->ll_driver->start(hdev); 1776aaac082dSDmitry Torokhov if (error) 1777aaac082dSDmitry Torokhov return error; 1778aaac082dSDmitry Torokhov 1779aaac082dSDmitry Torokhov if (connect_mask) { 1780aaac082dSDmitry Torokhov error = hid_connect(hdev, connect_mask); 1781aaac082dSDmitry Torokhov if (error) { 1782aaac082dSDmitry Torokhov hdev->ll_driver->stop(hdev); 1783aaac082dSDmitry Torokhov return error; 1784aaac082dSDmitry Torokhov } 1785aaac082dSDmitry Torokhov } 1786aaac082dSDmitry Torokhov 1787aaac082dSDmitry Torokhov return 0; 1788aaac082dSDmitry Torokhov } 1789aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_start); 1790aaac082dSDmitry Torokhov 1791aaac082dSDmitry Torokhov /** 1792aaac082dSDmitry Torokhov * hid_hw_stop - stop underlying HW 1793aaac082dSDmitry Torokhov * @hdev: hid device 1794aaac082dSDmitry Torokhov * 1795aaac082dSDmitry Torokhov * This is usually called from remove function or from probe when something 1796aaac082dSDmitry Torokhov * failed and hid_hw_start was called already. 1797aaac082dSDmitry Torokhov */ 1798aaac082dSDmitry Torokhov void hid_hw_stop(struct hid_device *hdev) 1799aaac082dSDmitry Torokhov { 1800aaac082dSDmitry Torokhov hid_disconnect(hdev); 1801aaac082dSDmitry Torokhov hdev->ll_driver->stop(hdev); 1802aaac082dSDmitry Torokhov } 1803aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_stop); 1804aaac082dSDmitry Torokhov 1805aaac082dSDmitry Torokhov /** 1806aaac082dSDmitry Torokhov * hid_hw_open - signal underlying HW to start delivering events 1807aaac082dSDmitry Torokhov * @hdev: hid device 1808aaac082dSDmitry Torokhov * 1809aaac082dSDmitry Torokhov * Tell underlying HW to start delivering events from the device. 1810aaac082dSDmitry Torokhov * This function should be called sometime after successful call 1811d6c70a86SHisao Tanabe * to hid_hw_start(). 1812aaac082dSDmitry Torokhov */ 1813aaac082dSDmitry Torokhov int hid_hw_open(struct hid_device *hdev) 1814aaac082dSDmitry Torokhov { 1815aaac082dSDmitry Torokhov int ret; 1816aaac082dSDmitry Torokhov 1817aaac082dSDmitry Torokhov ret = mutex_lock_killable(&hdev->ll_open_lock); 1818aaac082dSDmitry Torokhov if (ret) 1819aaac082dSDmitry Torokhov return ret; 1820aaac082dSDmitry Torokhov 1821aaac082dSDmitry Torokhov if (!hdev->ll_open_count++) { 1822aaac082dSDmitry Torokhov ret = hdev->ll_driver->open(hdev); 1823aaac082dSDmitry Torokhov if (ret) 1824aaac082dSDmitry Torokhov hdev->ll_open_count--; 1825aaac082dSDmitry Torokhov } 1826aaac082dSDmitry Torokhov 1827aaac082dSDmitry Torokhov mutex_unlock(&hdev->ll_open_lock); 1828aaac082dSDmitry Torokhov return ret; 1829aaac082dSDmitry Torokhov } 1830aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_open); 1831aaac082dSDmitry Torokhov 1832aaac082dSDmitry Torokhov /** 1833aaac082dSDmitry Torokhov * hid_hw_close - signal underlaying HW to stop delivering events 1834aaac082dSDmitry Torokhov * 1835aaac082dSDmitry Torokhov * @hdev: hid device 1836aaac082dSDmitry Torokhov * 1837aaac082dSDmitry Torokhov * This function indicates that we are not interested in the events 1838aaac082dSDmitry Torokhov * from this device anymore. Delivery of events may or may not stop, 1839aaac082dSDmitry Torokhov * depending on the number of users still outstanding. 1840aaac082dSDmitry Torokhov */ 1841aaac082dSDmitry Torokhov void hid_hw_close(struct hid_device *hdev) 1842aaac082dSDmitry Torokhov { 1843aaac082dSDmitry Torokhov mutex_lock(&hdev->ll_open_lock); 1844aaac082dSDmitry Torokhov if (!--hdev->ll_open_count) 1845aaac082dSDmitry Torokhov hdev->ll_driver->close(hdev); 1846aaac082dSDmitry Torokhov mutex_unlock(&hdev->ll_open_lock); 1847aaac082dSDmitry Torokhov } 1848aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_close); 1849aaac082dSDmitry Torokhov 18503a6f82f7SJiri Slaby struct hid_dynid { 18513a6f82f7SJiri Slaby struct list_head list; 18523a6f82f7SJiri Slaby struct hid_device_id id; 18533a6f82f7SJiri Slaby }; 18543a6f82f7SJiri Slaby 18553a6f82f7SJiri Slaby /** 18563a6f82f7SJiri Slaby * store_new_id - add a new HID device ID to this driver and re-probe devices 18573a6f82f7SJiri Slaby * @driver: target device driver 18583a6f82f7SJiri Slaby * @buf: buffer for scanning device ID data 18593a6f82f7SJiri Slaby * @count: input size 18603a6f82f7SJiri Slaby * 18613a6f82f7SJiri Slaby * Adds a new dynamic hid device ID to this driver, 18623a6f82f7SJiri Slaby * and causes the driver to probe for all devices again. 18633a6f82f7SJiri Slaby */ 1864c2810325SGreg Kroah-Hartman static ssize_t new_id_store(struct device_driver *drv, const char *buf, 18653a6f82f7SJiri Slaby size_t count) 18663a6f82f7SJiri Slaby { 1867ba91a967SGeliang Tang struct hid_driver *hdrv = to_hid_driver(drv); 18683a6f82f7SJiri Slaby struct hid_dynid *dynid; 18693a6f82f7SJiri Slaby __u32 bus, vendor, product; 18703a6f82f7SJiri Slaby unsigned long driver_data = 0; 18713a6f82f7SJiri Slaby int ret; 18723a6f82f7SJiri Slaby 18733a6f82f7SJiri Slaby ret = sscanf(buf, "%x %x %x %lx", 18743a6f82f7SJiri Slaby &bus, &vendor, &product, &driver_data); 18753a6f82f7SJiri Slaby if (ret < 3) 18763a6f82f7SJiri Slaby return -EINVAL; 18773a6f82f7SJiri Slaby 18783a6f82f7SJiri Slaby dynid = kzalloc(sizeof(*dynid), GFP_KERNEL); 18793a6f82f7SJiri Slaby if (!dynid) 18803a6f82f7SJiri Slaby return -ENOMEM; 18813a6f82f7SJiri Slaby 18823a6f82f7SJiri Slaby dynid->id.bus = bus; 18834d53b801SHenrik Rydberg dynid->id.group = HID_GROUP_ANY; 18843a6f82f7SJiri Slaby dynid->id.vendor = vendor; 18853a6f82f7SJiri Slaby dynid->id.product = product; 18863a6f82f7SJiri Slaby dynid->id.driver_data = driver_data; 18873a6f82f7SJiri Slaby 18883a6f82f7SJiri Slaby spin_lock(&hdrv->dyn_lock); 18893a6f82f7SJiri Slaby list_add_tail(&dynid->list, &hdrv->dyn_list); 18903a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 18913a6f82f7SJiri Slaby 18923a6f82f7SJiri Slaby ret = driver_attach(&hdrv->driver); 18933a6f82f7SJiri Slaby 18943a6f82f7SJiri Slaby return ret ? : count; 18953a6f82f7SJiri Slaby } 1896c2810325SGreg Kroah-Hartman static DRIVER_ATTR_WO(new_id); 1897c2810325SGreg Kroah-Hartman 1898c2810325SGreg Kroah-Hartman static struct attribute *hid_drv_attrs[] = { 1899c2810325SGreg Kroah-Hartman &driver_attr_new_id.attr, 1900c2810325SGreg Kroah-Hartman NULL, 1901c2810325SGreg Kroah-Hartman }; 1902c2810325SGreg Kroah-Hartman ATTRIBUTE_GROUPS(hid_drv); 19033a6f82f7SJiri Slaby 19043a6f82f7SJiri Slaby static void hid_free_dynids(struct hid_driver *hdrv) 19053a6f82f7SJiri Slaby { 19063a6f82f7SJiri Slaby struct hid_dynid *dynid, *n; 19073a6f82f7SJiri Slaby 19083a6f82f7SJiri Slaby spin_lock(&hdrv->dyn_lock); 19093a6f82f7SJiri Slaby list_for_each_entry_safe(dynid, n, &hdrv->dyn_list, list) { 19103a6f82f7SJiri Slaby list_del(&dynid->list); 19113a6f82f7SJiri Slaby kfree(dynid); 19123a6f82f7SJiri Slaby } 19133a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 19143a6f82f7SJiri Slaby } 19153a6f82f7SJiri Slaby 1916e04a0442SBenjamin Tissoires const struct hid_device_id *hid_match_device(struct hid_device *hdev, 19173a6f82f7SJiri Slaby struct hid_driver *hdrv) 19183a6f82f7SJiri Slaby { 19193a6f82f7SJiri Slaby struct hid_dynid *dynid; 19203a6f82f7SJiri Slaby 19213a6f82f7SJiri Slaby spin_lock(&hdrv->dyn_lock); 19223a6f82f7SJiri Slaby list_for_each_entry(dynid, &hdrv->dyn_list, list) { 19233a6f82f7SJiri Slaby if (hid_match_one_id(hdev, &dynid->id)) { 19243a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 19253a6f82f7SJiri Slaby return &dynid->id; 19263a6f82f7SJiri Slaby } 19273a6f82f7SJiri Slaby } 19283a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 19293a6f82f7SJiri Slaby 19303a6f82f7SJiri Slaby return hid_match_id(hdev, hdrv->id_table); 19313a6f82f7SJiri Slaby } 1932e04a0442SBenjamin Tissoires EXPORT_SYMBOL_GPL(hid_match_device); 19333a6f82f7SJiri Slaby 193485cdaf52SJiri Slaby static int hid_bus_match(struct device *dev, struct device_driver *drv) 193585cdaf52SJiri Slaby { 1936ba91a967SGeliang Tang struct hid_driver *hdrv = to_hid_driver(drv); 1937ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 193885cdaf52SJiri Slaby 1939070748edSHenrik Rydberg return hid_match_device(hdev, hdrv) != NULL; 194085cdaf52SJiri Slaby } 194185cdaf52SJiri Slaby 194285cdaf52SJiri Slaby static int hid_device_probe(struct device *dev) 194385cdaf52SJiri Slaby { 1944ba91a967SGeliang Tang struct hid_driver *hdrv = to_hid_driver(dev->driver); 1945ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 194685cdaf52SJiri Slaby const struct hid_device_id *id; 194785cdaf52SJiri Slaby int ret = 0; 194885cdaf52SJiri Slaby 1949c849a614SAndrew de los Reyes if (down_interruptible(&hdev->driver_input_lock)) { 1950c849a614SAndrew de los Reyes ret = -EINTR; 19516f68f0acSBinoy Jayan goto end; 1952c849a614SAndrew de los Reyes } 1953c849a614SAndrew de los Reyes hdev->io_started = false; 19544ea54542SDavid Herrmann 195585cdaf52SJiri Slaby if (!hdev->driver) { 19563a6f82f7SJiri Slaby id = hid_match_device(hdev, hdrv); 1957ba623a77SDan Carpenter if (id == NULL) { 1958ba623a77SDan Carpenter ret = -ENODEV; 1959ba623a77SDan Carpenter goto unlock; 1960ba623a77SDan Carpenter } 1961c500c971SJiri Slaby 1962e04a0442SBenjamin Tissoires if (hdrv->match) { 1963e04a0442SBenjamin Tissoires if (!hdrv->match(hdev, hid_ignore_special_drivers)) { 1964e04a0442SBenjamin Tissoires ret = -ENODEV; 1965e04a0442SBenjamin Tissoires goto unlock; 1966e04a0442SBenjamin Tissoires } 1967e04a0442SBenjamin Tissoires } else { 1968e04a0442SBenjamin Tissoires /* 1969e04a0442SBenjamin Tissoires * hid-generic implements .match(), so if 1970e04a0442SBenjamin Tissoires * hid_ignore_special_drivers is set, we can safely 1971e04a0442SBenjamin Tissoires * return. 1972e04a0442SBenjamin Tissoires */ 1973e04a0442SBenjamin Tissoires if (hid_ignore_special_drivers) { 1974e04a0442SBenjamin Tissoires ret = -ENODEV; 1975e04a0442SBenjamin Tissoires goto unlock; 1976e04a0442SBenjamin Tissoires } 1977e04a0442SBenjamin Tissoires } 1978e04a0442SBenjamin Tissoires 19792904e68fSBenjamin Tissoires /* reset the quirks that has been previously set */ 19802904e68fSBenjamin Tissoires hdev->quirks = hid_lookup_quirk(hdev); 198185cdaf52SJiri Slaby hdev->driver = hdrv; 1982c500c971SJiri Slaby if (hdrv->probe) { 1983c500c971SJiri Slaby ret = hdrv->probe(hdev, id); 1984c500c971SJiri Slaby } else { /* default probe */ 1985a7197c2eSHenrik Rydberg ret = hid_open_report(hdev); 1986c500c971SJiri Slaby if (!ret) 198793c10132SJiri Slaby ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT); 1988c500c971SJiri Slaby } 1989a7197c2eSHenrik Rydberg if (ret) { 1990a7197c2eSHenrik Rydberg hid_close_report(hdev); 1991c500c971SJiri Slaby hdev->driver = NULL; 199285cdaf52SJiri Slaby } 1993a7197c2eSHenrik Rydberg } 1994ba623a77SDan Carpenter unlock: 1995c849a614SAndrew de los Reyes if (!hdev->io_started) 1996c849a614SAndrew de los Reyes up(&hdev->driver_input_lock); 19976f68f0acSBinoy Jayan end: 199885cdaf52SJiri Slaby return ret; 199985cdaf52SJiri Slaby } 200085cdaf52SJiri Slaby 200185cdaf52SJiri Slaby static int hid_device_remove(struct device *dev) 200285cdaf52SJiri Slaby { 2003ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 20044ea54542SDavid Herrmann struct hid_driver *hdrv; 2005c849a614SAndrew de los Reyes int ret = 0; 200685cdaf52SJiri Slaby 2007c849a614SAndrew de los Reyes if (down_interruptible(&hdev->driver_input_lock)) { 2008c849a614SAndrew de los Reyes ret = -EINTR; 20096f68f0acSBinoy Jayan goto end; 2010c849a614SAndrew de los Reyes } 2011c849a614SAndrew de los Reyes hdev->io_started = false; 20124ea54542SDavid Herrmann 20134ea54542SDavid Herrmann hdrv = hdev->driver; 201485cdaf52SJiri Slaby if (hdrv) { 201585cdaf52SJiri Slaby if (hdrv->remove) 201685cdaf52SJiri Slaby hdrv->remove(hdev); 2017c500c971SJiri Slaby else /* default remove */ 2018c500c971SJiri Slaby hid_hw_stop(hdev); 2019a7197c2eSHenrik Rydberg hid_close_report(hdev); 202085cdaf52SJiri Slaby hdev->driver = NULL; 202185cdaf52SJiri Slaby } 202285cdaf52SJiri Slaby 2023c849a614SAndrew de los Reyes if (!hdev->io_started) 2024c849a614SAndrew de los Reyes up(&hdev->driver_input_lock); 20256f68f0acSBinoy Jayan end: 2026c849a614SAndrew de los Reyes return ret; 202785cdaf52SJiri Slaby } 202885cdaf52SJiri Slaby 20294d53b801SHenrik Rydberg static ssize_t modalias_show(struct device *dev, struct device_attribute *a, 20304d53b801SHenrik Rydberg char *buf) 20314d53b801SHenrik Rydberg { 20324d53b801SHenrik Rydberg struct hid_device *hdev = container_of(dev, struct hid_device, dev); 20334d53b801SHenrik Rydberg 2034dfa0c5faSRasmus Villemoes return scnprintf(buf, PAGE_SIZE, "hid:b%04Xg%04Xv%08Xp%08X\n", 20354d53b801SHenrik Rydberg hdev->bus, hdev->group, hdev->vendor, hdev->product); 20364d53b801SHenrik Rydberg } 20370d4260e0SGreg Kroah-Hartman static DEVICE_ATTR_RO(modalias); 20384d53b801SHenrik Rydberg 20390d4260e0SGreg Kroah-Hartman static struct attribute *hid_dev_attrs[] = { 20400d4260e0SGreg Kroah-Hartman &dev_attr_modalias.attr, 20410d4260e0SGreg Kroah-Hartman NULL, 20424d53b801SHenrik Rydberg }; 204354f32fd5SAndy Lutomirski static struct bin_attribute *hid_dev_bin_attrs[] = { 204454f32fd5SAndy Lutomirski &dev_bin_attr_report_desc, 204554f32fd5SAndy Lutomirski NULL 204654f32fd5SAndy Lutomirski }; 204754f32fd5SAndy Lutomirski static const struct attribute_group hid_dev_group = { 204854f32fd5SAndy Lutomirski .attrs = hid_dev_attrs, 204954f32fd5SAndy Lutomirski .bin_attrs = hid_dev_bin_attrs, 205054f32fd5SAndy Lutomirski }; 205154f32fd5SAndy Lutomirski __ATTRIBUTE_GROUPS(hid_dev); 20524d53b801SHenrik Rydberg 205385cdaf52SJiri Slaby static int hid_uevent(struct device *dev, struct kobj_uevent_env *env) 205485cdaf52SJiri Slaby { 2055ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 205685cdaf52SJiri Slaby 205785cdaf52SJiri Slaby if (add_uevent_var(env, "HID_ID=%04X:%08X:%08X", 205885cdaf52SJiri Slaby hdev->bus, hdev->vendor, hdev->product)) 205985cdaf52SJiri Slaby return -ENOMEM; 206085cdaf52SJiri Slaby 206185cdaf52SJiri Slaby if (add_uevent_var(env, "HID_NAME=%s", hdev->name)) 206285cdaf52SJiri Slaby return -ENOMEM; 206385cdaf52SJiri Slaby 206485cdaf52SJiri Slaby if (add_uevent_var(env, "HID_PHYS=%s", hdev->phys)) 206585cdaf52SJiri Slaby return -ENOMEM; 206685cdaf52SJiri Slaby 206785cdaf52SJiri Slaby if (add_uevent_var(env, "HID_UNIQ=%s", hdev->uniq)) 206885cdaf52SJiri Slaby return -ENOMEM; 206985cdaf52SJiri Slaby 20704d53b801SHenrik Rydberg if (add_uevent_var(env, "MODALIAS=hid:b%04Xg%04Xv%08Xp%08X", 20714d53b801SHenrik Rydberg hdev->bus, hdev->group, hdev->vendor, hdev->product)) 207285cdaf52SJiri Slaby return -ENOMEM; 207385cdaf52SJiri Slaby 207485cdaf52SJiri Slaby return 0; 207585cdaf52SJiri Slaby } 207685cdaf52SJiri Slaby 2077e04a0442SBenjamin Tissoires struct bus_type hid_bus_type = { 207885cdaf52SJiri Slaby .name = "hid", 20790d4260e0SGreg Kroah-Hartman .dev_groups = hid_dev_groups, 2080c2810325SGreg Kroah-Hartman .drv_groups = hid_drv_groups, 208185cdaf52SJiri Slaby .match = hid_bus_match, 208285cdaf52SJiri Slaby .probe = hid_device_probe, 208385cdaf52SJiri Slaby .remove = hid_device_remove, 208485cdaf52SJiri Slaby .uevent = hid_uevent, 208585cdaf52SJiri Slaby }; 2086d5d3e202SBenjamin Tissoires EXPORT_SYMBOL(hid_bus_type); 2087d458a9dfSJiri Slaby 208885cdaf52SJiri Slaby int hid_add_device(struct hid_device *hdev) 208985cdaf52SJiri Slaby { 209085cdaf52SJiri Slaby static atomic_t id = ATOMIC_INIT(0); 209185cdaf52SJiri Slaby int ret; 209285cdaf52SJiri Slaby 209385cdaf52SJiri Slaby if (WARN_ON(hdev->status & HID_STAT_ADDED)) 209485cdaf52SJiri Slaby return -EBUSY; 209585cdaf52SJiri Slaby 2096d5d3e202SBenjamin Tissoires hdev->quirks = hid_lookup_quirk(hdev); 2097d5d3e202SBenjamin Tissoires 2098d458a9dfSJiri Slaby /* we need to kill them here, otherwise they will stay allocated to 2099d458a9dfSJiri Slaby * wait for coming driver */ 21004529eefaSLamarque V. Souza if (hid_ignore(hdev)) 2101d458a9dfSJiri Slaby return -ENODEV; 2102d458a9dfSJiri Slaby 2103a7197c2eSHenrik Rydberg /* 21043c86726cSBenjamin Tissoires * Check for the mandatory transport channel. 21053c86726cSBenjamin Tissoires */ 21063c86726cSBenjamin Tissoires if (!hdev->ll_driver->raw_request) { 21073c86726cSBenjamin Tissoires hid_err(hdev, "transport driver missing .raw_request()\n"); 21083c86726cSBenjamin Tissoires return -EINVAL; 21093c86726cSBenjamin Tissoires } 21103c86726cSBenjamin Tissoires 21113c86726cSBenjamin Tissoires /* 2112a7197c2eSHenrik Rydberg * Read the device report descriptor once and use as template 2113a7197c2eSHenrik Rydberg * for the driver-specific modifications. 2114a7197c2eSHenrik Rydberg */ 2115a7197c2eSHenrik Rydberg ret = hdev->ll_driver->parse(hdev); 2116a7197c2eSHenrik Rydberg if (ret) 2117a7197c2eSHenrik Rydberg return ret; 2118a7197c2eSHenrik Rydberg if (!hdev->dev_rdesc) 2119a7197c2eSHenrik Rydberg return -ENODEV; 2120a7197c2eSHenrik Rydberg 2121734c6609SHenrik Rydberg /* 2122734c6609SHenrik Rydberg * Scan generic devices for group information 2123734c6609SHenrik Rydberg */ 21244392bf33SBenjamin Tissoires if (hid_ignore_special_drivers) { 21254392bf33SBenjamin Tissoires hdev->group = HID_GROUP_GENERIC; 21264392bf33SBenjamin Tissoires } else if (!hdev->group && 21276e65d9d5SBenjamin Tissoires !(hdev->quirks & HID_QUIRK_HAVE_SPECIAL_DRIVER)) { 2128734c6609SHenrik Rydberg ret = hid_scan_report(hdev); 2129734c6609SHenrik Rydberg if (ret) 2130734c6609SHenrik Rydberg hid_warn(hdev, "bad device descriptor (%d)\n", ret); 2131734c6609SHenrik Rydberg } 2132734c6609SHenrik Rydberg 21336bbe586fSKay Sievers /* XXX hack, any other cleaner solution after the driver core 21346bbe586fSKay Sievers * is converted to allow more than 20 bytes as the device name? */ 21356bbe586fSKay Sievers dev_set_name(&hdev->dev, "%04X:%04X:%04X.%04X", hdev->bus, 213685cdaf52SJiri Slaby hdev->vendor, hdev->product, atomic_inc_return(&id)); 213785cdaf52SJiri Slaby 21384da361b6SBruno Prémont hid_debug_register(hdev, dev_name(&hdev->dev)); 213985cdaf52SJiri Slaby ret = device_add(&hdev->dev); 214085cdaf52SJiri Slaby if (!ret) 214185cdaf52SJiri Slaby hdev->status |= HID_STAT_ADDED; 21424da361b6SBruno Prémont else 21434da361b6SBruno Prémont hid_debug_unregister(hdev); 2144a635f9ddSJiri Kosina 214585cdaf52SJiri Slaby return ret; 214685cdaf52SJiri Slaby } 214785cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_add_device); 214885cdaf52SJiri Slaby 214985cdaf52SJiri Slaby /** 215085cdaf52SJiri Slaby * hid_allocate_device - allocate new hid device descriptor 215185cdaf52SJiri Slaby * 215285cdaf52SJiri Slaby * Allocate and initialize hid device, so that hid_destroy_device might be 215385cdaf52SJiri Slaby * used to free it. 215485cdaf52SJiri Slaby * 215585cdaf52SJiri Slaby * New hid_device pointer is returned on success, otherwise ERR_PTR encoded 215685cdaf52SJiri Slaby * error value. 215785cdaf52SJiri Slaby */ 215885cdaf52SJiri Slaby struct hid_device *hid_allocate_device(void) 215985cdaf52SJiri Slaby { 216085cdaf52SJiri Slaby struct hid_device *hdev; 216185cdaf52SJiri Slaby int ret = -ENOMEM; 216285cdaf52SJiri Slaby 216385cdaf52SJiri Slaby hdev = kzalloc(sizeof(*hdev), GFP_KERNEL); 216485cdaf52SJiri Slaby if (hdev == NULL) 216585cdaf52SJiri Slaby return ERR_PTR(ret); 216685cdaf52SJiri Slaby 216785cdaf52SJiri Slaby device_initialize(&hdev->dev); 216885cdaf52SJiri Slaby hdev->dev.release = hid_device_release; 216985cdaf52SJiri Slaby hdev->dev.bus = &hid_bus_type; 217064bebefcSFu, Zhonghui device_enable_async_suspend(&hdev->dev); 217185cdaf52SJiri Slaby 2172a7197c2eSHenrik Rydberg hid_close_report(hdev); 217385cdaf52SJiri Slaby 2174cd667ce2SJiri Kosina init_waitqueue_head(&hdev->debug_wait); 2175cd667ce2SJiri Kosina INIT_LIST_HEAD(&hdev->debug_list); 21761deb9d34SJiri Kosina spin_lock_init(&hdev->debug_list_lock); 2177c849a614SAndrew de los Reyes sema_init(&hdev->driver_input_lock, 1); 2178aaac082dSDmitry Torokhov mutex_init(&hdev->ll_open_lock); 2179cd667ce2SJiri Kosina 218085cdaf52SJiri Slaby return hdev; 218185cdaf52SJiri Slaby } 218285cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_allocate_device); 218385cdaf52SJiri Slaby 218485cdaf52SJiri Slaby static void hid_remove_device(struct hid_device *hdev) 218585cdaf52SJiri Slaby { 218685cdaf52SJiri Slaby if (hdev->status & HID_STAT_ADDED) { 218785cdaf52SJiri Slaby device_del(&hdev->dev); 2188a635f9ddSJiri Kosina hid_debug_unregister(hdev); 218985cdaf52SJiri Slaby hdev->status &= ~HID_STAT_ADDED; 219085cdaf52SJiri Slaby } 2191a7197c2eSHenrik Rydberg kfree(hdev->dev_rdesc); 2192a7197c2eSHenrik Rydberg hdev->dev_rdesc = NULL; 2193a7197c2eSHenrik Rydberg hdev->dev_rsize = 0; 219485cdaf52SJiri Slaby } 219585cdaf52SJiri Slaby 219685cdaf52SJiri Slaby /** 219785cdaf52SJiri Slaby * hid_destroy_device - free previously allocated device 219885cdaf52SJiri Slaby * 219985cdaf52SJiri Slaby * @hdev: hid device 220085cdaf52SJiri Slaby * 220185cdaf52SJiri Slaby * If you allocate hid_device through hid_allocate_device, you should ever 220285cdaf52SJiri Slaby * free by this function. 220385cdaf52SJiri Slaby */ 220485cdaf52SJiri Slaby void hid_destroy_device(struct hid_device *hdev) 220585cdaf52SJiri Slaby { 220685cdaf52SJiri Slaby hid_remove_device(hdev); 220785cdaf52SJiri Slaby put_device(&hdev->dev); 220885cdaf52SJiri Slaby } 220985cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_destroy_device); 221085cdaf52SJiri Slaby 2211e04a0442SBenjamin Tissoires 2212c17a7476SBenjamin Tissoires static int __hid_bus_reprobe_drivers(struct device *dev, void *data) 2213e04a0442SBenjamin Tissoires { 2214c17a7476SBenjamin Tissoires struct hid_driver *hdrv = data; 2215c17a7476SBenjamin Tissoires struct hid_device *hdev = to_hid_device(dev); 2216c17a7476SBenjamin Tissoires 2217c17a7476SBenjamin Tissoires if (hdev->driver == hdrv && 2218c17a7476SBenjamin Tissoires !hdrv->match(hdev, hid_ignore_special_drivers)) 2219c17a7476SBenjamin Tissoires return device_reprobe(dev); 2220c17a7476SBenjamin Tissoires 2221c17a7476SBenjamin Tissoires return 0; 2222c17a7476SBenjamin Tissoires } 2223c17a7476SBenjamin Tissoires 2224c17a7476SBenjamin Tissoires static int __hid_bus_driver_added(struct device_driver *drv, void *data) 2225c17a7476SBenjamin Tissoires { 2226e04a0442SBenjamin Tissoires struct hid_driver *hdrv = to_hid_driver(drv); 2227e04a0442SBenjamin Tissoires 2228c17a7476SBenjamin Tissoires if (hdrv->match) { 2229c17a7476SBenjamin Tissoires bus_for_each_dev(&hid_bus_type, NULL, hdrv, 2230c17a7476SBenjamin Tissoires __hid_bus_reprobe_drivers); 2231c17a7476SBenjamin Tissoires } 2232e04a0442SBenjamin Tissoires 2233e04a0442SBenjamin Tissoires return 0; 2234e04a0442SBenjamin Tissoires } 2235e04a0442SBenjamin Tissoires 2236e04a0442SBenjamin Tissoires static int __bus_removed_driver(struct device_driver *drv, void *data) 2237e04a0442SBenjamin Tissoires { 2238c17a7476SBenjamin Tissoires return bus_rescan_devices(&hid_bus_type); 2239e04a0442SBenjamin Tissoires } 2240e04a0442SBenjamin Tissoires 224185cdaf52SJiri Slaby int __hid_register_driver(struct hid_driver *hdrv, struct module *owner, 224285cdaf52SJiri Slaby const char *mod_name) 224385cdaf52SJiri Slaby { 2244c17a7476SBenjamin Tissoires int ret; 2245c17a7476SBenjamin Tissoires 224685cdaf52SJiri Slaby hdrv->driver.name = hdrv->name; 224785cdaf52SJiri Slaby hdrv->driver.bus = &hid_bus_type; 224885cdaf52SJiri Slaby hdrv->driver.owner = owner; 224985cdaf52SJiri Slaby hdrv->driver.mod_name = mod_name; 225085cdaf52SJiri Slaby 22513a6f82f7SJiri Slaby INIT_LIST_HEAD(&hdrv->dyn_list); 22523a6f82f7SJiri Slaby spin_lock_init(&hdrv->dyn_lock); 22533a6f82f7SJiri Slaby 2254c17a7476SBenjamin Tissoires ret = driver_register(&hdrv->driver); 2255e04a0442SBenjamin Tissoires 2256c17a7476SBenjamin Tissoires if (ret == 0) 2257c17a7476SBenjamin Tissoires bus_for_each_drv(&hid_bus_type, NULL, NULL, 2258c17a7476SBenjamin Tissoires __hid_bus_driver_added); 2259c17a7476SBenjamin Tissoires 2260c17a7476SBenjamin Tissoires return ret; 226185cdaf52SJiri Slaby } 226285cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(__hid_register_driver); 226385cdaf52SJiri Slaby 226485cdaf52SJiri Slaby void hid_unregister_driver(struct hid_driver *hdrv) 226585cdaf52SJiri Slaby { 226685cdaf52SJiri Slaby driver_unregister(&hdrv->driver); 22673a6f82f7SJiri Slaby hid_free_dynids(hdrv); 2268e04a0442SBenjamin Tissoires 2269e04a0442SBenjamin Tissoires bus_for_each_drv(&hid_bus_type, NULL, hdrv, __bus_removed_driver); 227085cdaf52SJiri Slaby } 227185cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_unregister_driver); 227285cdaf52SJiri Slaby 22730361a28dSOliver Neukum int hid_check_keys_pressed(struct hid_device *hid) 22740361a28dSOliver Neukum { 22750361a28dSOliver Neukum struct hid_input *hidinput; 22760361a28dSOliver Neukum int i; 22770361a28dSOliver Neukum 2278e5288eb5SJiri Kosina if (!(hid->claimed & HID_CLAIMED_INPUT)) 2279e5288eb5SJiri Kosina return 0; 2280e5288eb5SJiri Kosina 22810361a28dSOliver Neukum list_for_each_entry(hidinput, &hid->inputs, list) { 22820361a28dSOliver Neukum for (i = 0; i < BITS_TO_LONGS(KEY_MAX); i++) 22830361a28dSOliver Neukum if (hidinput->input->key[i]) 22840361a28dSOliver Neukum return 1; 22850361a28dSOliver Neukum } 22860361a28dSOliver Neukum 22870361a28dSOliver Neukum return 0; 22880361a28dSOliver Neukum } 22890361a28dSOliver Neukum 22900361a28dSOliver Neukum EXPORT_SYMBOL_GPL(hid_check_keys_pressed); 22910361a28dSOliver Neukum 229286166b7bSJiri Kosina static int __init hid_init(void) 229386166b7bSJiri Kosina { 229485cdaf52SJiri Slaby int ret; 229585cdaf52SJiri Slaby 2296a635f9ddSJiri Kosina if (hid_debug) 22974291ee30SJoe Perches pr_warn("hid_debug is now used solely for parser and driver debugging.\n" 22984291ee30SJoe Perches "debugfs is now used for inspecting the device (report descriptor, reports)\n"); 2299a635f9ddSJiri Kosina 230085cdaf52SJiri Slaby ret = bus_register(&hid_bus_type); 230185cdaf52SJiri Slaby if (ret) { 23024291ee30SJoe Perches pr_err("can't register hid bus\n"); 230385cdaf52SJiri Slaby goto err; 230485cdaf52SJiri Slaby } 230585cdaf52SJiri Slaby 230685cdaf52SJiri Slaby ret = hidraw_init(); 230785cdaf52SJiri Slaby if (ret) 230885cdaf52SJiri Slaby goto err_bus; 230985cdaf52SJiri Slaby 2310a635f9ddSJiri Kosina hid_debug_init(); 2311a635f9ddSJiri Kosina 231285cdaf52SJiri Slaby return 0; 231385cdaf52SJiri Slaby err_bus: 231485cdaf52SJiri Slaby bus_unregister(&hid_bus_type); 231585cdaf52SJiri Slaby err: 231685cdaf52SJiri Slaby return ret; 231786166b7bSJiri Kosina } 231886166b7bSJiri Kosina 231986166b7bSJiri Kosina static void __exit hid_exit(void) 232086166b7bSJiri Kosina { 2321a635f9ddSJiri Kosina hid_debug_exit(); 232286166b7bSJiri Kosina hidraw_exit(); 232385cdaf52SJiri Slaby bus_unregister(&hid_bus_type); 2324d5d3e202SBenjamin Tissoires hid_quirks_exit(HID_BUS_ANY); 232586166b7bSJiri Kosina } 232686166b7bSJiri Kosina 232786166b7bSJiri Kosina module_init(hid_init); 232886166b7bSJiri Kosina module_exit(hid_exit); 232986166b7bSJiri Kosina 233088adb72bSJiri Kosina MODULE_AUTHOR("Andreas Gal"); 233188adb72bSJiri Kosina MODULE_AUTHOR("Vojtech Pavlik"); 233288adb72bSJiri Kosina MODULE_AUTHOR("Jiri Kosina"); 23337021b600SGrant Grundler MODULE_LICENSE("GPL"); 2334