wacom_sys.c 40.8 KB
Newer Older
1
/*
2
 * drivers/input/tablet/wacom_sys.c
3
 *
4
 *  USB Wacom tablet support - system specific code
5 6 7 8 9 10 11 12 13 14
 */

/*
 * 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 "wacom_wac.h"
15
#include "wacom.h"
16
#include <linux/input/mt.h>
17

18
#define WAC_MSG_RETRIES		5
19

20
#define WAC_CMD_WL_LED_CONTROL	0x03
21 22 23
#define WAC_CMD_LED_CONTROL	0x20
#define WAC_CMD_ICON_START	0x21
#define WAC_CMD_ICON_XFER	0x23
24
#define WAC_CMD_ICON_BT_XFER	0x26
25 26
#define WAC_CMD_RETRIES		10

27 28 29
#define DEV_ATTR_RW_PERM (S_IRUGO | S_IWUSR | S_IWGRP)
#define DEV_ATTR_WO_PERM (S_IWUSR | S_IWGRP)

30 31
static int wacom_get_report(struct hid_device *hdev, u8 type, u8 *buf,
			    size_t size, unsigned int retries)
32
{
33 34 35
	int retval;

	do {
36
		retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
37
				HID_REQ_GET_REPORT);
38 39 40
	} while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);

	return retval;
41 42
}

43 44
static int wacom_set_report(struct hid_device *hdev, u8 type, u8 *buf,
			    size_t size, unsigned int retries)
45
{
46 47 48
	int retval;

	do {
49
		retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
50
				HID_REQ_SET_REPORT);
51 52 53
	} while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);

	return retval;
54 55
}

56 57
static int wacom_raw_event(struct hid_device *hdev, struct hid_report *report,
		u8 *raw_data, int size)
58
{
59
	struct wacom *wacom = hid_get_drvdata(hdev);
60

61 62
	if (size > WACOM_PKGLEN_MAX)
		return 1;
63

64
	memcpy(wacom->wacom_wac.data, raw_data, size);
65

66 67 68
	wacom_wac_irq(&wacom->wacom_wac, size);

	return 0;
69 70 71 72
}

static int wacom_open(struct input_dev *dev)
{
73
	struct wacom *wacom = input_get_drvdata(dev);
74

75
	return hid_hw_open(wacom->hdev);
76 77 78 79
}

static void wacom_close(struct input_dev *dev)
{
80
	struct wacom *wacom = input_get_drvdata(dev);
81

82
	hid_hw_close(wacom->hdev);
83 84
}

85
/*
86
 * Calculate the resolution of the X or Y axis using hidinput_calc_abs_res.
87 88
 */
static int wacom_calc_hid_res(int logical_extents, int physical_extents,
89
			       unsigned unit, int exponent)
90
{
91 92 93 94 95 96 97 98
	struct hid_field field = {
		.logical_maximum = logical_extents,
		.physical_maximum = physical_extents,
		.unit = unit,
		.unit_exponent = exponent,
	};

	return hidinput_calc_abs_res(&field, ABS_X);
99 100
}

101 102
static void wacom_feature_mapping(struct hid_device *hdev,
		struct hid_field *field, struct hid_usage *usage)
103
{
104 105
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct wacom_features *features = &wacom->wacom_wac.features;
106
	struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
107 108
	u8 *data;
	int ret;
109

110 111 112
	switch (usage->hid) {
	case HID_DG_CONTACTMAX:
		/* leave touch_max as is if predefined */
113 114 115 116 117 118 119 120 121 122 123 124
		if (!features->touch_max) {
			/* read manually */
			data = kzalloc(2, GFP_KERNEL);
			if (!data)
				break;
			data[0] = field->report->id;
			ret = wacom_get_report(hdev, HID_FEATURE_REPORT,
						data, 2, 0);
			if (ret == 2)
				features->touch_max = data[1];
			kfree(data);
		}
125
		break;
126 127 128 129 130 131 132 133 134 135
	case HID_DG_INPUTMODE:
		/* Ignore if value index is out of bounds. */
		if (usage->usage_index >= field->report_count) {
			dev_err(&hdev->dev, "HID_DG_INPUTMODE out of range\n");
			break;
		}

		hid_data->inputmode = field->report->id;
		hid_data->inputmode_index = usage->usage_index;
		break;
136 137 138
	}
}

139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166
/*
 * Interface Descriptor of wacom devices can be incomplete and
 * inconsistent so wacom_features table is used to store stylus
 * device's packet lengths, various maximum values, and tablet
 * resolution based on product ID's.
 *
 * For devices that contain 2 interfaces, wacom_features table is
 * inaccurate for the touch interface.  Since the Interface Descriptor
 * for touch interfaces has pretty complete data, this function exists
 * to query tablet for this missing information instead of hard coding in
 * an additional table.
 *
 * A typical Interface Descriptor for a stylus will contain a
 * boot mouse application collection that is not of interest and this
 * function will ignore it.
 *
 * It also contains a digitizer application collection that also is not
 * of interest since any information it contains would be duplicate
 * of what is in wacom_features. Usually it defines a report of an array
 * of bytes that could be used as max length of the stylus packet returned.
 * If it happens to define a Digitizer-Stylus Physical Collection then
 * the X and Y logical values contain valid data but it is ignored.
 *
 * A typical Interface Descriptor for a touch interface will contain a
 * Digitizer-Finger Physical Collection which will define both logical
 * X/Y maximum as well as the physical size of tablet. Since touch
 * interfaces haven't supported pressure or distance, this is enough
 * information to override invalid values in the wacom_features table.
167
 *
168 169
 * Intuos5 touch interface and 3rd gen Bamboo Touch do not contain useful
 * data. We deal with them after returning from this function.
170
 */
171 172
static void wacom_usage_mapping(struct hid_device *hdev,
		struct hid_field *field, struct hid_usage *usage)
173
{
174 175
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct wacom_features *features = &wacom->wacom_wac.features;
176 177
	bool finger = WACOM_FINGER_FIELD(field);
	bool pen = WACOM_PEN_FIELD(field);
178

179 180 181 182 183 184 185 186
	/*
	* Requiring Stylus Usage will ignore boot mouse
	* X/Y values and some cases of invalid Digitizer X/Y
	* values commonly reported.
	*/
	if (!pen && !finger)
		return;

187 188 189 190 191 192 193 194 195
	/*
	 * Bamboo models do not support HID_DG_CONTACTMAX.
	 * And, Bamboo Pen only descriptor contains touch.
	 */
	if (features->type != BAMBOO_PT) {
		/* ISDv4 touch devices at least supports one touch point */
		if (finger && !features->touch_max)
			features->touch_max = 1;
	}
196 197 198 199 200 201 202 203 204 205

	switch (usage->hid) {
	case HID_GD_X:
		features->x_max = field->logical_maximum;
		if (finger) {
			features->device_type = BTN_TOOL_FINGER;
			features->x_phy = field->physical_maximum;
			if (features->type != BAMBOO_PT) {
				features->unit = field->unit;
				features->unitExpo = field->unit_exponent;
206
			}
207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225
		} else {
			features->device_type = BTN_TOOL_PEN;
		}
		break;
	case HID_GD_Y:
		features->y_max = field->logical_maximum;
		if (finger) {
			features->y_phy = field->physical_maximum;
			if (features->type != BAMBOO_PT) {
				features->unit = field->unit;
				features->unitExpo = field->unit_exponent;
			}
		}
		break;
	case HID_DG_TIPPRESSURE:
		if (pen)
			features->pressure_max = field->logical_maximum;
		break;
	}
226 227 228

	if (features->type == HID_GENERIC)
		wacom_wac_usage_mapping(hdev, field, usage);
229
}
230

