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 7f142b3a4SJiri Kosina * Copyright (c) 2006-2007 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 17dde5845aSJiri Kosina #include <linux/module.h> 18dde5845aSJiri Kosina #include <linux/slab.h> 19dde5845aSJiri Kosina #include <linux/init.h> 20dde5845aSJiri Kosina #include <linux/kernel.h> 21dde5845aSJiri Kosina #include <linux/list.h> 22dde5845aSJiri Kosina #include <linux/mm.h> 23dde5845aSJiri Kosina #include <linux/spinlock.h> 24dde5845aSJiri Kosina #include <asm/unaligned.h> 25dde5845aSJiri Kosina #include <asm/byteorder.h> 26dde5845aSJiri Kosina #include <linux/input.h> 27dde5845aSJiri Kosina #include <linux/wait.h> 2847a80edbSJiri Kosina #include <linux/vmalloc.h> 29dde5845aSJiri Kosina 30dde5845aSJiri Kosina #include <linux/hid.h> 31dde5845aSJiri Kosina #include <linux/hiddev.h> 32c080d89aSJiri Kosina #include <linux/hid-debug.h> 33dde5845aSJiri Kosina 34dde5845aSJiri Kosina /* 35dde5845aSJiri Kosina * Version Information 36dde5845aSJiri Kosina */ 37dde5845aSJiri Kosina 38dde5845aSJiri Kosina #define DRIVER_VERSION "v2.6" 39f142b3a4SJiri Kosina #define DRIVER_AUTHOR "Andreas Gal, Vojtech Pavlik, Jiri Kosina" 4053149801SJiri Kosina #define DRIVER_DESC "HID core driver" 41dde5845aSJiri Kosina #define DRIVER_LICENSE "GPL" 42dde5845aSJiri Kosina 43*58037eb9SJiri Kosina #ifdef CONFIG_HID_DEBUG 44*58037eb9SJiri Kosina int hid_debug = 0; 45*58037eb9SJiri Kosina module_param_named(debug, hid_debug, bool, 0600); 46*58037eb9SJiri Kosina MODULE_PARM_DESC(debug, "Turn HID debugging mode on and off"); 47*58037eb9SJiri Kosina EXPORT_SYMBOL_GPL(hid_debug); 48*58037eb9SJiri Kosina #endif 49*58037eb9SJiri Kosina 50dde5845aSJiri Kosina /* 51dde5845aSJiri Kosina * Register a new report for a device. 52dde5845aSJiri Kosina */ 53dde5845aSJiri Kosina 54dde5845aSJiri Kosina static struct hid_report *hid_register_report(struct hid_device *device, unsigned type, unsigned id) 55dde5845aSJiri Kosina { 56dde5845aSJiri Kosina struct hid_report_enum *report_enum = device->report_enum + type; 57dde5845aSJiri Kosina struct hid_report *report; 58dde5845aSJiri Kosina 59dde5845aSJiri Kosina if (report_enum->report_id_hash[id]) 60dde5845aSJiri Kosina return report_enum->report_id_hash[id]; 61dde5845aSJiri Kosina 62dde5845aSJiri Kosina if (!(report = kzalloc(sizeof(struct hid_report), GFP_KERNEL))) 63dde5845aSJiri Kosina return NULL; 64dde5845aSJiri Kosina 65dde5845aSJiri Kosina if (id != 0) 66dde5845aSJiri Kosina report_enum->numbered = 1; 67dde5845aSJiri Kosina 68dde5845aSJiri Kosina report->id = id; 69dde5845aSJiri Kosina report->type = type; 70dde5845aSJiri Kosina report->size = 0; 71dde5845aSJiri Kosina report->device = device; 72dde5845aSJiri Kosina report_enum->report_id_hash[id] = report; 73dde5845aSJiri Kosina 74dde5845aSJiri Kosina list_add_tail(&report->list, &report_enum->report_list); 75dde5845aSJiri Kosina 76dde5845aSJiri Kosina return report; 77dde5845aSJiri Kosina } 78dde5845aSJiri Kosina 79dde5845aSJiri Kosina /* 80dde5845aSJiri Kosina * Register a new field for this report. 81dde5845aSJiri Kosina */ 82dde5845aSJiri Kosina 83dde5845aSJiri Kosina static struct hid_field *hid_register_field(struct hid_report *report, unsigned usages, unsigned values) 84dde5845aSJiri Kosina { 85dde5845aSJiri Kosina struct hid_field *field; 86dde5845aSJiri Kosina 87dde5845aSJiri Kosina if (report->maxfield == HID_MAX_FIELDS) { 88*58037eb9SJiri Kosina dbg_hid("too many fields in report\n"); 89dde5845aSJiri Kosina return NULL; 90dde5845aSJiri Kosina } 91dde5845aSJiri Kosina 92dde5845aSJiri Kosina if (!(field = kzalloc(sizeof(struct hid_field) + usages * sizeof(struct hid_usage) 93dde5845aSJiri Kosina + values * sizeof(unsigned), GFP_KERNEL))) return NULL; 94dde5845aSJiri Kosina 95dde5845aSJiri Kosina field->index = report->maxfield++; 96dde5845aSJiri Kosina report->field[field->index] = field; 97dde5845aSJiri Kosina field->usage = (struct hid_usage *)(field + 1); 98dde5845aSJiri Kosina field->value = (unsigned *)(field->usage + usages); 99dde5845aSJiri Kosina field->report = report; 100dde5845aSJiri Kosina 101dde5845aSJiri Kosina return field; 102dde5845aSJiri Kosina } 103dde5845aSJiri Kosina 104dde5845aSJiri Kosina /* 105dde5845aSJiri Kosina * Open a collection. The type/usage is pushed on the stack. 106dde5845aSJiri Kosina */ 107dde5845aSJiri Kosina 108dde5845aSJiri Kosina static int open_collection(struct hid_parser *parser, unsigned type) 109dde5845aSJiri Kosina { 110dde5845aSJiri Kosina struct hid_collection *collection; 111dde5845aSJiri Kosina unsigned usage; 112dde5845aSJiri Kosina 113dde5845aSJiri Kosina usage = parser->local.usage[0]; 114dde5845aSJiri Kosina 115dde5845aSJiri Kosina if (parser->collection_stack_ptr == HID_COLLECTION_STACK_SIZE) { 116*58037eb9SJiri Kosina dbg_hid("collection stack overflow\n"); 117dde5845aSJiri Kosina return -1; 118dde5845aSJiri Kosina } 119dde5845aSJiri Kosina 120dde5845aSJiri Kosina if (parser->device->maxcollection == parser->device->collection_size) { 121dde5845aSJiri Kosina collection = kmalloc(sizeof(struct hid_collection) * 122dde5845aSJiri Kosina parser->device->collection_size * 2, GFP_KERNEL); 123dde5845aSJiri Kosina if (collection == NULL) { 124*58037eb9SJiri Kosina dbg_hid("failed to reallocate collection array\n"); 125dde5845aSJiri Kosina return -1; 126dde5845aSJiri Kosina } 127dde5845aSJiri Kosina memcpy(collection, parser->device->collection, 128dde5845aSJiri Kosina sizeof(struct hid_collection) * 129dde5845aSJiri Kosina parser->device->collection_size); 130dde5845aSJiri Kosina memset(collection + parser->device->collection_size, 0, 131dde5845aSJiri Kosina sizeof(struct hid_collection) * 132dde5845aSJiri Kosina parser->device->collection_size); 133dde5845aSJiri Kosina kfree(parser->device->collection); 134dde5845aSJiri Kosina parser->device->collection = collection; 135dde5845aSJiri Kosina parser->device->collection_size *= 2; 136dde5845aSJiri Kosina } 137dde5845aSJiri Kosina 138dde5845aSJiri Kosina parser->collection_stack[parser->collection_stack_ptr++] = 139dde5845aSJiri Kosina parser->device->maxcollection; 140dde5845aSJiri Kosina 141dde5845aSJiri Kosina collection = parser->device->collection + 142dde5845aSJiri Kosina parser->device->maxcollection++; 143dde5845aSJiri Kosina collection->type = type; 144dde5845aSJiri Kosina collection->usage = usage; 145dde5845aSJiri Kosina collection->level = parser->collection_stack_ptr - 1; 146dde5845aSJiri Kosina 147dde5845aSJiri Kosina if (type == HID_COLLECTION_APPLICATION) 148dde5845aSJiri Kosina parser->device->maxapplication++; 149dde5845aSJiri Kosina 150dde5845aSJiri Kosina return 0; 151dde5845aSJiri Kosina } 152dde5845aSJiri Kosina 153dde5845aSJiri Kosina /* 154dde5845aSJiri Kosina * Close a collection. 155dde5845aSJiri Kosina */ 156dde5845aSJiri Kosina 157dde5845aSJiri Kosina static int close_collection(struct hid_parser *parser) 158dde5845aSJiri Kosina { 159dde5845aSJiri Kosina if (!parser->collection_stack_ptr) { 160*58037eb9SJiri Kosina dbg_hid("collection stack underflow\n"); 161dde5845aSJiri Kosina return -1; 162dde5845aSJiri Kosina } 163dde5845aSJiri Kosina parser->collection_stack_ptr--; 164dde5845aSJiri Kosina return 0; 165dde5845aSJiri Kosina } 166dde5845aSJiri Kosina 167dde5845aSJiri Kosina /* 168dde5845aSJiri Kosina * Climb up the stack, search for the specified collection type 169dde5845aSJiri Kosina * and return the usage. 170dde5845aSJiri Kosina */ 171dde5845aSJiri Kosina 172dde5845aSJiri Kosina static unsigned hid_lookup_collection(struct hid_parser *parser, unsigned type) 173dde5845aSJiri Kosina { 174dde5845aSJiri Kosina int n; 175dde5845aSJiri Kosina for (n = parser->collection_stack_ptr - 1; n >= 0; n--) 176dde5845aSJiri Kosina if (parser->device->collection[parser->collection_stack[n]].type == type) 177dde5845aSJiri Kosina return parser->device->collection[parser->collection_stack[n]].usage; 178dde5845aSJiri Kosina return 0; /* we know nothing about this usage type */ 179dde5845aSJiri Kosina } 180dde5845aSJiri Kosina 181dde5845aSJiri Kosina /* 182dde5845aSJiri Kosina * Add a usage to the temporary parser table. 183dde5845aSJiri Kosina */ 184dde5845aSJiri Kosina 185dde5845aSJiri Kosina static int hid_add_usage(struct hid_parser *parser, unsigned usage) 186dde5845aSJiri Kosina { 187dde5845aSJiri Kosina if (parser->local.usage_index >= HID_MAX_USAGES) { 188*58037eb9SJiri Kosina dbg_hid("usage index exceeded\n"); 189dde5845aSJiri Kosina return -1; 190dde5845aSJiri Kosina } 191dde5845aSJiri Kosina parser->local.usage[parser->local.usage_index] = usage; 192dde5845aSJiri Kosina parser->local.collection_index[parser->local.usage_index] = 193dde5845aSJiri Kosina parser->collection_stack_ptr ? 194dde5845aSJiri Kosina parser->collection_stack[parser->collection_stack_ptr - 1] : 0; 195dde5845aSJiri Kosina parser->local.usage_index++; 196dde5845aSJiri Kosina return 0; 197dde5845aSJiri Kosina } 198dde5845aSJiri Kosina 199dde5845aSJiri Kosina /* 200dde5845aSJiri Kosina * Register a new field for this report. 201dde5845aSJiri Kosina */ 202dde5845aSJiri Kosina 203dde5845aSJiri Kosina static int hid_add_field(struct hid_parser *parser, unsigned report_type, unsigned flags) 204dde5845aSJiri Kosina { 205dde5845aSJiri Kosina struct hid_report *report; 206dde5845aSJiri Kosina struct hid_field *field; 207dde5845aSJiri Kosina int usages; 208dde5845aSJiri Kosina unsigned offset; 209dde5845aSJiri Kosina int i; 210dde5845aSJiri Kosina 211dde5845aSJiri Kosina if (!(report = hid_register_report(parser->device, report_type, parser->global.report_id))) { 212*58037eb9SJiri Kosina dbg_hid("hid_register_report failed\n"); 213dde5845aSJiri Kosina return -1; 214dde5845aSJiri Kosina } 215dde5845aSJiri Kosina 216dde5845aSJiri Kosina if (parser->global.logical_maximum < parser->global.logical_minimum) { 217*58037eb9SJiri Kosina dbg_hid("logical range invalid %d %d\n", parser->global.logical_minimum, parser->global.logical_maximum); 218dde5845aSJiri Kosina return -1; 219dde5845aSJiri Kosina } 220dde5845aSJiri Kosina 221dde5845aSJiri Kosina offset = report->size; 222dde5845aSJiri Kosina report->size += parser->global.report_size * parser->global.report_count; 223dde5845aSJiri Kosina 224dde5845aSJiri Kosina if (!parser->local.usage_index) /* Ignore padding fields */ 225dde5845aSJiri Kosina return 0; 226dde5845aSJiri Kosina 227dde5845aSJiri Kosina usages = max_t(int, parser->local.usage_index, parser->global.report_count); 228dde5845aSJiri Kosina 229dde5845aSJiri Kosina if ((field = hid_register_field(report, usages, parser->global.report_count)) == NULL) 230dde5845aSJiri Kosina return 0; 231dde5845aSJiri Kosina 232dde5845aSJiri Kosina field->physical = hid_lookup_collection(parser, HID_COLLECTION_PHYSICAL); 233dde5845aSJiri Kosina field->logical = hid_lookup_collection(parser, HID_COLLECTION_LOGICAL); 234dde5845aSJiri Kosina field->application = hid_lookup_collection(parser, HID_COLLECTION_APPLICATION); 235dde5845aSJiri Kosina 236dde5845aSJiri Kosina for (i = 0; i < usages; i++) { 237dde5845aSJiri Kosina int j = i; 238dde5845aSJiri Kosina /* Duplicate the last usage we parsed if we have excess values */ 239dde5845aSJiri Kosina if (i >= parser->local.usage_index) 240dde5845aSJiri Kosina j = parser->local.usage_index - 1; 241dde5845aSJiri Kosina field->usage[i].hid = parser->local.usage[j]; 242dde5845aSJiri Kosina field->usage[i].collection_index = 243dde5845aSJiri Kosina parser->local.collection_index[j]; 244dde5845aSJiri Kosina } 245dde5845aSJiri Kosina 246dde5845aSJiri Kosina field->maxusage = usages; 247dde5845aSJiri Kosina field->flags = flags; 248dde5845aSJiri Kosina field->report_offset = offset; 249dde5845aSJiri Kosina field->report_type = report_type; 250dde5845aSJiri Kosina field->report_size = parser->global.report_size; 251dde5845aSJiri Kosina field->report_count = parser->global.report_count; 252dde5845aSJiri Kosina field->logical_minimum = parser->global.logical_minimum; 253dde5845aSJiri Kosina field->logical_maximum = parser->global.logical_maximum; 254dde5845aSJiri Kosina field->physical_minimum = parser->global.physical_minimum; 255dde5845aSJiri Kosina field->physical_maximum = parser->global.physical_maximum; 256dde5845aSJiri Kosina field->unit_exponent = parser->global.unit_exponent; 257dde5845aSJiri Kosina field->unit = parser->global.unit; 258dde5845aSJiri Kosina 259dde5845aSJiri Kosina return 0; 260dde5845aSJiri Kosina } 261dde5845aSJiri Kosina 262dde5845aSJiri Kosina /* 263dde5845aSJiri Kosina * Read data value from item. 264dde5845aSJiri Kosina */ 265dde5845aSJiri Kosina 266dde5845aSJiri Kosina static u32 item_udata(struct hid_item *item) 267dde5845aSJiri Kosina { 268dde5845aSJiri Kosina switch (item->size) { 269dde5845aSJiri Kosina case 1: return item->data.u8; 270dde5845aSJiri Kosina case 2: return item->data.u16; 271dde5845aSJiri Kosina case 4: return item->data.u32; 272dde5845aSJiri Kosina } 273dde5845aSJiri Kosina return 0; 274dde5845aSJiri Kosina } 275dde5845aSJiri Kosina 276dde5845aSJiri Kosina static s32 item_sdata(struct hid_item *item) 277dde5845aSJiri Kosina { 278dde5845aSJiri Kosina switch (item->size) { 279dde5845aSJiri Kosina case 1: return item->data.s8; 280dde5845aSJiri Kosina case 2: return item->data.s16; 281dde5845aSJiri Kosina case 4: return item->data.s32; 282dde5845aSJiri Kosina } 283dde5845aSJiri Kosina return 0; 284dde5845aSJiri Kosina } 285dde5845aSJiri Kosina 286dde5845aSJiri Kosina /* 287dde5845aSJiri Kosina * Process a global item. 288dde5845aSJiri Kosina */ 289dde5845aSJiri Kosina 290dde5845aSJiri Kosina static int hid_parser_global(struct hid_parser *parser, struct hid_item *item) 291dde5845aSJiri Kosina { 292dde5845aSJiri Kosina switch (item->tag) { 293dde5845aSJiri Kosina 294dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PUSH: 295dde5845aSJiri Kosina 296dde5845aSJiri Kosina if (parser->global_stack_ptr == HID_GLOBAL_STACK_SIZE) { 297*58037eb9SJiri Kosina dbg_hid("global enviroment stack overflow\n"); 298dde5845aSJiri Kosina return -1; 299dde5845aSJiri Kosina } 300dde5845aSJiri Kosina 301dde5845aSJiri Kosina memcpy(parser->global_stack + parser->global_stack_ptr++, 302dde5845aSJiri Kosina &parser->global, sizeof(struct hid_global)); 303dde5845aSJiri Kosina return 0; 304dde5845aSJiri Kosina 305dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_POP: 306dde5845aSJiri Kosina 307dde5845aSJiri Kosina if (!parser->global_stack_ptr) { 308*58037eb9SJiri Kosina dbg_hid("global enviroment stack underflow\n"); 309dde5845aSJiri Kosina return -1; 310dde5845aSJiri Kosina } 311dde5845aSJiri Kosina 312dde5845aSJiri Kosina memcpy(&parser->global, parser->global_stack + --parser->global_stack_ptr, 313dde5845aSJiri Kosina sizeof(struct hid_global)); 314dde5845aSJiri Kosina return 0; 315dde5845aSJiri Kosina 316dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_USAGE_PAGE: 317dde5845aSJiri Kosina parser->global.usage_page = item_udata(item); 318dde5845aSJiri Kosina return 0; 319dde5845aSJiri Kosina 320dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM: 321dde5845aSJiri Kosina parser->global.logical_minimum = item_sdata(item); 322dde5845aSJiri Kosina return 0; 323dde5845aSJiri Kosina 324dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM: 325dde5845aSJiri Kosina if (parser->global.logical_minimum < 0) 326dde5845aSJiri Kosina parser->global.logical_maximum = item_sdata(item); 327dde5845aSJiri Kosina else 328dde5845aSJiri Kosina parser->global.logical_maximum = item_udata(item); 329dde5845aSJiri Kosina return 0; 330dde5845aSJiri Kosina 331dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM: 332dde5845aSJiri Kosina parser->global.physical_minimum = item_sdata(item); 333dde5845aSJiri Kosina return 0; 334dde5845aSJiri Kosina 335dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM: 336dde5845aSJiri Kosina if (parser->global.physical_minimum < 0) 337dde5845aSJiri Kosina parser->global.physical_maximum = item_sdata(item); 338dde5845aSJiri Kosina else 339dde5845aSJiri Kosina parser->global.physical_maximum = item_udata(item); 340dde5845aSJiri Kosina return 0; 341dde5845aSJiri Kosina 342dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT: 343dde5845aSJiri Kosina parser->global.unit_exponent = item_sdata(item); 344dde5845aSJiri Kosina return 0; 345dde5845aSJiri Kosina 346dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_UNIT: 347dde5845aSJiri Kosina parser->global.unit = item_udata(item); 348dde5845aSJiri Kosina return 0; 349dde5845aSJiri Kosina 350dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_SIZE: 351dde5845aSJiri Kosina if ((parser->global.report_size = item_udata(item)) > 32) { 352*58037eb9SJiri Kosina dbg_hid("invalid report_size %d\n", parser->global.report_size); 353dde5845aSJiri Kosina return -1; 354dde5845aSJiri Kosina } 355dde5845aSJiri Kosina return 0; 356dde5845aSJiri Kosina 357dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_COUNT: 358dde5845aSJiri Kosina if ((parser->global.report_count = item_udata(item)) > HID_MAX_USAGES) { 359*58037eb9SJiri Kosina dbg_hid("invalid report_count %d\n", parser->global.report_count); 360dde5845aSJiri Kosina return -1; 361dde5845aSJiri Kosina } 362dde5845aSJiri Kosina return 0; 363dde5845aSJiri Kosina 364dde5845aSJiri Kosina case HID_GLOBAL_ITEM_TAG_REPORT_ID: 365dde5845aSJiri Kosina if ((parser->global.report_id = item_udata(item)) == 0) { 366*58037eb9SJiri Kosina dbg_hid("report_id 0 is invalid\n"); 367dde5845aSJiri Kosina return -1; 368dde5845aSJiri Kosina } 369dde5845aSJiri Kosina return 0; 370dde5845aSJiri Kosina 371dde5845aSJiri Kosina default: 372*58037eb9SJiri Kosina dbg_hid("unknown global tag 0x%x\n", item->tag); 373dde5845aSJiri Kosina return -1; 374dde5845aSJiri Kosina } 375dde5845aSJiri Kosina } 376dde5845aSJiri Kosina 377dde5845aSJiri Kosina /* 378dde5845aSJiri Kosina * Process a local item. 379dde5845aSJiri Kosina */ 380dde5845aSJiri Kosina 381dde5845aSJiri Kosina static int hid_parser_local(struct hid_parser *parser, struct hid_item *item) 382dde5845aSJiri Kosina { 383dde5845aSJiri Kosina __u32 data; 384dde5845aSJiri Kosina unsigned n; 385dde5845aSJiri Kosina 386dde5845aSJiri Kosina if (item->size == 0) { 387*58037eb9SJiri Kosina dbg_hid("item data expected for local item\n"); 388dde5845aSJiri Kosina return -1; 389dde5845aSJiri Kosina } 390dde5845aSJiri Kosina 391dde5845aSJiri Kosina data = item_udata(item); 392dde5845aSJiri Kosina 393dde5845aSJiri Kosina switch (item->tag) { 394dde5845aSJiri Kosina 395dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_DELIMITER: 396dde5845aSJiri Kosina 397dde5845aSJiri Kosina if (data) { 398dde5845aSJiri Kosina /* 399dde5845aSJiri Kosina * We treat items before the first delimiter 400dde5845aSJiri Kosina * as global to all usage sets (branch 0). 401dde5845aSJiri Kosina * In the moment we process only these global 402dde5845aSJiri Kosina * items and the first delimiter set. 403dde5845aSJiri Kosina */ 404dde5845aSJiri Kosina if (parser->local.delimiter_depth != 0) { 405*58037eb9SJiri Kosina dbg_hid("nested delimiters\n"); 406dde5845aSJiri Kosina return -1; 407dde5845aSJiri Kosina } 408dde5845aSJiri Kosina parser->local.delimiter_depth++; 409dde5845aSJiri Kosina parser->local.delimiter_branch++; 410dde5845aSJiri Kosina } else { 411dde5845aSJiri Kosina if (parser->local.delimiter_depth < 1) { 412*58037eb9SJiri Kosina dbg_hid("bogus close delimiter\n"); 413dde5845aSJiri Kosina return -1; 414dde5845aSJiri Kosina } 415dde5845aSJiri Kosina parser->local.delimiter_depth--; 416dde5845aSJiri Kosina } 417dde5845aSJiri Kosina return 1; 418dde5845aSJiri Kosina 419dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE: 420dde5845aSJiri Kosina 421dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 422*58037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 423dde5845aSJiri Kosina return 0; 424dde5845aSJiri Kosina } 425dde5845aSJiri Kosina 426dde5845aSJiri Kosina if (item->size <= 2) 427dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 428dde5845aSJiri Kosina 429dde5845aSJiri Kosina return hid_add_usage(parser, data); 430dde5845aSJiri Kosina 431dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE_MINIMUM: 432dde5845aSJiri Kosina 433dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 434*58037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 435dde5845aSJiri Kosina return 0; 436dde5845aSJiri Kosina } 437dde5845aSJiri Kosina 438dde5845aSJiri Kosina if (item->size <= 2) 439dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 440dde5845aSJiri Kosina 441dde5845aSJiri Kosina parser->local.usage_minimum = data; 442dde5845aSJiri Kosina return 0; 443dde5845aSJiri Kosina 444dde5845aSJiri Kosina case HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM: 445dde5845aSJiri Kosina 446dde5845aSJiri Kosina if (parser->local.delimiter_branch > 1) { 447*58037eb9SJiri Kosina dbg_hid("alternative usage ignored\n"); 448dde5845aSJiri Kosina return 0; 449dde5845aSJiri Kosina } 450dde5845aSJiri Kosina 451dde5845aSJiri Kosina if (item->size <= 2) 452dde5845aSJiri Kosina data = (parser->global.usage_page << 16) + data; 453dde5845aSJiri Kosina 454dde5845aSJiri Kosina for (n = parser->local.usage_minimum; n <= data; n++) 455dde5845aSJiri Kosina if (hid_add_usage(parser, n)) { 456*58037eb9SJiri Kosina dbg_hid("hid_add_usage failed\n"); 457dde5845aSJiri Kosina return -1; 458dde5845aSJiri Kosina } 459dde5845aSJiri Kosina return 0; 460dde5845aSJiri Kosina 461dde5845aSJiri Kosina default: 462dde5845aSJiri Kosina 463*58037eb9SJiri Kosina dbg_hid("unknown local item tag 0x%x\n", item->tag); 464dde5845aSJiri Kosina return 0; 465dde5845aSJiri Kosina } 466dde5845aSJiri Kosina return 0; 467dde5845aSJiri Kosina } 468dde5845aSJiri Kosina 469dde5845aSJiri Kosina /* 470dde5845aSJiri Kosina * Process a main item. 471dde5845aSJiri Kosina */ 472dde5845aSJiri Kosina 473dde5845aSJiri Kosina static int hid_parser_main(struct hid_parser *parser, struct hid_item *item) 474dde5845aSJiri Kosina { 475dde5845aSJiri Kosina __u32 data; 476dde5845aSJiri Kosina int ret; 477dde5845aSJiri Kosina 478dde5845aSJiri Kosina data = item_udata(item); 479dde5845aSJiri Kosina 480dde5845aSJiri Kosina switch (item->tag) { 481dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION: 482dde5845aSJiri Kosina ret = open_collection(parser, data & 0xff); 483dde5845aSJiri Kosina break; 484dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_END_COLLECTION: 485dde5845aSJiri Kosina ret = close_collection(parser); 486dde5845aSJiri Kosina break; 487dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_INPUT: 488dde5845aSJiri Kosina ret = hid_add_field(parser, HID_INPUT_REPORT, data); 489dde5845aSJiri Kosina break; 490dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_OUTPUT: 491dde5845aSJiri Kosina ret = hid_add_field(parser, HID_OUTPUT_REPORT, data); 492dde5845aSJiri Kosina break; 493dde5845aSJiri Kosina case HID_MAIN_ITEM_TAG_FEATURE: 494dde5845aSJiri Kosina ret = hid_add_field(parser, HID_FEATURE_REPORT, data); 495dde5845aSJiri Kosina break; 496dde5845aSJiri Kosina default: 497*58037eb9SJiri Kosina dbg_hid("unknown main item tag 0x%x\n", item->tag); 498dde5845aSJiri Kosina ret = 0; 499dde5845aSJiri Kosina } 500dde5845aSJiri Kosina 501dde5845aSJiri Kosina memset(&parser->local, 0, sizeof(parser->local)); /* Reset the local parser environment */ 502dde5845aSJiri Kosina 503dde5845aSJiri Kosina return ret; 504dde5845aSJiri Kosina } 505dde5845aSJiri Kosina 506dde5845aSJiri Kosina /* 507dde5845aSJiri Kosina * Process a reserved item. 508dde5845aSJiri Kosina */ 509dde5845aSJiri Kosina 510dde5845aSJiri Kosina static int hid_parser_reserved(struct hid_parser *parser, struct hid_item *item) 511dde5845aSJiri Kosina { 512*58037eb9SJiri Kosina dbg_hid("reserved item type, tag 0x%x\n", item->tag); 513dde5845aSJiri Kosina return 0; 514dde5845aSJiri Kosina } 515dde5845aSJiri Kosina 516dde5845aSJiri Kosina /* 517dde5845aSJiri Kosina * Free a report and all registered fields. The field->usage and 518dde5845aSJiri Kosina * field->value table's are allocated behind the field, so we need 519dde5845aSJiri Kosina * only to free(field) itself. 520dde5845aSJiri Kosina */ 521dde5845aSJiri Kosina 522dde5845aSJiri Kosina static void hid_free_report(struct hid_report *report) 523dde5845aSJiri Kosina { 524dde5845aSJiri Kosina unsigned n; 525dde5845aSJiri Kosina 526dde5845aSJiri Kosina for (n = 0; n < report->maxfield; n++) 527dde5845aSJiri Kosina kfree(report->field[n]); 528dde5845aSJiri Kosina kfree(report); 529dde5845aSJiri Kosina } 530dde5845aSJiri Kosina 531dde5845aSJiri Kosina /* 532dde5845aSJiri Kosina * Free a device structure, all reports, and all fields. 533dde5845aSJiri Kosina */ 534dde5845aSJiri Kosina 535229695e5SJiri Kosina void hid_free_device(struct hid_device *device) 536dde5845aSJiri Kosina { 537dde5845aSJiri Kosina unsigned i,j; 538dde5845aSJiri Kosina 539dde5845aSJiri Kosina for (i = 0; i < HID_REPORT_TYPES; i++) { 540dde5845aSJiri Kosina struct hid_report_enum *report_enum = device->report_enum + i; 541dde5845aSJiri Kosina 542dde5845aSJiri Kosina for (j = 0; j < 256; j++) { 543dde5845aSJiri Kosina struct hid_report *report = report_enum->report_id_hash[j]; 544dde5845aSJiri Kosina if (report) 545dde5845aSJiri Kosina hid_free_report(report); 546dde5845aSJiri Kosina } 547dde5845aSJiri Kosina } 548dde5845aSJiri Kosina 549dde5845aSJiri Kosina kfree(device->rdesc); 550767fe787SJiri Kosina kfree(device->collection); 551dde5845aSJiri Kosina kfree(device); 552dde5845aSJiri Kosina } 553229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_free_device); 554dde5845aSJiri Kosina 555dde5845aSJiri Kosina /* 556dde5845aSJiri Kosina * Fetch a report description item from the data stream. We support long 557dde5845aSJiri Kosina * items, though they are not used yet. 558dde5845aSJiri Kosina */ 559dde5845aSJiri Kosina 560dde5845aSJiri Kosina static u8 *fetch_item(__u8 *start, __u8 *end, struct hid_item *item) 561dde5845aSJiri Kosina { 562dde5845aSJiri Kosina u8 b; 563dde5845aSJiri Kosina 564dde5845aSJiri Kosina if ((end - start) <= 0) 565dde5845aSJiri Kosina return NULL; 566dde5845aSJiri Kosina 567dde5845aSJiri Kosina b = *start++; 568dde5845aSJiri Kosina 569dde5845aSJiri Kosina item->type = (b >> 2) & 3; 570dde5845aSJiri Kosina item->tag = (b >> 4) & 15; 571dde5845aSJiri Kosina 572dde5845aSJiri Kosina if (item->tag == HID_ITEM_TAG_LONG) { 573dde5845aSJiri Kosina 574dde5845aSJiri Kosina item->format = HID_ITEM_FORMAT_LONG; 575dde5845aSJiri Kosina 576dde5845aSJiri Kosina if ((end - start) < 2) 577dde5845aSJiri Kosina return NULL; 578dde5845aSJiri Kosina 579dde5845aSJiri Kosina item->size = *start++; 580dde5845aSJiri Kosina item->tag = *start++; 581dde5845aSJiri Kosina 582dde5845aSJiri Kosina if ((end - start) < item->size) 583dde5845aSJiri Kosina return NULL; 584dde5845aSJiri Kosina 585dde5845aSJiri Kosina item->data.longdata = start; 586dde5845aSJiri Kosina start += item->size; 587dde5845aSJiri Kosina return start; 588dde5845aSJiri Kosina } 589dde5845aSJiri Kosina 590dde5845aSJiri Kosina item->format = HID_ITEM_FORMAT_SHORT; 591dde5845aSJiri Kosina item->size = b & 3; 592dde5845aSJiri Kosina 593dde5845aSJiri Kosina switch (item->size) { 594dde5845aSJiri Kosina 595dde5845aSJiri Kosina case 0: 596dde5845aSJiri Kosina return start; 597dde5845aSJiri Kosina 598dde5845aSJiri Kosina case 1: 599dde5845aSJiri Kosina if ((end - start) < 1) 600dde5845aSJiri Kosina return NULL; 601dde5845aSJiri Kosina item->data.u8 = *start++; 602dde5845aSJiri Kosina return start; 603dde5845aSJiri Kosina 604dde5845aSJiri Kosina case 2: 605dde5845aSJiri Kosina if ((end - start) < 2) 606dde5845aSJiri Kosina return NULL; 607dde5845aSJiri Kosina item->data.u16 = le16_to_cpu(get_unaligned((__le16*)start)); 608dde5845aSJiri Kosina start = (__u8 *)((__le16 *)start + 1); 609dde5845aSJiri Kosina return start; 610dde5845aSJiri Kosina 611dde5845aSJiri Kosina case 3: 612dde5845aSJiri Kosina item->size++; 613dde5845aSJiri Kosina if ((end - start) < 4) 614dde5845aSJiri Kosina return NULL; 615dde5845aSJiri Kosina item->data.u32 = le32_to_cpu(get_unaligned((__le32*)start)); 616dde5845aSJiri Kosina start = (__u8 *)((__le32 *)start + 1); 617dde5845aSJiri Kosina return start; 618dde5845aSJiri Kosina } 619dde5845aSJiri Kosina 620dde5845aSJiri Kosina return NULL; 621dde5845aSJiri Kosina } 622dde5845aSJiri Kosina 623dde5845aSJiri Kosina /* 624dde5845aSJiri Kosina * Parse a report description into a hid_device structure. Reports are 625dde5845aSJiri Kosina * enumerated, fields are attached to these reports. 626dde5845aSJiri Kosina */ 627dde5845aSJiri Kosina 628229695e5SJiri Kosina struct hid_device *hid_parse_report(__u8 *start, unsigned size) 629dde5845aSJiri Kosina { 630dde5845aSJiri Kosina struct hid_device *device; 631dde5845aSJiri Kosina struct hid_parser *parser; 632dde5845aSJiri Kosina struct hid_item item; 633dde5845aSJiri Kosina __u8 *end; 634dde5845aSJiri Kosina unsigned i; 635dde5845aSJiri Kosina static int (*dispatch_type[])(struct hid_parser *parser, 636dde5845aSJiri Kosina struct hid_item *item) = { 637dde5845aSJiri Kosina hid_parser_main, 638dde5845aSJiri Kosina hid_parser_global, 639dde5845aSJiri Kosina hid_parser_local, 640dde5845aSJiri Kosina hid_parser_reserved 641dde5845aSJiri Kosina }; 642dde5845aSJiri Kosina 643dde5845aSJiri Kosina if (!(device = kzalloc(sizeof(struct hid_device), GFP_KERNEL))) 644dde5845aSJiri Kosina return NULL; 645dde5845aSJiri Kosina 646dde5845aSJiri Kosina if (!(device->collection = kzalloc(sizeof(struct hid_collection) * 647dde5845aSJiri Kosina HID_DEFAULT_NUM_COLLECTIONS, GFP_KERNEL))) { 648dde5845aSJiri Kosina kfree(device); 649dde5845aSJiri Kosina return NULL; 650dde5845aSJiri Kosina } 651dde5845aSJiri Kosina device->collection_size = HID_DEFAULT_NUM_COLLECTIONS; 652dde5845aSJiri Kosina 653dde5845aSJiri Kosina for (i = 0; i < HID_REPORT_TYPES; i++) 654dde5845aSJiri Kosina INIT_LIST_HEAD(&device->report_enum[i].report_list); 655dde5845aSJiri Kosina 656d6509c36SAhmed S. Darwish if (!(device->rdesc = kmalloc(size, GFP_KERNEL))) { 657dde5845aSJiri Kosina kfree(device->collection); 658dde5845aSJiri Kosina kfree(device); 659dde5845aSJiri Kosina return NULL; 660dde5845aSJiri Kosina } 661dde5845aSJiri Kosina memcpy(device->rdesc, start, size); 662dde5845aSJiri Kosina device->rsize = size; 663dde5845aSJiri Kosina 66447a80edbSJiri Kosina if (!(parser = vmalloc(sizeof(struct hid_parser)))) { 665dde5845aSJiri Kosina kfree(device->rdesc); 666dde5845aSJiri Kosina kfree(device->collection); 667dde5845aSJiri Kosina kfree(device); 668dde5845aSJiri Kosina return NULL; 669dde5845aSJiri Kosina } 67047a80edbSJiri Kosina memset(parser, 0, sizeof(struct hid_parser)); 671dde5845aSJiri Kosina parser->device = device; 672dde5845aSJiri Kosina 673dde5845aSJiri Kosina end = start + size; 674dde5845aSJiri Kosina while ((start = fetch_item(start, end, &item)) != NULL) { 675dde5845aSJiri Kosina 676dde5845aSJiri Kosina if (item.format != HID_ITEM_FORMAT_SHORT) { 677*58037eb9SJiri Kosina dbg_hid("unexpected long global item\n"); 678dde5845aSJiri Kosina hid_free_device(device); 67947a80edbSJiri Kosina vfree(parser); 680dde5845aSJiri Kosina return NULL; 681dde5845aSJiri Kosina } 682dde5845aSJiri Kosina 683dde5845aSJiri Kosina if (dispatch_type[item.type](parser, &item)) { 684*58037eb9SJiri Kosina dbg_hid("item %u %u %u %u parsing failed\n", 685dde5845aSJiri Kosina item.format, (unsigned)item.size, (unsigned)item.type, (unsigned)item.tag); 686dde5845aSJiri Kosina hid_free_device(device); 68747a80edbSJiri Kosina vfree(parser); 688dde5845aSJiri Kosina return NULL; 689dde5845aSJiri Kosina } 690dde5845aSJiri Kosina 691dde5845aSJiri Kosina if (start == end) { 692dde5845aSJiri Kosina if (parser->collection_stack_ptr) { 693*58037eb9SJiri Kosina dbg_hid("unbalanced collection at end of report description\n"); 694dde5845aSJiri Kosina hid_free_device(device); 69547a80edbSJiri Kosina vfree(parser); 696dde5845aSJiri Kosina return NULL; 697dde5845aSJiri Kosina } 698dde5845aSJiri Kosina if (parser->local.delimiter_depth) { 699*58037eb9SJiri Kosina dbg_hid("unbalanced delimiter at end of report description\n"); 700dde5845aSJiri Kosina hid_free_device(device); 70147a80edbSJiri Kosina vfree(parser); 702dde5845aSJiri Kosina return NULL; 703dde5845aSJiri Kosina } 70447a80edbSJiri Kosina vfree(parser); 705dde5845aSJiri Kosina return device; 706dde5845aSJiri Kosina } 707dde5845aSJiri Kosina } 708dde5845aSJiri Kosina 709*58037eb9SJiri Kosina dbg_hid("item fetching failed at offset %d\n", (int)(end - start)); 710dde5845aSJiri Kosina hid_free_device(device); 71147a80edbSJiri Kosina vfree(parser); 712dde5845aSJiri Kosina return NULL; 713dde5845aSJiri Kosina } 714229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_parse_report); 715dde5845aSJiri Kosina 716dde5845aSJiri Kosina /* 717dde5845aSJiri Kosina * Convert a signed n-bit integer to signed 32-bit integer. Common 718dde5845aSJiri Kosina * cases are done through the compiler, the screwed things has to be 719dde5845aSJiri Kosina * done by hand. 720dde5845aSJiri Kosina */ 721dde5845aSJiri Kosina 722dde5845aSJiri Kosina static s32 snto32(__u32 value, unsigned n) 723dde5845aSJiri Kosina { 724dde5845aSJiri Kosina switch (n) { 725dde5845aSJiri Kosina case 8: return ((__s8)value); 726dde5845aSJiri Kosina case 16: return ((__s16)value); 727dde5845aSJiri Kosina case 32: return ((__s32)value); 728dde5845aSJiri Kosina } 729dde5845aSJiri Kosina return value & (1 << (n - 1)) ? value | (-1 << n) : value; 730dde5845aSJiri Kosina } 731dde5845aSJiri Kosina 732dde5845aSJiri Kosina /* 733dde5845aSJiri Kosina * Convert a signed 32-bit integer to a signed n-bit integer. 734dde5845aSJiri Kosina */ 735dde5845aSJiri Kosina 736dde5845aSJiri Kosina static u32 s32ton(__s32 value, unsigned n) 737dde5845aSJiri Kosina { 738dde5845aSJiri Kosina s32 a = value >> (n - 1); 739dde5845aSJiri Kosina if (a && a != -1) 740dde5845aSJiri Kosina return value < 0 ? 1 << (n - 1) : (1 << (n - 1)) - 1; 741dde5845aSJiri Kosina return value & ((1 << n) - 1); 742dde5845aSJiri Kosina } 743dde5845aSJiri Kosina 744dde5845aSJiri Kosina /* 745dde5845aSJiri Kosina * Extract/implement a data field from/to a little endian report (bit array). 746dde5845aSJiri Kosina * 747dde5845aSJiri Kosina * Code sort-of follows HID spec: 748dde5845aSJiri Kosina * http://www.usb.org/developers/devclass_docs/HID1_11.pdf 749dde5845aSJiri Kosina * 750dde5845aSJiri Kosina * While the USB HID spec allows unlimited length bit fields in "report 751dde5845aSJiri Kosina * descriptors", most devices never use more than 16 bits. 752dde5845aSJiri Kosina * One model of UPS is claimed to report "LINEV" as a 32-bit field. 753dde5845aSJiri Kosina * Search linux-kernel and linux-usb-devel archives for "hid-core extract". 754dde5845aSJiri Kosina */ 755dde5845aSJiri Kosina 756dde5845aSJiri Kosina static __inline__ __u32 extract(__u8 *report, unsigned offset, unsigned n) 757dde5845aSJiri Kosina { 758dde5845aSJiri Kosina u64 x; 759dde5845aSJiri Kosina 760dde5845aSJiri Kosina WARN_ON(n > 32); 761dde5845aSJiri Kosina 762dde5845aSJiri Kosina report += offset >> 3; /* adjust byte index */ 763dde5845aSJiri Kosina offset &= 7; /* now only need bit offset into one byte */ 764b87496aaSAl Viro x = le64_to_cpu(get_unaligned((__le64 *) report)); 765dde5845aSJiri Kosina x = (x >> offset) & ((1ULL << n) - 1); /* extract bit field */ 766dde5845aSJiri Kosina return (u32) x; 767dde5845aSJiri Kosina } 768dde5845aSJiri Kosina 769dde5845aSJiri Kosina /* 770dde5845aSJiri Kosina * "implement" : set bits in a little endian bit stream. 771dde5845aSJiri Kosina * Same concepts as "extract" (see comments above). 772dde5845aSJiri Kosina * The data mangled in the bit stream remains in little endian 773dde5845aSJiri Kosina * order the whole time. It make more sense to talk about 774dde5845aSJiri Kosina * endianness of register values by considering a register 775dde5845aSJiri Kosina * a "cached" copy of the little endiad bit stream. 776dde5845aSJiri Kosina */ 777dde5845aSJiri Kosina static __inline__ void implement(__u8 *report, unsigned offset, unsigned n, __u32 value) 778dde5845aSJiri Kosina { 779b87496aaSAl Viro __le64 x; 780dde5845aSJiri Kosina u64 m = (1ULL << n) - 1; 781dde5845aSJiri Kosina 782dde5845aSJiri Kosina WARN_ON(n > 32); 783dde5845aSJiri Kosina 784dde5845aSJiri Kosina WARN_ON(value > m); 785dde5845aSJiri Kosina value &= m; 786dde5845aSJiri Kosina 787dde5845aSJiri Kosina report += offset >> 3; 788dde5845aSJiri Kosina offset &= 7; 789dde5845aSJiri Kosina 790b87496aaSAl Viro x = get_unaligned((__le64 *)report); 791dde5845aSJiri Kosina x &= cpu_to_le64(~(m << offset)); 792dde5845aSJiri Kosina x |= cpu_to_le64(((u64) value) << offset); 793b87496aaSAl Viro put_unaligned(x, (__le64 *) report); 794dde5845aSJiri Kosina } 795dde5845aSJiri Kosina 796dde5845aSJiri Kosina /* 797dde5845aSJiri Kosina * Search an array for a value. 798dde5845aSJiri Kosina */ 799dde5845aSJiri Kosina 800dde5845aSJiri Kosina static __inline__ int search(__s32 *array, __s32 value, unsigned n) 801dde5845aSJiri Kosina { 802dde5845aSJiri Kosina while (n--) { 803dde5845aSJiri Kosina if (*array++ == value) 804dde5845aSJiri Kosina return 0; 805dde5845aSJiri Kosina } 806dde5845aSJiri Kosina return -1; 807dde5845aSJiri Kosina } 808dde5845aSJiri Kosina 809dde5845aSJiri Kosina static void hid_process_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value, int interrupt) 810dde5845aSJiri Kosina { 811dde5845aSJiri Kosina hid_dump_input(usage, value); 812dde5845aSJiri Kosina if (hid->claimed & HID_CLAIMED_INPUT) 813dde5845aSJiri Kosina hidinput_hid_event(hid, field, usage, value); 814aa938f79SJiri Kosina if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt && hid->hiddev_hid_event) 815aa938f79SJiri Kosina hid->hiddev_hid_event(hid, field, usage, value); 816dde5845aSJiri Kosina } 817dde5845aSJiri Kosina 818dde5845aSJiri Kosina /* 819dde5845aSJiri Kosina * Analyse a received field, and fetch the data from it. The field 820dde5845aSJiri Kosina * content is stored for next report processing (we do differential 821dde5845aSJiri Kosina * reporting to the layer). 822dde5845aSJiri Kosina */ 823dde5845aSJiri Kosina 824229695e5SJiri Kosina void hid_input_field(struct hid_device *hid, struct hid_field *field, __u8 *data, int interrupt) 825dde5845aSJiri Kosina { 826dde5845aSJiri Kosina unsigned n; 827dde5845aSJiri Kosina unsigned count = field->report_count; 828dde5845aSJiri Kosina unsigned offset = field->report_offset; 829dde5845aSJiri Kosina unsigned size = field->report_size; 830dde5845aSJiri Kosina __s32 min = field->logical_minimum; 831dde5845aSJiri Kosina __s32 max = field->logical_maximum; 832dde5845aSJiri Kosina __s32 *value; 833dde5845aSJiri Kosina 834dde5845aSJiri Kosina if (!(value = kmalloc(sizeof(__s32) * count, GFP_ATOMIC))) 835dde5845aSJiri Kosina return; 836dde5845aSJiri Kosina 837dde5845aSJiri Kosina for (n = 0; n < count; n++) { 838dde5845aSJiri Kosina 839dde5845aSJiri Kosina value[n] = min < 0 ? snto32(extract(data, offset + n * size, size), size) : 840dde5845aSJiri Kosina extract(data, offset + n * size, size); 841dde5845aSJiri Kosina 842dde5845aSJiri Kosina if (!(field->flags & HID_MAIN_ITEM_VARIABLE) /* Ignore report if ErrorRollOver */ 843dde5845aSJiri Kosina && value[n] >= min && value[n] <= max 844dde5845aSJiri Kosina && field->usage[value[n] - min].hid == HID_UP_KEYBOARD + 1) 845dde5845aSJiri Kosina goto exit; 846dde5845aSJiri Kosina } 847dde5845aSJiri Kosina 848dde5845aSJiri Kosina for (n = 0; n < count; n++) { 849dde5845aSJiri Kosina 850dde5845aSJiri Kosina if (HID_MAIN_ITEM_VARIABLE & field->flags) { 851dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[n], value[n], interrupt); 852dde5845aSJiri Kosina continue; 853dde5845aSJiri Kosina } 854dde5845aSJiri Kosina 855dde5845aSJiri Kosina if (field->value[n] >= min && field->value[n] <= max 856dde5845aSJiri Kosina && field->usage[field->value[n] - min].hid 857dde5845aSJiri Kosina && search(value, field->value[n], count)) 858dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[field->value[n] - min], 0, interrupt); 859dde5845aSJiri Kosina 860dde5845aSJiri Kosina if (value[n] >= min && value[n] <= max 861dde5845aSJiri Kosina && field->usage[value[n] - min].hid 862dde5845aSJiri Kosina && search(field->value, value[n], count)) 863dde5845aSJiri Kosina hid_process_event(hid, field, &field->usage[value[n] - min], 1, interrupt); 864dde5845aSJiri Kosina } 865dde5845aSJiri Kosina 866dde5845aSJiri Kosina memcpy(field->value, value, count * sizeof(__s32)); 867dde5845aSJiri Kosina exit: 868dde5845aSJiri Kosina kfree(value); 869dde5845aSJiri Kosina } 870229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_input_field); 871dde5845aSJiri Kosina 872dde5845aSJiri Kosina /* 873dde5845aSJiri Kosina * Output the field into the report. 874dde5845aSJiri Kosina */ 875dde5845aSJiri Kosina 876dde5845aSJiri Kosina static void hid_output_field(struct hid_field *field, __u8 *data) 877dde5845aSJiri Kosina { 878dde5845aSJiri Kosina unsigned count = field->report_count; 879dde5845aSJiri Kosina unsigned offset = field->report_offset; 880dde5845aSJiri Kosina unsigned size = field->report_size; 88146386b58SSimon Budig unsigned bitsused = offset + count * size; 882dde5845aSJiri Kosina unsigned n; 883dde5845aSJiri Kosina 88446386b58SSimon Budig /* make sure the unused bits in the last byte are zeros */ 88546386b58SSimon Budig if (count > 0 && size > 0 && (bitsused % 8) != 0) 88646386b58SSimon Budig data[(bitsused-1)/8] &= (1 << (bitsused % 8)) - 1; 88746386b58SSimon Budig 888dde5845aSJiri Kosina for (n = 0; n < count; n++) { 889dde5845aSJiri Kosina if (field->logical_minimum < 0) /* signed values */ 890dde5845aSJiri Kosina implement(data, offset + n * size, size, s32ton(field->value[n], size)); 891dde5845aSJiri Kosina else /* unsigned values */ 892dde5845aSJiri Kosina implement(data, offset + n * size, size, field->value[n]); 893dde5845aSJiri Kosina } 894dde5845aSJiri Kosina } 895dde5845aSJiri Kosina 896dde5845aSJiri Kosina /* 897dde5845aSJiri Kosina * Create a report. 898dde5845aSJiri Kosina */ 899dde5845aSJiri Kosina 900229695e5SJiri Kosina void hid_output_report(struct hid_report *report, __u8 *data) 901dde5845aSJiri Kosina { 902dde5845aSJiri Kosina unsigned n; 903dde5845aSJiri Kosina 904dde5845aSJiri Kosina if (report->id > 0) 905dde5845aSJiri Kosina *data++ = report->id; 906dde5845aSJiri Kosina 907dde5845aSJiri Kosina for (n = 0; n < report->maxfield; n++) 908dde5845aSJiri Kosina hid_output_field(report->field[n], data); 909dde5845aSJiri Kosina } 910229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_output_report); 911dde5845aSJiri Kosina 912dde5845aSJiri Kosina /* 913dde5845aSJiri Kosina * Set a field value. The report this field belongs to has to be 914dde5845aSJiri Kosina * created and transferred to the device, to set this value in the 915dde5845aSJiri Kosina * device. 916dde5845aSJiri Kosina */ 917dde5845aSJiri Kosina 918dde5845aSJiri Kosina int hid_set_field(struct hid_field *field, unsigned offset, __s32 value) 919dde5845aSJiri Kosina { 920dde5845aSJiri Kosina unsigned size = field->report_size; 921dde5845aSJiri Kosina 922dde5845aSJiri Kosina hid_dump_input(field->usage + offset, value); 923dde5845aSJiri Kosina 924dde5845aSJiri Kosina if (offset >= field->report_count) { 925*58037eb9SJiri Kosina dbg_hid("offset (%d) exceeds report_count (%d)\n", offset, field->report_count); 926dde5845aSJiri Kosina hid_dump_field(field, 8); 927dde5845aSJiri Kosina return -1; 928dde5845aSJiri Kosina } 929dde5845aSJiri Kosina if (field->logical_minimum < 0) { 930dde5845aSJiri Kosina if (value != snto32(s32ton(value, size), size)) { 931*58037eb9SJiri Kosina dbg_hid("value %d is out of range\n", value); 932dde5845aSJiri Kosina return -1; 933dde5845aSJiri Kosina } 934dde5845aSJiri Kosina } 935dde5845aSJiri Kosina field->value[offset] = value; 936dde5845aSJiri Kosina return 0; 937dde5845aSJiri Kosina } 938229695e5SJiri Kosina EXPORT_SYMBOL_GPL(hid_set_field); 939dde5845aSJiri Kosina 940aa8de2f0SJiri Kosina int hid_input_report(struct hid_device *hid, int type, u8 *data, int size, int interrupt) 941aa8de2f0SJiri Kosina { 942aa8de2f0SJiri Kosina struct hid_report_enum *report_enum = hid->report_enum + type; 943aa8de2f0SJiri Kosina struct hid_report *report; 944*58037eb9SJiri Kosina int n, rsize, i; 945aa8de2f0SJiri Kosina 946aa8de2f0SJiri Kosina if (!hid) 947aa8de2f0SJiri Kosina return -ENODEV; 948aa8de2f0SJiri Kosina 949aa8de2f0SJiri Kosina if (!size) { 950*58037eb9SJiri Kosina dbg_hid("empty report\n"); 951aa8de2f0SJiri Kosina return -1; 952aa8de2f0SJiri Kosina } 953aa8de2f0SJiri Kosina 954*58037eb9SJiri Kosina dbg_hid("report (size %u) (%snumbered)\n", size, report_enum->numbered ? "" : "un"); 955aa8de2f0SJiri Kosina 956aa8de2f0SJiri Kosina n = 0; /* Normally report number is 0 */ 957aa8de2f0SJiri Kosina if (report_enum->numbered) { /* Device uses numbered reports, data[0] is report number */ 958aa8de2f0SJiri Kosina n = *data++; 959aa8de2f0SJiri Kosina size--; 960aa8de2f0SJiri Kosina } 961aa8de2f0SJiri Kosina 962*58037eb9SJiri Kosina /* dump the report descriptor */ 963*58037eb9SJiri Kosina dbg_hid("report %d (size %u) = ", n, size); 964aa8de2f0SJiri Kosina for (i = 0; i < size; i++) 965*58037eb9SJiri Kosina dbg_hid_line(" %02x", data[i]); 966*58037eb9SJiri Kosina dbg_hid_line("\n"); 967aa8de2f0SJiri Kosina 968aa8de2f0SJiri Kosina if (!(report = report_enum->report_id_hash[n])) { 969*58037eb9SJiri Kosina dbg_hid("undefined report_id %d received\n", n); 970aa8de2f0SJiri Kosina return -1; 971aa8de2f0SJiri Kosina } 972aa8de2f0SJiri Kosina 973aa8de2f0SJiri Kosina rsize = ((report->size - 1) >> 3) + 1; 974aa8de2f0SJiri Kosina 975aa8de2f0SJiri Kosina if (size < rsize) { 976*58037eb9SJiri Kosina dbg_hid("report %d is too short, (%d < %d)\n", report->id, size, rsize); 9778da7d1baSAdam Kropelin memset(data + size, 0, rsize - size); 978aa8de2f0SJiri Kosina } 979aa8de2f0SJiri Kosina 980aa8de2f0SJiri Kosina if ((hid->claimed & HID_CLAIMED_HIDDEV) && hid->hiddev_report_event) 981aa8de2f0SJiri Kosina hid->hiddev_report_event(hid, report); 982aa8de2f0SJiri Kosina 983aa8de2f0SJiri Kosina for (n = 0; n < report->maxfield; n++) 984aa8de2f0SJiri Kosina hid_input_field(hid, report->field[n], data, interrupt); 985aa8de2f0SJiri Kosina 986aa8de2f0SJiri Kosina if (hid->claimed & HID_CLAIMED_INPUT) 987aa8de2f0SJiri Kosina hidinput_report_event(hid, report); 988aa8de2f0SJiri Kosina 989aa8de2f0SJiri Kosina return 0; 990aa8de2f0SJiri Kosina } 991aa8de2f0SJiri Kosina EXPORT_SYMBOL_GPL(hid_input_report); 992aa8de2f0SJiri Kosina 993aa938f79SJiri Kosina MODULE_LICENSE(DRIVER_LICENSE); 994aa938f79SJiri Kosina 995