wacom_sys.c 40.6 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 947 948 949 950
static int wacom_battery_get_property(struct power_supply *psy,
				      enum power_supply_property psp,
				      union power_supply_propval *val)
{
	struct wacom *wacom = container_of(psy, struct wacom, battery);
	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 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997
static int wacom_ac_get_property(struct power_supply *psy,
				enum power_supply_property psp,
				union power_supply_propval *val)
{
	struct wacom *wacom = container_of(psy, struct wacom, ac);
	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
	int error;
1002
	unsigned long n;
1003

1004
	if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) {
1005
		n = atomic_inc_return(&battery_no) - 1;
1006

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

1015 1016 1017 1018 1019 1020 1021 1022
		wacom->ac.properties = wacom_ac_props;
		wacom->ac.num_properties = ARRAY_SIZE(wacom_ac_props);
		wacom->ac.get_property = wacom_ac_get_property;
		sprintf(wacom->wacom_wac.ac_name, "wacom_ac_%ld", n);
		wacom->ac.name = wacom->wacom_wac.ac_name;
		wacom->ac.type = POWER_SUPPLY_TYPE_MAINS;
		wacom->ac.use_for_apm = 0;

1023
		error = power_supply_register(&wacom->hdev->dev,
1024
					      &wacom->battery);
1025 1026 1027 1028
		if (error)
			return error;

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

1030 1031 1032 1033 1034 1035 1036
		error = power_supply_register(&wacom->hdev->dev, &wacom->ac);
		if (error) {
			power_supply_unregister(&wacom->battery);
			return error;
		}

		power_supply_powers(&wacom->ac, &wacom->hdev->dev);
1037 1038
	}

1039
	return 0;
1040 1041 1042 1043
}

static void wacom_destroy_battery(struct wacom *wacom)
{
1044 1045
	if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
	     wacom->battery.dev) {
1046
		power_supply_unregister(&wacom->battery);
1047
		wacom->battery.dev = NULL;
1048 1049
		power_supply_unregister(&wacom->ac);
		wacom->ac.dev = NULL;
1050
	}
1051 1052
}

1053 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
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;
}

1082
static DEVICE_ATTR(speed, DEV_ATTR_RW_PERM,
1083 1084
		wacom_show_speed, wacom_store_speed);

1085
static struct input_dev *wacom_allocate_input(struct wacom *wacom)
1086 1087
{
	struct input_dev *input_dev;
1088
	struct hid_device *hdev = wacom->hdev;
1089 1090 1091
	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);

	input_dev = input_allocate_device();
1092 1093
	if (!input_dev)
		return NULL;
1094 1095

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

1107 1108 1109
	return input_dev;
}

1110
static void wacom_free_inputs(struct wacom *wacom)
1111
{
1112 1113 1114 1115 1116 1117 1118 1119
	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;
1120 1121
}

1122
static int wacom_allocate_inputs(struct wacom *wacom)
1123 1124 1125 1126 1127 1128 1129
{
	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) {
1130 1131
		wacom_free_inputs(wacom);
		return -ENOMEM;
1132 1133
	}

1134
	wacom_wac->input = input_dev;
1135 1136 1137
	wacom_wac->pad_input = pad_input_dev;
	wacom_wac->pad_input->name = wacom_wac->pad_name;

1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149
	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) {
1150
		if (wacom->wacom_wac.pad_registered)
1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171
			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;

1172 1173 1174 1175 1176
	error = wacom_setup_pentouch_input_capabilities(input_dev, wacom_wac);
	if (!error) {
		error = input_register_device(input_dev);
		if (error)
			return error;
1177
		wacom_wac->input_registered = true;
1178
	}
1179

1180 1181 1182 1183 1184 1185 1186 1187 1188
	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)
1189
			goto fail_register_pad_input;
1190
		wacom_wac->pad_registered = true;
1191 1192 1193

		error = wacom_initialize_leds(wacom);
		if (error)
1194
			goto fail_leds;
1195 1196
	}

1197
	return 0;
1198

1199
fail_leds:
1200 1201
	input_unregister_device(pad_input_dev);
	pad_input_dev = NULL;
