hid-lenovo.c 22.6 KB
Newer Older
1
/*
2 3
 *  HID driver for Lenovo:
 *  - ThinkPad USB Keyboard with TrackPoint (tpkbd)
4 5
 *  - ThinkPad Compact Bluetooth Keyboard with TrackPoint (cptkbd)
 *  - ThinkPad Compact USB Keyboard with TrackPoint (cptkbd)
6 7
 *
 *  Copyright (c) 2012 Bernhard Seibold
8
 *  Copyright (c) 2014 Jamie Lentin <jm@lentin.co.uk>
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26
 */

/*
 * 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/hid.h>
#include <linux/input.h>
#include <linux/leds.h>

#include "hid-ids.h"

27
struct lenovo_drvdata_tpkbd {
28 29 30 31 32 33 34 35 36 37 38
	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;
};

39 40
struct lenovo_drvdata_cptkbd {
	bool fn_lock;
41
	int sensitivity;
42 43
};

44 45
#define map_key_clear(c) hid_map_usage_clear(hi, usage, bit, max, EV_KEY, (c))

46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74
static const __u8 lenovo_pro_dock_need_fixup_collection[] = {
	0x05, 0x88,		/* Usage Page (Vendor Usage Page 0x88)	*/
	0x09, 0x01,		/* Usage (Vendor Usage 0x01)		*/
	0xa1, 0x01,		/* Collection (Application)		*/
	0x85, 0x04,		/*  Report ID (4)			*/
	0x19, 0x00,		/*  Usage Minimum (0)			*/
	0x2a, 0xff, 0xff,	/*  Usage Maximum (65535)		*/
};

static __u8 *lenovo_report_fixup(struct hid_device *hdev, __u8 *rdesc,
		unsigned int *rsize)
{
	switch (hdev->product) {
	case USB_DEVICE_ID_LENOVO_TPPRODOCK:
		/* the fixups that need to be done:
		 *   - get a reasonable usage max for the vendor collection
		 *     0x8801 from the report ID 4
		 */
		if (*rsize >= 153 &&
		    memcmp(&rdesc[140], lenovo_pro_dock_need_fixup_collection,
			  sizeof(lenovo_pro_dock_need_fixup_collection)) == 0) {
			rdesc[151] = 0x01;
			rdesc[152] = 0x00;
		}
		break;
	}
	return rdesc;
}

75
static int lenovo_input_mapping_tpkbd(struct hid_device *hdev,
76 77 78
		struct hid_input *hi, struct hid_field *field,
		struct hid_usage *usage, unsigned long **bit, int *max)
{
79
	if (usage->hid == (HID_UP_BUTTON | 0x0010)) {
80
		/* This sub-device contains trackpoint, mark it */
81
		hid_set_drvdata(hdev, (void *)1);
82 83 84 85 86 87
		map_key_clear(KEY_MICMUTE);
		return 1;
	}
	return 0;
}

88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116
static int lenovo_input_mapping_cptkbd(struct hid_device *hdev,
		struct hid_input *hi, struct hid_field *field,
		struct hid_usage *usage, unsigned long **bit, int *max)
{
	/* HID_UP_LNVENDOR = USB, HID_UP_MSVENDOR = BT */
	if ((usage->hid & HID_USAGE_PAGE) == HID_UP_MSVENDOR ||
	    (usage->hid & HID_USAGE_PAGE) == HID_UP_LNVENDOR) {
		switch (usage->hid & HID_USAGE) {
		case 0x00f1: /* Fn-F4: Mic mute */
			map_key_clear(KEY_MICMUTE);
			return 1;
		case 0x00f2: /* Fn-F5: Brightness down */
			map_key_clear(KEY_BRIGHTNESSDOWN);
			return 1;
		case 0x00f3: /* Fn-F6: Brightness up */
			map_key_clear(KEY_BRIGHTNESSUP);
			return 1;
		case 0x00f4: /* Fn-F7: External display (projector) */
			map_key_clear(KEY_SWITCHVIDEOMODE);
			return 1;
		case 0x00f5: /* Fn-F8: Wireless */
			map_key_clear(KEY_WLAN);
			return 1;
		case 0x00f6: /* Fn-F9: Control panel */
			map_key_clear(KEY_CONFIG);
			return 1;
		case 0x00f8: /* Fn-F11: View open applications (3 boxes) */
			map_key_clear(KEY_SCALE);
			return 1;
117
		case 0x00f9: /* Fn-F12: Open My computer (6 boxes) USB-only */
118 119 120
			/* NB: This mapping is invented in raw_event below */
			map_key_clear(KEY_FILE);
			return 1;
121 122 123
		case 0x00fa: /* Fn-Esc: Fn-lock toggle */
			map_key_clear(KEY_FN_ESC);
			return 1;
124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155
		case 0x00fb: /* Middle mouse button (in native mode) */
			map_key_clear(BTN_MIDDLE);
			return 1;
		}
	}

