| /* |
| * HID driver for Lenovo ThinkPad USB Keyboard with TrackPoint |
| * |
| * Copyright (c) 2012 Bernhard Seibold |
| */ |
| |
| /* |
| * 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. |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/sysfs.h> |
| #include <linux/device.h> |
| #include <linux/usb.h> |
| #include <linux/hid.h> |
| #include <linux/input.h> |
| #include <linux/leds.h> |
| #include "usbhid/usbhid.h" |
| |
| #include "hid-ids.h" |
| |
| /* This is only used for the trackpoint part of the driver, hence _tp */ |
| struct tpkbd_data_pointer { |
| int led_state; |
| struct led_classdev led_mute; |
| struct led_classdev led_micmute; |
| int press_to_select; |
| int dragging; |
| int release_to_select; |
| int select_right; |
| int sensitivity; |
| int press_speed; |
| }; |
| |
| #define map_key_clear(c) hid_map_usage_clear(hi, usage, bit, max, EV_KEY, (c)) |
| |
| static int tpkbd_input_mapping(struct hid_device *hdev, |
| struct hid_input *hi, struct hid_field *field, |
| struct hid_usage *usage, unsigned long **bit, int *max) |
| { |
| struct usbhid_device *uhdev; |
| |
| uhdev = (struct usbhid_device *) hdev->driver_data; |
| if (uhdev->ifnum == 1 && usage->hid == (HID_UP_BUTTON | 0x0010)) { |
| map_key_clear(KEY_MICMUTE); |
| return 1; |
| } |
| return 0; |
| } |
| |
| #undef map_key_clear |
| |
| static int tpkbd_features_set(struct hid_device *hdev) |
| { |
| struct hid_report *report; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| report = hdev->report_enum[HID_FEATURE_REPORT].report_id_hash[4]; |
| |
| report->field[0]->value[0] = data_pointer->press_to_select ? 0x01 : 0x02; |
| report->field[0]->value[0] |= data_pointer->dragging ? 0x04 : 0x08; |
| report->field[0]->value[0] |= data_pointer->release_to_select ? 0x10 : 0x20; |
| report->field[0]->value[0] |= data_pointer->select_right ? 0x80 : 0x40; |
| report->field[1]->value[0] = 0x03; // unknown setting, imitate windows driver |
| report->field[2]->value[0] = data_pointer->sensitivity; |
| report->field[3]->value[0] = data_pointer->press_speed; |
| |
| usbhid_submit_report(hdev, report, USB_DIR_OUT); |
| return 0; |
| } |
| |
| static ssize_t pointer_press_to_select_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->press_to_select); |
| } |
| |
| static ssize_t pointer_press_to_select_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int value; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (kstrtoint(buf, 10, &value)) |
| return -EINVAL; |
| if (value < 0 || value > 1) |
| return -EINVAL; |
| |
| data_pointer->press_to_select = value; |
| tpkbd_features_set(hdev); |
| |
| return count; |
| } |
| |
| static ssize_t pointer_dragging_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->dragging); |
| } |
| |
| static ssize_t pointer_dragging_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int value; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (kstrtoint(buf, 10, &value)) |
| return -EINVAL; |
| if (value < 0 || value > 1) |
| return -EINVAL; |
| |
| data_pointer->dragging = value; |
| tpkbd_features_set(hdev); |
| |
| return count; |
| } |
| |
| static ssize_t pointer_release_to_select_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->release_to_select); |
| } |
| |
| static ssize_t pointer_release_to_select_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int value; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (kstrtoint(buf, 10, &value)) |
| return -EINVAL; |
| if (value < 0 || value > 1) |
| return -EINVAL; |
| |
| data_pointer->release_to_select = value; |
| tpkbd_features_set(hdev); |
| |
| return count; |
| } |
| |
| static ssize_t pointer_select_right_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->select_right); |
| } |
| |
| static ssize_t pointer_select_right_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int value; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (kstrtoint(buf, 10, &value)) |
| return -EINVAL; |
| if (value < 0 || value > 1) |
| return -EINVAL; |
| |
| data_pointer->select_right = value; |
| tpkbd_features_set(hdev); |
| |
| return count; |
| } |
| |
| static ssize_t pointer_sensitivity_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| return snprintf(buf, PAGE_SIZE, "%u\n", |
| data_pointer->sensitivity); |
| } |
| |
| static ssize_t pointer_sensitivity_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int value; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (kstrtoint(buf, 10, &value) || value < 1 || value > 255) |
| return -EINVAL; |
| |
| data_pointer->sensitivity = value; |
| tpkbd_features_set(hdev); |
| |
| return count; |
| } |
| |
| static ssize_t pointer_press_speed_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| return snprintf(buf, PAGE_SIZE, "%u\n", |
| data_pointer->press_speed); |
| } |
| |
| static ssize_t pointer_press_speed_store(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int value; |
| |
| hdev = container_of(dev, struct hid_device, dev); |
| if (hdev == NULL) |
| return -ENODEV; |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (kstrtoint(buf, 10, &value) || value < 1 || value > 255) |
| return -EINVAL; |
| |
| data_pointer->press_speed = value; |
| tpkbd_features_set(hdev); |
| |
| return count; |
| } |
| |
| static struct device_attribute dev_attr_pointer_press_to_select = |
| __ATTR(press_to_select, S_IWUSR | S_IRUGO, |
| pointer_press_to_select_show, |
| pointer_press_to_select_store); |
| |
| static struct device_attribute dev_attr_pointer_dragging = |
| __ATTR(dragging, S_IWUSR | S_IRUGO, |
| pointer_dragging_show, |
| pointer_dragging_store); |
| |
| static struct device_attribute dev_attr_pointer_release_to_select = |
| __ATTR(release_to_select, S_IWUSR | S_IRUGO, |
| pointer_release_to_select_show, |
| pointer_release_to_select_store); |
| |
| static struct device_attribute dev_attr_pointer_select_right = |
| __ATTR(select_right, S_IWUSR | S_IRUGO, |
| pointer_select_right_show, |
| pointer_select_right_store); |
| |
| static struct device_attribute dev_attr_pointer_sensitivity = |
| __ATTR(sensitivity, S_IWUSR | S_IRUGO, |
| pointer_sensitivity_show, |
| pointer_sensitivity_store); |
| |
| static struct device_attribute dev_attr_pointer_press_speed = |
| __ATTR(press_speed, S_IWUSR | S_IRUGO, |
| pointer_press_speed_show, |
| pointer_press_speed_store); |
| |
| static struct attribute *tpkbd_attributes_pointer[] = { |
| &dev_attr_pointer_press_to_select.attr, |
| &dev_attr_pointer_dragging.attr, |
| &dev_attr_pointer_release_to_select.attr, |
| &dev_attr_pointer_select_right.attr, |
| &dev_attr_pointer_sensitivity.attr, |
| &dev_attr_pointer_press_speed.attr, |
| NULL |
| }; |
| |
| static const struct attribute_group tpkbd_attr_group_pointer = { |
| .attrs = tpkbd_attributes_pointer, |
| }; |
| |
| static enum led_brightness tpkbd_led_brightness_get( |
| struct led_classdev *led_cdev) |
| { |
| struct device *dev; |
| struct hid_device *hdev; |
| struct tpkbd_data_pointer *data_pointer; |
| int led_nr = 0; |
| |
| dev = led_cdev->dev->parent; |
| hdev = container_of(dev, struct hid_device, dev); |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (led_cdev == &data_pointer->led_micmute) |
| led_nr = 1; |
| |
| return data_pointer->led_state & (1 << led_nr) |
| ? LED_FULL |
| : LED_OFF; |
| } |
| |
| static void tpkbd_led_brightness_set(struct led_classdev *led_cdev, |
| enum led_brightness value) |
| { |
| struct device *dev; |
| struct hid_device *hdev; |
| struct hid_report *report; |
| struct tpkbd_data_pointer *data_pointer; |
| int led_nr = 0; |
| |
| dev = led_cdev->dev->parent; |
| hdev = container_of(dev, struct hid_device, dev); |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| if (led_cdev == &data_pointer->led_micmute) |
| led_nr = 1; |
| |
| if (value == LED_OFF) |
| data_pointer->led_state &= ~(1 << led_nr); |
| else |
| data_pointer->led_state |= 1 << led_nr; |
| |
| report = hdev->report_enum[HID_OUTPUT_REPORT].report_id_hash[3]; |
| report->field[0]->value[0] = (data_pointer->led_state >> 0) & 1; |
| report->field[0]->value[1] = (data_pointer->led_state >> 1) & 1; |
| usbhid_submit_report(hdev, report, USB_DIR_OUT); |
| } |
| |
| static int tpkbd_probe_tp(struct hid_device *hdev) |
| { |
| struct device *dev = &hdev->dev; |
| struct tpkbd_data_pointer *data_pointer; |
| size_t name_sz = strlen(dev_name(dev)) + 16; |
| char *name_mute, *name_micmute; |
| int ret; |
| |
| if (sysfs_create_group(&hdev->dev.kobj, |
| &tpkbd_attr_group_pointer)) { |
| hid_warn(hdev, "Could not create sysfs group\n"); |
| } |
| |
| data_pointer = kzalloc(sizeof(struct tpkbd_data_pointer), GFP_KERNEL); |
| if (data_pointer == NULL) { |
| hid_err(hdev, "Could not allocate memory for driver data\n"); |
| return -ENOMEM; |
| } |
| |
| // set same default values as windows driver |
| data_pointer->sensitivity = 0xa0; |
| data_pointer->press_speed = 0x38; |
| |
| name_mute = kzalloc(name_sz, GFP_KERNEL); |
| if (name_mute == NULL) { |
| hid_err(hdev, "Could not allocate memory for led data\n"); |
| ret = -ENOMEM; |
| goto err; |
| } |
| snprintf(name_mute, name_sz, "%s:amber:mute", dev_name(dev)); |
| |
| name_micmute = kzalloc(name_sz, GFP_KERNEL); |
| if (name_micmute == NULL) { |
| hid_err(hdev, "Could not allocate memory for led data\n"); |
| ret = -ENOMEM; |
| goto err2; |
| } |
| snprintf(name_micmute, name_sz, "%s:amber:micmute", dev_name(dev)); |
| |
| hid_set_drvdata(hdev, data_pointer); |
| |
| data_pointer->led_mute.name = name_mute; |
| data_pointer->led_mute.brightness_get = tpkbd_led_brightness_get; |
| data_pointer->led_mute.brightness_set = tpkbd_led_brightness_set; |
| data_pointer->led_mute.dev = dev; |
| led_classdev_register(dev, &data_pointer->led_mute); |
| |
| data_pointer->led_micmute.name = name_micmute; |
| data_pointer->led_micmute.brightness_get = tpkbd_led_brightness_get; |
| data_pointer->led_micmute.brightness_set = tpkbd_led_brightness_set; |
| data_pointer->led_micmute.dev = dev; |
| led_classdev_register(dev, &data_pointer->led_micmute); |
| |
| tpkbd_features_set(hdev); |
| |
| return 0; |
| |
| err2: |
| kfree(name_mute); |
| err: |
| kfree(data_pointer); |
| return ret; |
| } |
| |
| static int tpkbd_probe(struct hid_device *hdev, |
| const struct hid_device_id *id) |
| { |
| int ret; |
| struct usbhid_device *uhdev; |
| |
| ret = hid_parse(hdev); |
| if (ret) { |
| hid_err(hdev, "hid_parse failed\n"); |
| goto err_free; |
| } |
| |
| ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT); |
| if (ret) { |
| hid_err(hdev, "hid_hw_start failed\n"); |
| goto err_free; |
| } |
| |
| uhdev = (struct usbhid_device *) hdev->driver_data; |
| |
| if (uhdev->ifnum == 1) |
| return tpkbd_probe_tp(hdev); |
| |
| return 0; |
| err_free: |
| return ret; |
| } |
| |
| static void tpkbd_remove_tp(struct hid_device *hdev) |
| { |
| struct tpkbd_data_pointer *data_pointer; |
| |
| sysfs_remove_group(&hdev->dev.kobj, |
| &tpkbd_attr_group_pointer); |
| |
| data_pointer = (struct tpkbd_data_pointer *) hid_get_drvdata(hdev); |
| |
| led_classdev_unregister(&data_pointer->led_micmute); |
| led_classdev_unregister(&data_pointer->led_mute); |
| |
| hid_set_drvdata(hdev, NULL); |
| kfree(data_pointer->led_micmute.name); |
| kfree(data_pointer->led_mute.name); |
| kfree(data_pointer); |
| } |
| |
| static void tpkbd_remove(struct hid_device *hdev) |
| { |
| struct usbhid_device *uhdev; |
| |
| uhdev = (struct usbhid_device *) hdev->driver_data; |
| if (uhdev->ifnum == 1) |
| tpkbd_remove_tp(hdev); |
| |
| hid_hw_stop(hdev); |
| } |
| |
| static const struct hid_device_id tpkbd_devices[] = { |
| { HID_USB_DEVICE(USB_VENDOR_ID_LENOVO, USB_DEVICE_ID_LENOVO_TPKBD) }, |
| { } |
| }; |
| |
| MODULE_DEVICE_TABLE(hid, tpkbd_devices); |
| |
| static struct hid_driver tpkbd_driver = { |
| .name = "lenovo_tpkbd", |
| .id_table = tpkbd_devices, |
| .input_mapping = tpkbd_input_mapping, |
| .probe = tpkbd_probe, |
| .remove = tpkbd_remove, |
| }; |
| |
| static int __init tpkbd_init(void) |
| { |
| return hid_register_driver(&tpkbd_driver); |
| } |
| |
| static void __exit tpkbd_exit(void) |
| { |
| hid_unregister_driver(&tpkbd_driver); |
| } |
| |
| module_init(tpkbd_init); |
| module_exit(tpkbd_exit); |
| |
| MODULE_LICENSE("GPL"); |