1202
	wacom_wac->pad_registered = false;
1203
fail_register_pad_input:
1204
	input_unregister_device(input_dev);
1205
	wacom_wac->input = NULL;
1206
	wacom_wac->input_registered = false;
1207 1208 1209
	return error;
}

1210 1211 1212 1213 1214
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;
1215
	struct hid_device *hdev1, *hdev2;
1216 1217 1218
	struct wacom *wacom1, *wacom2;
	struct wacom_wac *wacom_wac1, *wacom_wac2;
	int error;
1219 1220 1221

	/*
	 * Regardless if this is a disconnect or a new tablet,
1222
	 * remove any existing input and battery devices.
1223 1224
	 */

1225 1226
	wacom_destroy_battery(wacom);

1227
	/* Stylus interface */
1228 1229
	hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
	wacom1 = hid_get_drvdata(hdev1);
1230
	wacom_wac1 = &(wacom1->wacom_wac);
1231
	wacom_clean_inputs(wacom1);
1232 1233

	/* Touch interface */
1234 1235
	hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
	wacom2 = hid_get_drvdata(hdev2);
1236
	wacom_wac2 = &(wacom2->wacom_wac);
1237
	wacom_clean_inputs(wacom2);
1238 1239

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

1245
		hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
1246
			 wacom_wac->pid);
1247

1248 1249 1250
		while (id->bus) {
			if (id->vendor == USB_VENDOR_ID_WACOM &&
			    id->product == wacom_wac->pid)
1251 1252 1253 1254
				break;
			id++;
		}

1255
		if (!id->bus) {
1256
			hid_info(wacom->hdev, "ignoring unknown PID.\n");
1257 1258 1259 1260
			return;
		}

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

		/* Touch interface */
1277 1278
		if (wacom_wac1->features.touch_max ||
		    wacom_wac1->features.type == INTUOSHT) {
1279
			wacom_wac2->features =
1280
				*((struct wacom_features *)id->driver_data);
1281 1282 1283 1284 1285 1286 1287 1288 1289
			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);
1290 1291
			snprintf(wacom_wac2->pad_name, WACOM_NAME_MAX,
				 "%s (WL) Pad", wacom_wac2->features.name);
1292
			wacom_wac2->pid = wacom_wac->pid;
1293 1294
			error = wacom_allocate_inputs(wacom2) ||
				wacom_register_inputs(wacom2);
1295 1296
			if (error)
				goto fail;
1297 1298 1299 1300

			if (wacom_wac1->features.type == INTUOSHT &&
			    wacom_wac1->features.touch_max)
				wacom_wac->shared->touch_input = wacom_wac2->input;
1301
		}
1302 1303 1304

		error = wacom_initialize_battery(wacom);
		if (error)
1305
			goto fail;
1306
	}
1307 1308 1309

	return;

1310
fail:
1311 1312
	wacom_clean_inputs(wacom1);
	wacom_clean_inputs(wacom2);
1313
	return;
1314 1315
}

1316 1317 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
/*
 * 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);
}

1343 1344 1345 1346 1347 1348 1349 1350 1351
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) {
1352
		size_t report_size = hid_report_len(report);
1353 1354 1355 1356 1357 1358 1359
		if (report_size > size)
			size = report_size;
	}

	return size;
}

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

1371
	if (!id->driver_data)
1372 1373
		return -EINVAL;

1374 1375
	hdev->quirks |= HID_QUIRK_NO_INIT_REPORTS;

1376
	wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
1377 1378
	if (!wacom)
		return -ENOMEM;
1379

1380 1381 1382
	hid_set_drvdata(hdev, wacom);
	wacom->hdev = hdev;

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

1390
	wacom_wac = &wacom->wacom_wac;
1391
	wacom_wac->features = *((struct wacom_features *)id->driver_data);
1392
	features = &wacom_wac->features;
1393
	features->pktlen = wacom_compute_pktlen(hdev);
1394 1395
	if (features->pktlen > WACOM_PKGLEN_MAX) {
		error = -EINVAL;
1396
		goto fail_pktlen;
1397
	}
1398

1399 1400
	if (features->check_for_hid_type && features->hid_type != hdev->type) {
		error = -ENODEV;
1401
		goto fail_type;
1402
	}
1403 1404

	wacom->usbdev = dev;
1405 1406
	wacom->intf = intf;
	mutex_init(&wacom->lock);
1407
	INIT_WORK(&wacom->work, wacom_wireless_work);
1408

1409 1410 1411 1412 1413 1414
	if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
		error = wacom_allocate_inputs(wacom);
		if (error)
			goto fail_allocate_inputs;
	}

1415 1416 1417
	/* set the default size in case we do not get them from hid */
	wacom_set_default_phy(features);