	/* Compatibility middle/wheel mappings should be ignored */
	if (usage->hid == HID_GD_WHEEL)
		return -1;
	if ((usage->hid & HID_USAGE_PAGE) == HID_UP_BUTTON &&
			(usage->hid & HID_USAGE) == 0x003)
		return -1;
	if ((usage->hid & HID_USAGE_PAGE) == HID_UP_CONSUMER &&
			(usage->hid & HID_USAGE) == 0x238)
		return -1;

	/* Map wheel emulation reports: 0xffa1 = USB, 0xff10 = BT */
	if ((usage->hid & HID_USAGE_PAGE) == 0xff100000 ||
	    (usage->hid & HID_USAGE_PAGE) == 0xffa10000) {
		field->flags |= HID_MAIN_ITEM_RELATIVE | HID_MAIN_ITEM_VARIABLE;
		field->logical_minimum = -127;
		field->logical_maximum = 127;

		switch (usage->hid & HID_USAGE) {
		case 0x0000:
			hid_map_usage(hi, usage, bit, max, EV_REL, 0x06);
			return 1;
		case 0x0001:
			hid_map_usage(hi, usage, bit, max, EV_REL, 0x08);
			return 1;
		default:
			return -1;
156 157 158 159 160 161
		}
	}

	return 0;
}

162 163 164 165 166 167 168 169
static int lenovo_input_mapping(struct hid_device *hdev,
		struct hid_input *hi, struct hid_field *field,
		struct hid_usage *usage, unsigned long **bit, int *max)
{
	switch (hdev->product) {
	case USB_DEVICE_ID_LENOVO_TPKBD:
		return lenovo_input_mapping_tpkbd(hdev, hi, field,
							usage, bit, max);
170 171 172 173
	case USB_DEVICE_ID_LENOVO_CUSBKBD:
	case USB_DEVICE_ID_LENOVO_CBTKBD:
		return lenovo_input_mapping_cptkbd(hdev, hi, field,
							usage, bit, max);
174 175 176 177 178
	default:
		return 0;
	}
}

179 180
#undef map_key_clear

181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
/* Send a config command to the keyboard */
static int lenovo_send_cmd_cptkbd(struct hid_device *hdev,
			unsigned char byte2, unsigned char byte3)
{
	int ret;
	unsigned char buf[] = {0x18, byte2, byte3};

	switch (hdev->product) {
	case USB_DEVICE_ID_LENOVO_CUSBKBD:
		ret = hid_hw_raw_request(hdev, 0x13, buf, sizeof(buf),
					HID_FEATURE_REPORT, HID_REQ_SET_REPORT);
		break;
	case USB_DEVICE_ID_LENOVO_CBTKBD:
		ret = hid_hw_output_report(hdev, buf, sizeof(buf));
		break;
	default:
		ret = -EINVAL;
		break;
	}

	return ret < 0 ? ret : 0; /* BT returns 0, USB returns sizeof(buf) */
}

static void lenovo_features_set_cptkbd(struct hid_device *hdev)
{
	int ret;
	struct lenovo_drvdata_cptkbd *cptkbd_data = hid_get_drvdata(hdev);

	ret = lenovo_send_cmd_cptkbd(hdev, 0x05, cptkbd_data->fn_lock);
210
	ret = lenovo_send_cmd_cptkbd(hdev, 0x02, cptkbd_data->sensitivity);
211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
	if (ret)
		hid_err(hdev, "Fn-lock setting failed: %d\n", ret);
}