231 232 233 234 235 236 237 238 239 240 241 242 243 244 245
static void wacom_post_parse_hid(struct hid_device *hdev,
				 struct wacom_features *features)
{
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct wacom_wac *wacom_wac = &wacom->wacom_wac;

	if (features->type == HID_GENERIC) {
		/* Any last-minute generic device setup */
		if (features->touch_max > 1) {
			input_mt_init_slots(wacom_wac->input, wacom_wac->features.touch_max,
				    INPUT_MT_DIRECT);
		}
	}
}

246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
static void wacom_parse_hid(struct hid_device *hdev,
			   struct wacom_features *features)
{
	struct hid_report_enum *rep_enum;
	struct hid_report *hreport;
	int i, j;

	/* check features first */
	rep_enum = &hdev->report_enum[HID_FEATURE_REPORT];
	list_for_each_entry(hreport, &rep_enum->report_list, list) {
		for (i = 0; i < hreport->maxfield; i++) {
			/* Ignore if report count is out of bounds. */
			if (hreport->field[i]->report_count < 1)
				continue;

			for (j = 0; j < hreport->field[i]->maxusage; j++) {
				wacom_feature_mapping(hdev, hreport->field[i],
						hreport->field[i]->usage + j);
264
			}
265 266 267
		}
	}

268 269 270 271 272 273 274 275 276 277 278 279
	/* now check the input usages */
	rep_enum = &hdev->report_enum[HID_INPUT_REPORT];
	list_for_each_entry(hreport, &rep_enum->report_list, list) {

		if (!hreport->maxfield)
			continue;

		for (i = 0; i < hreport->maxfield; i++)
			for (j = 0; j < hreport->field[i]->maxusage; j++)
				wacom_usage_mapping(hdev, hreport->field[i],
						hreport->field[i]->usage + j);
	}
280 281

	wacom_post_parse_hid(hdev, features);
282 283
}

284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
static int wacom_hid_set_device_mode(struct hid_device *hdev)
{
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
	struct hid_report *r;
	struct hid_report_enum *re;

	if (hid_data->inputmode < 0)
		return 0;

	re = &(hdev->report_enum[HID_FEATURE_REPORT]);
	r = re->report_id_hash[hid_data->inputmode];
	if (r) {
		r->field[0]->value[hid_data->inputmode_index] = 2;
		hid_hw_request(hdev, r, HID_REQ_SET_REPORT);
	}
	return 0;
}

303 304
static int wacom_set_device_mode(struct hid_device *hdev, int report_id,
		int length, int mode)
305 306
{
	unsigned char *rep_data;
307
	int error = -ENOMEM, limit = 0;
308

309
	rep_data = kzalloc(length, GFP_KERNEL);
310
	if (!rep_data)
311 312
		return error;

313
	do {
314 315 316
		rep_data[0] = report_id;
		rep_data[1] = mode;

317 318
		error = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data,
					 length, 1);
319
		if (error >= 0)
320
			error = wacom_get_report(hdev, HID_FEATURE_REPORT,
321
			                         rep_data, length, 1);
322 323 324 325 326 327 328
	} while ((error < 0 || rep_data[1] != mode) && limit++ < WAC_MSG_RETRIES);

	kfree(rep_data);

	return error < 0 ? error : 0;
}

329 330 331
static int wacom_bt_query_tablet_data(struct hid_device *hdev, u8 speed,
		struct wacom_features *features)
{
332 333 334 335 336 337 338 339
	struct wacom *wacom = hid_get_drvdata(hdev);
	int ret;
	u8 rep_data[2];

	switch (features->type) {
	case GRAPHIRE_BT:
		rep_data[0] = 0x03;
		rep_data[1] = 0x00;
340 341
		ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
					3);
342 343 344 345 346 347

		if (ret >= 0) {
			rep_data[0] = speed == 0 ? 0x05 : 0x06;
			rep_data[1] = 0x00;

			ret = wacom_set_report(hdev, HID_FEATURE_REPORT,
348
						rep_data, 2, 3);
349 350 351 352 353 354 355 356 357 358 359 360 361 362

			if (ret >= 0) {
				wacom->wacom_wac.bt_high_speed = speed;
				return 0;
			}
		}

		/*
		 * Note that if the raw queries fail, it's not a hard failure
		 * and it is safe to continue
		 */
		hid_warn(hdev, "failed to poke device, command %d, err %d\n",
			 rep_data[0], ret);
		break;
363 364 365 366 367 368 369 370 371
	case INTUOS4WL:
		if (speed == 1)
			wacom->wacom_wac.bt_features &= ~0x20;
		else
			wacom->wacom_wac.bt_features |= 0x20;

		rep_data[0] = 0x03;
		rep_data[1] = wacom->wacom_wac.bt_features;

372 373
		ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
					1);
374 375 376
		if (ret >= 0)
			wacom->wacom_wac.bt_high_speed = speed;
		break;
377 378
	}

379 380 381
	return 0;
}

382 383 384 385 386 387 388
/*
 * Switch the tablet into its most-capable mode. Wacom tablets are
 * typically configured to power-up in a mode which sends mouse-like
 * reports to the OS. To get absolute position, pressure data, etc.
 * from the tablet, it is necessary to switch the tablet out of this
 * mode and into one which sends the full range of tablet data.
 */
389 390
static int wacom_query_tablet_data(struct hid_device *hdev,
		struct wacom_features *features)
391
{
392 393 394
	if (hdev->bus == BUS_BLUETOOTH)
		return wacom_bt_query_tablet_data(hdev, 1, features);

395 396 397
	if (features->type == HID_GENERIC)
		return wacom_hid_set_device_mode(hdev);

398
	if (features->device_type == BTN_TOOL_FINGER) {
P
Ping Cheng 已提交
399
		if (features->type > TABLETPC) {
400
			/* MT Tablet PC touch */
401
			return wacom_set_device_mode(hdev, 3, 4, 4);
402
		}
403
		else if (features->type == WACOM_24HDT || features->type == CINTIQ_HYBRID) {
404
			return wacom_set_device_mode(hdev, 18, 3, 2);
405
		}
406 407 408
		else if (features->type == WACOM_27QHDT) {
			return wacom_set_device_mode(hdev, 131, 3, 2);
		}
409 410
	} else if (features->device_type == BTN_TOOL_PEN) {
		if (features->type <= BAMBOO_PT && features->type != WIRELESS) {
411
			return wacom_set_device_mode(hdev, 2, 2, 2);
412
		}
413
	}
414

415
	return 0;
416 417
}

418
static void wacom_retrieve_hid_descriptor(struct hid_device *hdev,
419
					 struct wacom_features *features)