1418
	/* Retrieve the physical and logical size for touch devices */
1419
	wacom_retrieve_hid_descriptor(hdev, features);
1420

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

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

1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
	/*
	 * 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;
	}

1449 1450 1451
	if (hdev->bus == BUS_BLUETOOTH)
		features->quirks |= WACOM_QUIRK_BATTERY;

1452 1453
	wacom_setup_device_quirks(features);

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

1461
	strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name));
1462 1463
	snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
		"%s Pad", features->name);
1464

1465
	if (features->quirks & WACOM_QUIRK_MULTI_INPUT) {
1466
		/* Append the device type to the name */
1467 1468 1469 1470 1471 1472
		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);
1473

1474
		error = wacom_add_shared_data(hdev);
1475
		if (error)
1476
			goto fail_shared_data;
1477 1478
	}

1479 1480 1481 1482
	if (!(features->quirks & WACOM_QUIRK_MONITOR) &&
	     (features->quirks & WACOM_QUIRK_BATTERY)) {
		error = wacom_initialize_battery(wacom);
		if (error)
1483
			goto fail_battery;
1484 1485
	}

1486
	if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
1487
		error = wacom_register_inputs(wacom);
1488
		if (error)
1489
			goto fail_register_inputs;
1490 1491 1492 1493 1494 1495 1496 1497
	}

	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);
1498
	}
1499

1500 1501 1502
	if (features->type == HID_GENERIC)
		connect_mask |= HID_CONNECT_DRIVER;

1503
	/* Regular HID work starts now */
1504
	error = hid_hw_start(hdev, connect_mask);
1505 1506
	if (error) {
		hid_err(hdev, "hw start failed\n");
1507
		goto fail_hw_start;
1508
	}
1509

1510 1511 1512
	/* Note that if query fails it is not a hard failure */
	wacom_query_tablet_data(hdev, features);

1513 1514 1515
	if (features->quirks & WACOM_QUIRK_MONITOR)
		error = hid_hw_open(hdev);

1516 1517 1518 1519 1520
	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;
	}

1521 1522
	return 0;

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

1542
static void wacom_remove(struct hid_device *hdev)
1543
{
1544
	struct wacom *wacom = hid_get_drvdata(hdev);
1545

1546
	hid_hw_stop(hdev);
1547

1548
	cancel_work_sync(&wacom->work);
1549
	wacom_clean_inputs(wacom);
1550 1551
	if (hdev->bus == BUS_BLUETOOTH)
		device_remove_file(&hdev->dev, &dev_attr_speed);
1552
	wacom_destroy_battery(wacom);
1553
	wacom_remove_shared_data(&wacom->wacom_wac);
1554

1555 1556
	hid_set_drvdata(hdev, NULL);
	kfree(wacom);
1557 1558
}

1559
#ifdef CONFIG_PM
1560
static int wacom_resume(struct hid_device *hdev)
1561
{
1562
	struct wacom *wacom = hid_get_drvdata(hdev);
1563
	struct wacom_features *features = &wacom->wacom_wac.features;
1564 1565

	mutex_lock(&wacom->lock);
1566 1567

	/* switch to wacom mode first */
1568
	wacom_query_tablet_data(hdev, features);
1569
	wacom_led_control(wacom);
1570

1571 1572
	mutex_unlock(&wacom->lock);

1573
	return 0;
1574 1575
}

1576
static int wacom_reset_resume(struct hid_device *hdev)
1577
{
1578
	return wacom_resume(hdev);
1579
}
1580
#endif /* CONFIG_PM */
1581

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

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