static ssize_t attr_fn_lock_show_cptkbd(struct device *dev,
		struct device_attribute *attr,
		char *buf)
{
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
	struct lenovo_drvdata_cptkbd *cptkbd_data = hid_get_drvdata(hdev);

	return snprintf(buf, PAGE_SIZE, "%u\n", cptkbd_data->fn_lock);
}

static ssize_t attr_fn_lock_store_cptkbd(struct device *dev,
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
	struct lenovo_drvdata_cptkbd *cptkbd_data = hid_get_drvdata(hdev);
	int value;

	if (kstrtoint(buf, 10, &value))
		return -EINVAL;
	if (value < 0 || value > 1)
		return -EINVAL;

	cptkbd_data->fn_lock = !!value;
	lenovo_features_set_cptkbd(hdev);

	return count;
}

245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274
static ssize_t attr_sensitivity_show_cptkbd(struct device *dev,
		struct device_attribute *attr,
		char *buf)
{
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
	struct lenovo_drvdata_cptkbd *cptkbd_data = hid_get_drvdata(hdev);

	return snprintf(buf, PAGE_SIZE, "%u\n",
		cptkbd_data->sensitivity);
}

static ssize_t attr_sensitivity_store_cptkbd(struct device *dev,
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
	struct lenovo_drvdata_cptkbd *cptkbd_data = hid_get_drvdata(hdev);
	int value;

	if (kstrtoint(buf, 10, &value) || value < 1 || value > 255)
		return -EINVAL;

	cptkbd_data->sensitivity = value;
	lenovo_features_set_cptkbd(hdev);

	return count;
}


275 276 277 278 279
static struct device_attribute dev_attr_fn_lock_cptkbd =
	__ATTR(fn_lock, S_IWUSR | S_IRUGO,
			attr_fn_lock_show_cptkbd,
			attr_fn_lock_store_cptkbd);

280 281 282 283 284 285
static struct device_attribute dev_attr_sensitivity_cptkbd =
	__ATTR(sensitivity, S_IWUSR | S_IRUGO,
			attr_sensitivity_show_cptkbd,
			attr_sensitivity_store_cptkbd);


286 287
static struct attribute *lenovo_attributes_cptkbd[] = {
	&dev_attr_fn_lock_cptkbd.attr,
288
	&dev_attr_sensitivity_cptkbd.attr,
289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308
	NULL
};

static const struct attribute_group lenovo_attr_group_cptkbd = {
	.attrs = lenovo_attributes_cptkbd,
};

static int lenovo_raw_event(struct hid_device *hdev,
			struct hid_report *report, u8 *data, int size)
{
	/*
	 * Compact USB keyboard's Fn-F12 report holds down many other keys, and
	 * its own key is outside the usage page range. Remove extra
	 * keypresses and remap to inside usage page.
	 */
	if (unlikely(hdev->product == USB_DEVICE_ID_LENOVO_CUSBKBD
			&& size == 3
			&& data[0] == 0x15
			&& data[1] == 0x94
			&& data[2] == 0x01)) {
309 310
		data[1] = 0x00;
		data[2] = 0x01;
311 312 313 314 315
	}

	return 0;
}

316
static int lenovo_features_set_tpkbd(struct hid_device *hdev)
317 318
{
	struct hid_report *report;
319
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
320 321 322 323 324 325 326 327 328 329 330

	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;

331
	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
332 333 334
	return 0;
}

335
static ssize_t attr_press_to_select_show_tpkbd(struct device *dev,
336 337 338
		struct device_attribute *attr,
		char *buf)
{
339
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
340
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
341 342 343 344

	return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->press_to_select);
}

345
static ssize_t attr_press_to_select_store_tpkbd(struct device *dev,
346 347 348 349
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
350
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
351
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
352 353 354 355 356 357 358 359
	int value;

	if (kstrtoint(buf, 10, &value))
		return -EINVAL;
	if (value < 0 || value > 1)
		return -EINVAL;

	data_pointer->press_to_select = value;
360
	lenovo_features_set_tpkbd(hdev);
361 362 363 364

	return count;
}

