|
|
|
@ -0,0 +1,564 @@
|
|
|
|
|
/*
|
|
|
|
|
* 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);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
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");
|