420
{
421 422
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct usb_interface *intf = wacom->intf;
423

424
	/* default features */
425
	features->device_type = BTN_TOOL_PEN;
426 427 428 429
	features->x_fuzz = 4;
	features->y_fuzz = 4;
	features->pressure_fuzz = 0;
	features->distance_fuzz = 0;
430

431 432 433 434 435 436 437 438 439 440
	/*
	 * The wireless device HID is basic and layout conflicts with
	 * other tablets (monitor and touch interface can look like pen).
	 * Skip the query for this type and modify defaults based on
	 * interface number.
	 */
	if (features->type == WIRELESS) {
		if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
			features->device_type = 0;
		} else if (intf->cur_altsetting->desc.bInterfaceNumber == 2) {
441
			features->device_type = BTN_TOOL_FINGER;
442 443 444 445
			features->pktlen = WACOM_PKGLEN_BBTOUCH3;
		}
	}

446
	/* only devices that support touch need to retrieve the info */
447 448
	if (features->type < BAMBOO_PT)
		return;
449

450
	wacom_parse_hid(hdev, features);
451 452
}

453
struct wacom_hdev_data {
454 455
	struct list_head list;
	struct kref kref;
456
	struct hid_device *dev;
457 458 459 460 461 462
	struct wacom_shared shared;
};

static LIST_HEAD(wacom_udev_list);
static DEFINE_MUTEX(wacom_udev_list_lock);

463 464
static bool wacom_are_sibling(struct hid_device *hdev,
		struct hid_device *sibling)
465
{
466 467 468 469 470 471 472 473 474 475
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct wacom_features *features = &wacom->wacom_wac.features;
	int vid = features->oVid;
	int pid = features->oPid;
	int n1,n2;

	if (vid == 0 && pid == 0) {
		vid = hdev->vendor;
		pid = hdev->product;
	}
476

477 478
	if (vid != sibling->vendor || pid != sibling->product)
		return false;
479

480 481 482 483 484
	/* Compare the physical path. */
	n1 = strrchr(hdev->phys, '.') - hdev->phys;
	n2 = strrchr(sibling->phys, '.') - sibling->phys;
	if (n1 != n2 || n1 <= 0 || n2 <= 0)
		return false;
485

486
	return !strncmp(hdev->phys, sibling->phys, n1);
487 488
}

489
static struct wacom_hdev_data *wacom_get_hdev_data(struct hid_device *hdev)
490
{
491
	struct wacom_hdev_data *data;
492 493

	list_for_each_entry(data, &wacom_udev_list, list) {
494
		if (wacom_are_sibling(hdev, data->dev)) {
495 496 497 498 499 500 501 502
			kref_get(&data->kref);
			return data;
		}
	}

	return NULL;
}

503
static int wacom_add_shared_data(struct hid_device *hdev)
504
{
505 506 507
	struct wacom *wacom = hid_get_drvdata(hdev);
	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
	struct wacom_hdev_data *data;
508 509 510 511
	int retval = 0;

	mutex_lock(&wacom_udev_list_lock);

512
	data = wacom_get_hdev_data(hdev);
513
	if (!data) {
514
		data = kzalloc(sizeof(struct wacom_hdev_data), GFP_KERNEL);
515 516 517 518 519 520
		if (!data) {
			retval = -ENOMEM;
			goto out;
		}

		kref_init(&data->kref);
521
		data->dev = hdev;
522 523 524
		list_add_tail(&data->list, &wacom_udev_list);
	}

525
	wacom_wac->shared = &data->shared;
526 527 528 529 530 531 532 533

out:
	mutex_unlock(&wacom_udev_list_lock);
	return retval;
}

static void wacom_release_shared_data(struct kref *kref)
{
534 535
	struct wacom_hdev_data *data =
		container_of(kref, struct wacom_hdev_data, kref);
536 537 538 539 540 541 542 543 544 545

	mutex_lock(&wacom_udev_list_lock);
	list_del(&data->list);
	mutex_unlock(&wacom_udev_list_lock);

	kfree(data);
}

static void wacom_remove_shared_data(struct wacom_wac *wacom)
{
546
	struct wacom_hdev_data *data;
547 548

	if (wacom->shared) {
549
		data = container_of(wacom->shared, struct wacom_hdev_data, shared);
550 551 552 553 554
		kref_put(&data->kref, wacom_release_shared_data);
		wacom->shared = NULL;
	}
}

555 556 557
static int wacom_led_control(struct wacom *wacom)
{
	unsigned char *buf;
558
	int retval;
559 560
	unsigned char report_id = WAC_CMD_LED_CONTROL;
	int buf_size = 9;
561

562 563 564 565 566
	if (wacom->wacom_wac.pid) { /* wireless connected */
		report_id = WAC_CMD_WL_LED_CONTROL;
		buf_size = 13;
	}
	buf = kzalloc(buf_size, GFP_KERNEL);
567 568 569
	if (!buf)
		return -ENOMEM;

570
	if (wacom->wacom_wac.features.type >= INTUOS5S &&
571
	    wacom->wacom_wac.features.type <= INTUOSPL) {
572 573 574 575 576 577 578 579
		/*
		 * Touch Ring and crop mark LED luminance may take on
		 * one of four values:
		 *    0 = Low; 1 = Medium; 2 = High; 3 = Off
		 */
		int ring_led = wacom->led.select[0] & 0x03;
		int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
		int crop_lum = 0;
580 581 582 583 584 585 586 587 588 589
		unsigned char led_bits = (crop_lum << 4) | (ring_lum << 2) | (ring_led);

		buf[0] = report_id;
		if (wacom->wacom_wac.pid) {
			wacom_get_report(wacom->hdev, HID_FEATURE_REPORT,
					 buf, buf_size, WAC_CMD_RETRIES);
			buf[0] = report_id;
			buf[4] = led_bits;
		} else
			buf[1] = led_bits;
590 591 592 593 594 595 596 597
	}
	else {
		int led = wacom->led.select[0] | 0x4;

		if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
		    wacom->wacom_wac.features.type == WACOM_24HD)
			led |= (wacom->led.select[1] << 4) | 0x40;

598
		buf[0] = report_id;
599 600 601 602 603
		buf[1] = led;
		buf[2] = wacom->led.llv;
		buf[3] = wacom->led.hlv;
		buf[4] = wacom->led.img_lum;
	}
604

605
	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, buf_size,
606
				  WAC_CMD_RETRIES);
607 608 609 610 611
	kfree(buf);

	return retval;
}

612 613
static int wacom_led_putimage(struct wacom *wacom, int button_id, u8 xfer_id,
		const unsigned len, const void *img)
614 615 616
{
	unsigned char *buf;
	int i, retval;
617
	const unsigned chunk_len = len / 4; /* 4 chunks are needed to be sent */
618

619
	buf = kzalloc(chunk_len + 3 , GFP_KERNEL);
620 621 622 623 624 625
	if (!buf)
		return -ENOMEM;

	/* Send 'start' command */
	buf[0] = WAC_CMD_ICON_START;
	buf[1] = 1;
626 627
	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
				  WAC_CMD_RETRIES);
628 629 630
	if (retval < 0)
		goto out;

631
	buf[0] = xfer_id;