365
static ssize_t attr_dragging_show_tpkbd(struct device *dev,
366 367 368
		struct device_attribute *attr,
		char *buf)
{
369
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
370
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
371 372 373 374

	return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->dragging);
}

375
static ssize_t attr_dragging_store_tpkbd(struct device *dev,
376 377 378 379
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
380
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
381
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
382 383 384 385 386 387 388 389
	int value;

	if (kstrtoint(buf, 10, &value))
		return -EINVAL;
	if (value < 0 || value > 1)
		return -EINVAL;

	data_pointer->dragging = value;
390
	lenovo_features_set_tpkbd(hdev);
391 392 393 394

	return count;
}

395
static ssize_t attr_release_to_select_show_tpkbd(struct device *dev,
396 397 398
		struct device_attribute *attr,
		char *buf)
{
399
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
400
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
401 402 403 404

	return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->release_to_select);
}

405
static ssize_t attr_release_to_select_store_tpkbd(struct device *dev,
406 407 408 409
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
410
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
411
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
412 413 414 415 416 417 418 419
	int value;

	if (kstrtoint(buf, 10, &value))
		return -EINVAL;
	if (value < 0 || value > 1)
		return -EINVAL;

	data_pointer->release_to_select = value;
420
	lenovo_features_set_tpkbd(hdev);
421 422 423 424

	return count;
}

425
static ssize_t attr_select_right_show_tpkbd(struct device *dev,
426 427 428
		struct device_attribute *attr,
		char *buf)
{
429
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
430
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
431 432 433 434

	return snprintf(buf, PAGE_SIZE, "%u\n", data_pointer->select_right);
}

435
static ssize_t attr_select_right_store_tpkbd(struct device *dev,
436 437 438 439
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
440
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
441
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
442 443 444 445 446 447 448 449
	int value;

	if (kstrtoint(buf, 10, &value))
		return -EINVAL;
	if (value < 0 || value > 1)
		return -EINVAL;

	data_pointer->select_right = value;
450
	lenovo_features_set_tpkbd(hdev);
451 452 453 454

	return count;
}

455
static ssize_t attr_sensitivity_show_tpkbd(struct device *dev,
456 457 458
		struct device_attribute *attr,
		char *buf)
{
459
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
460
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
461 462 463 464 465

	return snprintf(buf, PAGE_SIZE, "%u\n",
		data_pointer->sensitivity);
}

466
static ssize_t attr_sensitivity_store_tpkbd(struct device *dev,
467 468 469 470
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
471
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
472
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
473 474 475 476 477 478
	int value;

	if (kstrtoint(buf, 10, &value) || value < 1 || value > 255)
		return -EINVAL;

	data_pointer->sensitivity = value;
479
	lenovo_features_set_tpkbd(hdev);
480 481 482 483

	return count;
}

484
static ssize_t attr_press_speed_show_tpkbd(struct device *dev,
485 486 487
		struct device_attribute *attr,
		char *buf)
{
488
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
489
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
490 491 492 493 494

	return snprintf(buf, PAGE_SIZE, "%u\n",
		data_pointer->press_speed);
}

495
static ssize_t attr_press_speed_store_tpkbd(struct device *dev,
496 497 498 499
		struct device_attribute *attr,
		const char *buf,
		size_t count)
{
500
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
501
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
502 503 504 505 506 507
	int value;

	if (kstrtoint(buf, 10, &value) || value < 1 || value > 255)
		return -EINVAL;

	data_pointer->press_speed = value;
508
	lenovo_features_set_tpkbd(hdev);
509 510 511 512

	return count;
}

513
static struct device_attribute dev_attr_press_to_select_tpkbd =
514
	__ATTR(press_to_select, S_IWUSR | S_IRUGO,
515 516
			attr_press_to_select_show_tpkbd,
			attr_press_to_select_store_tpkbd);
517

518
static struct device_attribute dev_attr_dragging_tpkbd =
519
	__ATTR(dragging, S_IWUSR | S_IRUGO,
520 521
			attr_dragging_show_tpkbd,
			attr_dragging_store_tpkbd);
