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 13108a8a7cfSBenjamin Tissoires if (parser->collection_stack_ptr == parser->collection_stack_size) { 13208a8a7cfSBenjamin Tissoires unsigned int *collection_stack; 13308a8a7cfSBenjamin Tissoires unsigned int new_size = parser->collection_stack_size + 13408a8a7cfSBenjamin Tissoires HID_COLLECTION_STACK_SIZE; 13508a8a7cfSBenjamin Tissoires 13608a8a7cfSBenjamin Tissoires collection_stack = krealloc(parser->collection_stack, 13708a8a7cfSBenjamin Tissoires new_size * sizeof(unsigned int), 13808a8a7cfSBenjamin Tissoires GFP_KERNEL); 13908a8a7cfSBenjamin Tissoires if (!collection_stack) 14008a8a7cfSBenjamin Tissoires return -ENOMEM; 14108a8a7cfSBenjamin Tissoires 14208a8a7cfSBenjamin Tissoires parser->collection_stack = collection_stack; 14308a8a7cfSBenjamin Tissoires parser->collection_stack_size = new_size; 144dde5845aSJiri Kosina } 145dde5845aSJiri Kosina 146dde5845aSJiri Kosina if (parser->device->maxcollection == parser->device->collection_size) { 1476da2ec56SKees Cook collection = kmalloc( 1486da2ec56SKees Cook array3_size(sizeof(struct hid_collection), 1496da2ec56SKees Cook parser->device->collection_size, 1506da2ec56SKees Cook 2), 1516da2ec56SKees Cook GFP_KERNEL); 152dde5845aSJiri Kosina if (collection == NULL) { 1538c3d52fcSJiri Kosina hid_err(parser->device, "failed to reallocate collection array\n"); 154a6fbaacfSSachin Kamat return -ENOMEM; 155dde5845aSJiri Kosina } 156dde5845aSJiri Kosina memcpy(collection, parser->device->collection, 157dde5845aSJiri Kosina sizeof(struct hid_collection) * 158dde5845aSJiri Kosina parser->device->collection_size); 159dde5845aSJiri Kosina memset(collection + parser->device->collection_size, 0, 160dde5845aSJiri Kosina sizeof(struct hid_collection) * 161dde5845aSJiri Kosina parser->device->collection_size); 162dde5845aSJiri Kosina kfree(parser->device->collection); 163dde5845aSJiri Kosina parser->device->collection = collection; 164dde5845aSJiri Kosina parser->device->collection_size *= 2; 165dde5845aSJiri Kosina } 166dde5845aSJiri Kosina 167dde5845aSJiri Kosina parser->collection_stack[parser->collection_stack_ptr++] = 168dde5845aSJiri Kosina parser->device->maxcollection; 169dde5845aSJiri Kosina 170dde5845aSJiri Kosina collection = parser->device->collection + 171dde5845aSJiri Kosina parser->device->maxcollection++; 172dde5845aSJiri Kosina collection->type = type; 173dde5845aSJiri Kosina collection->usage = usage; 174dde5845aSJiri Kosina collection->level = parser->collection_stack_ptr - 1; 175c53431ebSPeter Hutterer collection->parent = parser->active_collection; 176c53431ebSPeter Hutterer parser->active_collection = collection; 177dde5845aSJiri Kosina 178dde5845aSJiri Kosina if (type == HID_COLLECTION_APPLICATION) 179dde5845aSJiri Kosina parser->device->maxapplication++; 180dde5845aSJiri Kosina 181dde5845aSJiri Kosina return 0; 182dde5845aSJiri Kosina } 183dde5845aSJiri Kosina 184dde5845aSJiri Kosina /* 185dde5845aSJiri Kosina * Close a collection. 186dde5845aSJiri Kosina */ 187dde5845aSJiri Kosina 188dde5845aSJiri Kosina static int close_collection(struct hid_parser *parser) 189dde5845aSJiri Kosina { 190dde5845aSJiri Kosina if (!parser->collection_stack_ptr) { 1918c3d52fcSJiri Kosina hid_err(parser->device, "collection stack underflow\n"); 192a6fbaacfSSachin Kamat return -EINVAL; 193dde5845aSJiri Kosina } 194dde5845aSJiri Kosina parser->collection_stack_ptr--; 195c53431ebSPeter Hutterer if (parser->active_collection) 196c53431ebSPeter Hutterer parser->active_collection = parser->active_collection->parent; 197dde5845aSJiri Kosina return 0; 198dde5845aSJiri Kosina } 199dde5845aSJiri Kosina 200dde5845aSJiri Kosina /* 201dde5845aSJiri Kosina * Climb up the stack, search for the specified collection type 202dde5845aSJiri Kosina * and return the usage. 203dde5845aSJiri Kosina */ 204dde5845aSJiri Kosina 205dde5845aSJiri Kosina static unsigned hid_lookup_collection(struct hid_parser *parser, unsigned type) 206dde5845aSJiri Kosina { 207504499f2SJoe Perches struct hid_collection *collection = parser->device->collection; 208dde5845aSJiri Kosina int n; 209504499f2SJoe Perches 210504499f2SJoe Perches for (n = parser->collection_stack_ptr - 1; n >= 0; n--) { 211504499f2SJoe Perches unsigned index = parser->collection_stack[n]; 212504499f2SJoe Perches if (collection[index].type == type) 213504499f2SJoe Perches return collection[index].usage; 214504499f2SJoe Perches } 215dde5845aSJiri Kosina return 0; /* we know nothing about this usage type */ 216dde5845aSJiri Kosina } 217dde5845aSJiri Kosina 218dde5845aSJiri Kosina /* 219dde5845aSJiri Kosina * Add a usage to the temporary parser table. 220dde5845aSJiri Kosina */ 221dde5845aSJiri Kosina 222dde5845aSJiri Kosina static int hid_add_usage(struct hid_parser *parser, unsigned usage) 223dde5845aSJiri Kosina { 224dde5845aSJiri Kosina if (parser->local.usage_index >= HID_MAX_USAGES) { 2258c3d52fcSJiri Kosina hid_err(parser->device, "usage index exceeded\n"); 226dde5845aSJiri Kosina return -1; 227dde5845aSJiri Kosina } 228dde5845aSJiri Kosina parser->local.usage[parser->local.usage_index] = usage; 229dde5845aSJiri Kosina parser->local.collection_index[parser->local.usage_index] = 230dde5845aSJiri Kosina parser->collection_stack_ptr ? 231dde5845aSJiri Kosina parser->collection_stack[parser->collection_stack_ptr - 1] : 0; 232dde5845aSJiri Kosina parser->local.usage_index++; 233dde5845aSJiri Kosina return 0; 234dde5845aSJiri Kosina } 235dde5845aSJiri Kosina 236dde5845aSJiri Kosina /* 237dde5845aSJiri Kosina * Register a new field for this report. 238dde5845aSJiri Kosina */ 239dde5845aSJiri Kosina 240dde5845aSJiri Kosina static int hid_add_field(struct hid_parser *parser, unsigned report_type, unsigned flags) 241dde5845aSJiri Kosina { 242dde5845aSJiri Kosina struct hid_report *report; 243dde5845aSJiri Kosina struct hid_field *field; 244f07b3c1dSBenjamin Tissoires unsigned int usages; 245f07b3c1dSBenjamin Tissoires unsigned int offset; 246f07b3c1dSBenjamin Tissoires unsigned int i; 247f07b3c1dSBenjamin Tissoires unsigned int application; 248dde5845aSJiri Kosina 249f07b3c1dSBenjamin Tissoires application = hid_lookup_collection(parser, HID_COLLECTION_APPLICATION); 250f07b3c1dSBenjamin Tissoires 251f07b3c1dSBenjamin Tissoires report = hid_register_report(parser->device, report_type, 252f07b3c1dSBenjamin Tissoires parser->global.report_id, application); 253a3789a17SJoe Perches if (!report) { 2548c3d52fcSJiri Kosina hid_err(parser->device, "hid_register_report failed\n"); 255dde5845aSJiri Kosina return -1; 256dde5845aSJiri Kosina } 257dde5845aSJiri Kosina 258bb2e1976SJiri Kosina /* Handle both signed and unsigned cases properly */ 2590cd516c2Ssrinivas pandruvada if ((parser->global.logical_minimum < 0 && 2600cd516c2Ssrinivas pandruvada parser->global.logical_maximum < 2610cd516c2Ssrinivas pandruvada parser->global.logical_minimum) || 2620cd516c2Ssrinivas pandruvada (parser->global.logical_minimum >= 0 && 2630cd516c2Ssrinivas pandruvada (__u32)parser->global.logical_maximum < 2640cd516c2Ssrinivas pandruvada (__u32)parser->global.logical_minimum)) { 2650cd516c2Ssrinivas pandruvada dbg_hid("logical range invalid 0x%x 0x%x\n", 2660cd516c2Ssrinivas pandruvada parser->global.logical_minimum, 2670cd516c2Ssrinivas pandruvada parser->global.logical_maximum); 268dde5845aSJiri Kosina return -1; 269dde5845aSJiri Kosina } 270dde5845aSJiri Kosina 271dde5845aSJiri Kosina offset = report->size; 272dde5845aSJiri Kosina report->size += parser->global.report_size * parser->global.report_count; 273dde5845aSJiri Kosina 274dde5845aSJiri Kosina if (!parser->local.usage_index) /* Ignore padding fields */ 275dde5845aSJiri Kosina return 0; 276dde5845aSJiri Kosina 277cc6b54aaSBenjamin Tissoires usages = max_t(unsigned, parser->local.usage_index, 278cc6b54aaSBenjamin Tissoires parser->global.report_count); 279dde5845aSJiri Kosina 280a3789a17SJoe Perches field = hid_register_field(report, usages, parser->global.report_count); 281a3789a17SJoe Perches if (!field) 282dde5845aSJiri Kosina return 0; 283dde5845aSJiri Kosina 284dde5845aSJiri Kosina field->physical = hid_lookup_collection(parser, HID_COLLECTION_PHYSICAL); 285dde5845aSJiri Kosina field->logical = hid_lookup_collection(parser, HID_COLLECTION_LOGICAL); 286f07b3c1dSBenjamin Tissoires field->application = application; 287dde5845aSJiri Kosina 288dde5845aSJiri Kosina for (i = 0; i < usages; i++) { 289cc6b54aaSBenjamin Tissoires unsigned j = i; 290dde5845aSJiri Kosina /* Duplicate the last usage we parsed if we have excess values */ 291dde5845aSJiri Kosina if (i >= parser->local.usage_index) 292dde5845aSJiri Kosina j = parser->local.usage_index - 1; 293dde5845aSJiri Kosina field->usage[i].hid = parser->local.usage[j]; 294dde5845aSJiri Kosina field->usage[i].collection_index = 295dde5845aSJiri Kosina parser->local.collection_index[j]; 296cc6b54aaSBenjamin Tissoires field->usage[i].usage_index = i; 297*5a4abb36SPeter Hutterer field->usage[i].resolution_multiplier = 1; 298dde5845aSJiri Kosina } 299dde5845aSJiri Kosina 300dde5845aSJiri Kosina field->maxusage = usages; 301dde5845aSJiri Kosina field->flags = flags; 302dde5845aSJiri Kosina field->report_offset = offset; 303dde5845aSJiri Kosina field->report_type = report_type; 304dde5845aSJiri Kosina field->report_size = parser->global.report_size; 305dde5845aSJiri Kosina field->report_count = parser->global.report_count; 306dde5845aSJiri Kosina field->logical_minimum = parser->global.logical_minimum; 307dde5845aSJiri Kosina field->logical_maximum = parser->global.logical_maximum; 308dde5845aSJiri Kosina field->physical_minimum = parser->global.physical_minimum; 309dde5845aSJiri Kosina field->physical_maximum = parser->global.physical_maximum; 310dde5845aSJiri Kosina field->unit_exponent = parser->global.unit_exponent; 311dde5845aSJiri Kosina field->unit = parser->global.unit; 312dde5845aSJiri Kosina 313dde5845aSJiri Kosina return 0; 314dde5845aSJiri Kosina } 315dde5845aSJiri Kosina 316dde5845aSJiri Kosina /* 317dde5845aSJiri Kosina * Read data value from item. 318dde5845aSJiri Kosina */ 319dde5845aSJiri Kosina 320dde5845aSJiri Kosina static u32 item_udata(struct hid_item *item) 321dde5845aSJiri Kosina { 322dde5845aSJiri Kosina switch (item->size) { 323dde5845aSJiri Kosina case 1: return item->data.u8; 324dde5845aSJiri Kosina case 2: return item->data.u16; 325dde5845aSJiri Kosina case 4: return item->data.u32; 326dde5845aSJiri Kosina } 327dde5845aSJiri Kosina return 0; 328dde5845aSJiri Kosina } 329dde5845aSJiri Kosina 330dde5845aSJiri Kosina static s32 item_sdata(struct hid_item *item) 331dde5845aSJiri Kosina { 332dde5845aSJiri Kosina switch (item->size) { 333dde5845aSJiri Kosina case 1: return item->data.s8; 334dde5845aSJiri Kosina case 2: return item->data.s16; 335dde5845aSJiri Kosina case 4: return item->data.s32; 336dde5845aSJiri Kosina } 337dde5845aSJiri Kosina return 0; 338dde5845aSJiri Kosina } 339dde5845aSJiri Kosina 340dde5845aSJiri Kosina /* 341dde5845aSJiri Kosina * Process a global item. 342dde5845aSJiri Kosina */ 343dde5845aSJiri Kosina 344dde5845aSJiri Kosina static int hid_parser_global(struct hid_parser *parser, struct hid_item *item) 345dde5845aSJiri Kosina { 346ad0e669bSNikolai Kondrashov __s32 raw_value; 347dde5845aSJiri Kosina switch (item->tag) { 348dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PUSH: 349dde5845aSJiri Kosina 350dde5845aSJiri Kosina if (parser->global_stack_ptr == HID_GLOBAL_STACK_SIZE) { 3518c3d52fcSJiri Kosina hid_err(parser->device, "global environment stack overflow\n"); 352dde5845aSJiri Kosina return -1; 353dde5845aSJiri Kosina } 354dde5845aSJiri Kosina 355dde5845aSJiri Kosina memcpy(parser->global_stack + parser->global_stack_ptr++, 356dde5845aSJiri Kosina &parser->global, sizeof(struct hid_global)); 357dde5845aSJiri Kosina return 0; 358dde5845aSJiri Kosina 359dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_POP: 360dde5845aSJiri Kosina 361dde5845aSJiri Kosina if (!parser->global_stack_ptr) { 3628c3d52fcSJiri Kosina hid_err(parser->device, "global environment stack underflow\n"); 363dde5845aSJiri Kosina return -1; 364dde5845aSJiri Kosina } 365dde5845aSJiri Kosina 366880d29f1SJiri Slaby memcpy(&parser->global, parser->global_stack + 367880d29f1SJiri Slaby --parser->global_stack_ptr, sizeof(struct hid_global)); 368dde5845aSJiri Kosina return 0; 369dde5845aSJiri Kosina 370dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_USAGE_PAGE: 371dde5845aSJiri Kosina parser->global.usage_page = item_udata(item); 372dde5845aSJiri Kosina return 0; 373dde5845aSJiri Kosina 374dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM: 375dde5845aSJiri Kosina parser->global.logical_minimum = item_sdata(item); 376dde5845aSJiri Kosina return 0; 377dde5845aSJiri Kosina 378dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM: 379dde5845aSJiri Kosina if (parser->global.logical_minimum < 0) 380dde5845aSJiri Kosina parser->global.logical_maximum = item_sdata(item); 381dde5845aSJiri Kosina else 382dde5845aSJiri Kosina parser->global.logical_maximum = item_udata(item); 383dde5845aSJiri Kosina return 0; 384dde5845aSJiri Kosina 385dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM: 386dde5845aSJiri Kosina parser->global.physical_minimum = item_sdata(item); 387dde5845aSJiri Kosina return 0; 388dde5845aSJiri Kosina 389dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM: 390dde5845aSJiri Kosina if (parser->global.physical_minimum < 0) 391dde5845aSJiri Kosina parser->global.physical_maximum = item_sdata(item); 392dde5845aSJiri Kosina else 393dde5845aSJiri Kosina parser->global.physical_maximum = item_udata(item); 394dde5845aSJiri Kosina return 0; 395dde5845aSJiri Kosina 396dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT: 397ad0e669bSNikolai Kondrashov /* Many devices provide unit exponent as a two's complement 398ad0e669bSNikolai Kondrashov * nibble due to the common misunderstanding of HID 399ad0e669bSNikolai Kondrashov * specification 1.11, 6.2.2.7 Global Items. Attempt to handle 400ad0e669bSNikolai Kondrashov * both this and the standard encoding. */ 401ad0e669bSNikolai Kondrashov raw_value = item_sdata(item); 40277463838SBenjamin Tissoires if (!(raw_value & 0xfffffff0)) 40377463838SBenjamin Tissoires parser->global.unit_exponent = hid_snto32(raw_value, 4); 40477463838SBenjamin Tissoires else 40577463838SBenjamin Tissoires parser->global.unit_exponent = raw_value; 406dde5845aSJiri Kosina return 0; 407dde5845aSJiri Kosina 408dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_UNIT: 409dde5845aSJiri Kosina parser->global.unit = item_udata(item); 410dde5845aSJiri Kosina return 0; 411dde5845aSJiri Kosina 412dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_SIZE: 413880d29f1SJiri Slaby parser->global.report_size = item_udata(item); 41471f6fa90SSong, Hongyan if (parser->global.report_size > 256) { 4158c3d52fcSJiri Kosina hid_err(parser->device, "invalid report_size %d\n", 416880d29f1SJiri Slaby parser->global.report_size); 417dde5845aSJiri Kosina return -1; 418dde5845aSJiri Kosina } 419dde5845aSJiri Kosina return 0; 420dde5845aSJiri Kosina 421dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_COUNT: 422880d29f1SJiri Slaby parser->global.report_count = item_udata(item); 423880d29f1SJiri Slaby if (parser->global.report_count > HID_MAX_USAGES) { 4248c3d52fcSJiri Kosina hid_err(parser->device, "invalid report_count %d\n", 425880d29f1SJiri Slaby parser->global.report_count); 426dde5845aSJiri Kosina return -1; 427dde5845aSJiri Kosina } 428dde5845aSJiri Kosina return 0; 429dde5845aSJiri Kosina 430dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_ID: 431880d29f1SJiri Slaby parser->global.report_id = item_udata(item); 43243622021SKees Cook if (parser->global.report_id == 0 || 43343622021SKees Cook parser->global.report_id >= HID_MAX_IDS) { 43443622021SKees Cook hid_err(parser->device, "report_id %u is invalid\n", 43543622021SKees Cook parser->global.report_id); 436dde5845aSJiri Kosina return -1; 437dde5845aSJiri Kosina } 438dde5845aSJiri Kosina return 0; 439dde5845aSJiri Kosina 440dde5845aSJiri Kosina default: 4418c3d52fcSJiri Kosina hid_err(parser->device, "unknown global tag 0x%x\n", item->tag); 442dde5845aSJiri Kosina return -1; 443dde5845aSJiri Kosina } 444dde5845aSJiri Kosina } 445dde5845aSJiri Kosina 446dde5845aSJiri Kosina /* 447dde5845aSJiri Kosina * Process a local item. 448dde5845aSJiri Kosina */ 449dde5845aSJiri Kosina 450dde5845aSJiri Kosina static int hid_parser_local(struct hid_parser *parser, struct hid_item *item) 451dde5845aSJiri Kosina { 452dde5845aSJiri Kosina __u32 data; 453dde5845aSJiri Kosina unsigned n; 454ba532198SBenjamin Tissoires __u32 count; 455dde5845aSJiri Kosina 456dde5845aSJiri Kosina data = item_udata(item); 457dde5845aSJiri Kosina 458dde5845aSJiri Kosina switch (item->tag) { 459dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_DELIMITER: 460dde5845aSJiri Kosina 461dde5845aSJiri Kosina if (data) { 462dde5845aSJiri Kosina /* 463dde5845aSJiri Kosina * We treat items before the first delimiter 464dde5845aSJiri Kosina * as global to all usage sets (branch 0). 465dde5845aSJiri Kosina * In the moment we process only these global 466dde5845aSJiri Kosina * items and the first delimiter set. 467dde5845aSJiri Kosina */ 468dde5845aSJiri Kosina if (parser->local.delimiter_depth != 0) { 4698c3d52fcSJiri Kosina hid_err(parser->device, "nested delimiters\n"); 470dde5845aSJiri Kosina return -1; 471dde5845aSJiri Kosina } 472dde5845aSJiri Kosina parser->local.delimiter_depth++; 473dde5845aSJiri Kosina parser->local.delimiter_branch++; 474dde5845aSJiri Kosina } else { 475dde5845aSJiri Kosina if (parser->local.delimiter_depth < 1) { 4768c3d52fcSJiri Kosina hid_err(parser->device, "bogus close delimiter\n"); 477dde5845aSJiri Kosina return -1; 478dde5845aSJiri Kosina } 479dde5845aSJiri Kosina parser->local.delimiter_depth--; 480dde5845aSJiri Kosina } 48138ead6efSPaul Chavent return 0; 482dde5845aSJiri Kosina 483dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE: 484dde5845aSJiri Kosina 485dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 48658037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 487dde5845aSJiri Kosina return 0; 488dde5845aSJiri Kosina } 489dde5845aSJiri Kosina 490dde5845aSJiri Kosina if (item->size <= 2) 491dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 492dde5845aSJiri Kosina 493dde5845aSJiri Kosina return hid_add_usage(parser, data); 494dde5845aSJiri Kosina 495dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE_MINIMUM: 496dde5845aSJiri Kosina 497dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 49858037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 499dde5845aSJiri Kosina return 0; 500dde5845aSJiri Kosina } 501dde5845aSJiri Kosina 502dde5845aSJiri Kosina if (item->size <= 2) 503dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 504dde5845aSJiri Kosina 505dde5845aSJiri Kosina parser->local.usage_minimum = data; 506dde5845aSJiri Kosina return 0; 507dde5845aSJiri Kosina 508dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM: 509dde5845aSJiri Kosina 510dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 51158037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 512dde5845aSJiri Kosina return 0; 513dde5845aSJiri Kosina } 514dde5845aSJiri Kosina 515dde5845aSJiri Kosina if (item->size <= 2) 516dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 517dde5845aSJiri Kosina 518ba532198SBenjamin Tissoires count = data - parser->local.usage_minimum; 519ba532198SBenjamin Tissoires if (count + parser->local.usage_index >= HID_MAX_USAGES) { 520ba532198SBenjamin Tissoires /* 521ba532198SBenjamin Tissoires * We do not warn if the name is not set, we are 522ba532198SBenjamin Tissoires * actually pre-scanning the device. 523ba532198SBenjamin Tissoires */ 524ba532198SBenjamin Tissoires if (dev_name(&parser->device->dev)) 525ba532198SBenjamin Tissoires hid_warn(parser->device, 526ba532198SBenjamin Tissoires "ignoring exceeding usage max\n"); 527ba532198SBenjamin Tissoires data = HID_MAX_USAGES - parser->local.usage_index + 528ba532198SBenjamin Tissoires parser->local.usage_minimum - 1; 529ba532198SBenjamin Tissoires if (data <= 0) { 530ba532198SBenjamin Tissoires hid_err(parser->device, 531ba532198SBenjamin Tissoires "no more usage index available\n"); 532ba532198SBenjamin Tissoires return -1; 533ba532198SBenjamin Tissoires } 534ba532198SBenjamin Tissoires } 535ba532198SBenjamin Tissoires 536dde5845aSJiri Kosina for (n = parser->local.usage_minimum; n <= data; n++) 537dde5845aSJiri Kosina if (hid_add_usage(parser, n)) { 53858037eb9SJiri Kosina dbg_hid("hid_add_usage failed\n"); 539dde5845aSJiri Kosina return -1; 540dde5845aSJiri Kosina } 541dde5845aSJiri Kosina return 0; 542dde5845aSJiri Kosina 543dde5845aSJiri Kosina default: 544dde5845aSJiri Kosina 54558037eb9SJiri Kosina dbg_hid("unknown local item tag 0x%x\n", item->tag); 546dde5845aSJiri Kosina return 0; 547dde5845aSJiri Kosina } 548dde5845aSJiri Kosina return 0; 549dde5845aSJiri Kosina } 550dde5845aSJiri Kosina 551dde5845aSJiri Kosina /* 552dde5845aSJiri Kosina * Process a main item. 553dde5845aSJiri Kosina */ 554dde5845aSJiri Kosina 555dde5845aSJiri Kosina static int hid_parser_main(struct hid_parser *parser, struct hid_item *item) 556dde5845aSJiri Kosina { 557dde5845aSJiri Kosina __u32 data; 558dde5845aSJiri Kosina int ret; 559dde5845aSJiri Kosina 560dde5845aSJiri Kosina data = item_udata(item); 561dde5845aSJiri Kosina 562dde5845aSJiri Kosina switch (item->tag) { 563dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION: 564dde5845aSJiri Kosina ret = open_collection(parser, data & 0xff); 565dde5845aSJiri Kosina break; 566dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_END_COLLECTION: 567dde5845aSJiri Kosina ret = close_collection(parser); 568dde5845aSJiri Kosina break; 569dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_INPUT: 570dde5845aSJiri Kosina ret = hid_add_field(parser, HID_INPUT_REPORT, data); 571dde5845aSJiri Kosina break; 572dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_OUTPUT: 573dde5845aSJiri Kosina ret = hid_add_field(parser, HID_OUTPUT_REPORT, data); 574dde5845aSJiri Kosina break; 575dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_FEATURE: 576dde5845aSJiri Kosina ret = hid_add_field(parser, HID_FEATURE_REPORT, data); 577dde5845aSJiri Kosina break; 578dde5845aSJiri Kosina default: 5797cb4774eSHans de Goede hid_warn(parser->device, "unknown main item tag 0x%x\n", item->tag); 580dde5845aSJiri Kosina ret = 0; 581dde5845aSJiri Kosina } 582dde5845aSJiri Kosina 583dde5845aSJiri Kosina memset(&parser->local, 0, sizeof(parser->local)); /* Reset the local parser environment */ 584dde5845aSJiri Kosina 585dde5845aSJiri Kosina return ret; 586dde5845aSJiri Kosina } 587dde5845aSJiri Kosina 588dde5845aSJiri Kosina /* 589dde5845aSJiri Kosina * Process a reserved item. 590dde5845aSJiri Kosina */ 591dde5845aSJiri Kosina 592dde5845aSJiri Kosina static int hid_parser_reserved(struct hid_parser *parser, struct hid_item *item) 593dde5845aSJiri Kosina { 59458037eb9SJiri Kosina dbg_hid("reserved item type, tag 0x%x\n", item->tag); 595dde5845aSJiri Kosina return 0; 596dde5845aSJiri Kosina } 597dde5845aSJiri Kosina 598dde5845aSJiri Kosina /* 599dde5845aSJiri Kosina * Free a report and all registered fields. The field->usage and 600dde5845aSJiri Kosina * field->value table's are allocated behind the field, so we need 601dde5845aSJiri Kosina * only to free(field) itself. 602dde5845aSJiri Kosina */ 603dde5845aSJiri Kosina 604dde5845aSJiri Kosina static void hid_free_report(struct hid_report *report) 605dde5845aSJiri Kosina { 606dde5845aSJiri Kosina unsigned n; 607dde5845aSJiri Kosina 608dde5845aSJiri Kosina for (n = 0; n < report->maxfield; n++) 609dde5845aSJiri Kosina kfree(report->field[n]); 610dde5845aSJiri Kosina kfree(report); 611dde5845aSJiri Kosina } 612dde5845aSJiri Kosina 613dde5845aSJiri Kosina /* 614a7197c2eSHenrik Rydberg * Close report. This function returns the device 615a7197c2eSHenrik Rydberg * state to the point prior to hid_open_report(). 616dde5845aSJiri Kosina */ 617a7197c2eSHenrik Rydberg static void hid_close_report(struct hid_device *device) 618dde5845aSJiri Kosina { 619dde5845aSJiri Kosina unsigned i, j; 620dde5845aSJiri Kosina 621dde5845aSJiri Kosina for (i = 0; i < HID_REPORT_TYPES; i++) { 622dde5845aSJiri Kosina struct hid_report_enum *report_enum = device->report_enum + i; 623dde5845aSJiri Kosina 62443622021SKees Cook for (j = 0; j < HID_MAX_IDS; j++) { 625dde5845aSJiri Kosina struct hid_report *report = report_enum->report_id_hash[j]; 626dde5845aSJiri Kosina if (report) 627dde5845aSJiri Kosina hid_free_report(report); 628dde5845aSJiri Kosina } 629a7197c2eSHenrik Rydberg memset(report_enum, 0, sizeof(*report_enum)); 630a7197c2eSHenrik Rydberg INIT_LIST_HEAD(&report_enum->report_list); 631dde5845aSJiri Kosina } 632dde5845aSJiri Kosina 633dde5845aSJiri Kosina kfree(device->rdesc); 634a7197c2eSHenrik Rydberg device->rdesc = NULL; 635a7197c2eSHenrik Rydberg device->rsize = 0; 636a7197c2eSHenrik Rydberg 637767fe787SJiri Kosina kfree(device->collection); 638a7197c2eSHenrik Rydberg device->collection = NULL; 639a7197c2eSHenrik Rydberg device->collection_size = 0; 640a7197c2eSHenrik Rydberg device->maxcollection = 0; 641a7197c2eSHenrik Rydberg device->maxapplication = 0; 642a7197c2eSHenrik Rydberg 643a7197c2eSHenrik Rydberg device->status &= ~HID_STAT_PARSED; 644a7197c2eSHenrik Rydberg } 645a7197c2eSHenrik Rydberg 646a7197c2eSHenrik Rydberg /* 647a7197c2eSHenrik Rydberg * Free a device structure, all reports, and all fields. 648a7197c2eSHenrik Rydberg */ 649a7197c2eSHenrik Rydberg 650a7197c2eSHenrik Rydberg static void hid_device_release(struct device *dev) 651a7197c2eSHenrik Rydberg { 652ee79a8f8SGeliang Tang struct hid_device *hid = to_hid_device(dev); 653a7197c2eSHenrik Rydberg 654a7197c2eSHenrik Rydberg hid_close_report(hid); 655a7197c2eSHenrik Rydberg kfree(hid->dev_rdesc); 656a7197c2eSHenrik Rydberg kfree(hid); 657dde5845aSJiri Kosina } 658dde5845aSJiri Kosina 659dde5845aSJiri Kosina /* 660dde5845aSJiri Kosina * Fetch a report description item from the data stream. We support long 661dde5845aSJiri Kosina * items, though they are not used yet. 662dde5845aSJiri Kosina */ 663dde5845aSJiri Kosina 664dde5845aSJiri Kosina static u8 *fetch_item(__u8 *start, __u8 *end, struct hid_item *item) 665dde5845aSJiri Kosina { 666dde5845aSJiri Kosina u8 b; 667dde5845aSJiri Kosina 668dde5845aSJiri Kosina if ((end - start) <= 0) 669dde5845aSJiri Kosina return NULL; 670dde5845aSJiri Kosina 671dde5845aSJiri Kosina b = *start++; 672dde5845aSJiri Kosina 673dde5845aSJiri Kosina item->type = (b >> 2) & 3; 674dde5845aSJiri Kosina item->tag = (b >> 4) & 15; 675dde5845aSJiri Kosina 676dde5845aSJiri Kosina if (item->tag == HID_ITEM_TAG_LONG) { 677dde5845aSJiri Kosina 678dde5845aSJiri Kosina item->format = HID_ITEM_FORMAT_LONG; 679dde5845aSJiri Kosina 680dde5845aSJiri Kosina if ((end - start) < 2) 681dde5845aSJiri Kosina return NULL; 682dde5845aSJiri Kosina 683dde5845aSJiri Kosina item->size = *start++; 684dde5845aSJiri Kosina item->tag = *start++; 685dde5845aSJiri Kosina 686dde5845aSJiri Kosina if ((end - start) < item->size) 687dde5845aSJiri Kosina return NULL; 688dde5845aSJiri Kosina 689dde5845aSJiri Kosina item->data.longdata = start; 690dde5845aSJiri Kosina start += item->size; 691dde5845aSJiri Kosina return start; 692dde5845aSJiri Kosina } 693dde5845aSJiri Kosina 694dde5845aSJiri Kosina item->format = HID_ITEM_FORMAT_SHORT; 695dde5845aSJiri Kosina item->size = b & 3; 696dde5845aSJiri Kosina 697dde5845aSJiri Kosina switch (item->size) { 698dde5845aSJiri Kosina case 0: 699dde5845aSJiri Kosina return start; 700dde5845aSJiri Kosina 701dde5845aSJiri Kosina case 1: 702dde5845aSJiri Kosina if ((end - start) < 1) 703dde5845aSJiri Kosina return NULL; 704dde5845aSJiri Kosina item->data.u8 = *start++; 705dde5845aSJiri Kosina return start; 706dde5845aSJiri Kosina 707dde5845aSJiri Kosina case 2: 708dde5845aSJiri Kosina if ((end - start) < 2) 709dde5845aSJiri Kosina return NULL; 710c105068fSHarvey Harrison item->data.u16 = get_unaligned_le16(start); 711dde5845aSJiri Kosina start = (__u8 *)((__le16 *)start + 1); 712dde5845aSJiri Kosina return start; 713dde5845aSJiri Kosina 714dde5845aSJiri Kosina case 3: 715dde5845aSJiri Kosina item->size++; 716dde5845aSJiri Kosina if ((end - start) < 4) 717dde5845aSJiri Kosina return NULL; 718c105068fSHarvey Harrison item->data.u32 = get_unaligned_le32(start); 719dde5845aSJiri Kosina start = (__u8 *)((__le32 *)start + 1); 720dde5845aSJiri Kosina return start; 721dde5845aSJiri Kosina } 722dde5845aSJiri Kosina 723dde5845aSJiri Kosina return NULL; 724dde5845aSJiri Kosina } 725dde5845aSJiri Kosina 7263dc8fc08SBenjamin Tissoires static void hid_scan_input_usage(struct hid_parser *parser, u32 usage) 727734c6609SHenrik Rydberg { 7283dc8fc08SBenjamin Tissoires struct hid_device *hid = parser->device; 7293dc8fc08SBenjamin Tissoires 7304fa3a583SHenrik Rydberg if (usage == HID_DG_CONTACTID) 7314fa3a583SHenrik Rydberg hid->group = HID_GROUP_MULTITOUCH; 732734c6609SHenrik Rydberg } 733734c6609SHenrik Rydberg 734f961bd35SBenjamin Tissoires static void hid_scan_feature_usage(struct hid_parser *parser, u32 usage) 735f961bd35SBenjamin Tissoires { 736f961bd35SBenjamin Tissoires if (usage == 0xff0000c5 && parser->global.report_count == 256 && 737f961bd35SBenjamin Tissoires parser->global.report_size == 8) 738f961bd35SBenjamin Tissoires parser->scan_flags |= HID_SCAN_FLAG_MT_WIN_8; 739f961bd35SBenjamin Tissoires } 740f961bd35SBenjamin Tissoires 7413dc8fc08SBenjamin Tissoires static void hid_scan_collection(struct hid_parser *parser, unsigned type) 7423dc8fc08SBenjamin Tissoires { 7433dc8fc08SBenjamin Tissoires struct hid_device *hid = parser->device; 744e39f2d59SAndrew Duggan int i; 7453dc8fc08SBenjamin Tissoires 7463dc8fc08SBenjamin Tissoires if (((parser->global.usage_page << 16) == HID_UP_SENSOR) && 7473dc8fc08SBenjamin Tissoires type == HID_COLLECTION_PHYSICAL) 7483dc8fc08SBenjamin Tissoires hid->group = HID_GROUP_SENSOR_HUB; 749be3b1634SAlan Wu 750be3b1634SAlan Wu if (hid->vendor == USB_VENDOR_ID_MICROSOFT && 7510a76ac80SDennis Chen hid->product == USB_DEVICE_ID_MS_POWER_COVER && 752be3b1634SAlan Wu hid->group == HID_GROUP_MULTITOUCH) 753be3b1634SAlan Wu hid->group = HID_GROUP_GENERIC; 754e39f2d59SAndrew Duggan 755e39f2d59SAndrew Duggan if ((parser->global.usage_page << 16) == HID_UP_GENDESK) 756e39f2d59SAndrew Duggan for (i = 0; i < parser->local.usage_index; i++) 757e39f2d59SAndrew Duggan if (parser->local.usage[i] == HID_GD_POINTER) 758e39f2d59SAndrew Duggan parser->scan_flags |= HID_SCAN_FLAG_GD_POINTER; 759e39f2d59SAndrew Duggan 760e39f2d59SAndrew Duggan if ((parser->global.usage_page << 16) >= HID_UP_MSVENDOR) 761e39f2d59SAndrew Duggan parser->scan_flags |= HID_SCAN_FLAG_VENDOR_SPECIFIC; 7623dc8fc08SBenjamin Tissoires } 7633dc8fc08SBenjamin Tissoires 7643dc8fc08SBenjamin Tissoires static int hid_scan_main(struct hid_parser *parser, struct hid_item *item) 7653dc8fc08SBenjamin Tissoires { 7663dc8fc08SBenjamin Tissoires __u32 data; 7673dc8fc08SBenjamin Tissoires int i; 7683dc8fc08SBenjamin Tissoires 7693dc8fc08SBenjamin Tissoires data = item_udata(item); 7703dc8fc08SBenjamin Tissoires 7713dc8fc08SBenjamin Tissoires switch (item->tag) { 7723dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION: 7733dc8fc08SBenjamin Tissoires hid_scan_collection(parser, data & 0xff); 7743dc8fc08SBenjamin Tissoires break; 7753dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_END_COLLECTION: 7763dc8fc08SBenjamin Tissoires break; 7773dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_INPUT: 778e24d0d39SBenjamin Tissoires /* ignore constant inputs, they will be ignored by hid-input */ 779e24d0d39SBenjamin Tissoires if (data & HID_MAIN_ITEM_CONSTANT) 780e24d0d39SBenjamin Tissoires break; 7813dc8fc08SBenjamin Tissoires for (i = 0; i < parser->local.usage_index; i++) 7823dc8fc08SBenjamin Tissoires hid_scan_input_usage(parser, parser->local.usage[i]); 7833dc8fc08SBenjamin Tissoires break; 7843dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_OUTPUT: 7853dc8fc08SBenjamin Tissoires break; 7863dc8fc08SBenjamin Tissoires case HID_MAIN_ITEM_TAG_FEATURE: 787f961bd35SBenjamin Tissoires for (i = 0; i < parser->local.usage_index; i++) 788f961bd35SBenjamin Tissoires hid_scan_feature_usage(parser, parser->local.usage[i]); 7893dc8fc08SBenjamin Tissoires break; 7903dc8fc08SBenjamin Tissoires } 7913dc8fc08SBenjamin Tissoires 7923dc8fc08SBenjamin Tissoires /* Reset the local parser environment */ 7933dc8fc08SBenjamin Tissoires memset(&parser->local, 0, sizeof(parser->local)); 7943dc8fc08SBenjamin Tissoires 7953dc8fc08SBenjamin Tissoires return 0; 7963dc8fc08SBenjamin Tissoires } 7973dc8fc08SBenjamin Tissoires 798734c6609SHenrik Rydberg /* 799734c6609SHenrik Rydberg * Scan a report descriptor before the device is added to the bus. 800734c6609SHenrik Rydberg * Sets device groups and other properties that determine what driver 801734c6609SHenrik Rydberg * to load. 802734c6609SHenrik Rydberg */ 803734c6609SHenrik Rydberg static int hid_scan_report(struct hid_device *hid) 804734c6609SHenrik Rydberg { 8053dc8fc08SBenjamin Tissoires struct hid_parser *parser; 8063dc8fc08SBenjamin Tissoires struct hid_item item; 807734c6609SHenrik Rydberg __u8 *start = hid->dev_rdesc; 808734c6609SHenrik Rydberg __u8 *end = start + hid->dev_rsize; 8093dc8fc08SBenjamin Tissoires static int (*dispatch_type[])(struct hid_parser *parser, 8103dc8fc08SBenjamin Tissoires struct hid_item *item) = { 8113dc8fc08SBenjamin Tissoires hid_scan_main, 8123dc8fc08SBenjamin Tissoires hid_parser_global, 8133dc8fc08SBenjamin Tissoires hid_parser_local, 8143dc8fc08SBenjamin Tissoires hid_parser_reserved 8153dc8fc08SBenjamin Tissoires }; 816734c6609SHenrik Rydberg 8173dc8fc08SBenjamin Tissoires parser = vzalloc(sizeof(struct hid_parser)); 8183dc8fc08SBenjamin Tissoires if (!parser) 8193dc8fc08SBenjamin Tissoires return -ENOMEM; 8203dc8fc08SBenjamin Tissoires 8213dc8fc08SBenjamin Tissoires parser->device = hid; 822734c6609SHenrik Rydberg hid->group = HID_GROUP_GENERIC; 823734c6609SHenrik Rydberg 8243dc8fc08SBenjamin Tissoires /* 8253dc8fc08SBenjamin Tissoires * The parsing is simpler than the one in hid_open_report() as we should 8263dc8fc08SBenjamin Tissoires * be robust against hid errors. Those errors will be raised by 8273dc8fc08SBenjamin Tissoires * hid_open_report() anyway. 8283dc8fc08SBenjamin Tissoires */ 8293dc8fc08SBenjamin Tissoires while ((start = fetch_item(start, end, &item)) != NULL) 8303dc8fc08SBenjamin Tissoires dispatch_type[item.type](parser, &item); 8313dc8fc08SBenjamin Tissoires 832f961bd35SBenjamin Tissoires /* 833f961bd35SBenjamin Tissoires * Handle special flags set during scanning. 834f961bd35SBenjamin Tissoires */ 835f961bd35SBenjamin Tissoires if ((parser->scan_flags & HID_SCAN_FLAG_MT_WIN_8) && 836f961bd35SBenjamin Tissoires (hid->group == HID_GROUP_MULTITOUCH)) 837f961bd35SBenjamin Tissoires hid->group = HID_GROUP_MULTITOUCH_WIN_8; 838f961bd35SBenjamin Tissoires 839ba391e5aSBenjamin Tissoires /* 840ba391e5aSBenjamin Tissoires * Vendor specific handlings 841ba391e5aSBenjamin Tissoires */ 84229b47391SBenjamin Tissoires switch (hid->vendor) { 84329b47391SBenjamin Tissoires case USB_VENDOR_ID_WACOM: 84429b47391SBenjamin Tissoires hid->group = HID_GROUP_WACOM; 84529b47391SBenjamin Tissoires break; 846c241c5eeSBenjamin Tissoires case USB_VENDOR_ID_SYNAPTICS: 84784379d83SJiri Kosina if (hid->group == HID_GROUP_GENERIC) 848e39f2d59SAndrew Duggan if ((parser->scan_flags & HID_SCAN_FLAG_VENDOR_SPECIFIC) 849e39f2d59SAndrew Duggan && (parser->scan_flags & HID_SCAN_FLAG_GD_POINTER)) 850e39f2d59SAndrew Duggan /* 851e39f2d59SAndrew Duggan * hid-rmi should take care of them, 852e39f2d59SAndrew Duggan * not hid-generic 853e39f2d59SAndrew Duggan */ 854c241c5eeSBenjamin Tissoires hid->group = HID_GROUP_RMI; 855c241c5eeSBenjamin Tissoires break; 85629b47391SBenjamin Tissoires } 85729b47391SBenjamin Tissoires 85808a8a7cfSBenjamin Tissoires kfree(parser->collection_stack); 8593dc8fc08SBenjamin Tissoires vfree(parser); 860734c6609SHenrik Rydberg return 0; 861734c6609SHenrik Rydberg } 862734c6609SHenrik Rydberg 86385cdaf52SJiri Slaby /** 86485cdaf52SJiri Slaby * hid_parse_report - parse device report 86585cdaf52SJiri Slaby * 86685cdaf52SJiri Slaby * @device: hid device 86785cdaf52SJiri Slaby * @start: report start 86885cdaf52SJiri Slaby * @size: report size 86985cdaf52SJiri Slaby * 870a7197c2eSHenrik Rydberg * Allocate the device report as read by the bus driver. This function should 871a7197c2eSHenrik Rydberg * only be called from parse() in ll drivers. 872a7197c2eSHenrik Rydberg */ 873a7197c2eSHenrik Rydberg int hid_parse_report(struct hid_device *hid, __u8 *start, unsigned size) 874a7197c2eSHenrik Rydberg { 875a7197c2eSHenrik Rydberg hid->dev_rdesc = kmemdup(start, size, GFP_KERNEL); 876a7197c2eSHenrik Rydberg if (!hid->dev_rdesc) 877a7197c2eSHenrik Rydberg return -ENOMEM; 878a7197c2eSHenrik Rydberg hid->dev_rsize = size; 879a7197c2eSHenrik Rydberg return 0; 880a7197c2eSHenrik Rydberg } 881a7197c2eSHenrik Rydberg EXPORT_SYMBOL_GPL(hid_parse_report); 882a7197c2eSHenrik Rydberg 883331415ffSKees Cook static const char * const hid_report_names[] = { 884331415ffSKees Cook "HID_INPUT_REPORT", 885331415ffSKees Cook "HID_OUTPUT_REPORT", 886331415ffSKees Cook "HID_FEATURE_REPORT", 887331415ffSKees Cook }; 888331415ffSKees Cook /** 889331415ffSKees Cook * hid_validate_values - validate existing device report's value indexes 890331415ffSKees Cook * 891331415ffSKees Cook * @device: hid device 892331415ffSKees Cook * @type: which report type to examine 893331415ffSKees Cook * @id: which report ID to examine (0 for first) 894331415ffSKees Cook * @field_index: which report field to examine 895331415ffSKees Cook * @report_counts: expected number of values 896331415ffSKees Cook * 897331415ffSKees Cook * Validate the number of values in a given field of a given report, after 898331415ffSKees Cook * parsing. 899331415ffSKees Cook */ 900331415ffSKees Cook struct hid_report *hid_validate_values(struct hid_device *hid, 901331415ffSKees Cook unsigned int type, unsigned int id, 902331415ffSKees Cook unsigned int field_index, 903331415ffSKees Cook unsigned int report_counts) 904331415ffSKees Cook { 905331415ffSKees Cook struct hid_report *report; 906331415ffSKees Cook 907331415ffSKees Cook if (type > HID_FEATURE_REPORT) { 908331415ffSKees Cook hid_err(hid, "invalid HID report type %u\n", type); 909331415ffSKees Cook return NULL; 910331415ffSKees Cook } 911331415ffSKees Cook 912331415ffSKees Cook if (id >= HID_MAX_IDS) { 913331415ffSKees Cook hid_err(hid, "invalid HID report id %u\n", id); 914331415ffSKees Cook return NULL; 915331415ffSKees Cook } 916331415ffSKees Cook 917331415ffSKees Cook /* 918331415ffSKees Cook * Explicitly not using hid_get_report() here since it depends on 919331415ffSKees Cook * ->numbered being checked, which may not always be the case when 920331415ffSKees Cook * drivers go to access report values. 921331415ffSKees Cook */ 9221b15d2e5SKees Cook if (id == 0) { 9231b15d2e5SKees Cook /* 9241b15d2e5SKees Cook * Validating on id 0 means we should examine the first 9251b15d2e5SKees Cook * report in the list. 9261b15d2e5SKees Cook */ 9271b15d2e5SKees Cook report = list_entry( 9281b15d2e5SKees Cook hid->report_enum[type].report_list.next, 9291b15d2e5SKees Cook struct hid_report, list); 9301b15d2e5SKees Cook } else { 931331415ffSKees Cook report = hid->report_enum[type].report_id_hash[id]; 9321b15d2e5SKees Cook } 933331415ffSKees Cook if (!report) { 934331415ffSKees Cook hid_err(hid, "missing %s %u\n", hid_report_names[type], id); 935331415ffSKees Cook return NULL; 936331415ffSKees Cook } 937331415ffSKees Cook if (report->maxfield <= field_index) { 938331415ffSKees Cook hid_err(hid, "not enough fields in %s %u\n", 939331415ffSKees Cook hid_report_names[type], id); 940331415ffSKees Cook return NULL; 941331415ffSKees Cook } 942331415ffSKees Cook if (report->field[field_index]->report_count < report_counts) { 943331415ffSKees Cook hid_err(hid, "not enough values in %s %u field %u\n", 944331415ffSKees Cook hid_report_names[type], id, field_index); 945331415ffSKees Cook return NULL; 946331415ffSKees Cook } 947331415ffSKees Cook return report; 948331415ffSKees Cook } 949331415ffSKees Cook EXPORT_SYMBOL_GPL(hid_validate_values); 950331415ffSKees Cook 951*5a4abb36SPeter Hutterer static int hid_calculate_multiplier(struct hid_device *hid, 952*5a4abb36SPeter Hutterer struct hid_field *multiplier) 953*5a4abb36SPeter Hutterer { 954*5a4abb36SPeter Hutterer int m; 955*5a4abb36SPeter Hutterer __s32 v = *multiplier->value; 956*5a4abb36SPeter Hutterer __s32 lmin = multiplier->logical_minimum; 957*5a4abb36SPeter Hutterer __s32 lmax = multiplier->logical_maximum; 958*5a4abb36SPeter Hutterer __s32 pmin = multiplier->physical_minimum; 959*5a4abb36SPeter Hutterer __s32 pmax = multiplier->physical_maximum; 960*5a4abb36SPeter Hutterer 961*5a4abb36SPeter Hutterer /* 962*5a4abb36SPeter Hutterer * "Because OS implementations will generally divide the control's 963*5a4abb36SPeter Hutterer * reported count by the Effective Resolution Multiplier, designers 964*5a4abb36SPeter Hutterer * should take care not to establish a potential Effective 965*5a4abb36SPeter Hutterer * Resolution Multiplier of zero." 966*5a4abb36SPeter Hutterer * HID Usage Table, v1.12, Section 4.3.1, p31 967*5a4abb36SPeter Hutterer */ 968*5a4abb36SPeter Hutterer if (lmax - lmin == 0) 969*5a4abb36SPeter Hutterer return 1; 970*5a4abb36SPeter Hutterer /* 971*5a4abb36SPeter Hutterer * Handling the unit exponent is left as an exercise to whoever 972*5a4abb36SPeter Hutterer * finds a device where that exponent is not 0. 973*5a4abb36SPeter Hutterer */ 974*5a4abb36SPeter Hutterer m = ((v - lmin)/(lmax - lmin) * (pmax - pmin) + pmin); 975*5a4abb36SPeter Hutterer if (unlikely(multiplier->unit_exponent != 0)) { 976*5a4abb36SPeter Hutterer hid_warn(hid, 977*5a4abb36SPeter Hutterer "unsupported Resolution Multiplier unit exponent %d\n", 978*5a4abb36SPeter Hutterer multiplier->unit_exponent); 979*5a4abb36SPeter Hutterer } 980*5a4abb36SPeter Hutterer 981*5a4abb36SPeter Hutterer /* There are no devices with an effective multiplier > 255 */ 982*5a4abb36SPeter Hutterer if (unlikely(m == 0 || m > 255 || m < -255)) { 983*5a4abb36SPeter Hutterer hid_warn(hid, "unsupported Resolution Multiplier %d\n", m); 984*5a4abb36SPeter Hutterer m = 1; 985*5a4abb36SPeter Hutterer } 986*5a4abb36SPeter Hutterer 987*5a4abb36SPeter Hutterer return m; 988*5a4abb36SPeter Hutterer } 989*5a4abb36SPeter Hutterer 990*5a4abb36SPeter Hutterer static void hid_apply_multiplier_to_field(struct hid_device *hid, 991*5a4abb36SPeter Hutterer struct hid_field *field, 992*5a4abb36SPeter Hutterer struct hid_collection *multiplier_collection, 993*5a4abb36SPeter Hutterer int effective_multiplier) 994*5a4abb36SPeter Hutterer { 995*5a4abb36SPeter Hutterer struct hid_collection *collection; 996*5a4abb36SPeter Hutterer struct hid_usage *usage; 997*5a4abb36SPeter Hutterer int i; 998*5a4abb36SPeter Hutterer 999*5a4abb36SPeter Hutterer /* 1000*5a4abb36SPeter Hutterer * If multiplier_collection is NULL, the multiplier applies 1001*5a4abb36SPeter Hutterer * to all fields in the report. 1002*5a4abb36SPeter Hutterer * Otherwise, it is the Logical Collection the multiplier applies to 1003*5a4abb36SPeter Hutterer * but our field may be in a subcollection of that collection. 1004*5a4abb36SPeter Hutterer */ 1005*5a4abb36SPeter Hutterer for (i = 0; i < field->maxusage; i++) { 1006*5a4abb36SPeter Hutterer usage = &field->usage[i]; 1007*5a4abb36SPeter Hutterer 1008*5a4abb36SPeter Hutterer collection = &hid->collection[usage->collection_index]; 1009*5a4abb36SPeter Hutterer while (collection && collection != multiplier_collection) 1010*5a4abb36SPeter Hutterer collection = collection->parent; 1011*5a4abb36SPeter Hutterer 1012*5a4abb36SPeter Hutterer if (collection || multiplier_collection == NULL) 1013*5a4abb36SPeter Hutterer usage->resolution_multiplier = effective_multiplier; 1014*5a4abb36SPeter Hutterer 1015*5a4abb36SPeter Hutterer } 1016*5a4abb36SPeter Hutterer } 1017*5a4abb36SPeter Hutterer 1018*5a4abb36SPeter Hutterer static void hid_apply_multiplier(struct hid_device *hid, 1019*5a4abb36SPeter Hutterer struct hid_field *multiplier) 1020*5a4abb36SPeter Hutterer { 1021*5a4abb36SPeter Hutterer struct hid_report_enum *rep_enum; 1022*5a4abb36SPeter Hutterer struct hid_report *rep; 1023*5a4abb36SPeter Hutterer struct hid_field *field; 1024*5a4abb36SPeter Hutterer struct hid_collection *multiplier_collection; 1025*5a4abb36SPeter Hutterer int effective_multiplier; 1026*5a4abb36SPeter Hutterer int i; 1027*5a4abb36SPeter Hutterer 1028*5a4abb36SPeter Hutterer /* 1029*5a4abb36SPeter Hutterer * "The Resolution Multiplier control must be contained in the same 1030*5a4abb36SPeter Hutterer * Logical Collection as the control(s) to which it is to be applied. 1031*5a4abb36SPeter Hutterer * If no Resolution Multiplier is defined, then the Resolution 1032*5a4abb36SPeter Hutterer * Multiplier defaults to 1. If more than one control exists in a 1033*5a4abb36SPeter Hutterer * Logical Collection, the Resolution Multiplier is associated with 1034*5a4abb36SPeter Hutterer * all controls in the collection. If no Logical Collection is 1035*5a4abb36SPeter Hutterer * defined, the Resolution Multiplier is associated with all 1036*5a4abb36SPeter Hutterer * controls in the report." 1037*5a4abb36SPeter Hutterer * HID Usage Table, v1.12, Section 4.3.1, p30 1038*5a4abb36SPeter Hutterer * 1039*5a4abb36SPeter Hutterer * Thus, search from the current collection upwards until we find a 1040*5a4abb36SPeter Hutterer * logical collection. Then search all fields for that same parent 1041*5a4abb36SPeter Hutterer * collection. Those are the fields the multiplier applies to. 1042*5a4abb36SPeter Hutterer * 1043*5a4abb36SPeter Hutterer * If we have more than one multiplier, it will overwrite the 1044*5a4abb36SPeter Hutterer * applicable fields later. 1045*5a4abb36SPeter Hutterer */ 1046*5a4abb36SPeter Hutterer multiplier_collection = &hid->collection[multiplier->usage->collection_index]; 1047*5a4abb36SPeter Hutterer while (multiplier_collection && 1048*5a4abb36SPeter Hutterer multiplier_collection->type != HID_COLLECTION_LOGICAL) 1049*5a4abb36SPeter Hutterer multiplier_collection = multiplier_collection->parent; 1050*5a4abb36SPeter Hutterer 1051*5a4abb36SPeter Hutterer effective_multiplier = hid_calculate_multiplier(hid, multiplier); 1052*5a4abb36SPeter Hutterer 1053*5a4abb36SPeter Hutterer rep_enum = &hid->report_enum[HID_INPUT_REPORT]; 1054*5a4abb36SPeter Hutterer list_for_each_entry(rep, &rep_enum->report_list, list) { 1055*5a4abb36SPeter Hutterer for (i = 0; i < rep->maxfield; i++) { 1056*5a4abb36SPeter Hutterer field = rep->field[i]; 1057*5a4abb36SPeter Hutterer hid_apply_multiplier_to_field(hid, field, 1058*5a4abb36SPeter Hutterer multiplier_collection, 1059*5a4abb36SPeter Hutterer effective_multiplier); 1060*5a4abb36SPeter Hutterer } 1061*5a4abb36SPeter Hutterer } 1062*5a4abb36SPeter Hutterer } 1063*5a4abb36SPeter Hutterer 1064*5a4abb36SPeter Hutterer /* 1065*5a4abb36SPeter Hutterer * hid_setup_resolution_multiplier - set up all resolution multipliers 1066*5a4abb36SPeter Hutterer * 1067*5a4abb36SPeter Hutterer * @device: hid device 1068*5a4abb36SPeter Hutterer * 1069*5a4abb36SPeter Hutterer * Search for all Resolution Multiplier Feature Reports and apply their 1070*5a4abb36SPeter Hutterer * value to all matching Input items. This only updates the internal struct 1071*5a4abb36SPeter Hutterer * fields. 1072*5a4abb36SPeter Hutterer * 1073*5a4abb36SPeter Hutterer * The Resolution Multiplier is applied by the hardware. If the multiplier 1074*5a4abb36SPeter Hutterer * is anything other than 1, the hardware will send pre-multiplied events 1075*5a4abb36SPeter Hutterer * so that the same physical interaction generates an accumulated 1076*5a4abb36SPeter Hutterer * accumulated_value = value * * multiplier 1077*5a4abb36SPeter Hutterer * This may be achieved by sending 1078*5a4abb36SPeter Hutterer * - "value * multiplier" for each event, or 1079*5a4abb36SPeter Hutterer * - "value" but "multiplier" times as frequently, or 1080*5a4abb36SPeter Hutterer * - a combination of the above 1081*5a4abb36SPeter Hutterer * The only guarantee is that the same physical interaction always generates 1082*5a4abb36SPeter Hutterer * an accumulated 'value * multiplier'. 1083*5a4abb36SPeter Hutterer * 1084*5a4abb36SPeter Hutterer * This function must be called before any event processing and after 1085*5a4abb36SPeter Hutterer * any SetRequest to the Resolution Multiplier. 1086*5a4abb36SPeter Hutterer */ 1087*5a4abb36SPeter Hutterer void hid_setup_resolution_multiplier(struct hid_device *hid) 1088*5a4abb36SPeter Hutterer { 1089*5a4abb36SPeter Hutterer struct hid_report_enum *rep_enum; 1090*5a4abb36SPeter Hutterer struct hid_report *rep; 1091*5a4abb36SPeter Hutterer struct hid_usage *usage; 1092*5a4abb36SPeter Hutterer int i, j; 1093*5a4abb36SPeter Hutterer 1094*5a4abb36SPeter Hutterer rep_enum = &hid->report_enum[HID_FEATURE_REPORT]; 1095*5a4abb36SPeter Hutterer list_for_each_entry(rep, &rep_enum->report_list, list) { 1096*5a4abb36SPeter Hutterer for (i = 0; i < rep->maxfield; i++) { 1097*5a4abb36SPeter Hutterer /* Ignore if report count is out of bounds. */ 1098*5a4abb36SPeter Hutterer if (rep->field[i]->report_count < 1) 1099*5a4abb36SPeter Hutterer continue; 1100*5a4abb36SPeter Hutterer 1101*5a4abb36SPeter Hutterer for (j = 0; j < rep->field[i]->maxusage; j++) { 1102*5a4abb36SPeter Hutterer usage = &rep->field[i]->usage[j]; 1103*5a4abb36SPeter Hutterer if (usage->hid == HID_GD_RESOLUTION_MULTIPLIER) 1104*5a4abb36SPeter Hutterer hid_apply_multiplier(hid, 1105*5a4abb36SPeter Hutterer rep->field[i]); 1106*5a4abb36SPeter Hutterer } 1107*5a4abb36SPeter Hutterer } 1108*5a4abb36SPeter Hutterer } 1109*5a4abb36SPeter Hutterer } 1110*5a4abb36SPeter Hutterer EXPORT_SYMBOL_GPL(hid_setup_resolution_multiplier); 1111*5a4abb36SPeter Hutterer 1112a7197c2eSHenrik Rydberg /** 1113a7197c2eSHenrik Rydberg * hid_open_report - open a driver-specific device report 1114a7197c2eSHenrik Rydberg * 1115a7197c2eSHenrik Rydberg * @device: hid device 1116a7197c2eSHenrik Rydberg * 1117dde5845aSJiri Kosina * Parse a report description into a hid_device structure. Reports are 1118dde5845aSJiri Kosina * enumerated, fields are attached to these reports. 111985cdaf52SJiri Slaby * 0 returned on success, otherwise nonzero error value. 1120a7197c2eSHenrik Rydberg * 1121a7197c2eSHenrik Rydberg * This function (or the equivalent hid_parse() macro) should only be 1122a7197c2eSHenrik Rydberg * called from probe() in drivers, before starting the device. 1123dde5845aSJiri Kosina */ 1124a7197c2eSHenrik Rydberg int hid_open_report(struct hid_device *device) 1125dde5845aSJiri Kosina { 1126dde5845aSJiri Kosina struct hid_parser *parser; 1127dde5845aSJiri Kosina struct hid_item item; 1128a7197c2eSHenrik Rydberg unsigned int size; 1129a7197c2eSHenrik Rydberg __u8 *start; 113086e6b77eSKevin Daughtridge __u8 *buf; 1131dde5845aSJiri Kosina __u8 *end; 113285cdaf52SJiri Slaby int ret; 1133dde5845aSJiri Kosina static int (*dispatch_type[])(struct hid_parser *parser, 1134dde5845aSJiri Kosina struct hid_item *item) = { 1135dde5845aSJiri Kosina hid_parser_main, 1136dde5845aSJiri Kosina hid_parser_global, 1137dde5845aSJiri Kosina hid_parser_local, 1138dde5845aSJiri Kosina hid_parser_reserved 1139dde5845aSJiri Kosina }; 1140dde5845aSJiri Kosina 1141a7197c2eSHenrik Rydberg if (WARN_ON(device->status & HID_STAT_PARSED)) 1142a7197c2eSHenrik Rydberg return -EBUSY; 1143a7197c2eSHenrik Rydberg 1144a7197c2eSHenrik Rydberg start = device->dev_rdesc; 1145a7197c2eSHenrik Rydberg if (WARN_ON(!start)) 1146a7197c2eSHenrik Rydberg return -ENODEV; 1147a7197c2eSHenrik Rydberg size = device->dev_rsize; 1148a7197c2eSHenrik Rydberg 114986e6b77eSKevin Daughtridge buf = kmemdup(start, size, GFP_KERNEL); 115086e6b77eSKevin Daughtridge if (buf == NULL) 115185cdaf52SJiri Slaby return -ENOMEM; 115286e6b77eSKevin Daughtridge 115386e6b77eSKevin Daughtridge if (device->driver->report_fixup) 115486e6b77eSKevin Daughtridge start = device->driver->report_fixup(device, buf, &size); 115586e6b77eSKevin Daughtridge else 115686e6b77eSKevin Daughtridge start = buf; 115786e6b77eSKevin Daughtridge 115886e6b77eSKevin Daughtridge start = kmemdup(start, size, GFP_KERNEL); 115986e6b77eSKevin Daughtridge kfree(buf); 116086e6b77eSKevin Daughtridge if (start == NULL) 116186e6b77eSKevin Daughtridge return -ENOMEM; 116286e6b77eSKevin Daughtridge 116386e6b77eSKevin Daughtridge device->rdesc = start; 1164dde5845aSJiri Kosina device->rsize = size; 1165dde5845aSJiri Kosina 1166fe258020SJoe Perches parser = vzalloc(sizeof(struct hid_parser)); 116785cdaf52SJiri Slaby if (!parser) { 116885cdaf52SJiri Slaby ret = -ENOMEM; 1169b034ed50SGustavo A. R. Silva goto alloc_err; 1170dde5845aSJiri Kosina } 117185cdaf52SJiri Slaby 1172dde5845aSJiri Kosina parser->device = device; 1173dde5845aSJiri Kosina 1174dde5845aSJiri Kosina end = start + size; 1175a7197c2eSHenrik Rydberg 1176a7197c2eSHenrik Rydberg device->collection = kcalloc(HID_DEFAULT_NUM_COLLECTIONS, 1177a7197c2eSHenrik Rydberg sizeof(struct hid_collection), GFP_KERNEL); 1178a7197c2eSHenrik Rydberg if (!device->collection) { 1179a7197c2eSHenrik Rydberg ret = -ENOMEM; 1180a7197c2eSHenrik Rydberg goto err; 1181a7197c2eSHenrik Rydberg } 1182a7197c2eSHenrik Rydberg device->collection_size = HID_DEFAULT_NUM_COLLECTIONS; 1183a7197c2eSHenrik Rydberg 118485cdaf52SJiri Slaby ret = -EINVAL; 1185dde5845aSJiri Kosina while ((start = fetch_item(start, end, &item)) != NULL) { 1186dde5845aSJiri Kosina 1187dde5845aSJiri Kosina if (item.format != HID_ITEM_FORMAT_SHORT) { 11888c3d52fcSJiri Kosina hid_err(device, "unexpected long global item\n"); 118985cdaf52SJiri Slaby goto err; 1190dde5845aSJiri Kosina } 1191dde5845aSJiri Kosina 1192dde5845aSJiri Kosina if (dispatch_type[item.type](parser, &item)) { 11938c3d52fcSJiri Kosina hid_err(device, "item %u %u %u %u parsing failed\n", 11944291ee30SJoe Perches item.format, (unsigned)item.size, 11954291ee30SJoe Perches (unsigned)item.type, (unsigned)item.tag); 119685cdaf52SJiri Slaby goto err; 1197dde5845aSJiri Kosina } 1198dde5845aSJiri Kosina 1199dde5845aSJiri Kosina if (start == end) { 1200dde5845aSJiri Kosina if (parser->collection_stack_ptr) { 12018c3d52fcSJiri Kosina hid_err(device, "unbalanced collection at end of report description\n"); 120285cdaf52SJiri Slaby goto err; 1203dde5845aSJiri Kosina } 1204dde5845aSJiri Kosina if (parser->local.delimiter_depth) { 12058c3d52fcSJiri Kosina hid_err(device, "unbalanced delimiter at end of report description\n"); 120685cdaf52SJiri Slaby goto err; 1207dde5845aSJiri Kosina } 1208*5a4abb36SPeter Hutterer 1209*5a4abb36SPeter Hutterer /* 1210*5a4abb36SPeter Hutterer * fetch initial values in case the device's 1211*5a4abb36SPeter Hutterer * default multiplier isn't the recommended 1 1212*5a4abb36SPeter Hutterer */ 1213*5a4abb36SPeter Hutterer hid_setup_resolution_multiplier(device); 1214*5a4abb36SPeter Hutterer 1215b2dd9f2eSStefan Agner kfree(parser->collection_stack); 121647a80edbSJiri Kosina vfree(parser); 1217a7197c2eSHenrik Rydberg device->status |= HID_STAT_PARSED; 1218*5a4abb36SPeter Hutterer 121985cdaf52SJiri Slaby return 0; 1220dde5845aSJiri Kosina } 1221dde5845aSJiri Kosina } 1222dde5845aSJiri Kosina 12238c3d52fcSJiri Kosina hid_err(device, "item fetching failed at offset %d\n", (int)(end - start)); 122485cdaf52SJiri Slaby err: 1225b2dd9f2eSStefan Agner kfree(parser->collection_stack); 1226b034ed50SGustavo A. R. Silva alloc_err: 122747a80edbSJiri Kosina vfree(parser); 1228a7197c2eSHenrik Rydberg hid_close_report(device); 122985cdaf52SJiri Slaby return ret; 1230dde5845aSJiri Kosina } 1231a7197c2eSHenrik Rydberg EXPORT_SYMBOL_GPL(hid_open_report); 1232dde5845aSJiri Kosina 1233dde5845aSJiri Kosina /* 1234dde5845aSJiri Kosina * Convert a signed n-bit integer to signed 32-bit integer. Common 1235dde5845aSJiri Kosina * cases are done through the compiler, the screwed things has to be 1236dde5845aSJiri Kosina * done by hand. 1237dde5845aSJiri Kosina */ 1238dde5845aSJiri Kosina 1239dde5845aSJiri Kosina static s32 snto32(__u32 value, unsigned n) 1240dde5845aSJiri Kosina { 1241dde5845aSJiri Kosina switch (n) { 1242dde5845aSJiri Kosina case 8: return ((__s8)value); 1243dde5845aSJiri Kosina case 16: return ((__s16)value); 1244dde5845aSJiri Kosina case 32: return ((__s32)value); 1245dde5845aSJiri Kosina } 124608585e43SAndy Shevchenko return value & (1 << (n - 1)) ? value | (~0U << n) : value; 1247dde5845aSJiri Kosina } 1248dde5845aSJiri Kosina 124977463838SBenjamin Tissoires s32 hid_snto32(__u32 value, unsigned n) 125077463838SBenjamin Tissoires { 125177463838SBenjamin Tissoires return snto32(value, n); 125277463838SBenjamin Tissoires } 125377463838SBenjamin Tissoires EXPORT_SYMBOL_GPL(hid_snto32); 125477463838SBenjamin Tissoires 1255dde5845aSJiri Kosina /* 1256dde5845aSJiri Kosina * Convert a signed 32-bit integer to a signed n-bit integer. 1257dde5845aSJiri Kosina */ 1258dde5845aSJiri Kosina 1259dde5845aSJiri Kosina static u32 s32ton(__s32 value, unsigned n) 1260dde5845aSJiri Kosina { 1261dde5845aSJiri Kosina s32 a = value >> (n - 1); 1262dde5845aSJiri Kosina if (a && a != -1) 1263dde5845aSJiri Kosina return value < 0 ? 1 << (n - 1) : (1 << (n - 1)) - 1; 1264dde5845aSJiri Kosina return value & ((1 << n) - 1); 1265dde5845aSJiri Kosina } 1266dde5845aSJiri Kosina 1267dde5845aSJiri Kosina /* 1268dde5845aSJiri Kosina * Extract/implement a data field from/to a little endian report (bit array). 1269dde5845aSJiri Kosina * 1270dde5845aSJiri Kosina * Code sort-of follows HID spec: 12715137b354SDmitry Torokhov * http://www.usb.org/developers/hidpage/HID1_11.pdf 1272dde5845aSJiri Kosina * 1273dde5845aSJiri Kosina * While the USB HID spec allows unlimited length bit fields in "report 1274dde5845aSJiri Kosina * descriptors", most devices never use more than 16 bits. 1275dde5845aSJiri Kosina * One model of UPS is claimed to report "LINEV" as a 32-bit field. 1276dde5845aSJiri Kosina * Search linux-kernel and linux-usb-devel archives for "hid-core extract". 1277dde5845aSJiri Kosina */ 1278dde5845aSJiri Kosina 12795137b354SDmitry Torokhov static u32 __extract(u8 *report, unsigned offset, int n) 12805137b354SDmitry Torokhov { 12815137b354SDmitry Torokhov unsigned int idx = offset / 8; 12825137b354SDmitry Torokhov unsigned int bit_nr = 0; 12835137b354SDmitry Torokhov unsigned int bit_shift = offset % 8; 12845137b354SDmitry Torokhov int bits_to_copy = 8 - bit_shift; 12855137b354SDmitry Torokhov u32 value = 0; 12865137b354SDmitry Torokhov u32 mask = n < 32 ? (1U << n) - 1 : ~0U; 12875137b354SDmitry Torokhov 12885137b354SDmitry Torokhov while (n > 0) { 12895137b354SDmitry Torokhov value |= ((u32)report[idx] >> bit_shift) << bit_nr; 12905137b354SDmitry Torokhov n -= bits_to_copy; 12915137b354SDmitry Torokhov bit_nr += bits_to_copy; 12925137b354SDmitry Torokhov bits_to_copy = 8; 12935137b354SDmitry Torokhov bit_shift = 0; 12945137b354SDmitry Torokhov idx++; 12955137b354SDmitry Torokhov } 12965137b354SDmitry Torokhov 12975137b354SDmitry Torokhov return value & mask; 12985137b354SDmitry Torokhov } 12995137b354SDmitry Torokhov 13005137b354SDmitry Torokhov u32 hid_field_extract(const struct hid_device *hid, u8 *report, 13014291ee30SJoe Perches unsigned offset, unsigned n) 1302dde5845aSJiri Kosina { 13035137b354SDmitry Torokhov if (n > 32) { 130404fba786SGoffredo Baroncelli hid_warn(hid, "hid_field_extract() called with n (%d) > 32! (%s)\n", 1305c4124c9bSJiri Kosina n, current->comm); 13065137b354SDmitry Torokhov n = 32; 13075137b354SDmitry Torokhov } 1308dde5845aSJiri Kosina 13095137b354SDmitry Torokhov return __extract(report, offset, n); 1310dde5845aSJiri Kosina } 131104fba786SGoffredo Baroncelli EXPORT_SYMBOL_GPL(hid_field_extract); 1312dde5845aSJiri Kosina 1313dde5845aSJiri Kosina /* 1314dde5845aSJiri Kosina * "implement" : set bits in a little endian bit stream. 1315dde5845aSJiri Kosina * Same concepts as "extract" (see comments above). 1316dde5845aSJiri Kosina * The data mangled in the bit stream remains in little endian 1317dde5845aSJiri Kosina * order the whole time. It make more sense to talk about 1318dde5845aSJiri Kosina * endianness of register values by considering a register 13195137b354SDmitry Torokhov * a "cached" copy of the little endian bit stream. 1320dde5845aSJiri Kosina */ 1321dde5845aSJiri Kosina 13225137b354SDmitry Torokhov static void __implement(u8 *report, unsigned offset, int n, u32 value) 13235137b354SDmitry Torokhov { 13245137b354SDmitry Torokhov unsigned int idx = offset / 8; 13255137b354SDmitry Torokhov unsigned int bit_shift = offset % 8; 13265137b354SDmitry Torokhov int bits_to_set = 8 - bit_shift; 13275137b354SDmitry Torokhov 13285137b354SDmitry Torokhov while (n - bits_to_set >= 0) { 132995d1c895SDmitry Torokhov report[idx] &= ~(0xff << bit_shift); 13305137b354SDmitry Torokhov report[idx] |= value << bit_shift; 13315137b354SDmitry Torokhov value >>= bits_to_set; 13325137b354SDmitry Torokhov n -= bits_to_set; 13335137b354SDmitry Torokhov bits_to_set = 8; 13345137b354SDmitry Torokhov bit_shift = 0; 13355137b354SDmitry Torokhov idx++; 13365137b354SDmitry Torokhov } 13375137b354SDmitry Torokhov 13385137b354SDmitry Torokhov /* last nibble */ 13395137b354SDmitry Torokhov if (n) { 134095d1c895SDmitry Torokhov u8 bit_mask = ((1U << n) - 1); 134195d1c895SDmitry Torokhov report[idx] &= ~(bit_mask << bit_shift); 134295d1c895SDmitry Torokhov report[idx] |= value << bit_shift; 13435137b354SDmitry Torokhov } 13445137b354SDmitry Torokhov } 13455137b354SDmitry Torokhov 13465137b354SDmitry Torokhov static void implement(const struct hid_device *hid, u8 *report, 13475137b354SDmitry Torokhov unsigned offset, unsigned n, u32 value) 13485137b354SDmitry Torokhov { 134995d1c895SDmitry Torokhov if (unlikely(n > 32)) { 13504291ee30SJoe Perches hid_warn(hid, "%s() called with n (%d) > 32! (%s)\n", 13514291ee30SJoe Perches __func__, n, current->comm); 13525137b354SDmitry Torokhov n = 32; 135395d1c895SDmitry Torokhov } else if (n < 32) { 135495d1c895SDmitry Torokhov u32 m = (1U << n) - 1; 1355dde5845aSJiri Kosina 135695d1c895SDmitry Torokhov if (unlikely(value > m)) { 135795d1c895SDmitry Torokhov hid_warn(hid, 135895d1c895SDmitry Torokhov "%s() called with too large value %d (n: %d)! (%s)\n", 135995d1c895SDmitry Torokhov __func__, value, n, current->comm); 136095d1c895SDmitry Torokhov WARN_ON(1); 1361dde5845aSJiri Kosina value &= m; 136295d1c895SDmitry Torokhov } 136395d1c895SDmitry Torokhov } 1364dde5845aSJiri Kosina 13655137b354SDmitry Torokhov __implement(report, offset, n, value); 1366dde5845aSJiri Kosina } 1367dde5845aSJiri Kosina 1368dde5845aSJiri Kosina /* 1369dde5845aSJiri Kosina * Search an array for a value. 1370dde5845aSJiri Kosina */ 1371dde5845aSJiri Kosina 137216ee4cc8SJoe Perches static int search(__s32 *array, __s32 value, unsigned n) 1373dde5845aSJiri Kosina { 1374dde5845aSJiri Kosina while (n--) { 1375dde5845aSJiri Kosina if (*array++ == value) 1376dde5845aSJiri Kosina return 0; 1377dde5845aSJiri Kosina } 1378dde5845aSJiri Kosina return -1; 1379dde5845aSJiri Kosina } 1380dde5845aSJiri Kosina 138185cdaf52SJiri Slaby /** 138285cdaf52SJiri Slaby * hid_match_report - check if driver's raw_event should be called 138385cdaf52SJiri Slaby * 138485cdaf52SJiri Slaby * @hid: hid device 138585cdaf52SJiri Slaby * @report_type: type to match against 138685cdaf52SJiri Slaby * 138785cdaf52SJiri Slaby * compare hid->driver->report_table->report_type to report->type 138885cdaf52SJiri Slaby */ 138985cdaf52SJiri Slaby static int hid_match_report(struct hid_device *hid, struct hid_report *report) 1390dde5845aSJiri Kosina { 139185cdaf52SJiri Slaby const struct hid_report_id *id = hid->driver->report_table; 139285cdaf52SJiri Slaby 139385cdaf52SJiri Slaby if (!id) /* NULL means all */ 139485cdaf52SJiri Slaby return 1; 139585cdaf52SJiri Slaby 139685cdaf52SJiri Slaby for (; id->report_type != HID_TERMINATOR; id++) 139785cdaf52SJiri Slaby if (id->report_type == HID_ANY_ID || 139885cdaf52SJiri Slaby id->report_type == report->type) 139985cdaf52SJiri Slaby return 1; 140085cdaf52SJiri Slaby return 0; 140185cdaf52SJiri Slaby } 140285cdaf52SJiri Slaby 140385cdaf52SJiri Slaby /** 140485cdaf52SJiri Slaby * hid_match_usage - check if driver's event should be called 140585cdaf52SJiri Slaby * 140685cdaf52SJiri Slaby * @hid: hid device 140785cdaf52SJiri Slaby * @usage: usage to match against 140885cdaf52SJiri Slaby * 140985cdaf52SJiri Slaby * compare hid->driver->usage_table->usage_{type,code} to 141085cdaf52SJiri Slaby * usage->usage_{type,code} 141185cdaf52SJiri Slaby */ 141285cdaf52SJiri Slaby static int hid_match_usage(struct hid_device *hid, struct hid_usage *usage) 141385cdaf52SJiri Slaby { 141485cdaf52SJiri Slaby const struct hid_usage_id *id = hid->driver->usage_table; 141585cdaf52SJiri Slaby 141685cdaf52SJiri Slaby if (!id) /* NULL means all */ 141785cdaf52SJiri Slaby return 1; 141885cdaf52SJiri Slaby 141985cdaf52SJiri Slaby for (; id->usage_type != HID_ANY_ID - 1; id++) 142085cdaf52SJiri Slaby if ((id->usage_hid == HID_ANY_ID || 142185cdaf52SJiri Slaby id->usage_hid == usage->hid) && 142285cdaf52SJiri Slaby (id->usage_type == HID_ANY_ID || 142385cdaf52SJiri Slaby id->usage_type == usage->type) && 142485cdaf52SJiri Slaby (id->usage_code == HID_ANY_ID || 142585cdaf52SJiri Slaby id->usage_code == usage->code)) 142685cdaf52SJiri Slaby return 1; 142785cdaf52SJiri Slaby return 0; 142885cdaf52SJiri Slaby } 142985cdaf52SJiri Slaby 143085cdaf52SJiri Slaby static void hid_process_event(struct hid_device *hid, struct hid_field *field, 143185cdaf52SJiri Slaby struct hid_usage *usage, __s32 value, int interrupt) 143285cdaf52SJiri Slaby { 143385cdaf52SJiri Slaby struct hid_driver *hdrv = hid->driver; 143485cdaf52SJiri Slaby int ret; 143585cdaf52SJiri Slaby 14369bfc8da0SHenrik Rydberg if (!list_empty(&hid->debug_list)) 1437cd667ce2SJiri Kosina hid_dump_input(hid, usage, value); 143885cdaf52SJiri Slaby 143985cdaf52SJiri Slaby if (hdrv && hdrv->event && hid_match_usage(hid, usage)) { 144085cdaf52SJiri Slaby ret = hdrv->event(hid, field, usage, value); 144185cdaf52SJiri Slaby if (ret != 0) { 144285cdaf52SJiri Slaby if (ret < 0) 14438c3d52fcSJiri Kosina hid_err(hid, "%s's event failed with %d\n", 144485cdaf52SJiri Slaby hdrv->name, ret); 144585cdaf52SJiri Slaby return; 144685cdaf52SJiri Slaby } 144785cdaf52SJiri Slaby } 144885cdaf52SJiri Slaby 1449dde5845aSJiri Kosina if (hid->claimed & HID_CLAIMED_INPUT) 1450dde5845aSJiri Kosina hidinput_hid_event(hid, field, usage, value); 1451aa938f79SJiri Kosina if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt && hid->hiddev_hid_event) 1452aa938f79SJiri Kosina hid->hiddev_hid_event(hid, field, usage, value); 1453dde5845aSJiri Kosina } 1454dde5845aSJiri Kosina 1455dde5845aSJiri Kosina /* 1456dde5845aSJiri Kosina * Analyse a received field, and fetch the data from it. The field 1457dde5845aSJiri Kosina * content is stored for next report processing (we do differential 1458dde5845aSJiri Kosina * reporting to the layer). 1459dde5845aSJiri Kosina */ 1460dde5845aSJiri Kosina 1461abdff0f7SAdrian Bunk static void hid_input_field(struct hid_device *hid, struct hid_field *field, 1462abdff0f7SAdrian Bunk __u8 *data, int interrupt) 1463dde5845aSJiri Kosina { 1464dde5845aSJiri Kosina unsigned n; 1465dde5845aSJiri Kosina unsigned count = field->report_count; 1466dde5845aSJiri Kosina unsigned offset = field->report_offset; 1467dde5845aSJiri Kosina unsigned size = field->report_size; 1468dde5845aSJiri Kosina __s32 min = field->logical_minimum; 1469dde5845aSJiri Kosina __s32 max = field->logical_maximum; 1470dde5845aSJiri Kosina __s32 *value; 1471dde5845aSJiri Kosina 14726da2ec56SKees Cook value = kmalloc_array(count, sizeof(__s32), GFP_ATOMIC); 1473a3789a17SJoe Perches if (!value) 1474dde5845aSJiri Kosina return; 1475dde5845aSJiri Kosina 1476dde5845aSJiri Kosina for (n = 0; n < count; n++) { 1477dde5845aSJiri Kosina 14784291ee30SJoe Perches value[n] = min < 0 ? 147904fba786SGoffredo Baroncelli snto32(hid_field_extract(hid, data, offset + n * size, 148004fba786SGoffredo Baroncelli size), size) : 148104fba786SGoffredo Baroncelli hid_field_extract(hid, data, offset + n * size, size); 1482dde5845aSJiri Kosina 14834291ee30SJoe Perches /* Ignore report if ErrorRollOver */ 14844291ee30SJoe Perches if (!(field->flags & HID_MAIN_ITEM_VARIABLE) && 14854291ee30SJoe Perches value[n] >= min && value[n] <= max && 148650220deaSBenjamin Tissoires value[n] - min < field->maxusage && 14874291ee30SJoe Perches field->usage[value[n] - min].hid == HID_UP_KEYBOARD + 1) 1488dde5845aSJiri Kosina goto exit; 1489dde5845aSJiri Kosina } 1490dde5845aSJiri Kosina 1491dde5845aSJiri Kosina for (n = 0; n < count; n++) { 1492dde5845aSJiri Kosina 1493dde5845aSJiri Kosina if (HID_MAIN_ITEM_VARIABLE & field->flags) { 1494dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[n], value[n], interrupt); 1495dde5845aSJiri Kosina continue; 1496dde5845aSJiri Kosina } 1497dde5845aSJiri Kosina 1498dde5845aSJiri Kosina if (field->value[n] >= min && field->value[n] <= max 149950220deaSBenjamin Tissoires && field->value[n] - min < field->maxusage 1500dde5845aSJiri Kosina && field->usage[field->value[n] - min].hid 1501dde5845aSJiri Kosina && search(value, field->value[n], count)) 1502dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[field->value[n] - min], 0, interrupt); 1503dde5845aSJiri Kosina 1504dde5845aSJiri Kosina if (value[n] >= min && value[n] <= max 150550220deaSBenjamin Tissoires && value[n] - min < field->maxusage 1506dde5845aSJiri Kosina && field->usage[value[n] - min].hid 1507dde5845aSJiri Kosina && search(field->value, value[n], count)) 1508dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[value[n] - min], 1, interrupt); 1509dde5845aSJiri Kosina } 1510dde5845aSJiri Kosina 1511dde5845aSJiri Kosina memcpy(field->value, value, count * sizeof(__s32)); 1512dde5845aSJiri Kosina exit: 1513dde5845aSJiri Kosina kfree(value); 1514dde5845aSJiri Kosina } 1515dde5845aSJiri Kosina 1516dde5845aSJiri Kosina /* 1517dde5845aSJiri Kosina * Output the field into the report. 1518dde5845aSJiri Kosina */ 1519dde5845aSJiri Kosina 15204291ee30SJoe Perches static void hid_output_field(const struct hid_device *hid, 15214291ee30SJoe Perches struct hid_field *field, __u8 *data) 1522dde5845aSJiri Kosina { 1523dde5845aSJiri Kosina unsigned count = field->report_count; 1524dde5845aSJiri Kosina unsigned offset = field->report_offset; 1525dde5845aSJiri Kosina unsigned size = field->report_size; 1526dde5845aSJiri Kosina unsigned n; 1527dde5845aSJiri Kosina 1528dde5845aSJiri Kosina for (n = 0; n < count; n++) { 1529dde5845aSJiri Kosina if (field->logical_minimum < 0) /* signed values */ 15304291ee30SJoe Perches implement(hid, data, offset + n * size, size, 15314291ee30SJoe Perches s32ton(field->value[n], size)); 1532dde5845aSJiri Kosina else /* unsigned values */ 15334291ee30SJoe Perches implement(hid, data, offset + n * size, size, 15344291ee30SJoe Perches field->value[n]); 1535dde5845aSJiri Kosina } 1536dde5845aSJiri Kosina } 1537dde5845aSJiri Kosina 1538dde5845aSJiri Kosina /* 153927ce4050SJiri Kosina * Create a report. 'data' has to be allocated using 154027ce4050SJiri Kosina * hid_alloc_report_buf() so that it has proper size. 1541dde5845aSJiri Kosina */ 1542dde5845aSJiri Kosina 1543229695e5SJiri Kosina void hid_output_report(struct hid_report *report, __u8 *data) 1544dde5845aSJiri Kosina { 1545dde5845aSJiri Kosina unsigned n; 1546dde5845aSJiri Kosina 1547dde5845aSJiri Kosina if (report->id > 0) 1548dde5845aSJiri Kosina *data++ = report->id; 1549dde5845aSJiri Kosina 155075c28df8SPete Zaitcev memset(data, 0, ((report->size - 1) >> 3) + 1); 1551dde5845aSJiri Kosina for (n = 0; n < report->maxfield; n++) 15524291ee30SJoe Perches hid_output_field(report->device, report->field[n], data); 1553dde5845aSJiri Kosina } 1554229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_output_report); 1555dde5845aSJiri Kosina 1556dde5845aSJiri Kosina /* 155727ce4050SJiri Kosina * Allocator for buffer that is going to be passed to hid_output_report() 155827ce4050SJiri Kosina */ 155927ce4050SJiri Kosina u8 *hid_alloc_report_buf(struct hid_report *report, gfp_t flags) 156027ce4050SJiri Kosina { 156127ce4050SJiri Kosina /* 156227ce4050SJiri Kosina * 7 extra bytes are necessary to achieve proper functionality 156327ce4050SJiri Kosina * of implement() working on 8 byte chunks 156427ce4050SJiri Kosina */ 156527ce4050SJiri Kosina 15666de0b13cSAaron Ma u32 len = hid_report_len(report) + 7; 156727ce4050SJiri Kosina 156827ce4050SJiri Kosina return kmalloc(len, flags); 156927ce4050SJiri Kosina } 157027ce4050SJiri Kosina EXPORT_SYMBOL_GPL(hid_alloc_report_buf); 157127ce4050SJiri Kosina 157227ce4050SJiri Kosina /* 1573dde5845aSJiri Kosina * Set a field value. The report this field belongs to has to be 1574dde5845aSJiri Kosina * created and transferred to the device, to set this value in the 1575dde5845aSJiri Kosina * device. 1576dde5845aSJiri Kosina */ 1577dde5845aSJiri Kosina 1578dde5845aSJiri Kosina int hid_set_field(struct hid_field *field, unsigned offset, __s32 value) 1579dde5845aSJiri Kosina { 1580be67b68dSKees Cook unsigned size; 1581be67b68dSKees Cook 1582be67b68dSKees Cook if (!field) 1583be67b68dSKees Cook return -1; 1584be67b68dSKees Cook 1585be67b68dSKees Cook size = field->report_size; 1586dde5845aSJiri Kosina 1587cd667ce2SJiri Kosina hid_dump_input(field->report->device, field->usage + offset, value); 1588dde5845aSJiri Kosina 1589dde5845aSJiri Kosina if (offset >= field->report_count) { 15908c3d52fcSJiri Kosina hid_err(field->report->device, "offset (%d) exceeds report_count (%d)\n", 15918c3d52fcSJiri Kosina offset, field->report_count); 1592dde5845aSJiri Kosina return -1; 1593dde5845aSJiri Kosina } 1594dde5845aSJiri Kosina if (field->logical_minimum < 0) { 1595dde5845aSJiri Kosina if (value != snto32(s32ton(value, size), size)) { 15968c3d52fcSJiri Kosina hid_err(field->report->device, "value %d is out of range\n", value); 1597dde5845aSJiri Kosina return -1; 1598dde5845aSJiri Kosina } 1599dde5845aSJiri Kosina } 1600dde5845aSJiri Kosina field->value[offset] = value; 1601dde5845aSJiri Kosina return 0; 1602dde5845aSJiri Kosina } 1603229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_set_field); 1604dde5845aSJiri Kosina 160585cdaf52SJiri Slaby static struct hid_report *hid_get_report(struct hid_report_enum *report_enum, 160685cdaf52SJiri Slaby const u8 *data) 160785cdaf52SJiri Slaby { 160885cdaf52SJiri Slaby struct hid_report *report; 160985cdaf52SJiri Slaby unsigned int n = 0; /* Normally report number is 0 */ 161085cdaf52SJiri Slaby 161185cdaf52SJiri Slaby /* Device uses numbered reports, data[0] is report number */ 161285cdaf52SJiri Slaby if (report_enum->numbered) 161385cdaf52SJiri Slaby n = *data; 161485cdaf52SJiri Slaby 161585cdaf52SJiri Slaby report = report_enum->report_id_hash[n]; 161685cdaf52SJiri Slaby if (report == NULL) 161785cdaf52SJiri Slaby dbg_hid("undefined report_id %u received\n", n); 161885cdaf52SJiri Slaby 161985cdaf52SJiri Slaby return report; 162085cdaf52SJiri Slaby } 162185cdaf52SJiri Slaby 16224fa5a7f7SBenjamin Tissoires /* 16234fa5a7f7SBenjamin Tissoires * Implement a generic .request() callback, using .raw_request() 16244fa5a7f7SBenjamin Tissoires * DO NOT USE in hid drivers directly, but through hid_hw_request instead. 16254fa5a7f7SBenjamin Tissoires */ 16264fa5a7f7SBenjamin Tissoires void __hid_request(struct hid_device *hid, struct hid_report *report, 16274fa5a7f7SBenjamin Tissoires int reqtype) 16284fa5a7f7SBenjamin Tissoires { 16294fa5a7f7SBenjamin Tissoires char *buf; 16304fa5a7f7SBenjamin Tissoires int ret; 16316de0b13cSAaron Ma u32 len; 16324fa5a7f7SBenjamin Tissoires 16334fa5a7f7SBenjamin Tissoires buf = hid_alloc_report_buf(report, GFP_KERNEL); 16344fa5a7f7SBenjamin Tissoires if (!buf) 16354fa5a7f7SBenjamin Tissoires return; 16364fa5a7f7SBenjamin Tissoires 16374fa5a7f7SBenjamin Tissoires len = hid_report_len(report); 16384fa5a7f7SBenjamin Tissoires 16394fa5a7f7SBenjamin Tissoires if (reqtype == HID_REQ_SET_REPORT) 16404fa5a7f7SBenjamin Tissoires hid_output_report(report, buf); 16414fa5a7f7SBenjamin Tissoires 16424fa5a7f7SBenjamin Tissoires ret = hid->ll_driver->raw_request(hid, report->id, buf, len, 16434fa5a7f7SBenjamin Tissoires report->type, reqtype); 16444fa5a7f7SBenjamin Tissoires if (ret < 0) { 16454fa5a7f7SBenjamin Tissoires dbg_hid("unable to complete request: %d\n", ret); 16464fa5a7f7SBenjamin Tissoires goto out; 16474fa5a7f7SBenjamin Tissoires } 16484fa5a7f7SBenjamin Tissoires 16494fa5a7f7SBenjamin Tissoires if (reqtype == HID_REQ_GET_REPORT) 16504fa5a7f7SBenjamin Tissoires hid_input_report(hid, report->type, buf, ret, 0); 16514fa5a7f7SBenjamin Tissoires 16524fa5a7f7SBenjamin Tissoires out: 16534fa5a7f7SBenjamin Tissoires kfree(buf); 16544fa5a7f7SBenjamin Tissoires } 16554fa5a7f7SBenjamin Tissoires EXPORT_SYMBOL_GPL(__hid_request); 16564fa5a7f7SBenjamin Tissoires 16576de0b13cSAaron Ma int hid_report_raw_event(struct hid_device *hid, int type, u8 *data, u32 size, 165885cdaf52SJiri Slaby int interrupt) 1659aa8de2f0SJiri Kosina { 1660aa8de2f0SJiri Kosina struct hid_report_enum *report_enum = hid->report_enum + type; 1661aa8de2f0SJiri Kosina struct hid_report *report; 16626d85d037SBenjamin Tissoires struct hid_driver *hdrv; 166385cdaf52SJiri Slaby unsigned int a; 16646de0b13cSAaron Ma u32 rsize, csize = size; 166585cdaf52SJiri Slaby u8 *cdata = data; 1666b6787242SJiri Kosina int ret = 0; 1667aa8de2f0SJiri Kosina 166885cdaf52SJiri Slaby report = hid_get_report(report_enum, data); 166985cdaf52SJiri Slaby if (!report) 1670b6787242SJiri Kosina goto out; 1671aa8de2f0SJiri Kosina 167285cdaf52SJiri Slaby if (report_enum->numbered) { 167385cdaf52SJiri Slaby cdata++; 167485cdaf52SJiri Slaby csize--; 1675aa8de2f0SJiri Kosina } 1676aa8de2f0SJiri Kosina 1677aa8de2f0SJiri Kosina rsize = ((report->size - 1) >> 3) + 1; 1678aa8de2f0SJiri Kosina 1679966922f2SArmando Visconti if (rsize > HID_MAX_BUFFER_SIZE) 1680966922f2SArmando Visconti rsize = HID_MAX_BUFFER_SIZE; 1681966922f2SArmando Visconti 168285cdaf52SJiri Slaby if (csize < rsize) { 168385cdaf52SJiri Slaby dbg_hid("report %d is too short, (%d < %d)\n", report->id, 168485cdaf52SJiri Slaby csize, rsize); 168585cdaf52SJiri Slaby memset(cdata + csize, 0, rsize - csize); 1686aa8de2f0SJiri Kosina } 1687aa8de2f0SJiri Kosina 1688aa8de2f0SJiri Kosina if ((hid->claimed & HID_CLAIMED_HIDDEV) && hid->hiddev_report_event) 1689aa8de2f0SJiri Kosina hid->hiddev_report_event(hid, report); 1690b6787242SJiri Kosina if (hid->claimed & HID_CLAIMED_HIDRAW) { 1691b6787242SJiri Kosina ret = hidraw_report_event(hid, data, size); 1692b6787242SJiri Kosina if (ret) 1693b6787242SJiri Kosina goto out; 1694b6787242SJiri Kosina } 1695aa8de2f0SJiri Kosina 1696cc6b54aaSBenjamin Tissoires if (hid->claimed != HID_CLAIMED_HIDRAW && report->maxfield) { 169785cdaf52SJiri Slaby for (a = 0; a < report->maxfield; a++) 169885cdaf52SJiri Slaby hid_input_field(hid, report->field[a], cdata, interrupt); 16996d85d037SBenjamin Tissoires hdrv = hid->driver; 17006d85d037SBenjamin Tissoires if (hdrv && hdrv->report) 17016d85d037SBenjamin Tissoires hdrv->report(hid, report); 1702b94e3c94SMatthieu CASTET } 1703aa8de2f0SJiri Kosina 1704aa8de2f0SJiri Kosina if (hid->claimed & HID_CLAIMED_INPUT) 1705aa8de2f0SJiri Kosina hidinput_report_event(hid, report); 1706b6787242SJiri Kosina out: 1707b6787242SJiri Kosina return ret; 170885cdaf52SJiri Slaby } 170985cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_report_raw_event); 171085cdaf52SJiri Slaby 171185cdaf52SJiri Slaby /** 171285cdaf52SJiri Slaby * hid_input_report - report data from lower layer (usb, bt...) 171385cdaf52SJiri Slaby * 171485cdaf52SJiri Slaby * @hid: hid device 171585cdaf52SJiri Slaby * @type: HID report type (HID_*_REPORT) 171685cdaf52SJiri Slaby * @data: report contents 171785cdaf52SJiri Slaby * @size: size of data parameter 1718ff9b00a2SJiri Kosina * @interrupt: distinguish between interrupt and control transfers 171985cdaf52SJiri Slaby * 172085cdaf52SJiri Slaby * This is data entry for lower layers. 172185cdaf52SJiri Slaby */ 17226de0b13cSAaron Ma int hid_input_report(struct hid_device *hid, int type, u8 *data, u32 size, int interrupt) 172385cdaf52SJiri Slaby { 172476c317d6SJulia Lawall struct hid_report_enum *report_enum; 172576c317d6SJulia Lawall struct hid_driver *hdrv; 172685cdaf52SJiri Slaby struct hid_report *report; 172745dc1ac7SJiri Kosina int ret = 0; 172885cdaf52SJiri Slaby 17294ea54542SDavid Herrmann if (!hid) 173085cdaf52SJiri Slaby return -ENODEV; 17314ea54542SDavid Herrmann 1732c849a614SAndrew de los Reyes if (down_trylock(&hid->driver_input_lock)) 17334ea54542SDavid Herrmann return -EBUSY; 17344ea54542SDavid Herrmann 17354ea54542SDavid Herrmann if (!hid->driver) { 17364ea54542SDavid Herrmann ret = -ENODEV; 17374ea54542SDavid Herrmann goto unlock; 17384ea54542SDavid Herrmann } 173976c317d6SJulia Lawall report_enum = hid->report_enum + type; 174076c317d6SJulia Lawall hdrv = hid->driver; 174185cdaf52SJiri Slaby 174285cdaf52SJiri Slaby if (!size) { 174385cdaf52SJiri Slaby dbg_hid("empty report\n"); 17444ea54542SDavid Herrmann ret = -1; 17454ea54542SDavid Herrmann goto unlock; 174685cdaf52SJiri Slaby } 174785cdaf52SJiri Slaby 1748b94e3c94SMatthieu CASTET /* Avoid unnecessary overhead if debugfs is disabled */ 1749a5f04b9dSBenjamin Tissoires if (!list_empty(&hid->debug_list)) 1750a5f04b9dSBenjamin Tissoires hid_dump_report(hid, type, data, size); 1751b94e3c94SMatthieu CASTET 1752f77e347bSJiri Kosina report = hid_get_report(report_enum, data); 1753f77e347bSJiri Kosina 17544ea54542SDavid Herrmann if (!report) { 17554ea54542SDavid Herrmann ret = -1; 17564ea54542SDavid Herrmann goto unlock; 17574ea54542SDavid Herrmann } 1758f77e347bSJiri Kosina 175985cdaf52SJiri Slaby if (hdrv && hdrv->raw_event && hid_match_report(hid, report)) { 176085cdaf52SJiri Slaby ret = hdrv->raw_event(hid, report, data, size); 1761556483e2SFelix Rueegg if (ret < 0) 17624ea54542SDavid Herrmann goto unlock; 17634ea54542SDavid Herrmann } 176485cdaf52SJiri Slaby 1765b6787242SJiri Kosina ret = hid_report_raw_event(hid, type, data, size, interrupt); 1766aa8de2f0SJiri Kosina 17674ea54542SDavid Herrmann unlock: 1768c849a614SAndrew de los Reyes up(&hid->driver_input_lock); 176945dc1ac7SJiri Kosina return ret; 1770aa8de2f0SJiri Kosina } 1771aa8de2f0SJiri Kosina EXPORT_SYMBOL_GPL(hid_input_report); 1772aa8de2f0SJiri Kosina 1773d5d3e202SBenjamin Tissoires bool hid_match_one_id(const struct hid_device *hdev, 17740f37cd03SJiri Kosina const struct hid_device_id *id) 17750f37cd03SJiri Kosina { 17767431fb76SHenrik Rydberg return (id->bus == HID_BUS_ANY || id->bus == hdev->bus) && 17774d53b801SHenrik Rydberg (id->group == HID_GROUP_ANY || id->group == hdev->group) && 17780f37cd03SJiri Kosina (id->vendor == HID_ANY_ID || id->vendor == hdev->vendor) && 17790f37cd03SJiri Kosina (id->product == HID_ANY_ID || id->product == hdev->product); 17800f37cd03SJiri Kosina } 17810f37cd03SJiri Kosina 1782d5d3e202SBenjamin Tissoires const struct hid_device_id *hid_match_id(const struct hid_device *hdev, 17830f37cd03SJiri Kosina const struct hid_device_id *id) 17840f37cd03SJiri Kosina { 17850f37cd03SJiri Kosina for (; id->bus; id++) 17860f37cd03SJiri Kosina if (hid_match_one_id(hdev, id)) 17870f37cd03SJiri Kosina return id; 17880f37cd03SJiri Kosina 17890f37cd03SJiri Kosina return NULL; 17900f37cd03SJiri Kosina } 17910f37cd03SJiri Kosina 17920f37cd03SJiri Kosina static const struct hid_device_id hid_hiddev_list[] = { 1793c0bd6a42SRichard Hughes { HID_USB_DEVICE(USB_VENDOR_ID_MGE, USB_DEVICE_ID_MGE_UPS) }, 1794c0bd6a42SRichard Hughes { HID_USB_DEVICE(USB_VENDOR_ID_MGE, USB_DEVICE_ID_MGE_UPS1) }, 17950f37cd03SJiri Kosina { } 17960f37cd03SJiri Kosina }; 17970f37cd03SJiri Kosina 17980f37cd03SJiri Kosina static bool hid_hiddev(struct hid_device *hdev) 17990f37cd03SJiri Kosina { 18000f37cd03SJiri Kosina return !!hid_match_id(hdev, hid_hiddev_list); 18010f37cd03SJiri Kosina } 18020f37cd03SJiri Kosina 18036d3bfb74SAlan Ott 18046d3bfb74SAlan Ott static ssize_t 18056d3bfb74SAlan Ott read_report_descriptor(struct file *filp, struct kobject *kobj, 18066d3bfb74SAlan Ott struct bin_attribute *attr, 18076d3bfb74SAlan Ott char *buf, loff_t off, size_t count) 18086d3bfb74SAlan Ott { 18092cf83833SGeliang Tang struct device *dev = kobj_to_dev(kobj); 1810ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 18116d3bfb74SAlan Ott 18126d3bfb74SAlan Ott if (off >= hdev->rsize) 18136d3bfb74SAlan Ott return 0; 18146d3bfb74SAlan Ott 18156d3bfb74SAlan Ott if (off + count > hdev->rsize) 18166d3bfb74SAlan Ott count = hdev->rsize - off; 18176d3bfb74SAlan Ott 18186d3bfb74SAlan Ott memcpy(buf, hdev->rdesc + off, count); 18196d3bfb74SAlan Ott 18206d3bfb74SAlan Ott return count; 18216d3bfb74SAlan Ott } 18226d3bfb74SAlan Ott 1823a877417eSOlivier Gay static ssize_t 1824a877417eSOlivier Gay show_country(struct device *dev, struct device_attribute *attr, 1825a877417eSOlivier Gay char *buf) 1826a877417eSOlivier Gay { 1827ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 1828a877417eSOlivier Gay 1829a877417eSOlivier Gay return sprintf(buf, "%02x\n", hdev->country & 0xff); 1830a877417eSOlivier Gay } 1831a877417eSOlivier Gay 18326d3bfb74SAlan Ott static struct bin_attribute dev_bin_attr_report_desc = { 18336d3bfb74SAlan Ott .attr = { .name = "report_descriptor", .mode = 0444 }, 18346d3bfb74SAlan Ott .read = read_report_descriptor, 18356d3bfb74SAlan Ott .size = HID_MAX_DESCRIPTOR_SIZE, 18366d3bfb74SAlan Ott }; 18376d3bfb74SAlan Ott 1838ad8378edSBhumika Goyal static const struct device_attribute dev_attr_country = { 1839a877417eSOlivier Gay .attr = { .name = "country", .mode = 0444 }, 1840a877417eSOlivier Gay .show = show_country, 1841a877417eSOlivier Gay }; 1842a877417eSOlivier Gay 184393c10132SJiri Slaby int hid_connect(struct hid_device *hdev, unsigned int connect_mask) 184493c10132SJiri Slaby { 184593c10132SJiri Slaby static const char *types[] = { "Device", "Pointer", "Mouse", "Device", 184693c10132SJiri Slaby "Joystick", "Gamepad", "Keyboard", "Keypad", 184793c10132SJiri Slaby "Multi-Axis Controller" 184893c10132SJiri Slaby }; 184993c10132SJiri Slaby const char *type, *bus; 185079b568b9SRichard Purdie char buf[64] = ""; 185193c10132SJiri Slaby unsigned int i; 185293c10132SJiri Slaby int len; 18536d3bfb74SAlan Ott int ret; 185493c10132SJiri Slaby 1855b5e5a37eSBastien Nocera if (hdev->quirks & HID_QUIRK_HIDDEV_FORCE) 1856b5e5a37eSBastien Nocera connect_mask |= (HID_CONNECT_HIDDEV_FORCE | HID_CONNECT_HIDDEV); 18573a343ee4SDaniel Mack if (hdev->quirks & HID_QUIRK_HIDINPUT_FORCE) 18583a343ee4SDaniel Mack connect_mask |= HID_CONNECT_HIDINPUT_FORCE; 185993c10132SJiri Slaby if (hdev->bus != BUS_USB) 186093c10132SJiri Slaby connect_mask &= ~HID_CONNECT_HIDDEV; 18610f37cd03SJiri Kosina if (hid_hiddev(hdev)) 18620f37cd03SJiri Kosina connect_mask |= HID_CONNECT_HIDDEV_FORCE; 186393c10132SJiri Slaby 186493c10132SJiri Slaby if ((connect_mask & HID_CONNECT_HIDINPUT) && !hidinput_connect(hdev, 186593c10132SJiri Slaby connect_mask & HID_CONNECT_HIDINPUT_FORCE)) 186693c10132SJiri Slaby hdev->claimed |= HID_CLAIMED_INPUT; 1867b77c3920SBenjamin Tissoires 186893c10132SJiri Slaby if ((connect_mask & HID_CONNECT_HIDDEV) && hdev->hiddev_connect && 186993c10132SJiri Slaby !hdev->hiddev_connect(hdev, 187093c10132SJiri Slaby connect_mask & HID_CONNECT_HIDDEV_FORCE)) 187193c10132SJiri Slaby hdev->claimed |= HID_CLAIMED_HIDDEV; 187293c10132SJiri Slaby if ((connect_mask & HID_CONNECT_HIDRAW) && !hidraw_connect(hdev)) 187393c10132SJiri Slaby hdev->claimed |= HID_CLAIMED_HIDRAW; 187493c10132SJiri Slaby 18757704ac93SBenjamin Tissoires if (connect_mask & HID_CONNECT_DRIVER) 18767704ac93SBenjamin Tissoires hdev->claimed |= HID_CLAIMED_DRIVER; 18777704ac93SBenjamin Tissoires 18784bc19f62SDavid Herrmann /* Drivers with the ->raw_event callback set are not required to connect 18794bc19f62SDavid Herrmann * to any other listener. */ 18804bc19f62SDavid Herrmann if (!hdev->claimed && !hdev->driver->raw_event) { 18814bc19f62SDavid Herrmann hid_err(hdev, "device has no listeners, quitting\n"); 188293c10132SJiri Slaby return -ENODEV; 188393c10132SJiri Slaby } 188493c10132SJiri Slaby 188593c10132SJiri Slaby if ((hdev->claimed & HID_CLAIMED_INPUT) && 188693c10132SJiri Slaby (connect_mask & HID_CONNECT_FF) && hdev->ff_init) 188793c10132SJiri Slaby hdev->ff_init(hdev); 188893c10132SJiri Slaby 188993c10132SJiri Slaby len = 0; 189093c10132SJiri Slaby if (hdev->claimed & HID_CLAIMED_INPUT) 189193c10132SJiri Slaby len += sprintf(buf + len, "input"); 189293c10132SJiri Slaby if (hdev->claimed & HID_CLAIMED_HIDDEV) 189393c10132SJiri Slaby len += sprintf(buf + len, "%shiddev%d", len ? "," : "", 1894733aca90SJaejoong Kim ((struct hiddev *)hdev->hiddev)->minor); 189593c10132SJiri Slaby if (hdev->claimed & HID_CLAIMED_HIDRAW) 189693c10132SJiri Slaby len += sprintf(buf + len, "%shidraw%d", len ? "," : "", 189793c10132SJiri Slaby ((struct hidraw *)hdev->hidraw)->minor); 189893c10132SJiri Slaby 189993c10132SJiri Slaby type = "Device"; 190093c10132SJiri Slaby for (i = 0; i < hdev->maxcollection; i++) { 190193c10132SJiri Slaby struct hid_collection *col = &hdev->collection[i]; 190293c10132SJiri Slaby if (col->type == HID_COLLECTION_APPLICATION && 190393c10132SJiri Slaby (col->usage & HID_USAGE_PAGE) == HID_UP_GENDESK && 190493c10132SJiri Slaby (col->usage & 0xffff) < ARRAY_SIZE(types)) { 190593c10132SJiri Slaby type = types[col->usage & 0xffff]; 190693c10132SJiri Slaby break; 190793c10132SJiri Slaby } 190893c10132SJiri Slaby } 190993c10132SJiri Slaby 191093c10132SJiri Slaby switch (hdev->bus) { 191193c10132SJiri Slaby case BUS_USB: 191293c10132SJiri Slaby bus = "USB"; 191393c10132SJiri Slaby break; 191493c10132SJiri Slaby case BUS_BLUETOOTH: 191593c10132SJiri Slaby bus = "BLUETOOTH"; 191693c10132SJiri Slaby break; 191706780727SDaniel Martin case BUS_I2C: 191806780727SDaniel Martin bus = "I2C"; 191906780727SDaniel Martin break; 192093c10132SJiri Slaby default: 192193c10132SJiri Slaby bus = "<UNKNOWN>"; 192293c10132SJiri Slaby } 192393c10132SJiri Slaby 1924a877417eSOlivier Gay ret = device_create_file(&hdev->dev, &dev_attr_country); 1925a877417eSOlivier Gay if (ret) 1926a877417eSOlivier Gay hid_warn(hdev, 1927a877417eSOlivier Gay "can't create sysfs country code attribute err: %d\n", ret); 1928a877417eSOlivier Gay 19294291ee30SJoe Perches hid_info(hdev, "%s: %s HID v%x.%02x %s [%s] on %s\n", 193093c10132SJiri Slaby buf, bus, hdev->version >> 8, hdev->version & 0xff, 193193c10132SJiri Slaby type, hdev->name, hdev->phys); 193293c10132SJiri Slaby 193393c10132SJiri Slaby return 0; 193493c10132SJiri Slaby } 193593c10132SJiri Slaby EXPORT_SYMBOL_GPL(hid_connect); 193693c10132SJiri Slaby 1937c4c259bcSJiri Kosina void hid_disconnect(struct hid_device *hdev) 1938c4c259bcSJiri Kosina { 1939a877417eSOlivier Gay device_remove_file(&hdev->dev, &dev_attr_country); 1940c4c259bcSJiri Kosina if (hdev->claimed & HID_CLAIMED_INPUT) 1941c4c259bcSJiri Kosina hidinput_disconnect(hdev); 1942c4c259bcSJiri Kosina if (hdev->claimed & HID_CLAIMED_HIDDEV) 1943c4c259bcSJiri Kosina hdev->hiddev_disconnect(hdev); 1944c4c259bcSJiri Kosina if (hdev->claimed & HID_CLAIMED_HIDRAW) 1945c4c259bcSJiri Kosina hidraw_disconnect(hdev); 19469c5c6ed7SBenjamin Tissoires hdev->claimed = 0; 1947c4c259bcSJiri Kosina } 1948c4c259bcSJiri Kosina EXPORT_SYMBOL_GPL(hid_disconnect); 1949c4c259bcSJiri Kosina 1950aaac082dSDmitry Torokhov /** 1951aaac082dSDmitry Torokhov * hid_hw_start - start underlying HW 1952aaac082dSDmitry Torokhov * @hdev: hid device 1953aaac082dSDmitry Torokhov * @connect_mask: which outputs to connect, see HID_CONNECT_* 1954aaac082dSDmitry Torokhov * 1955aaac082dSDmitry Torokhov * Call this in probe function *after* hid_parse. This will setup HW 1956aaac082dSDmitry Torokhov * buffers and start the device (if not defeirred to device open). 1957aaac082dSDmitry Torokhov * hid_hw_stop must be called if this was successful. 1958aaac082dSDmitry Torokhov */ 1959aaac082dSDmitry Torokhov int hid_hw_start(struct hid_device *hdev, unsigned int connect_mask) 1960aaac082dSDmitry Torokhov { 1961aaac082dSDmitry Torokhov int error; 1962aaac082dSDmitry Torokhov 1963aaac082dSDmitry Torokhov error = hdev->ll_driver->start(hdev); 1964aaac082dSDmitry Torokhov if (error) 1965aaac082dSDmitry Torokhov return error; 1966aaac082dSDmitry Torokhov 1967aaac082dSDmitry Torokhov if (connect_mask) { 1968aaac082dSDmitry Torokhov error = hid_connect(hdev, connect_mask); 1969aaac082dSDmitry Torokhov if (error) { 1970aaac082dSDmitry Torokhov hdev->ll_driver->stop(hdev); 1971aaac082dSDmitry Torokhov return error; 1972aaac082dSDmitry Torokhov } 1973aaac082dSDmitry Torokhov } 1974aaac082dSDmitry Torokhov 1975aaac082dSDmitry Torokhov return 0; 1976aaac082dSDmitry Torokhov } 1977aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_start); 1978aaac082dSDmitry Torokhov 1979aaac082dSDmitry Torokhov /** 1980aaac082dSDmitry Torokhov * hid_hw_stop - stop underlying HW 1981aaac082dSDmitry Torokhov * @hdev: hid device 1982aaac082dSDmitry Torokhov * 1983aaac082dSDmitry Torokhov * This is usually called from remove function or from probe when something 1984aaac082dSDmitry Torokhov * failed and hid_hw_start was called already. 1985aaac082dSDmitry Torokhov */ 1986aaac082dSDmitry Torokhov void hid_hw_stop(struct hid_device *hdev) 1987aaac082dSDmitry Torokhov { 1988aaac082dSDmitry Torokhov hid_disconnect(hdev); 1989aaac082dSDmitry Torokhov hdev->ll_driver->stop(hdev); 1990aaac082dSDmitry Torokhov } 1991aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_stop); 1992aaac082dSDmitry Torokhov 1993aaac082dSDmitry Torokhov /** 1994aaac082dSDmitry Torokhov * hid_hw_open - signal underlying HW to start delivering events 1995aaac082dSDmitry Torokhov * @hdev: hid device 1996aaac082dSDmitry Torokhov * 1997aaac082dSDmitry Torokhov * Tell underlying HW to start delivering events from the device. 1998aaac082dSDmitry Torokhov * This function should be called sometime after successful call 1999d6c70a86SHisao Tanabe * to hid_hw_start(). 2000aaac082dSDmitry Torokhov */ 2001aaac082dSDmitry Torokhov int hid_hw_open(struct hid_device *hdev) 2002aaac082dSDmitry Torokhov { 2003aaac082dSDmitry Torokhov int ret; 2004aaac082dSDmitry Torokhov 2005aaac082dSDmitry Torokhov ret = mutex_lock_killable(&hdev->ll_open_lock); 2006aaac082dSDmitry Torokhov if (ret) 2007aaac082dSDmitry Torokhov return ret; 2008aaac082dSDmitry Torokhov 2009aaac082dSDmitry Torokhov if (!hdev->ll_open_count++) { 2010aaac082dSDmitry Torokhov ret = hdev->ll_driver->open(hdev); 2011aaac082dSDmitry Torokhov if (ret) 2012aaac082dSDmitry Torokhov hdev->ll_open_count--; 2013aaac082dSDmitry Torokhov } 2014aaac082dSDmitry Torokhov 2015aaac082dSDmitry Torokhov mutex_unlock(&hdev->ll_open_lock); 2016aaac082dSDmitry Torokhov return ret; 2017aaac082dSDmitry Torokhov } 2018aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_open); 2019aaac082dSDmitry Torokhov 2020aaac082dSDmitry Torokhov /** 2021aaac082dSDmitry Torokhov * hid_hw_close - signal underlaying HW to stop delivering events 2022aaac082dSDmitry Torokhov * 2023aaac082dSDmitry Torokhov * @hdev: hid device 2024aaac082dSDmitry Torokhov * 2025aaac082dSDmitry Torokhov * This function indicates that we are not interested in the events 2026aaac082dSDmitry Torokhov * from this device anymore. Delivery of events may or may not stop, 2027aaac082dSDmitry Torokhov * depending on the number of users still outstanding. 2028aaac082dSDmitry Torokhov */ 2029aaac082dSDmitry Torokhov void hid_hw_close(struct hid_device *hdev) 2030aaac082dSDmitry Torokhov { 2031aaac082dSDmitry Torokhov mutex_lock(&hdev->ll_open_lock); 2032aaac082dSDmitry Torokhov if (!--hdev->ll_open_count) 2033aaac082dSDmitry Torokhov hdev->ll_driver->close(hdev); 2034aaac082dSDmitry Torokhov mutex_unlock(&hdev->ll_open_lock); 2035aaac082dSDmitry Torokhov } 2036aaac082dSDmitry Torokhov EXPORT_SYMBOL_GPL(hid_hw_close); 2037aaac082dSDmitry Torokhov 20383a6f82f7SJiri Slaby struct hid_dynid { 20393a6f82f7SJiri Slaby struct list_head list; 20403a6f82f7SJiri Slaby struct hid_device_id id; 20413a6f82f7SJiri Slaby }; 20423a6f82f7SJiri Slaby 20433a6f82f7SJiri Slaby /** 20443a6f82f7SJiri Slaby * store_new_id - add a new HID device ID to this driver and re-probe devices 20453a6f82f7SJiri Slaby * @driver: target device driver 20463a6f82f7SJiri Slaby * @buf: buffer for scanning device ID data 20473a6f82f7SJiri Slaby * @count: input size 20483a6f82f7SJiri Slaby * 20493a6f82f7SJiri Slaby * Adds a new dynamic hid device ID to this driver, 20503a6f82f7SJiri Slaby * and causes the driver to probe for all devices again. 20513a6f82f7SJiri Slaby */ 2052c2810325SGreg Kroah-Hartman static ssize_t new_id_store(struct device_driver *drv, const char *buf, 20533a6f82f7SJiri Slaby size_t count) 20543a6f82f7SJiri Slaby { 2055ba91a967SGeliang Tang struct hid_driver *hdrv = to_hid_driver(drv); 20563a6f82f7SJiri Slaby struct hid_dynid *dynid; 20573a6f82f7SJiri Slaby __u32 bus, vendor, product; 20583a6f82f7SJiri Slaby unsigned long driver_data = 0; 20593a6f82f7SJiri Slaby int ret; 20603a6f82f7SJiri Slaby 20613a6f82f7SJiri Slaby ret = sscanf(buf, "%x %x %x %lx", 20623a6f82f7SJiri Slaby &bus, &vendor, &product, &driver_data); 20633a6f82f7SJiri Slaby if (ret < 3) 20643a6f82f7SJiri Slaby return -EINVAL; 20653a6f82f7SJiri Slaby 20663a6f82f7SJiri Slaby dynid = kzalloc(sizeof(*dynid), GFP_KERNEL); 20673a6f82f7SJiri Slaby if (!dynid) 20683a6f82f7SJiri Slaby return -ENOMEM; 20693a6f82f7SJiri Slaby 20703a6f82f7SJiri Slaby dynid->id.bus = bus; 20714d53b801SHenrik Rydberg dynid->id.group = HID_GROUP_ANY; 20723a6f82f7SJiri Slaby dynid->id.vendor = vendor; 20733a6f82f7SJiri Slaby dynid->id.product = product; 20743a6f82f7SJiri Slaby dynid->id.driver_data = driver_data; 20753a6f82f7SJiri Slaby 20763a6f82f7SJiri Slaby spin_lock(&hdrv->dyn_lock); 20773a6f82f7SJiri Slaby list_add_tail(&dynid->list, &hdrv->dyn_list); 20783a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 20793a6f82f7SJiri Slaby 20803a6f82f7SJiri Slaby ret = driver_attach(&hdrv->driver); 20813a6f82f7SJiri Slaby 20823a6f82f7SJiri Slaby return ret ? : count; 20833a6f82f7SJiri Slaby } 2084c2810325SGreg Kroah-Hartman static DRIVER_ATTR_WO(new_id); 2085c2810325SGreg Kroah-Hartman 2086c2810325SGreg Kroah-Hartman static struct attribute *hid_drv_attrs[] = { 2087c2810325SGreg Kroah-Hartman &driver_attr_new_id.attr, 2088c2810325SGreg Kroah-Hartman NULL, 2089c2810325SGreg Kroah-Hartman }; 2090c2810325SGreg Kroah-Hartman ATTRIBUTE_GROUPS(hid_drv); 20913a6f82f7SJiri Slaby 20923a6f82f7SJiri Slaby static void hid_free_dynids(struct hid_driver *hdrv) 20933a6f82f7SJiri Slaby { 20943a6f82f7SJiri Slaby struct hid_dynid *dynid, *n; 20953a6f82f7SJiri Slaby 20963a6f82f7SJiri Slaby spin_lock(&hdrv->dyn_lock); 20973a6f82f7SJiri Slaby list_for_each_entry_safe(dynid, n, &hdrv->dyn_list, list) { 20983a6f82f7SJiri Slaby list_del(&dynid->list); 20993a6f82f7SJiri Slaby kfree(dynid); 21003a6f82f7SJiri Slaby } 21013a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 21023a6f82f7SJiri Slaby } 21033a6f82f7SJiri Slaby 2104e04a0442SBenjamin Tissoires const struct hid_device_id *hid_match_device(struct hid_device *hdev, 21053a6f82f7SJiri Slaby struct hid_driver *hdrv) 21063a6f82f7SJiri Slaby { 21073a6f82f7SJiri Slaby struct hid_dynid *dynid; 21083a6f82f7SJiri Slaby 21093a6f82f7SJiri Slaby spin_lock(&hdrv->dyn_lock); 21103a6f82f7SJiri Slaby list_for_each_entry(dynid, &hdrv->dyn_list, list) { 21113a6f82f7SJiri Slaby if (hid_match_one_id(hdev, &dynid->id)) { 21123a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 21133a6f82f7SJiri Slaby return &dynid->id; 21143a6f82f7SJiri Slaby } 21153a6f82f7SJiri Slaby } 21163a6f82f7SJiri Slaby spin_unlock(&hdrv->dyn_lock); 21173a6f82f7SJiri Slaby 21183a6f82f7SJiri Slaby return hid_match_id(hdev, hdrv->id_table); 21193a6f82f7SJiri Slaby } 2120e04a0442SBenjamin Tissoires EXPORT_SYMBOL_GPL(hid_match_device); 21213a6f82f7SJiri Slaby 212285cdaf52SJiri Slaby static int hid_bus_match(struct device *dev, struct device_driver *drv) 212385cdaf52SJiri Slaby { 2124ba91a967SGeliang Tang struct hid_driver *hdrv = to_hid_driver(drv); 2125ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 212685cdaf52SJiri Slaby 2127070748edSHenrik Rydberg return hid_match_device(hdev, hdrv) != NULL; 212885cdaf52SJiri Slaby } 212985cdaf52SJiri Slaby 21301a8861f1SDaniel M. Lambea /** 21311a8861f1SDaniel M. Lambea * hid_compare_device_paths - check if both devices share the same path 21321a8861f1SDaniel M. Lambea * @hdev_a: hid device 21331a8861f1SDaniel M. Lambea * @hdev_b: hid device 21341a8861f1SDaniel M. Lambea * @separator: char to use as separator 21351a8861f1SDaniel M. Lambea * 21361a8861f1SDaniel M. Lambea * Check if two devices share the same path up to the last occurrence of 21371a8861f1SDaniel M. Lambea * the separator char. Both paths must exist (i.e., zero-length paths 21381a8861f1SDaniel M. Lambea * don't match). 21391a8861f1SDaniel M. Lambea */ 21401a8861f1SDaniel M. Lambea bool hid_compare_device_paths(struct hid_device *hdev_a, 21411a8861f1SDaniel M. Lambea struct hid_device *hdev_b, char separator) 21421a8861f1SDaniel M. Lambea { 21431a8861f1SDaniel M. Lambea int n1 = strrchr(hdev_a->phys, separator) - hdev_a->phys; 21441a8861f1SDaniel M. Lambea int n2 = strrchr(hdev_b->phys, separator) - hdev_b->phys; 21451a8861f1SDaniel M. Lambea 21461a8861f1SDaniel M. Lambea if (n1 != n2 || n1 <= 0 || n2 <= 0) 21471a8861f1SDaniel M. Lambea return false; 21481a8861f1SDaniel M. Lambea 21491a8861f1SDaniel M. Lambea return !strncmp(hdev_a->phys, hdev_b->phys, n1); 21501a8861f1SDaniel M. Lambea } 21511a8861f1SDaniel M. Lambea EXPORT_SYMBOL_GPL(hid_compare_device_paths); 21521a8861f1SDaniel M. Lambea 215385cdaf52SJiri Slaby static int hid_device_probe(struct device *dev) 215485cdaf52SJiri Slaby { 2155ba91a967SGeliang Tang struct hid_driver *hdrv = to_hid_driver(dev->driver); 2156ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 215785cdaf52SJiri Slaby const struct hid_device_id *id; 215885cdaf52SJiri Slaby int ret = 0; 215985cdaf52SJiri Slaby 2160c849a614SAndrew de los Reyes if (down_interruptible(&hdev->driver_input_lock)) { 2161c849a614SAndrew de los Reyes ret = -EINTR; 21626f68f0acSBinoy Jayan goto end; 2163c849a614SAndrew de los Reyes } 2164c849a614SAndrew de los Reyes hdev->io_started = false; 21654ea54542SDavid Herrmann 21668f732850SBenjamin Tissoires clear_bit(ffs(HID_STAT_REPROBED), &hdev->status); 21678f732850SBenjamin Tissoires 216885cdaf52SJiri Slaby if (!hdev->driver) { 21693a6f82f7SJiri Slaby id = hid_match_device(hdev, hdrv); 2170ba623a77SDan Carpenter if (id == NULL) { 2171ba623a77SDan Carpenter ret = -ENODEV; 2172ba623a77SDan Carpenter goto unlock; 2173ba623a77SDan Carpenter } 2174c500c971SJiri Slaby 2175e04a0442SBenjamin Tissoires if (hdrv->match) { 2176e04a0442SBenjamin Tissoires if (!hdrv->match(hdev, hid_ignore_special_drivers)) { 2177e04a0442SBenjamin Tissoires ret = -ENODEV; 2178e04a0442SBenjamin Tissoires goto unlock; 2179e04a0442SBenjamin Tissoires } 2180e04a0442SBenjamin Tissoires } else { 2181e04a0442SBenjamin Tissoires /* 2182e04a0442SBenjamin Tissoires * hid-generic implements .match(), so if 2183e04a0442SBenjamin Tissoires * hid_ignore_special_drivers is set, we can safely 2184e04a0442SBenjamin Tissoires * return. 2185e04a0442SBenjamin Tissoires */ 2186e04a0442SBenjamin Tissoires if (hid_ignore_special_drivers) { 2187e04a0442SBenjamin Tissoires ret = -ENODEV; 2188e04a0442SBenjamin Tissoires goto unlock; 2189e04a0442SBenjamin Tissoires } 2190e04a0442SBenjamin Tissoires } 2191e04a0442SBenjamin Tissoires 21922904e68fSBenjamin Tissoires /* reset the quirks that has been previously set */ 21932904e68fSBenjamin Tissoires hdev->quirks = hid_lookup_quirk(hdev); 219485cdaf52SJiri Slaby hdev->driver = hdrv; 2195c500c971SJiri Slaby if (hdrv->probe) { 2196c500c971SJiri Slaby ret = hdrv->probe(hdev, id); 2197c500c971SJiri Slaby } else { /* default probe */ 2198a7197c2eSHenrik Rydberg ret = hid_open_report(hdev); 2199c500c971SJiri Slaby if (!ret) 220093c10132SJiri Slaby ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT); 2201c500c971SJiri Slaby } 2202a7197c2eSHenrik Rydberg if (ret) { 2203a7197c2eSHenrik Rydberg hid_close_report(hdev); 2204c500c971SJiri Slaby hdev->driver = NULL; 220585cdaf52SJiri Slaby } 2206a7197c2eSHenrik Rydberg } 2207ba623a77SDan Carpenter unlock: 2208c849a614SAndrew de los Reyes if (!hdev->io_started) 2209c849a614SAndrew de los Reyes up(&hdev->driver_input_lock); 22106f68f0acSBinoy Jayan end: 221185cdaf52SJiri Slaby return ret; 221285cdaf52SJiri Slaby } 221385cdaf52SJiri Slaby 221485cdaf52SJiri Slaby static int hid_device_remove(struct device *dev) 221585cdaf52SJiri Slaby { 2216ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 22174ea54542SDavid Herrmann struct hid_driver *hdrv; 2218c849a614SAndrew de los Reyes int ret = 0; 221985cdaf52SJiri Slaby 2220c849a614SAndrew de los Reyes if (down_interruptible(&hdev->driver_input_lock)) { 2221c849a614SAndrew de los Reyes ret = -EINTR; 22226f68f0acSBinoy Jayan goto end; 2223c849a614SAndrew de los Reyes } 2224c849a614SAndrew de los Reyes hdev->io_started = false; 22254ea54542SDavid Herrmann 22264ea54542SDavid Herrmann hdrv = hdev->driver; 222785cdaf52SJiri Slaby if (hdrv) { 222885cdaf52SJiri Slaby if (hdrv->remove) 222985cdaf52SJiri Slaby hdrv->remove(hdev); 2230c500c971SJiri Slaby else /* default remove */ 2231c500c971SJiri Slaby hid_hw_stop(hdev); 2232a7197c2eSHenrik Rydberg hid_close_report(hdev); 223385cdaf52SJiri Slaby hdev->driver = NULL; 223485cdaf52SJiri Slaby } 223585cdaf52SJiri Slaby 2236c849a614SAndrew de los Reyes if (!hdev->io_started) 2237c849a614SAndrew de los Reyes up(&hdev->driver_input_lock); 22386f68f0acSBinoy Jayan end: 2239c849a614SAndrew de los Reyes return ret; 224085cdaf52SJiri Slaby } 224185cdaf52SJiri Slaby 22424d53b801SHenrik Rydberg static ssize_t modalias_show(struct device *dev, struct device_attribute *a, 22434d53b801SHenrik Rydberg char *buf) 22444d53b801SHenrik Rydberg { 22454d53b801SHenrik Rydberg struct hid_device *hdev = container_of(dev, struct hid_device, dev); 22464d53b801SHenrik Rydberg 2247dfa0c5faSRasmus Villemoes return scnprintf(buf, PAGE_SIZE, "hid:b%04Xg%04Xv%08Xp%08X\n", 22484d53b801SHenrik Rydberg hdev->bus, hdev->group, hdev->vendor, hdev->product); 22494d53b801SHenrik Rydberg } 22500d4260e0SGreg Kroah-Hartman static DEVICE_ATTR_RO(modalias); 22514d53b801SHenrik Rydberg 22520d4260e0SGreg Kroah-Hartman static struct attribute *hid_dev_attrs[] = { 22530d4260e0SGreg Kroah-Hartman &dev_attr_modalias.attr, 22540d4260e0SGreg Kroah-Hartman NULL, 22554d53b801SHenrik Rydberg }; 225654f32fd5SAndy Lutomirski static struct bin_attribute *hid_dev_bin_attrs[] = { 225754f32fd5SAndy Lutomirski &dev_bin_attr_report_desc, 225854f32fd5SAndy Lutomirski NULL 225954f32fd5SAndy Lutomirski }; 226054f32fd5SAndy Lutomirski static const struct attribute_group hid_dev_group = { 226154f32fd5SAndy Lutomirski .attrs = hid_dev_attrs, 226254f32fd5SAndy Lutomirski .bin_attrs = hid_dev_bin_attrs, 226354f32fd5SAndy Lutomirski }; 226454f32fd5SAndy Lutomirski __ATTRIBUTE_GROUPS(hid_dev); 22654d53b801SHenrik Rydberg 226685cdaf52SJiri Slaby static int hid_uevent(struct device *dev, struct kobj_uevent_env *env) 226785cdaf52SJiri Slaby { 2268ee79a8f8SGeliang Tang struct hid_device *hdev = to_hid_device(dev); 226985cdaf52SJiri Slaby 227085cdaf52SJiri Slaby if (add_uevent_var(env, "HID_ID=%04X:%08X:%08X", 227185cdaf52SJiri Slaby hdev->bus, hdev->vendor, hdev->product)) 227285cdaf52SJiri Slaby return -ENOMEM; 227385cdaf52SJiri Slaby 227485cdaf52SJiri Slaby if (add_uevent_var(env, "HID_NAME=%s", hdev->name)) 227585cdaf52SJiri Slaby return -ENOMEM; 227685cdaf52SJiri Slaby 227785cdaf52SJiri Slaby if (add_uevent_var(env, "HID_PHYS=%s", hdev->phys)) 227885cdaf52SJiri Slaby return -ENOMEM; 227985cdaf52SJiri Slaby 228085cdaf52SJiri Slaby if (add_uevent_var(env, "HID_UNIQ=%s", hdev->uniq)) 228185cdaf52SJiri Slaby return -ENOMEM; 228285cdaf52SJiri Slaby 22834d53b801SHenrik Rydberg if (add_uevent_var(env, "MODALIAS=hid:b%04Xg%04Xv%08Xp%08X", 22844d53b801SHenrik Rydberg hdev->bus, hdev->group, hdev->vendor, hdev->product)) 228585cdaf52SJiri Slaby return -ENOMEM; 228685cdaf52SJiri Slaby 228785cdaf52SJiri Slaby return 0; 228885cdaf52SJiri Slaby } 228985cdaf52SJiri Slaby 2290e04a0442SBenjamin Tissoires struct bus_type hid_bus_type = { 229185cdaf52SJiri Slaby .name = "hid", 22920d4260e0SGreg Kroah-Hartman .dev_groups = hid_dev_groups, 2293c2810325SGreg Kroah-Hartman .drv_groups = hid_drv_groups, 229485cdaf52SJiri Slaby .match = hid_bus_match, 229585cdaf52SJiri Slaby .probe = hid_device_probe, 229685cdaf52SJiri Slaby .remove = hid_device_remove, 229785cdaf52SJiri Slaby .uevent = hid_uevent, 229885cdaf52SJiri Slaby }; 2299d5d3e202SBenjamin Tissoires EXPORT_SYMBOL(hid_bus_type); 2300d458a9dfSJiri Slaby 230185cdaf52SJiri Slaby int hid_add_device(struct hid_device *hdev) 230285cdaf52SJiri Slaby { 230385cdaf52SJiri Slaby static atomic_t id = ATOMIC_INIT(0); 230485cdaf52SJiri Slaby int ret; 230585cdaf52SJiri Slaby 230685cdaf52SJiri Slaby if (WARN_ON(hdev->status & HID_STAT_ADDED)) 230785cdaf52SJiri Slaby return -EBUSY; 230885cdaf52SJiri Slaby 2309d5d3e202SBenjamin Tissoires hdev->quirks = hid_lookup_quirk(hdev); 2310d5d3e202SBenjamin Tissoires 2311d458a9dfSJiri Slaby /* we need to kill them here, otherwise they will stay allocated to 2312d458a9dfSJiri Slaby * wait for coming driver */ 23134529eefaSLamarque V. Souza if (hid_ignore(hdev)) 2314d458a9dfSJiri Slaby return -ENODEV; 2315d458a9dfSJiri Slaby 2316a7197c2eSHenrik Rydberg /* 23173c86726cSBenjamin Tissoires * Check for the mandatory transport channel. 23183c86726cSBenjamin Tissoires */ 23193c86726cSBenjamin Tissoires if (!hdev->ll_driver->raw_request) { 23203c86726cSBenjamin Tissoires hid_err(hdev, "transport driver missing .raw_request()\n"); 23213c86726cSBenjamin Tissoires return -EINVAL; 23223c86726cSBenjamin Tissoires } 23233c86726cSBenjamin Tissoires 23243c86726cSBenjamin Tissoires /* 2325a7197c2eSHenrik Rydberg * Read the device report descriptor once and use as template 2326a7197c2eSHenrik Rydberg * for the driver-specific modifications. 2327a7197c2eSHenrik Rydberg */ 2328a7197c2eSHenrik Rydberg ret = hdev->ll_driver->parse(hdev); 2329a7197c2eSHenrik Rydberg if (ret) 2330a7197c2eSHenrik Rydberg return ret; 2331a7197c2eSHenrik Rydberg if (!hdev->dev_rdesc) 2332a7197c2eSHenrik Rydberg return -ENODEV; 2333a7197c2eSHenrik Rydberg 2334734c6609SHenrik Rydberg /* 2335734c6609SHenrik Rydberg * Scan generic devices for group information 2336734c6609SHenrik Rydberg */ 23374392bf33SBenjamin Tissoires if (hid_ignore_special_drivers) { 23384392bf33SBenjamin Tissoires hdev->group = HID_GROUP_GENERIC; 23394392bf33SBenjamin Tissoires } else if (!hdev->group && 23406e65d9d5SBenjamin Tissoires !(hdev->quirks & HID_QUIRK_HAVE_SPECIAL_DRIVER)) { 2341734c6609SHenrik Rydberg ret = hid_scan_report(hdev); 2342734c6609SHenrik Rydberg if (ret) 2343734c6609SHenrik Rydberg hid_warn(hdev, "bad device descriptor (%d)\n", ret); 2344734c6609SHenrik Rydberg } 2345734c6609SHenrik Rydberg 23466bbe586fSKay Sievers /* XXX hack, any other cleaner solution after the driver core 23476bbe586fSKay Sievers * is converted to allow more than 20 bytes as the device name? */ 23486bbe586fSKay Sievers dev_set_name(&hdev->dev, "%04X:%04X:%04X.%04X", hdev->bus, 234985cdaf52SJiri Slaby hdev->vendor, hdev->product, atomic_inc_return(&id)); 235085cdaf52SJiri Slaby 23514da361b6SBruno Prémont hid_debug_register(hdev, dev_name(&hdev->dev)); 235285cdaf52SJiri Slaby ret = device_add(&hdev->dev); 235385cdaf52SJiri Slaby if (!ret) 235485cdaf52SJiri Slaby hdev->status |= HID_STAT_ADDED; 23554da361b6SBruno Prémont else 23564da361b6SBruno Prémont hid_debug_unregister(hdev); 2357a635f9ddSJiri Kosina 235885cdaf52SJiri Slaby return ret; 235985cdaf52SJiri Slaby } 236085cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_add_device); 236185cdaf52SJiri Slaby 236285cdaf52SJiri Slaby /** 236385cdaf52SJiri Slaby * hid_allocate_device - allocate new hid device descriptor 236485cdaf52SJiri Slaby * 236585cdaf52SJiri Slaby * Allocate and initialize hid device, so that hid_destroy_device might be 236685cdaf52SJiri Slaby * used to free it. 236785cdaf52SJiri Slaby * 236885cdaf52SJiri Slaby * New hid_device pointer is returned on success, otherwise ERR_PTR encoded 236985cdaf52SJiri Slaby * error value. 237085cdaf52SJiri Slaby */ 237185cdaf52SJiri Slaby struct hid_device *hid_allocate_device(void) 237285cdaf52SJiri Slaby { 237385cdaf52SJiri Slaby struct hid_device *hdev; 237485cdaf52SJiri Slaby int ret = -ENOMEM; 237585cdaf52SJiri Slaby 237685cdaf52SJiri Slaby hdev = kzalloc(sizeof(*hdev), GFP_KERNEL); 237785cdaf52SJiri Slaby if (hdev == NULL) 237885cdaf52SJiri Slaby return ERR_PTR(ret); 237985cdaf52SJiri Slaby 238085cdaf52SJiri Slaby device_initialize(&hdev->dev); 238185cdaf52SJiri Slaby hdev->dev.release = hid_device_release; 238285cdaf52SJiri Slaby hdev->dev.bus = &hid_bus_type; 238364bebefcSFu, Zhonghui device_enable_async_suspend(&hdev->dev); 238485cdaf52SJiri Slaby 2385a7197c2eSHenrik Rydberg hid_close_report(hdev); 238685cdaf52SJiri Slaby 2387cd667ce2SJiri Kosina init_waitqueue_head(&hdev->debug_wait); 2388cd667ce2SJiri Kosina INIT_LIST_HEAD(&hdev->debug_list); 23891deb9d34SJiri Kosina spin_lock_init(&hdev->debug_list_lock); 2390c849a614SAndrew de los Reyes sema_init(&hdev->driver_input_lock, 1); 2391aaac082dSDmitry Torokhov mutex_init(&hdev->ll_open_lock); 2392cd667ce2SJiri Kosina 239385cdaf52SJiri Slaby return hdev; 239485cdaf52SJiri Slaby } 239585cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_allocate_device); 239685cdaf52SJiri Slaby 239785cdaf52SJiri Slaby static void hid_remove_device(struct hid_device *hdev) 239885cdaf52SJiri Slaby { 239985cdaf52SJiri Slaby if (hdev->status & HID_STAT_ADDED) { 240085cdaf52SJiri Slaby device_del(&hdev->dev); 2401a635f9ddSJiri Kosina hid_debug_unregister(hdev); 240285cdaf52SJiri Slaby hdev->status &= ~HID_STAT_ADDED; 240385cdaf52SJiri Slaby } 2404a7197c2eSHenrik Rydberg kfree(hdev->dev_rdesc); 2405a7197c2eSHenrik Rydberg hdev->dev_rdesc = NULL; 2406a7197c2eSHenrik Rydberg hdev->dev_rsize = 0; 240785cdaf52SJiri Slaby } 240885cdaf52SJiri Slaby 240985cdaf52SJiri Slaby /** 241085cdaf52SJiri Slaby * hid_destroy_device - free previously allocated device 241185cdaf52SJiri Slaby * 241285cdaf52SJiri Slaby * @hdev: hid device 241385cdaf52SJiri Slaby * 241485cdaf52SJiri Slaby * If you allocate hid_device through hid_allocate_device, you should ever 241585cdaf52SJiri Slaby * free by this function. 241685cdaf52SJiri Slaby */ 241785cdaf52SJiri Slaby void hid_destroy_device(struct hid_device *hdev) 241885cdaf52SJiri Slaby { 241985cdaf52SJiri Slaby hid_remove_device(hdev); 242085cdaf52SJiri Slaby put_device(&hdev->dev); 242185cdaf52SJiri Slaby } 242285cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_destroy_device); 242385cdaf52SJiri Slaby 2424e04a0442SBenjamin Tissoires 2425c17a7476SBenjamin Tissoires static int __hid_bus_reprobe_drivers(struct device *dev, void *data) 2426e04a0442SBenjamin Tissoires { 2427c17a7476SBenjamin Tissoires struct hid_driver *hdrv = data; 2428c17a7476SBenjamin Tissoires struct hid_device *hdev = to_hid_device(dev); 2429c17a7476SBenjamin Tissoires 2430c17a7476SBenjamin Tissoires if (hdev->driver == hdrv && 24318f732850SBenjamin Tissoires !hdrv->match(hdev, hid_ignore_special_drivers) && 24328f732850SBenjamin Tissoires !test_and_set_bit(ffs(HID_STAT_REPROBED), &hdev->status)) 2433c17a7476SBenjamin Tissoires return device_reprobe(dev); 2434c17a7476SBenjamin Tissoires 2435c17a7476SBenjamin Tissoires return 0; 2436c17a7476SBenjamin Tissoires } 2437c17a7476SBenjamin Tissoires 2438c17a7476SBenjamin Tissoires static int __hid_bus_driver_added(struct device_driver *drv, void *data) 2439c17a7476SBenjamin Tissoires { 2440e04a0442SBenjamin Tissoires struct hid_driver *hdrv = to_hid_driver(drv); 2441e04a0442SBenjamin Tissoires 2442c17a7476SBenjamin Tissoires if (hdrv->match) { 2443c17a7476SBenjamin Tissoires bus_for_each_dev(&hid_bus_type, NULL, hdrv, 2444c17a7476SBenjamin Tissoires __hid_bus_reprobe_drivers); 2445c17a7476SBenjamin Tissoires } 2446e04a0442SBenjamin Tissoires 2447e04a0442SBenjamin Tissoires return 0; 2448e04a0442SBenjamin Tissoires } 2449e04a0442SBenjamin Tissoires 2450e04a0442SBenjamin Tissoires static int __bus_removed_driver(struct device_driver *drv, void *data) 2451e04a0442SBenjamin Tissoires { 2452c17a7476SBenjamin Tissoires return bus_rescan_devices(&hid_bus_type); 2453e04a0442SBenjamin Tissoires } 2454e04a0442SBenjamin Tissoires 245585cdaf52SJiri Slaby int __hid_register_driver(struct hid_driver *hdrv, struct module *owner, 245685cdaf52SJiri Slaby const char *mod_name) 245785cdaf52SJiri Slaby { 2458c17a7476SBenjamin Tissoires int ret; 2459c17a7476SBenjamin Tissoires 246085cdaf52SJiri Slaby hdrv->driver.name = hdrv->name; 246185cdaf52SJiri Slaby hdrv->driver.bus = &hid_bus_type; 246285cdaf52SJiri Slaby hdrv->driver.owner = owner; 246385cdaf52SJiri Slaby hdrv->driver.mod_name = mod_name; 246485cdaf52SJiri Slaby 24653a6f82f7SJiri Slaby INIT_LIST_HEAD(&hdrv->dyn_list); 24663a6f82f7SJiri Slaby spin_lock_init(&hdrv->dyn_lock); 24673a6f82f7SJiri Slaby 2468c17a7476SBenjamin Tissoires ret = driver_register(&hdrv->driver); 2469e04a0442SBenjamin Tissoires 2470c17a7476SBenjamin Tissoires if (ret == 0) 2471c17a7476SBenjamin Tissoires bus_for_each_drv(&hid_bus_type, NULL, NULL, 2472c17a7476SBenjamin Tissoires __hid_bus_driver_added); 2473c17a7476SBenjamin Tissoires 2474c17a7476SBenjamin Tissoires return ret; 247585cdaf52SJiri Slaby } 247685cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(__hid_register_driver); 247785cdaf52SJiri Slaby 247885cdaf52SJiri Slaby void hid_unregister_driver(struct hid_driver *hdrv) 247985cdaf52SJiri Slaby { 248085cdaf52SJiri Slaby driver_unregister(&hdrv->driver); 24813a6f82f7SJiri Slaby hid_free_dynids(hdrv); 2482e04a0442SBenjamin Tissoires 2483e04a0442SBenjamin Tissoires bus_for_each_drv(&hid_bus_type, NULL, hdrv, __bus_removed_driver); 248485cdaf52SJiri Slaby } 248585cdaf52SJiri Slaby EXPORT_SYMBOL_GPL(hid_unregister_driver); 248685cdaf52SJiri Slaby 24870361a28dSOliver Neukum int hid_check_keys_pressed(struct hid_device *hid) 24880361a28dSOliver Neukum { 24890361a28dSOliver Neukum struct hid_input *hidinput; 24900361a28dSOliver Neukum int i; 24910361a28dSOliver Neukum 2492e5288eb5SJiri Kosina if (!(hid->claimed & HID_CLAIMED_INPUT)) 2493e5288eb5SJiri Kosina return 0; 2494e5288eb5SJiri Kosina 24950361a28dSOliver Neukum list_for_each_entry(hidinput, &hid->inputs, list) { 24960361a28dSOliver Neukum for (i = 0; i < BITS_TO_LONGS(KEY_MAX); i++) 24970361a28dSOliver Neukum if (hidinput->input->key[i]) 24980361a28dSOliver Neukum return 1; 24990361a28dSOliver Neukum } 25000361a28dSOliver Neukum 25010361a28dSOliver Neukum return 0; 25020361a28dSOliver Neukum } 25030361a28dSOliver Neukum 25040361a28dSOliver Neukum EXPORT_SYMBOL_GPL(hid_check_keys_pressed); 25050361a28dSOliver Neukum 250686166b7bSJiri Kosina static int __init hid_init(void) 250786166b7bSJiri Kosina { 250885cdaf52SJiri Slaby int ret; 250985cdaf52SJiri Slaby 2510a635f9ddSJiri Kosina if (hid_debug) 25114291ee30SJoe Perches pr_warn("hid_debug is now used solely for parser and driver debugging.\n" 25124291ee30SJoe Perches "debugfs is now used for inspecting the device (report descriptor, reports)\n"); 2513a635f9ddSJiri Kosina 251485cdaf52SJiri Slaby ret = bus_register(&hid_bus_type); 251585cdaf52SJiri Slaby if (ret) { 25164291ee30SJoe Perches pr_err("can't register hid bus\n"); 251785cdaf52SJiri Slaby goto err; 251885cdaf52SJiri Slaby } 251985cdaf52SJiri Slaby 252085cdaf52SJiri Slaby ret = hidraw_init(); 252185cdaf52SJiri Slaby if (ret) 252285cdaf52SJiri Slaby goto err_bus; 252385cdaf52SJiri Slaby 2524a635f9ddSJiri Kosina hid_debug_init(); 2525a635f9ddSJiri Kosina 252685cdaf52SJiri Slaby return 0; 252785cdaf52SJiri Slaby err_bus: 252885cdaf52SJiri Slaby bus_unregister(&hid_bus_type); 252985cdaf52SJiri Slaby err: 253085cdaf52SJiri Slaby return ret; 253186166b7bSJiri Kosina } 253286166b7bSJiri Kosina 253386166b7bSJiri Kosina static void __exit hid_exit(void) 253486166b7bSJiri Kosina { 2535a635f9ddSJiri Kosina hid_debug_exit(); 253686166b7bSJiri Kosina hidraw_exit(); 253785cdaf52SJiri Slaby bus_unregister(&hid_bus_type); 2538d5d3e202SBenjamin Tissoires hid_quirks_exit(HID_BUS_ANY); 253986166b7bSJiri Kosina } 254086166b7bSJiri Kosina 254186166b7bSJiri Kosina module_init(hid_init); 254286166b7bSJiri Kosina module_exit(hid_exit); 254386166b7bSJiri Kosina 254488adb72bSJiri Kosina MODULE_AUTHOR("Andreas Gal"); 254588adb72bSJiri Kosina MODULE_AUTHOR("Vojtech Pavlik"); 254688adb72bSJiri Kosina MODULE_AUTHOR("Jiri Kosina"); 25477021b600SGrant Grundler MODULE_LICENSE("GPL"); 2548