Changelogs (since 0.4.0): 1. Make hidinput_disconnect_core() be more robust, it can not break anything even failed to allocate device struct. 2. Thanks new input device driver API, we need not the extra code for support force-feed device yet, so say bye to CONFIG_HID_SIMPLE_FF.
This is one patch of The HID Simple Driver patches, for convenience, you can find them all in that mail: [PATCH] usb/hid: The HID Simple Driver Patches 0.4.1 (all-in-one) The code base is 2.6.19. Is this ready to merge? or What still is problem in them? Thanks. Signed-off-by: Liyu <[EMAIL PROTECTED]> diff -Naurp linux-2.6.19.orig/drivers/usb/input/hid-core.c linux-2.6.19/drivers/usb/input/hid-core.c --- linux-2.6.19.orig/drivers/usb/input/hid-core.c 2006-11-30 05:57:37.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/hid-core.c 2006-12-05 09:47:11.000000000 +0800 @@ -26,6 +26,7 @@ #include <asm/byteorder.h> #include <linux/input.h> #include <linux/wait.h> +#include <linux/mutex.h> #undef DEBUG #undef DEBUG_DATA @@ -33,6 +34,7 @@ #include <linux/usb.h> #include "hid.h" +#include "hid-simple.h" #include <linux/hiddev.h> /* @@ -46,6 +48,15 @@ static char *hid_types[] = {"Device", "Pointer", "Mouse", "Device", "Joystick", "Gamepad", "Keyboard", "Keypad", "Multi-Axis Controller"}; + +/* + * The global data structure for simple device driver interface. + */ +static DEFINE_MUTEX(matched_devices_lock); +static DEFINE_MUTEX(simple_drivers_lock); +static struct list_head matched_devices_list; +static struct list_head simple_drivers_list; + /* * Module parameters. */ @@ -818,8 +829,13 @@ static __inline__ int search(__s32 *arra static void hid_process_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value, int interrupt) { hid_dump_input(usage, value); - if (hid->claimed & HID_CLAIMED_INPUT) - hidinput_hid_event(hid, field, usage, value); + if (hid->claimed & HID_CLAIMED_INPUT) { + if (!hidinput_simple_event_filter(hid, field, usage, value)) + return; + hidinput_hid_event(hid, field, usage, value); + hidinput_simple_event_post(hid, field, usage, value); + } + if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt) hiddev_hid_event(hid, field, usage, value); } @@ -2097,8 +2113,32 @@ static void hid_disconnect(struct usb_in del_timer_sync(&hid->io_retry); flush_scheduled_work(); - if (hid->claimed & HID_CLAIMED_INPUT) + if (hid->claimed & HID_CLAIMED_INPUT) { + struct list_head *node; + struct matched_device *matched = NULL; + struct hidinput_simple_driver *simple = hid->simple; + + mutex_lock(&matched_devices_lock); + list_for_each(node, &matched_devices_list) { + matched = list_entry(node, struct matched_device, node); + if (matched->intf == intf) { + list_del(&matched->node); + break; + } + matched = NULL; + } + mutex_unlock(&matched_devices_lock); + /* disconnect simple device driver if need */ + if (matched && simple) { + hidinput_simple_driver_disconnect(hid, matched); + module_put(simple->owner); + } + if (matched) { + matched->intf = NULL; + kfree(matched); + } hidinput_disconnect(hid); + } if (hid->claimed & HID_CLAIMED_HIDDEV) hiddev_disconnect(hid); @@ -2111,6 +2151,139 @@ static void hid_disconnect(struct usb_in hid_free_device(hid); } +#ifdef CONFIG_HID_SIMPLE +static int hidinput_simple_driver_bind_one(struct hidinput_simple_driver *simple, + struct hid_device *hid, + struct matched_device *matched, + int reload) +{ + int ret; + + if (!try_module_get(simple->owner)) + return -ENODEV; + /* + * If the simple driver register itself after device insert, + * we must send hotplug message to userspace again, elsewise, + * we will break down some applications. + */ + if (reload && hidinput_disconnect_core(hid)) { + module_put(simple->owner); + return -ENODEV; + } + ret = hidinput_simple_driver_connect(simple, hid, matched); + + if (reload) + hidinput_reconnect_core(hid); /* To activate this input_dev */ + if (!ret) + printk(KERN_INFO "The simple driver \'%s\' attach" + " to the device \'%s\'\n", simple->name, hid->name); + else + module_put(simple->owner); + return 0; +} + +/* Only be called in hid_probe(), so we just use the hid of matched->intf. */ +static void hidinput_simple_driver_bind_foreach_simple( + struct matched_device *matched) +{ + struct hidinput_simple_driver *simple; + struct list_head *node; + struct hid_device *hid; + + if (!matched || !matched->intf) /* should not get here */ + return; + hid = usb_get_intfdata (matched->intf); + if (!hid || hid->simple) + return; + + mutex_lock(&simple_drivers_lock); + list_for_each(node, &simple_drivers_list) { + simple = list_entry(node, struct hidinput_simple_driver, node); + if (usb_match_id(matched->intf, simple->id_table)) { + if (!hidinput_simple_driver_bind_one(simple, hid, matched, 0)) + break; + } + } + mutex_unlock(&simple_drivers_lock); +} + +static void hidinput_simple_driver_bind_foreach_matched( + struct hidinput_simple_driver *simple) +{ + struct list_head *node=NULL; + struct matched_device *matched; + struct hid_device *hid=NULL; + + if (!simple) + return; + + mutex_lock(&matched_devices_lock); + list_for_each(node, &matched_devices_list) { + matched = list_entry(node, struct matched_device, node); + hid = usb_get_intfdata (matched->intf); + if (!hid || hid->simple) + continue; + if (!usb_match_id(matched->intf, simple->id_table)) + continue; + if (!hidinput_simple_driver_bind_one(simple, hid, matched, 1)) + break; + } + mutex_unlock(&matched_devices_lock); +} + +static void hidinput_simple_driver_bind_foreach(void) +{ + struct hidinput_simple_driver *simple; + struct matched_device *matched = NULL; + struct list_head *matched_node = NULL, *simple_node = NULL; + struct hid_device *hid = NULL; + + mutex_lock(&matched_devices_lock); + list_for_each(matched_node, &matched_devices_list) { + matched = list_entry(matched_node, struct matched_device, node); + hid = usb_get_intfdata(matched->intf); + if (!hid || hid->simple) + continue; + mutex_lock(&simple_drivers_lock); + list_for_each(simple_node, &simple_drivers_list) { + simple = list_entry(simple_node, struct hidinput_simple_driver, node); + if (!usb_match_id(matched->intf, simple->id_table)) + continue; + hidinput_simple_driver_bind_one(simple, hid, matched, 1); + } + mutex_unlock(&simple_drivers_lock); + } + mutex_unlock(&matched_devices_lock); +} + +int hidinput_register_simple_driver(struct hidinput_simple_driver *simple) +{ + if (!simple || !simple->name) + return -EINVAL; + + hidinput_simple_driver_init(simple); + hidinput_simple_driver_bind_foreach_matched(simple); + + mutex_lock(&simple_drivers_lock); + list_add(&simple->node, &simple_drivers_list); + mutex_unlock(&simple_drivers_lock); + + return 0; +} +EXPORT_SYMBOL_GPL(hidinput_register_simple_driver); + +void hidinput_unregister_simple_driver(struct hidinput_simple_driver *simple) +{ + hidinput_simple_driver_clear(simple); + mutex_lock(&simple_drivers_lock); + list_del(&simple->node); + mutex_unlock(&simple_drivers_lock); + /* to active simple device driver that it is waiting */ + hidinput_simple_driver_bind_foreach(); +} +EXPORT_SYMBOL_GPL(hidinput_unregister_simple_driver); +#endif + static int hid_probe(struct usb_interface *intf, const struct usb_device_id *id) { struct hid_device *hid; @@ -2127,15 +2300,25 @@ static int hid_probe(struct usb_interfac hid_init_reports(hid); hid_dump_device(hid); - if (!hidinput_connect(hid)) + usb_set_intfdata(intf, hid); + + if (!hidinput_connect(hid)) { + struct matched_device *matched; + matched = kmalloc(sizeof(struct matched_device), GFP_KERNEL); + if (matched) { + matched->intf = intf; + mutex_lock(&matched_devices_lock); + list_add(&matched->node, &matched_devices_list); + mutex_unlock(&matched_devices_lock); + hidinput_simple_driver_bind_foreach_simple(matched); + } hid->claimed |= HID_CLAIMED_INPUT; + } if (!hiddev_connect(hid)) hid->claimed |= HID_CLAIMED_HIDDEV; - usb_set_intfdata(intf, hid); - if (!hid->claimed) { - printk ("HID device not claimed by input or hiddev\n"); + printk (KERN_INFO "HID device not claimed by input or hiddev\n"); hid_disconnect(intf); return -ENODEV; } @@ -2234,6 +2417,8 @@ static int __init hid_init(void) retval = hiddev_init(); if (retval) goto hiddev_init_fail; + INIT_LIST_HEAD(&matched_devices_list); + INIT_LIST_HEAD(&simple_drivers_list); retval = usb_register(&hid_driver); if (retval) goto usb_register_fail; @@ -2248,7 +2433,15 @@ hiddev_init_fail: static void __exit hid_exit(void) { + struct list_head *node, *tmp; + struct matched_device *matched; + usb_deregister(&hid_driver); + list_for_each_safe(node, tmp, &matched_devices_list) { + matched = list_entry(node, struct matched_device, node); + list_del(&matched->node); + kfree(matched); + } hiddev_exit(); } diff -Naurp linux-2.6.19.orig/drivers/usb/input/hid.h linux-2.6.19/drivers/usb/input/hid.h --- linux-2.6.19.orig/drivers/usb/input/hid.h 2006-11-30 05:57:37.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/hid.h 2006-12-05 18:11:05.000000000 +0800 @@ -33,7 +33,7 @@ #include <linux/list.h> #include <linux/timer.h> #include <linux/workqueue.h> - +#include <linux/mutex.h> /* * USB HID (Human Interface Device) interface class code */ @@ -390,8 +390,15 @@ struct hid_input { struct list_head list; struct hid_report *report; struct input_dev *input; + unsigned long input_lock; /* To protect accessing input_dev from + * hid-input processing. But it not + * necessary for accessing this input_dev + * instance from input subsystem. */ + void *private; }; +struct hidinput_simple_driver; + struct hid_device { /* device report descriptor */ __u8 *rdesc; unsigned rsize; @@ -450,6 +457,8 @@ struct hid_device { /* device repo char phys[64]; /* Device physical location */ char uniq[64]; /* Device unique identifier (serial #) */ + struct hidinput_simple_driver *simple; + #ifdef CONFIG_USB_HIDINPUT_POWERBOOK unsigned long pb_pressed_fn[NBITS(KEY_MAX)]; unsigned long pb_pressed_numlock[NBITS(KEY_MAX)]; @@ -504,12 +513,16 @@ extern void hidinput_hid_event(struct hi extern void hidinput_report_event(struct hid_device *hid, struct hid_report *report); extern int hidinput_connect(struct hid_device *); extern void hidinput_disconnect(struct hid_device *); +extern void hidinput_reconnect_core(struct hid_device *); +extern int hidinput_disconnect_core(struct hid_device *); #else #define IS_INPUT_APPLICATION(a) (0) static inline void hidinput_hid_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value) { } static inline void hidinput_report_event(struct hid_device *hid, struct hid_report *report) { } static inline int hidinput_connect(struct hid_device *hid) { return -ENODEV; } static inline void hidinput_disconnect(struct hid_device *hid) { } +static inline void hidinput_reconnect_core(struct hid_device *hid) { } +static inline int hidinput_disconnect_core(struct hid_device *hid) { return -ENODEV; } #endif int hid_open(struct hid_device *); diff -Naurp linux-2.6.19.orig/drivers/usb/input/hid-input.c linux-2.6.19/drivers/usb/input/hid-input.c --- linux-2.6.19.orig/drivers/usb/input/hid-input.c 2006-11-30 05:57:37.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/hid-input.c 2006-12-05 18:15:41.000000000 +0800 @@ -29,12 +29,13 @@ #include <linux/module.h> #include <linux/slab.h> #include <linux/kernel.h> +#include <linux/spinlock.h> #include <linux/usb/input.h> #undef DEBUG #include "hid.h" - +#include "hid-simple.h" #define unk KEY_UNKNOWN static const unsigned char hid_keyboard[256] = { @@ -61,6 +62,8 @@ static const struct { __s32 y; } hid_hat_to_axis[] = {{ 0, 0}, { 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}}; +typedef void (*do_usage_t)(struct hid_field *, struct hid_usage *); + #define map_abs(c) do { usage->code = c; usage->type = EV_ABS; bit = input->absbit; max = ABS_MAX; } while (0) #define map_rel(c) do { usage->code = c; usage->type = EV_REL; bit = input->relbit; max = REL_MAX; } while (0) #define map_key(c) do { usage->code = c; usage->type = EV_KEY; bit = input->keybit; max = KEY_MAX; } while (0) @@ -69,6 +72,15 @@ static const struct { #define map_abs_clear(c) do { map_abs(c); clear_bit(c, bit); } while (0) #define map_key_clear(c) do { map_key(c); clear_bit(c, bit); } while (0) +static inline void hidinput_send_event(struct hid_input *hidinput, int type, + int code, int value) +{ + if (!hidinput_trylock_simple(hidinput)) { + input_event(hidinput->input, type, code, value); + hidinput_unlock_simple(hidinput); + } +} + #ifdef CONFIG_USB_HIDINPUT_POWERBOOK struct hidinput_key_translation { @@ -144,7 +156,7 @@ static struct hidinput_key_translation * return NULL; } -static int hidinput_pb_event(struct hid_device *hid, struct input_dev *input, +static int hidinput_pb_event(struct hid_device *hid, struct hid_input *hidinput, struct hid_usage *usage, __s32 value) { struct hidinput_key_translation *trans; @@ -153,7 +165,7 @@ static int hidinput_pb_event(struct hid_ if (value) hid->quirks |= HID_QUIRK_POWERBOOK_FN_ON; else hid->quirks &= ~HID_QUIRK_POWERBOOK_FN_ON; - input_event(input, usage->type, usage->code, value); + hidinput_send_event(hidinput, usage->type, usage->code, value); return 1; } @@ -178,12 +190,14 @@ static int hidinput_pb_event(struct hid_ else clear_bit(usage->code, hid->pb_pressed_fn); - input_event(input, usage->type, trans->to, value); + hidinput_send_event(hidinput, usage->type, trans->to, value); return 1; } } + if (hidinput_trylock_simple(hidinput)) + return 0; if (test_bit(usage->code, hid->pb_pressed_numlock) || test_bit(LED_NUML, input->led)) { trans = find_translation(powerbook_numlock_keys, usage->code); @@ -194,11 +208,12 @@ static int hidinput_pb_event(struct hid_ else clear_bit(usage->code, hid->pb_pressed_numlock); - input_event(input, usage->type, trans->to, value); + input_event(hidinput->input, usage->type, trans->to, value); } - + hidinput_unlock_simple(hidinput); return 1; } + hidinput_unlock_simple(hidinput); } if (hid->quirks & HID_QUIRK_POWERBOOK_ISO_KEYBOARD) { @@ -229,7 +244,7 @@ static void hidinput_pb_setup(struct inp set_bit(trans->to, input->keybit); } #else -static inline int hidinput_pb_event(struct hid_device *hid, struct input_dev *input, +static inline int hidinput_pb_event(struct hid_device *hid, struct hid_input *hidinput, struct hid_usage *usage, __s32 value) { return 0; @@ -240,16 +255,13 @@ static inline void hidinput_pb_setup(str } #endif -static void hidinput_configure_usage(struct hid_input *hidinput, struct hid_field *field, +static void hidinput_configure_usage(struct input_dev *input, struct hid_field *field, struct hid_usage *usage) { - struct input_dev *input = hidinput->input; struct hid_device *device = input->private; int max = 0, code; unsigned long *bit = NULL; - field->hidinput = hidinput; - #ifdef DEBUG printk(KERN_DEBUG "Mapping: "); resolv_usage(usage->hid); @@ -632,6 +644,7 @@ ignore: void hidinput_hid_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value) { + struct hid_input *hidinput; struct input_dev *input; int *quirks = &hid->quirks; @@ -643,6 +656,8 @@ void hidinput_hid_event(struct hid_devic if (!usage->type) return; + hidinput = field->hidinput; + if (((hid->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_5) && (usage->hid == 0x00090005)) || ((hid->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_7) && (usage->hid == 0x00090007))) { if (value) hid->quirks |= HID_QUIRK_2WHEEL_MOUSE_HACK_ON; @@ -651,16 +666,16 @@ void hidinput_hid_event(struct hid_devic } if ((hid->quirks & HID_QUIRK_INVERT_HWHEEL) && (usage->code == REL_HWHEEL)) { - input_event(input, usage->type, usage->code, -value); + hidinput_send_event(hidinput, usage->type, usage->code, -value); return; } if ((hid->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_ON) && (usage->code == REL_WHEEL)) { - input_event(input, usage->type, REL_HWHEEL, value); + hidinput_send_event(hidinput, usage->type, REL_HWHEEL, value); return; } - if ((hid->quirks & HID_QUIRK_POWERBOOK_HAS_FN) && hidinput_pb_event(hid, input, usage, value)) + if ((hid->quirks & HID_QUIRK_POWERBOOK_HAS_FN) && hidinput_pb_event(hid, hidinput, usage, value)) return; if (usage->hat_min < usage->hat_max || usage->hat_dir) { @@ -668,8 +683,8 @@ void hidinput_hid_event(struct hid_devic if (!hat_dir) hat_dir = (value - usage->hat_min) * 8 / (usage->hat_max - usage->hat_min + 1) + 1; if (hat_dir < 0 || hat_dir > 8) hat_dir = 0; - input_event(input, usage->type, usage->code , hid_hat_to_axis[hat_dir].x); - input_event(input, usage->type, usage->code + 1, hid_hat_to_axis[hat_dir].y); + hidinput_send_event(hidinput, usage->type, usage->code , hid_hat_to_axis[hat_dir].x); + hidinput_send_event(hidinput, usage->type, usage->code + 1, hid_hat_to_axis[hat_dir].y); return; } @@ -680,18 +695,18 @@ void hidinput_hid_event(struct hid_devic if (usage->hid == (HID_UP_DIGITIZER | 0x0032)) { /* InRange */ if (value) { - input_event(input, usage->type, (*quirks & HID_QUIRK_INVERT) ? BTN_TOOL_RUBBER : usage->code, 1); + hidinput_send_event(hidinput, usage->type, (*quirks & HID_QUIRK_INVERT) ? BTN_TOOL_RUBBER : usage->code, 1); return; } - input_event(input, usage->type, usage->code, 0); - input_event(input, usage->type, BTN_TOOL_RUBBER, 0); + hidinput_send_event(hidinput, usage->type, usage->code, 0); + hidinput_send_event(hidinput, usage->type, BTN_TOOL_RUBBER, 0); return; } if (usage->hid == (HID_UP_DIGITIZER | 0x0030) && (*quirks & HID_QUIRK_NOTOUCH)) { /* Pressure */ int a = field->logical_minimum; int b = field->logical_maximum; - input_event(input, EV_KEY, BTN_TOUCH, value > a + ((b - a) >> 3)); + hidinput_send_event(hidinput, EV_KEY, BTN_TOUCH, value > a + ((b - a) >> 3)); } if (usage->hid == (HID_UP_PID | 0x83UL)) { /* Simultaneous Effects Max */ @@ -707,18 +722,22 @@ void hidinput_hid_event(struct hid_devic if ((usage->type == EV_KEY) && (usage->code == 0)) /* Key 0 is "unassigned", not KEY_UNKNOWN */ return; - input_event(input, usage->type, usage->code, value); + hidinput_send_event(hidinput, usage->type, usage->code, value); if ((field->flags & HID_MAIN_ITEM_RELATIVE) && (usage->type == EV_KEY)) - input_event(input, usage->type, usage->code, 0); + hidinput_send_event(hidinput, usage->type, usage->code, 0); } void hidinput_report_event(struct hid_device *hid, struct hid_report *report) { - struct hid_input *hidinput; + struct hid_input *hidinput = NULL; - list_for_each_entry(hidinput, &hid->inputs, list) + list_for_each_entry(hidinput, &hid->inputs, list) { + if (hidinput_trylock_simple(hidinput)) + continue; input_sync(hidinput->input); + hidinput_unlock_simple(hidinput); + } } static int hidinput_find_field(struct hid_device *hid, unsigned int type, unsigned int code, struct hid_field **field) @@ -763,15 +782,41 @@ static int hidinput_input_event(struct i static int hidinput_open(struct input_dev *dev) { struct hid_device *hid = dev->private; - return hid_open(hid); + int ret = 0; + + if (hid && hid->simple && hid->simple->open) + ret = hid->simple->open(dev); + if (!ret) + return hid_open(hid); + else + return ret; } static void hidinput_close(struct input_dev *dev) { struct hid_device *hid = dev->private; + + if (hid && hid->simple && hid->simple->close) + hid->simple->close(dev); hid_close(hid); } +static void hidinput_input_init(struct hid_device *hid, + struct input_dev *input_dev) +{ + if (!hid || !input_dev) + return; + input_dev->private = hid; + input_dev->event = hidinput_input_event; + input_dev->open = hidinput_open; + input_dev->close = hidinput_close; + input_dev->name = hid->name; + input_dev->phys = hid->phys; + input_dev->uniq = hid->uniq; + usb_to_input_id(hid->dev, &input_dev->id); + input_dev->cdev.dev = &hid->intf->dev; + return; +} /* * Register the input device; print a message. * Configure the input layer interface @@ -780,7 +825,6 @@ static void hidinput_close(struct input_ int hidinput_connect(struct hid_device *hid) { - struct usb_device *dev = hid->dev; struct hid_report *report; struct hid_input *hidinput = NULL; struct input_dev *input_dev; @@ -812,26 +856,18 @@ int hidinput_connect(struct hid_device * err("Out of memory during hid input probe"); return -1; } - - input_dev->private = hid; - input_dev->event = hidinput_input_event; - input_dev->open = hidinput_open; - input_dev->close = hidinput_close; - - input_dev->name = hid->name; - input_dev->phys = hid->phys; - input_dev->uniq = hid->uniq; - usb_to_input_id(dev, &input_dev->id); - input_dev->cdev.dev = &hid->intf->dev; - + hidinput_input_init(hid, input_dev); + hidinput->input_lock = 0; hidinput->input = input_dev; list_add_tail(&hidinput->list, &hid->inputs); } - for (i = 0; i < report->maxfield; i++) + for (i = 0; i < report->maxfield; i++) { + report->field[i]->hidinput = hidinput; for (j = 0; j < report->field[i]->maxusage; j++) - hidinput_configure_usage(hidinput, report->field[i], + hidinput_configure_usage(hidinput->input, report->field[i], report->field[i]->usage + j); + } if (hid->quirks & HID_QUIRK_MULTI_INPUT) { /* This will leave hidinput NULL, so that it @@ -856,6 +892,77 @@ int hidinput_connect(struct hid_device * return 0; } +static void hidinput_setup_usage(struct hid_device *hid, + struct input_dev *input) +{ + struct hid_report *report; + int i, j, k; + + for (i = 0; i < hid->maxcollection; i++) + if (hid->collection[i].type == HID_COLLECTION_APPLICATION || + hid->collection[i].type == HID_COLLECTION_PHYSICAL) + if (IS_INPUT_APPLICATION(hid->collection[i].usage)) + break; + + if (i == hid->maxcollection) + return; + + for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) + list_for_each_entry(report, &hid->report_enum[k].report_list, list) { + if (!report->maxfield) + continue; + for (i = 0; i < report->maxfield; i++) + for (j = 0; j < report->field[i]->maxusage; j++) + hidinput_configure_usage(input, report->field[i], + report->field[i]->usage + j); + } + return; +} + +/* + * The caller must be call hidinput_reconnect() soon, + * this function hold hidinput->input_lock. + */ +int hidinput_disconnect_core(struct hid_device *hid) +{ + struct hid_input *hidinput, *next; + struct input_dev *input_dev = NULL; + struct list_head tmp_list; + + INIT_LIST_HEAD(&tmp_list); + list_for_each_entry_safe(hidinput, next, &hid->inputs, list) { + input_dev = input_allocate_device(); + if (!input_dev) + break; + list_add_tail(&input_dev->node, &tmp_list); + } + while (!list_empty(&tmp_list)) { + list_del_init(tmp_list.next); + } + if (!input_dev) + return -ENOMEM; + list_for_each_entry_safe(hidinput, next, &hid->inputs, list) { + hidinput_input_init(hid, input_dev); + hidinput_lock_simple(hidinput); + input_unregister_device(hidinput->input); + hidinput->input = input_dev; + if (!(hid->quirks&HID_QUIRK_MULTI_INPUT)) + hid_ff_init(hid); + } + return 0; +} + +void hidinput_reconnect_core(struct hid_device *hid) +{ + struct hid_input *hidinput, *next; + + list_for_each_entry_safe(hidinput, next, &hid->inputs, list) { + hidinput_setup_usage(hid, hidinput->input); + input_register_device(hidinput->input); + hidinput_unlock_simple(hidinput); + } +} + void hidinput_disconnect(struct hid_device *hid) { struct hid_input *hidinput, *next; diff -Naurp linux-2.6.19.orig/drivers/usb/input/hid-simple.c linux-2.6.19/drivers/usb/input/hid-simple.c --- linux-2.6.19.orig/drivers/usb/input/hid-simple.c 1970-01-01 08:00:00.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/hid-simple.c 2006-12-06 17:42:14.000000000 +0800 @@ -0,0 +1,326 @@ +/* + * HID Simple Driver Interface v0.4.1 + * + * Copyright (c) 2006 Li Yu <[EMAIL PROTECTED]> + */ + +/* + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + * + * Should you need to contact me, the author, you can do so either by + * e-mail - mail your message to <[EMAIL PROTECTED]>, or by paper mail: + * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic + */ + +#include <linux/module.h> +#include <linux/slab.h> +#include <linux/kernel.h> +#include <linux/input.h> + +#include "hid.h" +#include "hid-simple.h" + +typedef void (*do_usage_t)(struct hid_field *, struct hid_usage *); + +int hidinput_simple_driver_init(struct hidinput_simple_driver *simple) +{ + if (unlikely(!simple)) + return -EINVAL; + INIT_LIST_HEAD(&simple->node); + INIT_LIST_HEAD(&simple->raw_devices); + simple->flags = 0; + return 0; +} + +static void inline hidinput_simple_configure_one_usage(int op, + struct input_dev *input, + struct hid_usage *usage, + struct usage_block *usage_block) +{ + unsigned long *bits; + int flag; + struct hid_device *hid; + + hid = input->private; + switch (usage_block->event) { + case EV_KEY: + flag = HIDINPUT_SIMPLE_KEYBIT; + bits = input->keybit; + break; + case EV_REL: + flag = HIDINPUT_SIMPLE_RELBIT; + bits = input->relbit; + break; + case EV_ABS: + flag = HIDINPUT_SIMPLE_ABSBIT; + bits = input->relbit; + break; + case EV_MSC: + flag = HIDINPUT_SIMPLE_MSCBIT; + bits = input->absbit; + break; + case EV_SW: + flag = HIDINPUT_SIMPLE_SWBIT; + bits = input->swbit; + break; + case EV_LED: + flag = HIDINPUT_SIMPLE_LEDBIT; + bits = input->ledbit; + break; + case EV_SND: + flag = HIDINPUT_SIMPLE_SNDBIT; + bits = input->sndbit; + break; + case EV_FF: + flag = HIDINPUT_SIMPLE_FFBIT; + bits = input->ffbit; + break; + case EV_FF_STATUS: + flag = HIDINPUT_SIMPLE_FFSTSBIT; + bits = NULL; + break; + default: + return; + } + + if (__OP_SET_BIT == op) { + usage->code = usage_block->code; + usage->type = usage_block->event; + if (bits) + set_bit(usage_block->code, bits); + /* if this event bit is set by us first, remember it */ + if (!test_and_set_bit(usage_block->event, input->evbit)) + set_bit(flag, &hid->simple->flags); + } + else if (__OP_CLR_BIT == op) { + usage->code = 0; + usage->type = 0; + if (bits) + clear_bit(usage_block->code, bits); + /* clear event bit, only if it's set by us. */ + if (test_and_clear_bit(flag, &hid->simple->flags)) + clear_bit(usage_block->event, input->evbit); + } +} + +static do_usage_t hidinput_simple_driver_configure_usage_prep( + struct hidinput_simple_driver *simple, + int *op) +{ + do_usage_t do_usage; + + if (test_bit(HIDINPUT_SIMPLE_SETUP_USAGE, &simple->flags)) { + do_usage = simple->setup_usage; + *op = __OP_SET_BIT; + } + else { + do_usage = simple->clear_usage; + *op = __OP_CLR_BIT; + } + return do_usage; +} + +static void __hidinput_simple_driver_configure_usage( + struct hidinput_simple_driver *simple, + int op, + struct hid_field *field, + struct hid_usage *hid_usage) +{ + struct input_dev *input = field->hidinput->input; + struct usage_block *usage_block; + struct usage_page_block *page_block; + int page; + int usage; + + page = (hid_usage->hid & HID_USAGE_PAGE); + usage = (hid_usage->hid & HID_USAGE); + page_block = simple->usage_page_table; + for (;page_block && page_block->usage_blockes;page_block++) { + if (page_block->page != page) + continue; + usage_block = page_block->usage_blockes; + for (; usage_block && usage_block->usage; usage_block++) { + if (usage_block->usage != usage) + continue; + hidinput_simple_configure_one_usage(op, input, + hid_usage, usage_block); + } + } +} + +/* + * To give one simple device a configure usage chance. + * The framework of this function come from hidinput_connect() + */ +void hidinput_simple_driver_configure_usage(struct hidinput_simple_driver *simple, struct hid_device *hid) +{ + struct hid_report *report; + int i, j, k; + do_usage_t do_usage; + int op; + + if (!simple) + return; + do_usage = hidinput_simple_driver_configure_usage_prep(simple, &op); + + for (i = 0; i < hid->maxcollection; i++) + if (hid->collection[i].type == HID_COLLECTION_APPLICATION || + hid->collection[i].type==HID_COLLECTION_PHYSICAL) + if (IS_INPUT_APPLICATION(hid->collection[i].usage)) + break; + + if (i == hid->maxcollection) + return; + + for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) + list_for_each_entry(report, &hid->report_enum[k].report_list, list) { + if (!report->maxfield) + continue; + + for (i = 0; i < report->maxfield; i++) + for (j = 0; j < report->field[i]->maxusage; j++) { + __hidinput_simple_driver_configure_usage(simple, op, report->field[i], report->field[i]->usage + j); + if (do_usage) + do_usage(report->field[i], + report->field[i]->usage + j); + } + } + + return; +} + +int hidinput_simple_driver_push(struct hid_device *hid, + struct hidinput_simple_driver *simple, + struct matched_device *matched) +{ + struct raw_simple_device *raw_simple; + + raw_simple = kmalloc(sizeof(struct raw_simple_device), GFP_KERNEL); + if (!raw_simple) + return -ENOMEM; + raw_simple->intf = matched->intf; + hid = usb_get_intfdata(matched->intf); + hid->simple = simple; + list_add(&raw_simple->node, &simple->raw_devices); + return 0; +} + +void hidinput_simple_driver_pop(struct hid_device *hid, + struct matched_device *matched) +{ + struct list_head *node; + struct raw_simple_device *raw_simple=NULL; + + list_for_each (node, &hid->simple->raw_devices) { + raw_simple = list_entry(node, struct raw_simple_device, node); + if (raw_simple && raw_simple->intf == matched->intf) { + hid->simple = NULL; + list_del(&raw_simple->node); + raw_simple->intf = NULL; + kfree(raw_simple); + return; + } + } +} + +void hidinput_simple_driver_clear(struct hidinput_simple_driver *simple) +{ + struct raw_simple_device *raw_simple; + struct hid_device *hid; + + while (!list_empty_careful(&simple->raw_devices)) { + raw_simple = list_entry(simple->raw_devices.next, + struct raw_simple_device, node); + hid = usb_get_intfdata (raw_simple->intf); + if (hid) { + if (hid->simple) + BUG_ON(hid->simple != simple); + hidinput_simple_driver_disconnect(hid, NULL); + hidinput_disconnect_core(hid); + hidinput_reconnect_core(hid); + hid->simple = NULL; + } + list_del_init(simple->raw_devices.next); + raw_simple->intf = NULL; + kfree(raw_simple); + } +} + +int hidinput_simple_driver_connect(struct hidinput_simple_driver *simple, + struct hid_device *hid, + struct matched_device *matched) +{ + struct hid_input *hidinput, *next; + int ret = -ENODEV; + + if (!simple || !matched) + return -EINVAL; + + if (!simple->connect) { + ret = 0; + goto exit; + } + list_for_each_entry_safe(hidinput, next, &hid->inputs, list) { + if (!simple->connect(hid, hidinput)) + ret = 0; + } +exit: + hid->simple = simple; + hidinput_simple_driver_setup_usage(simple, hid); + /* One simple driver may handle more devices */ + if (hidinput_simple_driver_push(hid, simple, matched)) { + hidinput_simple_driver_disconnect(hid, NULL); + return -ENODEV; + } + return ret; +} + +void hidinput_simple_driver_disconnect(struct hid_device *hid, + struct matched_device *matched) +{ + struct hid_input *hidinput, *next; + + if (!hid || !hid->simple) + return; + if (!hid->simple->disconnect) + goto exit; + + hidinput_simple_driver_clear_usage(hid->simple, hid); + wmb(); + list_for_each_entry_safe(hidinput, next, &hid->inputs, list) { + hid->simple->disconnect(hid, hidinput); + } +exit: + if (matched) + hidinput_simple_driver_pop(hid, matched); + return; +} + +struct hid_input* hidinput_simple_inputdev_to_hidinput(struct input_dev *dev) +{ + struct hid_device *hid = dev->private; + struct list_head *iter; + struct hid_input *hidinput; + + if (!hid) + return NULL; + list_for_each(iter, &hid->inputs) { + hidinput = list_entry(iter, struct hid_input, list); + if (hidinput->input == dev) + return hidinput; + } + return NULL; +} +EXPORT_SYMBOL_GPL(hidinput_simple_inputdev_to_hidinput); diff -Naurp linux-2.6.19.orig/drivers/usb/input/hid-simple.h linux-2.6.19/drivers/usb/input/hid-simple.h --- linux-2.6.19.orig/drivers/usb/input/hid-simple.h 1970-01-01 08:00:00.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/hid-simple.h 2006-12-05 18:14:55.000000000 +0800 @@ -0,0 +1,221 @@ +/* + * NOTE: + * For use me , you must include hid.h in your source first. + */ +#ifndef __HID_SIMPLE_H +#define __HID_SIMPLE_H + +#ifdef __KERNEL__ + +#include <linux/usb.h> +#include <asm/bitops.h> +/***** The public interface for simple device driver *****/ +struct usage_block { + int usage; /* usage code */ + int value; /* not used, for F_EVENT_BY_VALUE in future */ + int event; /* input event type, e.g. EV_KEY. */ + int code; /* input subsystem code, e.g. KEY_F1. */ + int flags; /* not used */ +}; + +struct usage_page_block { + int page; /* usage page code */ + int flags; /* not used */ + struct usage_block *usage_blockes; +}; + +/* usage_block flags list */ +#define F_EVENT_BY_VALUE (0x1) /* submit input event by usage_block.value, + not implement yet */ + +#define USAGE_BLOCK(i_usage, i_value, i_event, i_code, i_flags) \ + {\ + .usage = (i_usage),\ + .value = (i_value),\ + .event = (i_event),\ + .code = (i_code),\ + .flags = (i_flags),\ + } + +#define USAGE_BLOCK_NULL {} + +#define USAGE_PAGE_BLOCK(i_page, i_usage_blockes) \ + {\ + .page = (i_page),\ + .usage_blockes = (i_usage_blockes),\ + } + +#define USAGE_PAGE_BLOCK_NULL {} + +#define __SIMPLE_DRIVER_INIT \ + .owner = THIS_MODULE, + +struct hidinput_simple_driver { +/* private */ + struct list_head node; /* link with simple_drivers_list */ + struct list_head raw_devices; + unsigned long flags; +/* public */ + struct module *owner; + char *name; + int (*connect)(struct hid_device *, struct hid_input *); + void (*disconnect)(struct hid_device *, struct hid_input *); + void (*setup_usage)(struct hid_field *, struct hid_usage *); + void (*clear_usage)(struct hid_field *, struct hid_usage *); + int (*pre_event)(const struct hid_device *, const struct hid_field *, + const struct hid_usage *, const __s32); + int (*post_event)(const struct hid_device *, const struct hid_field *, + const struct hid_usage *, const __s32); + int (*open)(struct input_dev *dev); + void (*close)(struct input_dev *dev); + struct usb_device_id *id_table; + struct usage_page_block *usage_page_table; + void *private; +}; + +int hidinput_register_simple_driver(struct hidinput_simple_driver *device); +void hidinput_unregister_simple_driver(struct hidinput_simple_driver *device); +struct hid_input* hidinput_simple_inputdev_to_hidinput(struct input_dev *dev); + +/********************* The public section end ***********/ + +/***** The private section for simple device driver implement only *****/ + +/* simple driver internal flags */ +#define HIDINPUT_SIMPLE_SETUP_USAGE (0x0) +#define HIDINPUT_SIMPLE_KEYBIT (0x1) +#define HIDINPUT_SIMPLE_RELBIT (0x2) +#define HIDINPUT_SIMPLE_ABSBIT (0x3) +#define HIDINPUT_SIMPLE_MSCBIT (0x4) +#define HIDINPUT_SIMPLE_SWBIT (0x5) +#define HIDINPUT_SIMPLE_LEDBIT (0x6) +#define HIDINPUT_SIMPLE_SNDBIT (0x7) +#define HIDINPUT_SIMPLE_FFBIT (0x8) +#define HIDINPUT_SIMPLE_FFSTSBIT (0x9) + +/* used in hidinput_simple_driver_configure_usage() */ +#define __OP_SET_BIT (1) +#define __OP_CLR_BIT (0) + +/* + * matched_device record one device which hid-subsystem handle, it may + * be one simple device can not handle. + * + * The element of matched_device list is inserted at hidinput_connect(), + * and is removed at hidinput_disconnect(). + */ +struct matched_device { + struct usb_interface *intf; + struct list_head node; +}; + +/* + * raw_simple_driver record one device which hid simple device handle. + * It used as one member of hid_simple_driver. + */ + +struct raw_simple_device { + struct usb_interface *intf; + struct list_head node; +}; + +#ifdef CONFIG_HID_SIMPLE +extern void hidinput_simple_driver_configure_usage(struct hidinput_simple_driver *simple, struct hid_device *hid); +extern int hidinput_simple_driver_init(struct hidinput_simple_driver *simple); +extern void hidinput_simple_driver_clear(struct hidinput_simple_driver *simple); +extern int hidinput_simple_driver_connect(struct hidinput_simple_driver *simple, + struct hid_device *hid, + struct matched_device *dev); +extern void hidinput_simple_driver_disconnect(struct hid_device *hid, + struct matched_device *dev); + +static void inline hidinput_lock_simple(struct hid_input *dev) +{ + while (!test_and_set_bit(0, &dev->input_lock)) + schedule(); +} + +static int inline hidinput_trylock_simple(struct hid_input *dev) +{ + if (!test_and_set_bit(0, &dev->input_lock)) + return 0; + return -EBUSY; +} + +static void inline hidinput_unlock_simple(struct hid_input *dev) +{ + clear_bit(0, &dev->input_lock); +} + +static inline int hidinput_simple_event_filter(struct hid_device *hid, + struct hid_field *field, + struct hid_usage *usage, + __s32 value) +{ + int ret; + + if (!hid->simple || !hid->simple->pre_event) + return (!0); + if (hidinput_trylock_simple(field->hidinput)) + return 0; + ret = hid->simple->pre_event(hid, field, usage, value); + hidinput_unlock_simple(field->hidinput); + return ret; +} + +static inline void hidinput_simple_event_post(struct hid_device *hid, + struct hid_field *field, + struct hid_usage *usage, + __s32 value) +{ + if (!hid->simple || !hid->simple->post_event) + return; + if (hidinput_trylock_simple(field->hidinput)) + return; + hid->simple->post_event(hid, field, usage, value); + hidinput_unlock_simple(field->hidinput); +} + +static inline void hidinput_simple_driver_setup_usage(struct hidinput_simple_driver *simple, struct hid_device *hid) +{ + if (simple) { + set_bit(HIDINPUT_SIMPLE_SETUP_USAGE, &simple->flags); + hidinput_simple_driver_configure_usage(simple, hid); + } +} + +static void inline hidinput_simple_driver_clear_usage(struct hidinput_simple_driver *simple, struct hid_device *hid) +{ + if (simple) { + clear_bit(HIDINPUT_SIMPLE_SETUP_USAGE, &simple->flags); + hidinput_simple_driver_configure_usage(simple, hid); + } +} + +#else /* CONFIG_HID_SIMPLE */ +static inline void hidinput_simple_driver_bind_foreach_simple( + struct matched_device *matched) {} +static inline void hidinput_simple_driver_configure_usage(struct hid_device *hid) +{} +static inline int hidinput_simple_driver_init(struct hidinput_simple_driver *simple) +{ + return 0; +} +static inline void hidinput_simple_driver_clear( + struct hidinput_simple_driver *simple) {} +static inline int hidinput_simple_driver_connect( + struct hidinput_simple_driver *simple, + struct hid_device *hid, + struct matched_device *dev) +{ + return 0; +} +static inline void hidinput_simple_driver_disconnect(struct hid_device *hid, + struct matched_device *dev) {} +static inline void hidinput_simple_driver_setup_usage(struct hid_device *hid) {} +static inline void hidinput_simple_driver_clear_usage(struct hid_device *hid) {} +static void inline hidinput_simple_driver_ff_init(struct input_dev *input_dev) {} +#endif +/***** The private section end. *****/ +#endif /* __KERNEL__ */ +#endif /* __HID_SIMPLE_H */ diff -Naurp linux-2.6.19.orig/drivers/usb/input/Kconfig linux-2.6.19/drivers/usb/input/Kconfig --- linux-2.6.19.orig/drivers/usb/input/Kconfig 2006-11-30 05:57:37.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/Kconfig 2006-12-06 17:41:21.000000000 +0800 @@ -348,3 +348,20 @@ config USB_APPLETOUCH To compile this driver as a module, choose M here: the module will be called appletouch. + +config HID_SIMPLE + bool "HID simple driver interface" + depends on USB_HIDINPUT + help + This simple interface let the writing HID driver more easier. Moreover, + this allow you write force-feedback driver without touch HID input + implementation code. Also, it can be used as input filter. + +config HID_SIMPLE_MSNEK4K + tristate "Microsoft Natural Ergonomic Keyboard 4000 Driver" + depends on HID_SIMPLE + help + Microsoft Natural Ergonomic Keyboard 4000 extend keys support. These + may not work without change user space configration, e.g, XKB + configuration in X. + diff -Naurp linux-2.6.19.orig/drivers/usb/input/Makefile linux-2.6.19/drivers/usb/input/Makefile --- linux-2.6.19.orig/drivers/usb/input/Makefile 2006-11-30 05:57:37.000000000 +0800 +++ linux-2.6.19/drivers/usb/input/Makefile 2006-12-06 17:44:14.000000000 +0800 @@ -29,6 +29,9 @@ endif ifeq ($(CONFIG_HID_FF),y) usbhid-objs += hid-ff.o endif +ifeq ($(CONFIG_HID_SIMPLE),y) + usbhid-objs += hid-simple.o +endif obj-$(CONFIG_USB_AIPTEK) += aiptek.o obj-$(CONFIG_USB_ATI_REMOTE) += ati_remote.o @@ -48,6 +51,7 @@ obj-$(CONFIG_USB_ACECAD) += acecad.o obj-$(CONFIG_USB_YEALINK) += yealink.o obj-$(CONFIG_USB_XPAD) += xpad.o obj-$(CONFIG_USB_APPLETOUCH) += appletouch.o +obj-$(CONFIG_HID_SIMPLE_MSNEK4K) += usbnek4k.o ifeq ($(CONFIG_USB_DEBUG),y) EXTRA_CFLAGS += -DDEBUG - To unsubscribe from this list: send the line "unsubscribe linux-kernel" in the body of a message to [EMAIL PROTECTED] More majordomo info at http://vger.kernel.org/majordomo-info.html Please read the FAQ at http://www.tux.org/lkml/