522

523
static struct device_attribute dev_attr_release_to_select_tpkbd =
524
	__ATTR(release_to_select, S_IWUSR | S_IRUGO,
525 526
			attr_release_to_select_show_tpkbd,
			attr_release_to_select_store_tpkbd);
527

528
static struct device_attribute dev_attr_select_right_tpkbd =
529
	__ATTR(select_right, S_IWUSR | S_IRUGO,
530 531
			attr_select_right_show_tpkbd,
			attr_select_right_store_tpkbd);
532

533
static struct device_attribute dev_attr_sensitivity_tpkbd =
534
	__ATTR(sensitivity, S_IWUSR | S_IRUGO,
535 536
			attr_sensitivity_show_tpkbd,
			attr_sensitivity_store_tpkbd);
537

538
static struct device_attribute dev_attr_press_speed_tpkbd =
539
	__ATTR(press_speed, S_IWUSR | S_IRUGO,
540 541 542 543 544 545 546 547 548 549
			attr_press_speed_show_tpkbd,
			attr_press_speed_store_tpkbd);

static struct attribute *lenovo_attributes_tpkbd[] = {
	&dev_attr_press_to_select_tpkbd.attr,
	&dev_attr_dragging_tpkbd.attr,
	&dev_attr_release_to_select_tpkbd.attr,
	&dev_attr_select_right_tpkbd.attr,
	&dev_attr_sensitivity_tpkbd.attr,
	&dev_attr_press_speed_tpkbd.attr,
550 551 552
	NULL
};

553 554
static const struct attribute_group lenovo_attr_group_tpkbd = {
	.attrs = lenovo_attributes_tpkbd,
555 556
};

557
static enum led_brightness lenovo_led_brightness_get_tpkbd(
558 559
			struct led_classdev *led_cdev)
{
560 561
	struct device *dev = led_cdev->dev->parent;
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
562
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
563 564 565 566 567 568 569 570 571 572
	int led_nr = 0;

	if (led_cdev == &data_pointer->led_micmute)
		led_nr = 1;

	return data_pointer->led_state & (1 << led_nr)
				? LED_FULL
				: LED_OFF;
}

573
static void lenovo_led_brightness_set_tpkbd(struct led_classdev *led_cdev,
574 575
			enum led_brightness value)
{
576 577
	struct device *dev = led_cdev->dev->parent;
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
578
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
579 580 581 582 583 584 585 586 587 588 589 590 591 592
	struct hid_report *report;
	int led_nr = 0;

	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;
593
	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
594 595
}