632 633 634
	buf[1] = button_id & 0x07;
	for (i = 0; i < 4; i++) {
		buf[2] = i;
635
		memcpy(buf + 3, img + i * chunk_len, chunk_len);
636

637
		retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
638
					  buf, chunk_len + 3, WAC_CMD_RETRIES);
639 640 641 642 643 644 645
		if (retval < 0)
			break;
	}

	/* Send 'stop' */
	buf[0] = WAC_CMD_ICON_START;
	buf[1] = 0;
646 647
	wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
			 WAC_CMD_RETRIES);
648 649 650 651 652 653

out:
	kfree(buf);
	return retval;
}

654
static ssize_t wacom_led_select_store(struct device *dev, int set_id,
655 656
				      const char *buf, size_t count)
{
657
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
658
	struct wacom *wacom = hid_get_drvdata(hdev);
659 660 661 662 663 664 665 666 667
	unsigned int id;
	int err;

	err = kstrtouint(buf, 10, &id);
	if (err)
		return err;

	mutex_lock(&wacom->lock);

668
	wacom->led.select[set_id] = id & 0x3;
669 670 671 672 673 674 675
	err = wacom_led_control(wacom);

	mutex_unlock(&wacom->lock);

	return err < 0 ? err : count;
}

676 677 678 679 680 681
#define DEVICE_LED_SELECT_ATTR(SET_ID)					\
static ssize_t wacom_led##SET_ID##_select_store(struct device *dev,	\
	struct device_attribute *attr, const char *buf, size_t count)	\
{									\
	return wacom_led_select_store(dev, SET_ID, buf, count);		\
}									\
682 683 684
static ssize_t wacom_led##SET_ID##_select_show(struct device *dev,	\
	struct device_attribute *attr, char *buf)			\
{									\
685
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
686
	struct wacom *wacom = hid_get_drvdata(hdev);			\
P
Ping Cheng 已提交
687 688
	return scnprintf(buf, PAGE_SIZE, "%d\n",			\
			 wacom->led.select[SET_ID]);			\
689
}									\
690
static DEVICE_ATTR(status_led##SET_ID##_select, DEV_ATTR_RW_PERM,	\
691
		    wacom_led##SET_ID##_select_show,			\
692 693 694 695
		    wacom_led##SET_ID##_select_store)

DEVICE_LED_SELECT_ATTR(0);
DEVICE_LED_SELECT_ATTR(1);
696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720

static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
				     const char *buf, size_t count)
{
	unsigned int value;
	int err;

	err = kstrtouint(buf, 10, &value);
	if (err)
		return err;

	mutex_lock(&wacom->lock);

	*dest = value & 0x7f;
	err = wacom_led_control(wacom);

	mutex_unlock(&wacom->lock);

	return err < 0 ? err : count;
}

#define DEVICE_LUMINANCE_ATTR(name, field)				\
static ssize_t wacom_##name##_luminance_store(struct device *dev,	\
	struct device_attribute *attr, const char *buf, size_t count)	\
{									\
721
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
722
	struct wacom *wacom = hid_get_drvdata(hdev);			\
723 724 725 726
									\
	return wacom_luminance_store(wacom, &wacom->led.field,		\
				     buf, count);			\
}									\
P
Ping Cheng 已提交
727 728 729 730 731 732
static ssize_t wacom_##name##_luminance_show(struct device *dev,	\
	struct device_attribute *attr, char *buf)			\
{									\
	struct wacom *wacom = dev_get_drvdata(dev);			\
	return scnprintf(buf, PAGE_SIZE, "%d\n", wacom->led.field);	\
}									\
733
static DEVICE_ATTR(name##_luminance, DEV_ATTR_RW_PERM,			\
P
Ping Cheng 已提交
734 735
		   wacom_##name##_luminance_show,			\
		   wacom_##name##_luminance_store)
736 737 738 739 740 741 742 743

DEVICE_LUMINANCE_ATTR(status0, llv);
DEVICE_LUMINANCE_ATTR(status1, hlv);
DEVICE_LUMINANCE_ATTR(buttons, img_lum);

static ssize_t wacom_button_image_store(struct device *dev, int button_id,
					const char *buf, size_t count)
{
744
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
745
	struct wacom *wacom = hid_get_drvdata(hdev);
746
	int err;
747 748 749 750 751 752 753 754 755 756
	unsigned len;
	u8 xfer_id;

	if (hdev->bus == BUS_BLUETOOTH) {
		len = 256;
		xfer_id = WAC_CMD_ICON_BT_XFER;
	} else {
		len = 1024;
		xfer_id = WAC_CMD_ICON_XFER;
	}
757

758
	if (count != len)
759 760 761 762
		return -EINVAL;

	mutex_lock(&wacom->lock);

763
	err = wacom_led_putimage(wacom, button_id, xfer_id, len, buf);
764 765 766 767 768 769 770 771 772 773 774 775

	mutex_unlock(&wacom->lock);

	return err < 0 ? err : count;
}

#define DEVICE_BTNIMG_ATTR(BUTTON_ID)					\
static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev,	\
	struct device_attribute *attr, const char *buf, size_t count)	\
{									\
	return wacom_button_image_store(dev, BUTTON_ID, buf, count);	\
}									\
776
static DEVICE_ATTR(button##BUTTON_ID##_rawimg, DEV_ATTR_WO_PERM,	\
777 778 779 780 781 782 783 784 785 786 787
		   NULL, wacom_btnimg##BUTTON_ID##_store)

DEVICE_BTNIMG_ATTR(0);
DEVICE_BTNIMG_ATTR(1);
DEVICE_BTNIMG_ATTR(2);
DEVICE_BTNIMG_ATTR(3);
DEVICE_BTNIMG_ATTR(4);
DEVICE_BTNIMG_ATTR(5);
DEVICE_BTNIMG_ATTR(6);
DEVICE_BTNIMG_ATTR(7);

788 789 790 791 792 793 794 795 796 797 798 799
static struct attribute *cintiq_led_attrs[] = {
	&dev_attr_status_led0_select.attr,
	&dev_attr_status_led1_select.attr,
	NULL
};

static struct attribute_group cintiq_led_attr_group = {
	.name = "wacom_led",
	.attrs = cintiq_led_attrs,
};

static struct attribute *intuos4_led_attrs[] = {
800 801
	&dev_attr_status0_luminance.attr,
	&dev_attr_status1_luminance.attr,
802
	&dev_attr_status_led0_select.attr,
803 804 805 806 807 808 809 810 811 812 813 814
	&dev_attr_buttons_luminance.attr,
	&dev_attr_button0_rawimg.attr,
	&dev_attr_button1_rawimg.attr,
	&dev_attr_button2_rawimg.attr,
	&dev_attr_button3_rawimg.attr,
	&dev_attr_button4_rawimg.attr,
	&dev_attr_button5_rawimg.attr,
	&dev_attr_button6_rawimg.attr,
	&dev_attr_button7_rawimg.attr,
	NULL
};

815
static struct attribute_group intuos4_led_attr_group = {
816
	.name = "wacom_led",
817
	.attrs = intuos4_led_attrs,
818 819
};

820 821 822 823 824 825 826 827 828 829 830
static struct attribute *intuos5_led_attrs[] = {
	&dev_attr_status0_luminance.attr,
	&dev_attr_status_led0_select.attr,
	NULL
};

static struct attribute_group intuos5_led_attr_group = {
	.name = "wacom_led",
	.attrs = intuos5_led_attrs,
};

831 832 833 834
static int wacom_initialize_leds(struct wacom *wacom)
{
	int error;

835 836
	/* Initialize default values */
	switch (wacom->wacom_wac.features.type) {
837
	case INTUOS4S:
838
	case INTUOS4:
839
	case INTUOS4WL:
840 841 842
	case INTUOS4L:
		wacom->led.select[0] = 0;
		wacom->led.select[1] = 0;
843
		wacom->led.llv = 10;
844 845
		wacom->led.hlv = 20;
		wacom->led.img_lum = 10;
846
		error = sysfs_create_group(&wacom->hdev->dev.kobj,
847 848 849
					   &intuos4_led_attr_group);
		break;

850
	case WACOM_24HD:
851 852 853 854 855 856
	case WACOM_21UX2:
		wacom->led.select[0] = 0;
		wacom->led.select[1] = 0;
		wacom->led.llv = 0;
		wacom->led.hlv = 0;
		wacom->led.img_lum = 0;
857

858
		error = sysfs_create_group(&wacom->hdev->dev.kobj,
859 860 861
					   &cintiq_led_attr_group);
		break;

862 863 864
	case INTUOS5S:
	case INTUOS5:
	case INTUOS5L:
865 866 867
	case INTUOSPS:
	case INTUOSPM:
	case INTUOSPL:
868 869 870 871 872 873 874
		if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN) {
			wacom->led.select[0] = 0;
			wacom->led.select[1] = 0;
			wacom->led.llv = 32;
			wacom->led.hlv = 0;
			wacom->led.img_lum = 0;

875
			error = sysfs_create_group(&wacom->hdev->dev.kobj,
876 877 878
						  &intuos5_led_attr_group);
		} else
			return 0;
879 880
		break;

881 882
	default:
		return 0;
883 884
	}

885
	if (error) {
886
		hid_err(wacom->hdev,
887 888 889 890
			"cannot create sysfs group err: %d\n", error);
		return error;
	}
	wacom_led_control(wacom);
891
	wacom->led_initialized = true;
892

893 894 895 896 897
	return 0;
}