596
static int lenovo_probe_tpkbd(struct hid_device *hdev)
597 598
{
	struct device *dev = &hdev->dev;
599
	struct lenovo_drvdata_tpkbd *data_pointer;
600 601
	size_t name_sz = strlen(dev_name(dev)) + 16;
	char *name_mute, *name_micmute;
602
	int i;
603
	int ret;
604

605 606 607 608 609 610 611 612 613
	/*
	 * Only register extra settings against subdevice where input_mapping
	 * set drvdata to 1, i.e. the trackpoint.
	 */
	if (!hid_get_drvdata(hdev))
		return 0;

	hid_set_drvdata(hdev, NULL);

614 615 616 617 618 619 620
	/* Validate required reports. */
	for (i = 0; i < 4; i++) {
		if (!hid_validate_values(hdev, HID_FEATURE_REPORT, 4, i, 1))
			return -ENODEV;
	}
	if (!hid_validate_values(hdev, HID_OUTPUT_REPORT, 3, 0, 2))
		return -ENODEV;
621

622 623 624
	ret = sysfs_create_group(&hdev->dev.kobj, &lenovo_attr_group_tpkbd);
	if (ret)
		hid_warn(hdev, "Could not create sysfs group: %d\n", ret);
625

626
	data_pointer = devm_kzalloc(&hdev->dev,
627
				    sizeof(struct lenovo_drvdata_tpkbd),
628
				    GFP_KERNEL);
629 630
	if (data_pointer == NULL) {
		hid_err(hdev, "Could not allocate memory for driver data\n");
631 632
		ret = -ENOMEM;
		goto err;
633 634 635 636 637 638
	}

	// set same default values as windows driver
	data_pointer->sensitivity = 0xa0;
	data_pointer->press_speed = 0x38;

639 640 641
	name_mute = devm_kzalloc(&hdev->dev, name_sz, GFP_KERNEL);
	name_micmute = devm_kzalloc(&hdev->dev, name_sz, GFP_KERNEL);
	if (name_mute == NULL || name_micmute == NULL) {
642
		hid_err(hdev, "Could not allocate memory for led data\n");
643 644
		ret = -ENOMEM;
		goto err;
645 646 647 648 649 650 651
	}
	snprintf(name_mute, name_sz, "%s:amber:mute", dev_name(dev));
	snprintf(name_micmute, name_sz, "%s:amber:micmute", dev_name(dev));

	hid_set_drvdata(hdev, data_pointer);

	data_pointer->led_mute.name = name_mute;
652 653
	data_pointer->led_mute.brightness_get = lenovo_led_brightness_get_tpkbd;
	data_pointer->led_mute.brightness_set = lenovo_led_brightness_set_tpkbd;
654 655 656 657
	data_pointer->led_mute.dev = dev;
	led_classdev_register(dev, &data_pointer->led_mute);

	data_pointer->led_micmute.name = name_micmute;
658 659 660 661
	data_pointer->led_micmute.brightness_get =
		lenovo_led_brightness_get_tpkbd;
	data_pointer->led_micmute.brightness_set =
		lenovo_led_brightness_set_tpkbd;
662 663 664
	data_pointer->led_micmute.dev = dev;
	led_classdev_register(dev, &data_pointer->led_micmute);

665
	lenovo_features_set_tpkbd(hdev);
666 667

	return 0;
668 669 670
err:
	sysfs_remove_group(&hdev->dev.kobj, &lenovo_attr_group_tpkbd);
	return ret;
671 672
}

673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701
static int lenovo_probe_cptkbd(struct hid_device *hdev)
{
	int ret;
	struct lenovo_drvdata_cptkbd *cptkbd_data;

	/* All the custom action happens on the USBMOUSE device for USB */
	if (hdev->product == USB_DEVICE_ID_LENOVO_CUSBKBD
			&& hdev->type != HID_TYPE_USBMOUSE) {
		hid_dbg(hdev, "Ignoring keyboard half of device\n");
		return 0;
	}

	cptkbd_data = devm_kzalloc(&hdev->dev,
					sizeof(*cptkbd_data),
					GFP_KERNEL);
	if (cptkbd_data == NULL) {
		hid_err(hdev, "can't alloc keyboard descriptor\n");
		return -ENOMEM;
	}
	hid_set_drvdata(hdev, cptkbd_data);

	/*
	 * Tell the keyboard a driver understands it, and turn F7, F9, F11 into
	 * regular keys
	 */
	ret = lenovo_send_cmd_cptkbd(hdev, 0x01, 0x03);
	if (ret)
		hid_warn(hdev, "Failed to switch F7/9/11 mode: %d\n", ret);

702 703 704 705 706
	/* Switch middle button to native mode */
	ret = lenovo_send_cmd_cptkbd(hdev, 0x09, 0x01);
	if (ret)
		hid_warn(hdev, "Failed to switch middle button: %d\n", ret);

707
	/* Set keyboard settings to known state */
708
	cptkbd_data->fn_lock = true;
709
	cptkbd_data->sensitivity = 0x05;
710 711 712 713 714 715 716 717 718
	lenovo_features_set_cptkbd(hdev);

	ret = sysfs_create_group(&hdev->dev.kobj, &lenovo_attr_group_cptkbd);
	if (ret)
		hid_warn(hdev, "Could not create sysfs group: %d\n", ret);

	return 0;
}

719
static int lenovo_probe(struct hid_device *hdev,
720 721 722 723 724 725 726
		const struct hid_device_id *id)
{
	int ret;

	ret = hid_parse(hdev);
	if (ret) {
		hid_err(hdev, "hid_parse failed\n");
727
		goto err;
728 729 730 731 732
	}

	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
	if (ret) {
		hid_err(hdev, "hid_hw_start failed\n");
733
		goto err;
734 735
	}

736 737
	switch (hdev->product) {
	case USB_DEVICE_ID_LENOVO_TPKBD:
738
		ret = lenovo_probe_tpkbd(hdev);
739
		break;
740 741 742 743
	case USB_DEVICE_ID_LENOVO_CUSBKBD:
	case USB_DEVICE_ID_LENOVO_CBTKBD:
		ret = lenovo_probe_cptkbd(hdev);
		break;
744 745 746
	default:
		ret = 0;
		break;
747
	}
748 749
	if (ret)
		goto err_hid;
750 751

	return 0;
752 753 754
err_hid:
	hid_hw_stop(hdev);
err:
755 756 757
	return ret;
}

758
static void lenovo_remove_tpkbd(struct hid_device *hdev)
759
{
760
	struct lenovo_drvdata_tpkbd *data_pointer = hid_get_drvdata(hdev);
761

762 763 764 765 766 767 768
	/*
	 * Only the trackpoint half of the keyboard has drvdata and stuff that
	 * needs unregistering.
	 */
	if (data_pointer == NULL)
		return;

769
	sysfs_remove_group(&hdev->dev.kobj,
770
			&lenovo_attr_group_tpkbd);
771 772 773 774 775 776 777

	led_classdev_unregister(&data_pointer->led_micmute);
	led_classdev_unregister(&data_pointer->led_mute);

	hid_set_drvdata(hdev, NULL);
}

778 779 780 781 782 783
static void lenovo_remove_cptkbd(struct hid_device *hdev)
{
	sysfs_remove_group(&hdev->dev.kobj,
			&lenovo_attr_group_cptkbd);
}

784
static void lenovo_remove(struct hid_device *hdev)
785
{
786 787
	switch (hdev->product) {
	case USB_DEVICE_ID_LENOVO_TPKBD:
788
		lenovo_remove_tpkbd(hdev);
789
		break;
790 791 792 793
	case USB_DEVICE_ID_LENOVO_CUSBKBD:
	case USB_DEVICE_ID_LENOVO_CBTKBD:
		lenovo_remove_cptkbd(hdev);
		break;
794
	}
795 796 797 798

	hid_hw_stop(hdev);
}

799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816
static void lenovo_input_configured(struct hid_device *hdev,
		struct hid_input *hi)
{
	switch (hdev->product) {
		case USB_DEVICE_ID_LENOVO_TPKBD:
		case USB_DEVICE_ID_LENOVO_CUSBKBD:
		case USB_DEVICE_ID_LENOVO_CBTKBD:
			if (test_bit(EV_REL, hi->input->evbit)) {
				/* set only for trackpoint device */
				__set_bit(INPUT_PROP_POINTER, hi->input->propbit);
				__set_bit(INPUT_PROP_POINTING_STICK,
						hi->input->propbit);
			}
			break;
	}
}


817
static const struct hid_device_id lenovo_devices[] = {
818
	{ HID_USB_DEVICE(USB_VENDOR_ID_LENOVO, USB_DEVICE_ID_LENOVO_TPKBD) },
819 820
	{ HID_USB_DEVICE(USB_VENDOR_ID_LENOVO, USB_DEVICE_ID_LENOVO_CUSBKBD) },
	{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_LENOVO, USB_DEVICE_ID_LENOVO_CBTKBD) },
821
	{ HID_USB_DEVICE(USB_VENDOR_ID_LENOVO, USB_DEVICE_ID_LENOVO_TPPRODOCK) },
822 823 824
	{ }
};

825
MODULE_DEVICE_TABLE(hid, lenovo_devices);
826

827 828 829
static struct hid_driver lenovo_driver = {
	.name = "lenovo",
	.id_table = lenovo_devices,
830
	.input_configured = lenovo_input_configured,
831
	.input_mapping = lenovo_input_mapping,
832 833
	.probe = lenovo_probe,
	.remove = lenovo_remove,
834
	.raw_event = lenovo_raw_event,
835
	.report_fixup = lenovo_report_fixup,
836
};
837
module_hid_driver(lenovo_driver);
838 839

MODULE_LICENSE("GPL");