static void wacom_destroy_leds(struct wacom *wacom)
{
898 899 900 901 902
	if (!wacom->led_initialized)
		return;

	wacom->led_initialized = false;

903
	switch (wacom->wacom_wac.features.type) {
904
	case INTUOS4S:
905
	case INTUOS4:
906
	case INTUOS4WL:
907
	case INTUOS4L:
908
		sysfs_remove_group(&wacom->hdev->dev.kobj,
909 910 911
				   &intuos4_led_attr_group);
		break;

912
	case WACOM_24HD:
913
	case WACOM_21UX2:
914
		sysfs_remove_group(&wacom->hdev->dev.kobj,
915 916
				   &cintiq_led_attr_group);
		break;
917 918 919 920

	case INTUOS5S:
	case INTUOS5:
	case INTUOS5L:
921 922 923
	case INTUOSPS:
	case INTUOSPM:
	case INTUOSPL:
924
		if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN)
925
			sysfs_remove_group(&wacom->hdev->dev.kobj,
926
					   &intuos5_led_attr_group);
927
		break;
928 929 930
	}
}

931
static enum power_supply_property wacom_battery_props[] = {
932
	POWER_SUPPLY_PROP_STATUS,
933
	POWER_SUPPLY_PROP_SCOPE,
934 935 936
	POWER_SUPPLY_PROP_CAPACITY
};

937 938 939 940 941 942
static enum power_supply_property wacom_ac_props[] = {
	POWER_SUPPLY_PROP_PRESENT,
	POWER_SUPPLY_PROP_ONLINE,
	POWER_SUPPLY_PROP_SCOPE,
};

943 944 945 946
static int wacom_battery_get_property(struct power_supply *psy,
				      enum power_supply_property psp,
				      union power_supply_propval *val)
{
947
	struct wacom *wacom = power_supply_get_drvdata(psy);
948 949 950
	int ret = 0;

	switch (psp) {
951 952 953
		case POWER_SUPPLY_PROP_SCOPE:
			val->intval = POWER_SUPPLY_SCOPE_DEVICE;
			break;
954 955
		case POWER_SUPPLY_PROP_CAPACITY:
			val->intval =
956 957 958 959 960 961 962 963 964 965
				wacom->wacom_wac.battery_capacity;
			break;
		case POWER_SUPPLY_PROP_STATUS:
			if (wacom->wacom_wac.bat_charging)
				val->intval = POWER_SUPPLY_STATUS_CHARGING;
			else if (wacom->wacom_wac.battery_capacity == 100 &&
				    wacom->wacom_wac.ps_connected)
				val->intval = POWER_SUPPLY_STATUS_FULL;
			else
				val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
966 967 968 969 970 971 972 973 974
			break;
		default:
			ret = -EINVAL;
			break;
	}

	return ret;
}

975 976 977 978
static int wacom_ac_get_property(struct power_supply *psy,
				enum power_supply_property psp,
				union power_supply_propval *val)
{
979
	struct wacom *wacom = power_supply_get_drvdata(psy);
980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997
	int ret = 0;

	switch (psp) {
	case POWER_SUPPLY_PROP_PRESENT:
		/* fall through */
	case POWER_SUPPLY_PROP_ONLINE:
		val->intval = wacom->wacom_wac.ps_connected;
		break;
	case POWER_SUPPLY_PROP_SCOPE:
		val->intval = POWER_SUPPLY_SCOPE_DEVICE;
		break;
	default:
		ret = -EINVAL;
		break;
	}
	return ret;
}

998 999
static int wacom_initialize_battery(struct wacom *wacom)
{
1000
	static atomic_t battery_no = ATOMIC_INIT(0);
1001
	struct power_supply_config psy_cfg = { .drv_data = wacom, };
1002
	unsigned long n;
1003

1004
	if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) {
1005 1006
		struct power_supply_desc *bat_desc = &wacom->battery_desc;
		struct power_supply_desc *ac_desc = &wacom->ac_desc;
1007
		n = atomic_inc_return(&battery_no) - 1;
1008

1009 1010 1011
		bat_desc->properties = wacom_battery_props;
		bat_desc->num_properties = ARRAY_SIZE(wacom_battery_props);
		bat_desc->get_property = wacom_battery_get_property;
1012
		sprintf(wacom->wacom_wac.bat_name, "wacom_battery_%ld", n);
1013 1014 1015
		bat_desc->name = wacom->wacom_wac.bat_name;
		bat_desc->type = POWER_SUPPLY_TYPE_BATTERY;
		bat_desc->use_for_apm = 0;
1016

1017 1018 1019
		ac_desc->properties = wacom_ac_props;
		ac_desc->num_properties = ARRAY_SIZE(wacom_ac_props);
		ac_desc->get_property = wacom_ac_get_property;
1020
		sprintf(wacom->wacom_wac.ac_name, "wacom_ac_%ld", n);
1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037
		ac_desc->name = wacom->wacom_wac.ac_name;
		ac_desc->type = POWER_SUPPLY_TYPE_MAINS;
		ac_desc->use_for_apm = 0;

		wacom->battery = power_supply_register(&wacom->hdev->dev,
					      &wacom->battery_desc, &psy_cfg);
		if (IS_ERR(wacom->battery))
			return PTR_ERR(wacom->battery);

		power_supply_powers(wacom->battery, &wacom->hdev->dev);

		wacom->ac = power_supply_register(&wacom->hdev->dev,
						  &wacom->ac_desc,
						  &psy_cfg);
		if (IS_ERR(wacom->ac)) {
			power_supply_unregister(wacom->battery);
			return PTR_ERR(wacom->ac);
1038 1039
		}

1040
		power_supply_powers(wacom->ac, &wacom->hdev->dev);
1041 1042
	}

1043
	return 0;
1044 1045 1046 1047
}

static void wacom_destroy_battery(struct wacom *wacom)
{
1048
	if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
1049 1050 1051 1052 1053
	     wacom->battery) {
		power_supply_unregister(wacom->battery);
		wacom->battery = NULL;
		power_supply_unregister(wacom->ac);
		wacom->ac = NULL;
1054
	}
1055 1056
}

1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085
static ssize_t wacom_show_speed(struct device *dev,
				struct device_attribute
				*attr, char *buf)
{
	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
	struct wacom *wacom = hid_get_drvdata(hdev);

	return snprintf(buf, PAGE_SIZE, "%i\n", wacom->wacom_wac.bt_high_speed);
}

static ssize_t wacom_store_speed(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 wacom *wacom = hid_get_drvdata(hdev);
	u8 new_speed;

	if (kstrtou8(buf, 0, &new_speed))
		return -EINVAL;

	if (new_speed != 0 && new_speed != 1)
		return -EINVAL;

	wacom_bt_query_tablet_data(hdev, new_speed, &wacom->wacom_wac.features);

	return count;
}

1086
static DEVICE_ATTR(speed, DEV_ATTR_RW_PERM,
1087 1088
		wacom_show_speed, wacom_store_speed);

1089
static struct input_dev *wacom_allocate_input(struct wacom *wacom)
1090 1091
{
	struct input_dev *input_dev;
1092
	struct hid_device *hdev = wacom->hdev;
1093 1094 1095
	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);

	input_dev = input_allocate_device();
1096 1097
	if (!input_dev)
		return NULL;
1098 1099

	input_dev->name = wacom_wac->name;
1100 1101
	input_dev->phys = hdev->phys;
	input_dev->dev.parent = &hdev->dev;
1102 1103
	input_dev->open = wacom_open;
	input_dev->close = wacom_close;
1104 1105 1106
	input_dev->uniq = hdev->uniq;
	input_dev->id.bustype = hdev->bus;
	input_dev->id.vendor  = hdev->vendor;
1107
	input_dev->id.product = wacom_wac->pid ? wacom_wac->pid : hdev->product;
1108
	input_dev->id.version = hdev->version;
1109 1110
	input_set_drvdata(input_dev, wacom);

1111 1112 1113
	return input_dev;
}

1114
static void wacom_free_inputs(struct wacom *wacom)
1115
{
1116 1117 1118 1119 1120 1121 1122 1123
	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);

	if (wacom_wac->input)
		input_free_device(wacom_wac->input);
	if (wacom_wac->pad_input)
		input_free_device(wacom_wac->pad_input);
	wacom_wac->input = NULL;
	wacom_wac->pad_input = NULL;
1124 1125
}

1126
static int wacom_allocate_inputs(struct wacom *wacom)
1127 1128 1129 1130 1131 1132 1133
{
	struct input_dev *input_dev, *pad_input_dev;
	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);

	input_dev = wacom_allocate_input(wacom);
	pad_input_dev = wacom_allocate_input(wacom);
	if (!input_dev || !pad_input_dev) {
1134 1135
		wacom_free_inputs(wacom);
		return -ENOMEM;
1136 1137
	}

1138
	wacom_wac->input = input_dev;
1139 1140 1141
	wacom_wac->pad_input = pad_input_dev;
	wacom_wac->pad_input->name = wacom_wac->pad_name;

1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153
	return 0;
}

static void wacom_clean_inputs(struct wacom *wacom)
{
	if (wacom->wacom_wac.input) {
		if (wacom->wacom_wac.input_registered)
			input_unregister_device(wacom->wacom_wac.input);
		else
			input_free_device(wacom->wacom_wac.input);
	}
	if (wacom->wacom_wac.pad_input) {
1154
		if (wacom->wacom_wac.pad_registered)
1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175
			input_unregister_device(wacom->wacom_wac.pad_input);
		else
			input_free_device(wacom->wacom_wac.pad_input);
	}
	wacom->wacom_wac.input = NULL;
	wacom->wacom_wac.pad_input = NULL;
	wacom_destroy_leds(wacom);
}

static int wacom_register_inputs(struct wacom *wacom)
{
	struct input_dev *input_dev, *pad_input_dev;
	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
	int error;

	input_dev = wacom_wac->input;
	pad_input_dev = wacom_wac->pad_input;

	if (!input_dev || !pad_input_dev)
		return -EINVAL;

1176 1177 1178 1179 1180
	error = wacom_setup_pentouch_input_capabilities(input_dev, wacom_wac);
	if (!error) {
		error = input_register_device(input_dev);
		if (error)
			return error;
1181
		wacom_wac->input_registered = true;
1182
	}
1183

1184 1185 1186 1187 1188 1189 1190 1191 1192
	error = wacom_setup_pad_input_capabilities(pad_input_dev, wacom_wac);
	if (error) {
		/* no pad in use on this interface */
		input_free_device(pad_input_dev);
		wacom_wac->pad_input = NULL;
		pad_input_dev = NULL;
	} else {
		error = input_register_device(pad_input_dev);
		if (error)
1193
			goto fail_register_pad_input;
1194
		wacom_wac->pad_registered = true;
1195 1196 1197

		error = wacom_initialize_leds(wacom);
		if (error)
1198
			goto fail_leds;
1199 1200
	}

1201
	return 0;
1202

1203
fail_leds:
1204 1205
	input_unregister_device(pad_input_dev);
	pad_input_dev = NULL;
1206
	wacom_wac->pad_registered = false;
1207
fail_register_pad_input:
1208
	input_unregister_device(input_dev);
1209
	wacom_wac->input = NULL;
1210
	wacom_wac->input_registered = false;
1211 1212 1213
	return error;
}

1214 1215 1216 1217 1218
static void wacom_wireless_work(struct work_struct *work)
{
	struct wacom *wacom = container_of(work, struct wacom, work);
	struct usb_device *usbdev = wacom->usbdev;
	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1219
	struct hid_device *hdev1, *hdev2;
1220 1221 1222
	struct wacom *wacom1, *wacom2;
	struct wacom_wac *wacom_wac1, *wacom_wac2;
	int error;
1223 1224 1225

	/*
	 * Regardless if this is a disconnect or a new tablet,
1226
	 * remove any existing input and battery devices.
1227 1228
	 */

1229 1230
	wacom_destroy_battery(wacom);

1231
	/* Stylus interface */
1232 1233
	hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
	wacom1 = hid_get_drvdata(hdev1);
1234
	wacom_wac1 = &(wacom1->wacom_wac);
1235
	wacom_clean_inputs(wacom1);
1236 1237

	/* Touch interface */
1238 1239
	hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
	wacom2 = hid_get_drvdata(hdev2);
1240
	wacom_wac2 = &(wacom2->wacom_wac);
1241
	wacom_clean_inputs(wacom2);
1242 1243

	if (wacom_wac->pid == 0) {
1244
		hid_info(wacom->hdev, "wireless tablet disconnected\n");
1245
		wacom_wac1->shared->type = 0;
1246
	} else {
1247
		const struct hid_device_id *id = wacom_ids;
1248

1249
		hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
1250
			 wacom_wac->pid);
1251

1252 1253 1254
		while (id->bus) {
			if (id->vendor == USB_VENDOR_ID_WACOM &&
			    id->product == wacom_wac->pid)
1255 1256 1257 1258
				break;
			id++;
		}

1259
		if (!id->bus) {
1260
			hid_info(wacom->hdev, "ignoring unknown PID.\n");
1261 1262 1263 1264
			return;
		}

		/* Stylus interface */
1265
		wacom_wac1->features =
1266
			*((struct wacom_features *)id->driver_data);
1267
		wacom_wac1->features.device_type = BTN_TOOL_PEN;
1268 1269
		snprintf(wacom_wac1->name, WACOM_NAME_MAX, "%s (WL) Pen",
			 wacom_wac1->features.name);
1270 1271
		snprintf(wacom_wac1->pad_name, WACOM_NAME_MAX, "%s (WL) Pad",
			 wacom_wac1->features.name);
1272 1273
		wacom_wac1->shared->touch_max = wacom_wac1->features.touch_max;
		wacom_wac1->shared->type = wacom_wac1->features.type;
1274
		wacom_wac1->pid = wacom_wac->pid;
1275 1276
		error = wacom_allocate_inputs(wacom1) ||
			wacom_register_inputs(wacom1);
1277
		if (error)
1278
			goto fail;
1279 1280

		/* Touch interface */
1281 1282
		if (wacom_wac1->features.touch_max ||
		    wacom_wac1->features.type == INTUOSHT) {
1283
			wacom_wac2->features =
1284
				*((struct wacom_features *)id->driver_data);
1285 1286 1287 1288 1289 1290 1291 1292 1293
			wacom_wac2->features.pktlen = WACOM_PKGLEN_BBTOUCH3;
			wacom_wac2->features.device_type = BTN_TOOL_FINGER;
			wacom_wac2->features.x_max = wacom_wac2->features.y_max = 4096;
			if (wacom_wac2->features.touch_max)
				snprintf(wacom_wac2->name, WACOM_NAME_MAX,
					 "%s (WL) Finger",wacom_wac2->features.name);
			else
				snprintf(wacom_wac2->name, WACOM_NAME_MAX,
					 "%s (WL) Pad",wacom_wac2->features.name);
1294 1295
			snprintf(wacom_wac2->pad_name, WACOM_NAME_MAX,
				 "%s (WL) Pad", wacom_wac2->features.name);
1296
			wacom_wac2->pid = wacom_wac->pid;
1297 1298
			error = wacom_allocate_inputs(wacom2) ||
				wacom_register_inputs(wacom2);
1299 1300
			if (error)
				goto fail;
1301 1302 1303 1304

			if (wacom_wac1->features.type == INTUOSHT &&
			    wacom_wac1->features.touch_max)
				wacom_wac->shared->touch_input = wacom_wac2->input;
1305
		}
1306 1307 1308

		error = wacom_initialize_battery(wacom);
		if (error)
1309
			goto fail;
1310
	}
1311 1312 1313

	return;

1314
fail:
1315 1316
	wacom_clean_inputs(wacom1);
	wacom_clean_inputs(wacom2);
1317
	return;
1318 1319
}

1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
/*
 * Not all devices report physical dimensions from HID.
 * Compute the default from hardcoded logical dimension
 * and resolution before driver overwrites them.
 */
static void wacom_set_default_phy(struct wacom_features *features)
{
	if (features->x_resolution) {
		features->x_phy = (features->x_max * 100) /
					features->x_resolution;
		features->y_phy = (features->y_max * 100) /
					features->y_resolution;
	}
}

static void wacom_calculate_res(struct wacom_features *features)
{
	features->x_resolution = wacom_calc_hid_res(features->x_max,
						    features->x_phy,
						    features->unit,
						    features->unitExpo);
	features->y_resolution = wacom_calc_hid_res(features->y_max,
						    features->y_phy,
						    features->unit,
						    features->unitExpo);
}

1347 1348 1349 1350 1351 1352 1353 1354 1355
static size_t wacom_compute_pktlen(struct hid_device *hdev)
{
	struct hid_report_enum *report_enum;
	struct hid_report *report;
	size_t size = 0;

	report_enum = hdev->report_enum + HID_INPUT_REPORT;

	list_for_each_entry(report, &report_enum->report_list, list) {
1356
		size_t report_size = hid_report_len(report);
1357 1358 1359 1360 1361 1362 1363
		if (report_size > size)
			size = report_size;
	}

	return size;
}

1364 1365
static int wacom_probe(struct hid_device *hdev,
		const struct hid_device_id *id)
1366
{
1367
	struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
1368 1369 1370
	struct usb_device *dev = interface_to_usbdev(intf);
	struct wacom *wacom;
	struct wacom_wac *wacom_wac;
1371 1372
	struct wacom_features *features;
	int error;
1373
	unsigned int connect_mask = HID_CONNECT_HIDRAW;
1374

1375
	if (!id->driver_data)
1376 1377
		return -EINVAL;

1378 1379
	hdev->quirks |= HID_QUIRK_NO_INIT_REPORTS;

1380
	wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
1381 1382
	if (!wacom)
		return -ENOMEM;
1383

1384 1385 1386
	hid_set_drvdata(hdev, wacom);
	wacom->hdev = hdev;

1387 1388 1389 1390
	/* ask for the report descriptor to be loaded by HID */
	error = hid_parse(hdev);
	if (error) {
		hid_err(hdev, "parse failed\n");
1391
		goto fail_parse;
1392 1393
	}

1394
	wacom_wac = &wacom->wacom_wac;
1395
	wacom_wac->features = *((struct wacom_features *)id->driver_data);
1396
	features = &wacom_wac->features;
1397
	features->pktlen = wacom_compute_pktlen(hdev);
1398 1399
	if (features->pktlen > WACOM_PKGLEN_MAX) {
		error = -EINVAL;
1400
		goto fail_pktlen;
1401
	}
1402

1403 1404
	if (features->check_for_hid_type && features->hid_type != hdev->type) {
		error = -ENODEV;
1405
		goto fail_type;
1406
	}
1407 1408

	wacom->usbdev = dev;
1409 1410
	wacom->intf = intf;
	mutex_init(&wacom->lock);
1411
	INIT_WORK(&wacom->work, wacom_wireless_work);
1412

1413 1414 1415 1416 1417 1418
	if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
		error = wacom_allocate_inputs(wacom);
		if (error)
			goto fail_allocate_inputs;
	}

1419 1420 1421
	/* set the default size in case we do not get them from hid */
	wacom_set_default_phy(features);

1422
	/* Retrieve the physical and logical size for touch devices */
1423
	wacom_retrieve_hid_descriptor(hdev, features);
1424

1425 1426
	/*
	 * Intuos5 has no useful data about its touch interface in its
1427
	 * HID descriptor. If this is the touch interface (PacketSize
1428 1429
	 * of WACOM_PKGLEN_BBTOUCH3), override the table values.
	 */
1430
	if (features->type >= INTUOS5S && features->type <= INTUOSHT) {
1431
		if (features->pktlen == WACOM_PKGLEN_BBTOUCH3) {
1432 1433 1434 1435 1436 1437 1438 1439 1440
			features->device_type = BTN_TOOL_FINGER;

			features->x_max = 4096;
			features->y_max = 4096;
		} else {
			features->device_type = BTN_TOOL_PEN;
		}
	}

1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452
	/*
	 * Same thing for Bamboo 3rd gen.
	 */
	if ((features->type == BAMBOO_PT) &&
	    (features->pktlen == WACOM_PKGLEN_BBTOUCH3) &&
	    (features->device_type == BTN_TOOL_PEN)) {
		features->device_type = BTN_TOOL_FINGER;

		features->x_max = 4096;
		features->y_max = 4096;
	}

1453 1454 1455
	if (hdev->bus == BUS_BLUETOOTH)
		features->quirks |= WACOM_QUIRK_BATTERY;

1456 1457
	wacom_setup_device_quirks(features);

1458 1459 1460
	/* set unit to "100th of a mm" for devices not reported by HID */
	if (!features->unit) {
		features->unit = 0x11;
1461
		features->unitExpo = -3;
1462 1463 1464
	}
	wacom_calculate_res(features);

1465
	strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name));
1466 1467
	snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
		"%s Pad", features->name);
1468

1469
	if (features->quirks & WACOM_QUIRK_MULTI_INPUT) {
1470
		/* Append the device type to the name */
1471 1472 1473 1474 1475 1476
		if (features->device_type != BTN_TOOL_FINGER)
			strlcat(wacom_wac->name, " Pen", WACOM_NAME_MAX);
		else if (features->touch_max)
			strlcat(wacom_wac->name, " Finger", WACOM_NAME_MAX);
		else
			strlcat(wacom_wac->name, " Pad", WACOM_NAME_MAX);
1477

1478
		error = wacom_add_shared_data(hdev);
1479
		if (error)
1480
			goto fail_shared_data;
1481 1482
	}

1483 1484 1485 1486
	if (!(features->quirks & WACOM_QUIRK_MONITOR) &&
	     (features->quirks & WACOM_QUIRK_BATTERY)) {
		error = wacom_initialize_battery(wacom);
		if (error)
1487
			goto fail_battery;
1488 1489
	}

1490
	if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
1491
		error = wacom_register_inputs(wacom);
1492
		if (error)
1493
			goto fail_register_inputs;
1494 1495 1496 1497 1498 1499 1500 1501
	}

	if (hdev->bus == BUS_BLUETOOTH) {
		error = device_create_file(&hdev->dev, &dev_attr_speed);
		if (error)
			hid_warn(hdev,
				 "can't create sysfs speed attribute err: %d\n",
				 error);
1502
	}
1503

1504 1505 1506
	if (features->type == HID_GENERIC)
		connect_mask |= HID_CONNECT_DRIVER;

1507
	/* Regular HID work starts now */
1508
	error = hid_hw_start(hdev, connect_mask);
1509 1510
	if (error) {
		hid_err(hdev, "hw start failed\n");
1511
		goto fail_hw_start;
1512
	}
1513

1514 1515 1516
	/* Note that if query fails it is not a hard failure */
	wacom_query_tablet_data(hdev, features);

1517 1518 1519
	if (features->quirks & WACOM_QUIRK_MONITOR)
		error = hid_hw_open(hdev);

1520 1521 1522 1523 1524
	if (wacom_wac->features.type == INTUOSHT && wacom_wac->features.touch_max) {
		if (wacom_wac->features.device_type == BTN_TOOL_FINGER)
			wacom_wac->shared->touch_input = wacom_wac->input;
	}

1525 1526
	return 0;

1527 1528
fail_hw_start:
	if (hdev->bus == BUS_BLUETOOTH)
1529
		device_remove_file(&hdev->dev, &dev_attr_speed);
1530
fail_register_inputs:
1531
	wacom_clean_inputs(wacom);
1532 1533 1534 1535
	wacom_destroy_battery(wacom);
fail_battery:
	wacom_remove_shared_data(wacom_wac);
fail_shared_data:
1536 1537
	wacom_clean_inputs(wacom);
fail_allocate_inputs:
1538 1539 1540 1541
fail_type:
fail_pktlen:
fail_parse:
	kfree(wacom);
1542
	hid_set_drvdata(hdev, NULL);
1543
	return error;
1544 1545
}

1546
static void wacom_remove(struct hid_device *hdev)
1547
{
1548
	struct wacom *wacom = hid_get_drvdata(hdev);
1549

1550
	hid_hw_stop(hdev);
1551

1552
	cancel_work_sync(&wacom->work);
1553
	wacom_clean_inputs(wacom);
1554 1555
	if (hdev->bus == BUS_BLUETOOTH)
		device_remove_file(&hdev->dev, &dev_attr_speed);
1556
	wacom_destroy_battery(wacom);
1557
	wacom_remove_shared_data(&wacom->wacom_wac);
1558

1559 1560
	hid_set_drvdata(hdev, NULL);
	kfree(wacom);
1561 1562
}

1563
#ifdef CONFIG_PM
1564
static int wacom_resume(struct hid_device *hdev)
1565
{
1566
	struct wacom *wacom = hid_get_drvdata(hdev);
1567
	struct wacom_features *features = &wacom->wacom_wac.features;
1568 1569

	mutex_lock(&wacom->lock);
1570 1571

	/* switch to wacom mode first */
1572
	wacom_query_tablet_data(hdev, features);
1573
	wacom_led_control(wacom);
1574

1575 1576
	mutex_unlock(&wacom->lock);

1577
	return 0;
1578 1579
}

1580
static int wacom_reset_resume(struct hid_device *hdev)
1581
{
1582
	return wacom_resume(hdev);
1583
}
1584
#endif /* CONFIG_PM */
1585

1586
static struct hid_driver wacom_driver = {
1587
	.name =		"wacom",
1588
	.id_table =	wacom_ids,
1589
	.probe =	wacom_probe,
1590
	.remove =	wacom_remove,
1591 1592
	.event =	wacom_wac_event,
	.report =	wacom_wac_report,
1593
#ifdef CONFIG_PM
1594 1595
	.resume =	wacom_resume,
	.reset_resume =	wacom_reset_resume,
1596 1597
#endif
	.raw_event =	wacom_raw_event,
1598
};
1599
module_hid_driver(wacom_driver);
1600 1601 1602 1603 1604

MODULE_VERSION(DRIVER_VERSION);
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE(DRIVER_LICENSE);