• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * drivers/input/tablet/wacom_sys.c
3  *
4  *  USB Wacom tablet support - system specific code
5  */
6 
7 /*
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  */
13 
14 #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 #define WAC_CMD_LED_CONTROL	0x20
22 #define WAC_CMD_ICON_START	0x21
23 #define WAC_CMD_ICON_XFER	0x23
24 #define WAC_CMD_ICON_BT_XFER	0x26
25 #define WAC_CMD_RETRIES		10
26 #define WAC_CMD_DELETE_PAIRING	0x20
27 #define WAC_CMD_UNPAIR_ALL	0xFF
28 #define WAC_REMOTE_SERIAL_MAX_STRLEN	9
29 
30 #define DEV_ATTR_RW_PERM (S_IRUGO | S_IWUSR | S_IWGRP)
31 #define DEV_ATTR_WO_PERM (S_IWUSR | S_IWGRP)
32 #define DEV_ATTR_RO_PERM (S_IRUSR | S_IRGRP)
33 
wacom_get_report(struct hid_device * hdev,u8 type,u8 * buf,size_t size,unsigned int retries)34 static int wacom_get_report(struct hid_device *hdev, u8 type, u8 *buf,
35 			    size_t size, unsigned int retries)
36 {
37 	int retval;
38 
39 	do {
40 		retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
41 				HID_REQ_GET_REPORT);
42 	} while ((retval == -ETIMEDOUT || retval == -EAGAIN) && --retries);
43 
44 	if (retval < 0)
45 		hid_err(hdev, "wacom_get_report: ran out of retries "
46 			"(last error = %d)\n", retval);
47 
48 	return retval;
49 }
50 
wacom_set_report(struct hid_device * hdev,u8 type,u8 * buf,size_t size,unsigned int retries)51 static int wacom_set_report(struct hid_device *hdev, u8 type, u8 *buf,
52 			    size_t size, unsigned int retries)
53 {
54 	int retval;
55 
56 	do {
57 		retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
58 				HID_REQ_SET_REPORT);
59 	} while ((retval == -ETIMEDOUT || retval == -EAGAIN) && --retries);
60 
61 	if (retval < 0)
62 		hid_err(hdev, "wacom_set_report: ran out of retries "
63 			"(last error = %d)\n", retval);
64 
65 	return retval;
66 }
67 
wacom_raw_event(struct hid_device * hdev,struct hid_report * report,u8 * raw_data,int size)68 static int wacom_raw_event(struct hid_device *hdev, struct hid_report *report,
69 		u8 *raw_data, int size)
70 {
71 	struct wacom *wacom = hid_get_drvdata(hdev);
72 
73 	if (size > WACOM_PKGLEN_MAX)
74 		return 1;
75 
76 	memcpy(wacom->wacom_wac.data, raw_data, size);
77 
78 	wacom_wac_irq(&wacom->wacom_wac, size);
79 
80 	return 0;
81 }
82 
wacom_open(struct input_dev * dev)83 static int wacom_open(struct input_dev *dev)
84 {
85 	struct wacom *wacom = input_get_drvdata(dev);
86 
87 	return hid_hw_open(wacom->hdev);
88 }
89 
wacom_close(struct input_dev * dev)90 static void wacom_close(struct input_dev *dev)
91 {
92 	struct wacom *wacom = input_get_drvdata(dev);
93 
94 	hid_hw_close(wacom->hdev);
95 }
96 
97 /*
98  * Calculate the resolution of the X or Y axis using hidinput_calc_abs_res.
99  */
wacom_calc_hid_res(int logical_extents,int physical_extents,unsigned unit,int exponent)100 static int wacom_calc_hid_res(int logical_extents, int physical_extents,
101 			       unsigned unit, int exponent)
102 {
103 	struct hid_field field = {
104 		.logical_maximum = logical_extents,
105 		.physical_maximum = physical_extents,
106 		.unit = unit,
107 		.unit_exponent = exponent,
108 	};
109 
110 	return hidinput_calc_abs_res(&field, ABS_X);
111 }
112 
wacom_feature_mapping(struct hid_device * hdev,struct hid_field * field,struct hid_usage * usage)113 static void wacom_feature_mapping(struct hid_device *hdev,
114 		struct hid_field *field, struct hid_usage *usage)
115 {
116 	struct wacom *wacom = hid_get_drvdata(hdev);
117 	struct wacom_features *features = &wacom->wacom_wac.features;
118 	struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
119 	u8 *data;
120 	int ret;
121 
122 	switch (usage->hid) {
123 	case HID_DG_CONTACTMAX:
124 		/* leave touch_max as is if predefined */
125 		if (!features->touch_max) {
126 			/* read manually */
127 			data = kzalloc(2, GFP_KERNEL);
128 			if (!data)
129 				break;
130 			data[0] = field->report->id;
131 			ret = wacom_get_report(hdev, HID_FEATURE_REPORT,
132 						data, 2, WAC_CMD_RETRIES);
133 			if (ret == 2) {
134 				features->touch_max = data[1];
135 			} else {
136 				features->touch_max = 16;
137 				hid_warn(hdev, "wacom_feature_mapping: "
138 					 "could not get HID_DG_CONTACTMAX, "
139 					 "defaulting to %d\n",
140 					  features->touch_max);
141 			}
142 			kfree(data);
143 		}
144 		break;
145 	case HID_DG_INPUTMODE:
146 		/* Ignore if value index is out of bounds. */
147 		if (usage->usage_index >= field->report_count) {
148 			dev_err(&hdev->dev, "HID_DG_INPUTMODE out of range\n");
149 			break;
150 		}
151 
152 		hid_data->inputmode = field->report->id;
153 		hid_data->inputmode_index = usage->usage_index;
154 		break;
155 	}
156 }
157 
158 /*
159  * Interface Descriptor of wacom devices can be incomplete and
160  * inconsistent so wacom_features table is used to store stylus
161  * device's packet lengths, various maximum values, and tablet
162  * resolution based on product ID's.
163  *
164  * For devices that contain 2 interfaces, wacom_features table is
165  * inaccurate for the touch interface.  Since the Interface Descriptor
166  * for touch interfaces has pretty complete data, this function exists
167  * to query tablet for this missing information instead of hard coding in
168  * an additional table.
169  *
170  * A typical Interface Descriptor for a stylus will contain a
171  * boot mouse application collection that is not of interest and this
172  * function will ignore it.
173  *
174  * It also contains a digitizer application collection that also is not
175  * of interest since any information it contains would be duplicate
176  * of what is in wacom_features. Usually it defines a report of an array
177  * of bytes that could be used as max length of the stylus packet returned.
178  * If it happens to define a Digitizer-Stylus Physical Collection then
179  * the X and Y logical values contain valid data but it is ignored.
180  *
181  * A typical Interface Descriptor for a touch interface will contain a
182  * Digitizer-Finger Physical Collection which will define both logical
183  * X/Y maximum as well as the physical size of tablet. Since touch
184  * interfaces haven't supported pressure or distance, this is enough
185  * information to override invalid values in the wacom_features table.
186  *
187  * Intuos5 touch interface and 3rd gen Bamboo Touch do not contain useful
188  * data. We deal with them after returning from this function.
189  */
wacom_usage_mapping(struct hid_device * hdev,struct hid_field * field,struct hid_usage * usage)190 static void wacom_usage_mapping(struct hid_device *hdev,
191 		struct hid_field *field, struct hid_usage *usage)
192 {
193 	struct wacom *wacom = hid_get_drvdata(hdev);
194 	struct wacom_features *features = &wacom->wacom_wac.features;
195 	bool finger = WACOM_FINGER_FIELD(field);
196 	bool pen = WACOM_PEN_FIELD(field);
197 
198 	/*
199 	* Requiring Stylus Usage will ignore boot mouse
200 	* X/Y values and some cases of invalid Digitizer X/Y
201 	* values commonly reported.
202 	*/
203 	if (pen)
204 		features->device_type |= WACOM_DEVICETYPE_PEN;
205 	else if (finger)
206 		features->device_type |= WACOM_DEVICETYPE_TOUCH;
207 	else
208 		return;
209 
210 	/*
211 	 * Bamboo models do not support HID_DG_CONTACTMAX.
212 	 * And, Bamboo Pen only descriptor contains touch.
213 	 */
214 	if (features->type > BAMBOO_PT) {
215 		/* ISDv4 touch devices at least supports one touch point */
216 		if (finger && !features->touch_max)
217 			features->touch_max = 1;
218 	}
219 
220 	switch (usage->hid) {
221 	case HID_GD_X:
222 		features->x_max = field->logical_maximum;
223 		if (finger) {
224 			features->x_phy = field->physical_maximum;
225 			if ((features->type != BAMBOO_PT) &&
226 			    (features->type != BAMBOO_TOUCH)) {
227 				features->unit = field->unit;
228 				features->unitExpo = field->unit_exponent;
229 			}
230 		}
231 		break;
232 	case HID_GD_Y:
233 		features->y_max = field->logical_maximum;
234 		if (finger) {
235 			features->y_phy = field->physical_maximum;
236 			if ((features->type != BAMBOO_PT) &&
237 			    (features->type != BAMBOO_TOUCH)) {
238 				features->unit = field->unit;
239 				features->unitExpo = field->unit_exponent;
240 			}
241 		}
242 		break;
243 	case HID_DG_TIPPRESSURE:
244 		if (pen)
245 			features->pressure_max = field->logical_maximum;
246 		break;
247 	}
248 
249 	if (features->type == HID_GENERIC)
250 		wacom_wac_usage_mapping(hdev, field, usage);
251 }
252 
wacom_post_parse_hid(struct hid_device * hdev,struct wacom_features * features)253 static void wacom_post_parse_hid(struct hid_device *hdev,
254 				 struct wacom_features *features)
255 {
256 	struct wacom *wacom = hid_get_drvdata(hdev);
257 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
258 
259 	if (features->type == HID_GENERIC) {
260 		/* Any last-minute generic device setup */
261 		if (features->touch_max > 1) {
262 			input_mt_init_slots(wacom_wac->touch_input, wacom_wac->features.touch_max,
263 				    INPUT_MT_DIRECT);
264 		}
265 	}
266 }
267 
wacom_parse_hid(struct hid_device * hdev,struct wacom_features * features)268 static void wacom_parse_hid(struct hid_device *hdev,
269 			   struct wacom_features *features)
270 {
271 	struct hid_report_enum *rep_enum;
272 	struct hid_report *hreport;
273 	int i, j;
274 
275 	/* check features first */
276 	rep_enum = &hdev->report_enum[HID_FEATURE_REPORT];
277 	list_for_each_entry(hreport, &rep_enum->report_list, list) {
278 		for (i = 0; i < hreport->maxfield; i++) {
279 			/* Ignore if report count is out of bounds. */
280 			if (hreport->field[i]->report_count < 1)
281 				continue;
282 
283 			for (j = 0; j < hreport->field[i]->maxusage; j++) {
284 				wacom_feature_mapping(hdev, hreport->field[i],
285 						hreport->field[i]->usage + j);
286 			}
287 		}
288 	}
289 
290 	/* now check the input usages */
291 	rep_enum = &hdev->report_enum[HID_INPUT_REPORT];
292 	list_for_each_entry(hreport, &rep_enum->report_list, list) {
293 
294 		if (!hreport->maxfield)
295 			continue;
296 
297 		for (i = 0; i < hreport->maxfield; i++)
298 			for (j = 0; j < hreport->field[i]->maxusage; j++)
299 				wacom_usage_mapping(hdev, hreport->field[i],
300 						hreport->field[i]->usage + j);
301 	}
302 
303 	wacom_post_parse_hid(hdev, features);
304 }
305 
wacom_hid_set_device_mode(struct hid_device * hdev)306 static int wacom_hid_set_device_mode(struct hid_device *hdev)
307 {
308 	struct wacom *wacom = hid_get_drvdata(hdev);
309 	struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
310 	struct hid_report *r;
311 	struct hid_report_enum *re;
312 
313 	if (hid_data->inputmode < 0)
314 		return 0;
315 
316 	re = &(hdev->report_enum[HID_FEATURE_REPORT]);
317 	r = re->report_id_hash[hid_data->inputmode];
318 	if (r) {
319 		r->field[0]->value[hid_data->inputmode_index] = 2;
320 		hid_hw_request(hdev, r, HID_REQ_SET_REPORT);
321 	}
322 	return 0;
323 }
324 
wacom_set_device_mode(struct hid_device * hdev,int report_id,int length,int mode)325 static int wacom_set_device_mode(struct hid_device *hdev, int report_id,
326 		int length, int mode)
327 {
328 	unsigned char *rep_data;
329 	int error = -ENOMEM, limit = 0;
330 
331 	rep_data = kzalloc(length, GFP_KERNEL);
332 	if (!rep_data)
333 		return error;
334 
335 	do {
336 		rep_data[0] = report_id;
337 		rep_data[1] = mode;
338 
339 		error = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data,
340 					 length, 1);
341 		if (error >= 0)
342 			error = wacom_get_report(hdev, HID_FEATURE_REPORT,
343 			                         rep_data, length, 1);
344 	} while (error >= 0 && rep_data[1] != mode && limit++ < WAC_MSG_RETRIES);
345 
346 	kfree(rep_data);
347 
348 	return error < 0 ? error : 0;
349 }
350 
wacom_bt_query_tablet_data(struct hid_device * hdev,u8 speed,struct wacom_features * features)351 static int wacom_bt_query_tablet_data(struct hid_device *hdev, u8 speed,
352 		struct wacom_features *features)
353 {
354 	struct wacom *wacom = hid_get_drvdata(hdev);
355 	int ret;
356 	u8 rep_data[2];
357 
358 	switch (features->type) {
359 	case GRAPHIRE_BT:
360 		rep_data[0] = 0x03;
361 		rep_data[1] = 0x00;
362 		ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
363 					3);
364 
365 		if (ret >= 0) {
366 			rep_data[0] = speed == 0 ? 0x05 : 0x06;
367 			rep_data[1] = 0x00;
368 
369 			ret = wacom_set_report(hdev, HID_FEATURE_REPORT,
370 						rep_data, 2, 3);
371 
372 			if (ret >= 0) {
373 				wacom->wacom_wac.bt_high_speed = speed;
374 				return 0;
375 			}
376 		}
377 
378 		/*
379 		 * Note that if the raw queries fail, it's not a hard failure
380 		 * and it is safe to continue
381 		 */
382 		hid_warn(hdev, "failed to poke device, command %d, err %d\n",
383 			 rep_data[0], ret);
384 		break;
385 	case INTUOS4WL:
386 		if (speed == 1)
387 			wacom->wacom_wac.bt_features &= ~0x20;
388 		else
389 			wacom->wacom_wac.bt_features |= 0x20;
390 
391 		rep_data[0] = 0x03;
392 		rep_data[1] = wacom->wacom_wac.bt_features;
393 
394 		ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
395 					1);
396 		if (ret >= 0)
397 			wacom->wacom_wac.bt_high_speed = speed;
398 		break;
399 	}
400 
401 	return 0;
402 }
403 
404 /*
405  * Switch the tablet into its most-capable mode. Wacom tablets are
406  * typically configured to power-up in a mode which sends mouse-like
407  * reports to the OS. To get absolute position, pressure data, etc.
408  * from the tablet, it is necessary to switch the tablet out of this
409  * mode and into one which sends the full range of tablet data.
410  */
wacom_query_tablet_data(struct hid_device * hdev,struct wacom_features * features)411 static int wacom_query_tablet_data(struct hid_device *hdev,
412 		struct wacom_features *features)
413 {
414 	if (hdev->bus == BUS_BLUETOOTH)
415 		return wacom_bt_query_tablet_data(hdev, 1, features);
416 
417 	if (features->type == HID_GENERIC)
418 		return wacom_hid_set_device_mode(hdev);
419 
420 	if (features->device_type & WACOM_DEVICETYPE_TOUCH) {
421 		if (features->type > TABLETPC) {
422 			/* MT Tablet PC touch */
423 			return wacom_set_device_mode(hdev, 3, 4, 4);
424 		}
425 		else if (features->type == WACOM_24HDT) {
426 			return wacom_set_device_mode(hdev, 18, 3, 2);
427 		}
428 		else if (features->type == WACOM_27QHDT) {
429 			return wacom_set_device_mode(hdev, 131, 3, 2);
430 		}
431 		else if (features->type == BAMBOO_PAD) {
432 			return wacom_set_device_mode(hdev, 2, 2, 2);
433 		}
434 	} else if (features->device_type & WACOM_DEVICETYPE_PEN) {
435 		if (features->type <= BAMBOO_PT) {
436 			return wacom_set_device_mode(hdev, 2, 2, 2);
437 		}
438 	}
439 
440 	return 0;
441 }
442 
wacom_retrieve_hid_descriptor(struct hid_device * hdev,struct wacom_features * features)443 static void wacom_retrieve_hid_descriptor(struct hid_device *hdev,
444 					 struct wacom_features *features)
445 {
446 	struct wacom *wacom = hid_get_drvdata(hdev);
447 	struct usb_interface *intf = wacom->intf;
448 
449 	/* default features */
450 	features->x_fuzz = 4;
451 	features->y_fuzz = 4;
452 	features->pressure_fuzz = 0;
453 	features->distance_fuzz = 0;
454 
455 	/*
456 	 * The wireless device HID is basic and layout conflicts with
457 	 * other tablets (monitor and touch interface can look like pen).
458 	 * Skip the query for this type and modify defaults based on
459 	 * interface number.
460 	 */
461 	if (features->type == WIRELESS && intf) {
462 		if (intf->cur_altsetting->desc.bInterfaceNumber == 0)
463 			features->device_type = WACOM_DEVICETYPE_WL_MONITOR;
464 		else
465 			features->device_type = WACOM_DEVICETYPE_NONE;
466 		return;
467 	}
468 
469 	wacom_parse_hid(hdev, features);
470 }
471 
472 struct wacom_hdev_data {
473 	struct list_head list;
474 	struct kref kref;
475 	struct hid_device *dev;
476 	struct wacom_shared shared;
477 };
478 
479 static LIST_HEAD(wacom_udev_list);
480 static DEFINE_MUTEX(wacom_udev_list_lock);
481 
wacom_are_sibling(struct hid_device * hdev,struct hid_device * sibling)482 static bool wacom_are_sibling(struct hid_device *hdev,
483 		struct hid_device *sibling)
484 {
485 	struct wacom *wacom = hid_get_drvdata(hdev);
486 	struct wacom_features *features = &wacom->wacom_wac.features;
487 	int vid = features->oVid;
488 	int pid = features->oPid;
489 	int n1,n2;
490 
491 	if (vid == 0 && pid == 0) {
492 		vid = hdev->vendor;
493 		pid = hdev->product;
494 	}
495 
496 	if (vid != sibling->vendor || pid != sibling->product)
497 		return false;
498 
499 	/* Compare the physical path. */
500 	n1 = strrchr(hdev->phys, '.') - hdev->phys;
501 	n2 = strrchr(sibling->phys, '.') - sibling->phys;
502 	if (n1 != n2 || n1 <= 0 || n2 <= 0)
503 		return false;
504 
505 	return !strncmp(hdev->phys, sibling->phys, n1);
506 }
507 
wacom_get_hdev_data(struct hid_device * hdev)508 static struct wacom_hdev_data *wacom_get_hdev_data(struct hid_device *hdev)
509 {
510 	struct wacom_hdev_data *data;
511 
512 	list_for_each_entry(data, &wacom_udev_list, list) {
513 		if (wacom_are_sibling(hdev, data->dev)) {
514 			kref_get(&data->kref);
515 			return data;
516 		}
517 	}
518 
519 	return NULL;
520 }
521 
wacom_add_shared_data(struct hid_device * hdev)522 static int wacom_add_shared_data(struct hid_device *hdev)
523 {
524 	struct wacom *wacom = hid_get_drvdata(hdev);
525 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
526 	struct wacom_hdev_data *data;
527 	int retval = 0;
528 
529 	mutex_lock(&wacom_udev_list_lock);
530 
531 	data = wacom_get_hdev_data(hdev);
532 	if (!data) {
533 		data = kzalloc(sizeof(struct wacom_hdev_data), GFP_KERNEL);
534 		if (!data) {
535 			retval = -ENOMEM;
536 			goto out;
537 		}
538 
539 		kref_init(&data->kref);
540 		data->dev = hdev;
541 		list_add_tail(&data->list, &wacom_udev_list);
542 	}
543 
544 	wacom_wac->shared = &data->shared;
545 
546 	if (wacom_wac->features.device_type & WACOM_DEVICETYPE_TOUCH)
547 		wacom_wac->shared->touch = hdev;
548 	else if (wacom_wac->features.device_type & WACOM_DEVICETYPE_PEN)
549 		wacom_wac->shared->pen = hdev;
550 
551 out:
552 	mutex_unlock(&wacom_udev_list_lock);
553 	return retval;
554 }
555 
wacom_release_shared_data(struct kref * kref)556 static void wacom_release_shared_data(struct kref *kref)
557 {
558 	struct wacom_hdev_data *data =
559 		container_of(kref, struct wacom_hdev_data, kref);
560 
561 	mutex_lock(&wacom_udev_list_lock);
562 	list_del(&data->list);
563 	mutex_unlock(&wacom_udev_list_lock);
564 
565 	kfree(data);
566 }
567 
wacom_remove_shared_data(struct wacom * wacom)568 static void wacom_remove_shared_data(struct wacom *wacom)
569 {
570 	struct wacom_hdev_data *data;
571 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
572 
573 	if (wacom_wac->shared) {
574 		data = container_of(wacom_wac->shared, struct wacom_hdev_data,
575 				    shared);
576 
577 		if (wacom_wac->shared->touch == wacom->hdev)
578 			wacom_wac->shared->touch = NULL;
579 		else if (wacom_wac->shared->pen == wacom->hdev)
580 			wacom_wac->shared->pen = NULL;
581 
582 		kref_put(&data->kref, wacom_release_shared_data);
583 		wacom_wac->shared = NULL;
584 	}
585 }
586 
wacom_led_control(struct wacom * wacom)587 static int wacom_led_control(struct wacom *wacom)
588 {
589 	unsigned char *buf;
590 	int retval;
591 	unsigned char report_id = WAC_CMD_LED_CONTROL;
592 	int buf_size = 9;
593 
594 	if (wacom->wacom_wac.pid) { /* wireless connected */
595 		report_id = WAC_CMD_WL_LED_CONTROL;
596 		buf_size = 13;
597 	}
598 	buf = kzalloc(buf_size, GFP_KERNEL);
599 	if (!buf)
600 		return -ENOMEM;
601 
602 	if (wacom->wacom_wac.features.type >= INTUOS5S &&
603 	    wacom->wacom_wac.features.type <= INTUOSPL) {
604 		/*
605 		 * Touch Ring and crop mark LED luminance may take on
606 		 * one of four values:
607 		 *    0 = Low; 1 = Medium; 2 = High; 3 = Off
608 		 */
609 		int ring_led = wacom->led.select[0] & 0x03;
610 		int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
611 		int crop_lum = 0;
612 		unsigned char led_bits = (crop_lum << 4) | (ring_lum << 2) | (ring_led);
613 
614 		buf[0] = report_id;
615 		if (wacom->wacom_wac.pid) {
616 			wacom_get_report(wacom->hdev, HID_FEATURE_REPORT,
617 					 buf, buf_size, WAC_CMD_RETRIES);
618 			buf[0] = report_id;
619 			buf[4] = led_bits;
620 		} else
621 			buf[1] = led_bits;
622 	}
623 	else {
624 		int led = wacom->led.select[0] | 0x4;
625 
626 		if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
627 		    wacom->wacom_wac.features.type == WACOM_24HD)
628 			led |= (wacom->led.select[1] << 4) | 0x40;
629 
630 		buf[0] = report_id;
631 		buf[1] = led;
632 		buf[2] = wacom->led.llv;
633 		buf[3] = wacom->led.hlv;
634 		buf[4] = wacom->led.img_lum;
635 	}
636 
637 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, buf_size,
638 				  WAC_CMD_RETRIES);
639 	kfree(buf);
640 
641 	return retval;
642 }
643 
wacom_led_putimage(struct wacom * wacom,int button_id,u8 xfer_id,const unsigned len,const void * img)644 static int wacom_led_putimage(struct wacom *wacom, int button_id, u8 xfer_id,
645 		const unsigned len, const void *img)
646 {
647 	unsigned char *buf;
648 	int i, retval;
649 	const unsigned chunk_len = len / 4; /* 4 chunks are needed to be sent */
650 
651 	buf = kzalloc(chunk_len + 3 , GFP_KERNEL);
652 	if (!buf)
653 		return -ENOMEM;
654 
655 	/* Send 'start' command */
656 	buf[0] = WAC_CMD_ICON_START;
657 	buf[1] = 1;
658 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
659 				  WAC_CMD_RETRIES);
660 	if (retval < 0)
661 		goto out;
662 
663 	buf[0] = xfer_id;
664 	buf[1] = button_id & 0x07;
665 	for (i = 0; i < 4; i++) {
666 		buf[2] = i;
667 		memcpy(buf + 3, img + i * chunk_len, chunk_len);
668 
669 		retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
670 					  buf, chunk_len + 3, WAC_CMD_RETRIES);
671 		if (retval < 0)
672 			break;
673 	}
674 
675 	/* Send 'stop' */
676 	buf[0] = WAC_CMD_ICON_START;
677 	buf[1] = 0;
678 	wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
679 			 WAC_CMD_RETRIES);
680 
681 out:
682 	kfree(buf);
683 	return retval;
684 }
685 
wacom_led_select_store(struct device * dev,int set_id,const char * buf,size_t count)686 static ssize_t wacom_led_select_store(struct device *dev, int set_id,
687 				      const char *buf, size_t count)
688 {
689 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
690 	struct wacom *wacom = hid_get_drvdata(hdev);
691 	unsigned int id;
692 	int err;
693 
694 	err = kstrtouint(buf, 10, &id);
695 	if (err)
696 		return err;
697 
698 	mutex_lock(&wacom->lock);
699 
700 	wacom->led.select[set_id] = id & 0x3;
701 	err = wacom_led_control(wacom);
702 
703 	mutex_unlock(&wacom->lock);
704 
705 	return err < 0 ? err : count;
706 }
707 
708 #define DEVICE_LED_SELECT_ATTR(SET_ID)					\
709 static ssize_t wacom_led##SET_ID##_select_store(struct device *dev,	\
710 	struct device_attribute *attr, const char *buf, size_t count)	\
711 {									\
712 	return wacom_led_select_store(dev, SET_ID, buf, count);		\
713 }									\
714 static ssize_t wacom_led##SET_ID##_select_show(struct device *dev,	\
715 	struct device_attribute *attr, char *buf)			\
716 {									\
717 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
718 	struct wacom *wacom = hid_get_drvdata(hdev);			\
719 	return scnprintf(buf, PAGE_SIZE, "%d\n",			\
720 			 wacom->led.select[SET_ID]);			\
721 }									\
722 static DEVICE_ATTR(status_led##SET_ID##_select, DEV_ATTR_RW_PERM,	\
723 		    wacom_led##SET_ID##_select_show,			\
724 		    wacom_led##SET_ID##_select_store)
725 
726 DEVICE_LED_SELECT_ATTR(0);
727 DEVICE_LED_SELECT_ATTR(1);
728 
wacom_luminance_store(struct wacom * wacom,u8 * dest,const char * buf,size_t count)729 static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
730 				     const char *buf, size_t count)
731 {
732 	unsigned int value;
733 	int err;
734 
735 	err = kstrtouint(buf, 10, &value);
736 	if (err)
737 		return err;
738 
739 	mutex_lock(&wacom->lock);
740 
741 	*dest = value & 0x7f;
742 	err = wacom_led_control(wacom);
743 
744 	mutex_unlock(&wacom->lock);
745 
746 	return err < 0 ? err : count;
747 }
748 
749 #define DEVICE_LUMINANCE_ATTR(name, field)				\
750 static ssize_t wacom_##name##_luminance_store(struct device *dev,	\
751 	struct device_attribute *attr, const char *buf, size_t count)	\
752 {									\
753 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
754 	struct wacom *wacom = hid_get_drvdata(hdev);			\
755 									\
756 	return wacom_luminance_store(wacom, &wacom->led.field,		\
757 				     buf, count);			\
758 }									\
759 static ssize_t wacom_##name##_luminance_show(struct device *dev,	\
760 	struct device_attribute *attr, char *buf)			\
761 {									\
762 	struct wacom *wacom = dev_get_drvdata(dev);			\
763 	return scnprintf(buf, PAGE_SIZE, "%d\n", wacom->led.field);	\
764 }									\
765 static DEVICE_ATTR(name##_luminance, DEV_ATTR_RW_PERM,			\
766 		   wacom_##name##_luminance_show,			\
767 		   wacom_##name##_luminance_store)
768 
769 DEVICE_LUMINANCE_ATTR(status0, llv);
770 DEVICE_LUMINANCE_ATTR(status1, hlv);
771 DEVICE_LUMINANCE_ATTR(buttons, img_lum);
772 
wacom_button_image_store(struct device * dev,int button_id,const char * buf,size_t count)773 static ssize_t wacom_button_image_store(struct device *dev, int button_id,
774 					const char *buf, size_t count)
775 {
776 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
777 	struct wacom *wacom = hid_get_drvdata(hdev);
778 	int err;
779 	unsigned len;
780 	u8 xfer_id;
781 
782 	if (hdev->bus == BUS_BLUETOOTH) {
783 		len = 256;
784 		xfer_id = WAC_CMD_ICON_BT_XFER;
785 	} else {
786 		len = 1024;
787 		xfer_id = WAC_CMD_ICON_XFER;
788 	}
789 
790 	if (count != len)
791 		return -EINVAL;
792 
793 	mutex_lock(&wacom->lock);
794 
795 	err = wacom_led_putimage(wacom, button_id, xfer_id, len, buf);
796 
797 	mutex_unlock(&wacom->lock);
798 
799 	return err < 0 ? err : count;
800 }
801 
802 #define DEVICE_BTNIMG_ATTR(BUTTON_ID)					\
803 static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev,	\
804 	struct device_attribute *attr, const char *buf, size_t count)	\
805 {									\
806 	return wacom_button_image_store(dev, BUTTON_ID, buf, count);	\
807 }									\
808 static DEVICE_ATTR(button##BUTTON_ID##_rawimg, DEV_ATTR_WO_PERM,	\
809 		   NULL, wacom_btnimg##BUTTON_ID##_store)
810 
811 DEVICE_BTNIMG_ATTR(0);
812 DEVICE_BTNIMG_ATTR(1);
813 DEVICE_BTNIMG_ATTR(2);
814 DEVICE_BTNIMG_ATTR(3);
815 DEVICE_BTNIMG_ATTR(4);
816 DEVICE_BTNIMG_ATTR(5);
817 DEVICE_BTNIMG_ATTR(6);
818 DEVICE_BTNIMG_ATTR(7);
819 
820 static struct attribute *cintiq_led_attrs[] = {
821 	&dev_attr_status_led0_select.attr,
822 	&dev_attr_status_led1_select.attr,
823 	NULL
824 };
825 
826 static struct attribute_group cintiq_led_attr_group = {
827 	.name = "wacom_led",
828 	.attrs = cintiq_led_attrs,
829 };
830 
831 static struct attribute *intuos4_led_attrs[] = {
832 	&dev_attr_status0_luminance.attr,
833 	&dev_attr_status1_luminance.attr,
834 	&dev_attr_status_led0_select.attr,
835 	&dev_attr_buttons_luminance.attr,
836 	&dev_attr_button0_rawimg.attr,
837 	&dev_attr_button1_rawimg.attr,
838 	&dev_attr_button2_rawimg.attr,
839 	&dev_attr_button3_rawimg.attr,
840 	&dev_attr_button4_rawimg.attr,
841 	&dev_attr_button5_rawimg.attr,
842 	&dev_attr_button6_rawimg.attr,
843 	&dev_attr_button7_rawimg.attr,
844 	NULL
845 };
846 
847 static struct attribute_group intuos4_led_attr_group = {
848 	.name = "wacom_led",
849 	.attrs = intuos4_led_attrs,
850 };
851 
852 static struct attribute *intuos5_led_attrs[] = {
853 	&dev_attr_status0_luminance.attr,
854 	&dev_attr_status_led0_select.attr,
855 	NULL
856 };
857 
858 static struct attribute_group intuos5_led_attr_group = {
859 	.name = "wacom_led",
860 	.attrs = intuos5_led_attrs,
861 };
862 
wacom_initialize_leds(struct wacom * wacom)863 static int wacom_initialize_leds(struct wacom *wacom)
864 {
865 	int error;
866 
867 	if (!(wacom->wacom_wac.features.device_type & WACOM_DEVICETYPE_PAD))
868 		return 0;
869 
870 	/* Initialize default values */
871 	switch (wacom->wacom_wac.features.type) {
872 	case INTUOS4S:
873 	case INTUOS4:
874 	case INTUOS4WL:
875 	case INTUOS4L:
876 		wacom->led.select[0] = 0;
877 		wacom->led.select[1] = 0;
878 		wacom->led.llv = 10;
879 		wacom->led.hlv = 20;
880 		wacom->led.img_lum = 10;
881 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
882 					   &intuos4_led_attr_group);
883 		break;
884 
885 	case WACOM_24HD:
886 	case WACOM_21UX2:
887 		wacom->led.select[0] = 0;
888 		wacom->led.select[1] = 0;
889 		wacom->led.llv = 0;
890 		wacom->led.hlv = 0;
891 		wacom->led.img_lum = 0;
892 
893 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
894 					   &cintiq_led_attr_group);
895 		break;
896 
897 	case INTUOS5S:
898 	case INTUOS5:
899 	case INTUOS5L:
900 	case INTUOSPS:
901 	case INTUOSPM:
902 	case INTUOSPL:
903 		wacom->led.select[0] = 0;
904 		wacom->led.select[1] = 0;
905 		wacom->led.llv = 32;
906 		wacom->led.hlv = 0;
907 		wacom->led.img_lum = 0;
908 
909 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
910 					  &intuos5_led_attr_group);
911 		break;
912 
913 	default:
914 		return 0;
915 	}
916 
917 	if (error) {
918 		hid_err(wacom->hdev,
919 			"cannot create sysfs group err: %d\n", error);
920 		return error;
921 	}
922 	wacom_led_control(wacom);
923 	wacom->led_initialized = true;
924 
925 	return 0;
926 }
927 
wacom_destroy_leds(struct wacom * wacom)928 static void wacom_destroy_leds(struct wacom *wacom)
929 {
930 	if (!wacom->led_initialized)
931 		return;
932 
933 	if (!(wacom->wacom_wac.features.device_type & WACOM_DEVICETYPE_PAD))
934 		return;
935 
936 	wacom->led_initialized = false;
937 
938 	switch (wacom->wacom_wac.features.type) {
939 	case INTUOS4S:
940 	case INTUOS4:
941 	case INTUOS4WL:
942 	case INTUOS4L:
943 		sysfs_remove_group(&wacom->hdev->dev.kobj,
944 				   &intuos4_led_attr_group);
945 		break;
946 
947 	case WACOM_24HD:
948 	case WACOM_21UX2:
949 		sysfs_remove_group(&wacom->hdev->dev.kobj,
950 				   &cintiq_led_attr_group);
951 		break;
952 
953 	case INTUOS5S:
954 	case INTUOS5:
955 	case INTUOS5L:
956 	case INTUOSPS:
957 	case INTUOSPM:
958 	case INTUOSPL:
959 		sysfs_remove_group(&wacom->hdev->dev.kobj,
960 				   &intuos5_led_attr_group);
961 		break;
962 	}
963 }
964 
965 static enum power_supply_property wacom_battery_props[] = {
966 	POWER_SUPPLY_PROP_PRESENT,
967 	POWER_SUPPLY_PROP_STATUS,
968 	POWER_SUPPLY_PROP_SCOPE,
969 	POWER_SUPPLY_PROP_CAPACITY
970 };
971 
972 static enum power_supply_property wacom_ac_props[] = {
973 	POWER_SUPPLY_PROP_PRESENT,
974 	POWER_SUPPLY_PROP_ONLINE,
975 	POWER_SUPPLY_PROP_SCOPE,
976 };
977 
wacom_battery_get_property(struct power_supply * psy,enum power_supply_property psp,union power_supply_propval * val)978 static int wacom_battery_get_property(struct power_supply *psy,
979 				      enum power_supply_property psp,
980 				      union power_supply_propval *val)
981 {
982 	struct wacom *wacom = power_supply_get_drvdata(psy);
983 	int ret = 0;
984 
985 	switch (psp) {
986 		case POWER_SUPPLY_PROP_PRESENT:
987 			val->intval = wacom->wacom_wac.bat_connected;
988 			break;
989 		case POWER_SUPPLY_PROP_SCOPE:
990 			val->intval = POWER_SUPPLY_SCOPE_DEVICE;
991 			break;
992 		case POWER_SUPPLY_PROP_CAPACITY:
993 			val->intval =
994 				wacom->wacom_wac.battery_capacity;
995 			break;
996 		case POWER_SUPPLY_PROP_STATUS:
997 			if (wacom->wacom_wac.bat_charging)
998 				val->intval = POWER_SUPPLY_STATUS_CHARGING;
999 			else if (wacom->wacom_wac.battery_capacity == 100 &&
1000 				    wacom->wacom_wac.ps_connected)
1001 				val->intval = POWER_SUPPLY_STATUS_FULL;
1002 			else if (wacom->wacom_wac.ps_connected)
1003 				val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
1004 			else
1005 				val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
1006 			break;
1007 		default:
1008 			ret = -EINVAL;
1009 			break;
1010 	}
1011 
1012 	return ret;
1013 }
1014 
wacom_ac_get_property(struct power_supply * psy,enum power_supply_property psp,union power_supply_propval * val)1015 static int wacom_ac_get_property(struct power_supply *psy,
1016 				enum power_supply_property psp,
1017 				union power_supply_propval *val)
1018 {
1019 	struct wacom *wacom = power_supply_get_drvdata(psy);
1020 	int ret = 0;
1021 
1022 	switch (psp) {
1023 	case POWER_SUPPLY_PROP_PRESENT:
1024 		/* fall through */
1025 	case POWER_SUPPLY_PROP_ONLINE:
1026 		val->intval = wacom->wacom_wac.ps_connected;
1027 		break;
1028 	case POWER_SUPPLY_PROP_SCOPE:
1029 		val->intval = POWER_SUPPLY_SCOPE_DEVICE;
1030 		break;
1031 	default:
1032 		ret = -EINVAL;
1033 		break;
1034 	}
1035 	return ret;
1036 }
1037 
wacom_initialize_battery(struct wacom * wacom)1038 static int wacom_initialize_battery(struct wacom *wacom)
1039 {
1040 	static atomic_t battery_no = ATOMIC_INIT(0);
1041 	struct power_supply_config psy_cfg = { .drv_data = wacom, };
1042 	unsigned long n;
1043 
1044 	if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) {
1045 		struct power_supply_desc *bat_desc = &wacom->battery_desc;
1046 		struct power_supply_desc *ac_desc = &wacom->ac_desc;
1047 		n = atomic_inc_return(&battery_no) - 1;
1048 
1049 		bat_desc->properties = wacom_battery_props;
1050 		bat_desc->num_properties = ARRAY_SIZE(wacom_battery_props);
1051 		bat_desc->get_property = wacom_battery_get_property;
1052 		sprintf(wacom->wacom_wac.bat_name, "wacom_battery_%ld", n);
1053 		bat_desc->name = wacom->wacom_wac.bat_name;
1054 		bat_desc->type = POWER_SUPPLY_TYPE_BATTERY;
1055 		bat_desc->use_for_apm = 0;
1056 
1057 		ac_desc->properties = wacom_ac_props;
1058 		ac_desc->num_properties = ARRAY_SIZE(wacom_ac_props);
1059 		ac_desc->get_property = wacom_ac_get_property;
1060 		sprintf(wacom->wacom_wac.ac_name, "wacom_ac_%ld", n);
1061 		ac_desc->name = wacom->wacom_wac.ac_name;
1062 		ac_desc->type = POWER_SUPPLY_TYPE_MAINS;
1063 		ac_desc->use_for_apm = 0;
1064 
1065 		wacom->battery = power_supply_register(&wacom->hdev->dev,
1066 					      &wacom->battery_desc, &psy_cfg);
1067 		if (IS_ERR(wacom->battery))
1068 			return PTR_ERR(wacom->battery);
1069 
1070 		power_supply_powers(wacom->battery, &wacom->hdev->dev);
1071 
1072 		wacom->ac = power_supply_register(&wacom->hdev->dev,
1073 						  &wacom->ac_desc,
1074 						  &psy_cfg);
1075 		if (IS_ERR(wacom->ac)) {
1076 			power_supply_unregister(wacom->battery);
1077 			return PTR_ERR(wacom->ac);
1078 		}
1079 
1080 		power_supply_powers(wacom->ac, &wacom->hdev->dev);
1081 	}
1082 
1083 	return 0;
1084 }
1085 
wacom_destroy_battery(struct wacom * wacom)1086 static void wacom_destroy_battery(struct wacom *wacom)
1087 {
1088 	if (wacom->battery) {
1089 		power_supply_unregister(wacom->battery);
1090 		wacom->battery = NULL;
1091 		power_supply_unregister(wacom->ac);
1092 		wacom->ac = NULL;
1093 	}
1094 }
1095 
wacom_show_speed(struct device * dev,struct device_attribute * attr,char * buf)1096 static ssize_t wacom_show_speed(struct device *dev,
1097 				struct device_attribute
1098 				*attr, char *buf)
1099 {
1100 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
1101 	struct wacom *wacom = hid_get_drvdata(hdev);
1102 
1103 	return snprintf(buf, PAGE_SIZE, "%i\n", wacom->wacom_wac.bt_high_speed);
1104 }
1105 
wacom_store_speed(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1106 static ssize_t wacom_store_speed(struct device *dev,
1107 				struct device_attribute *attr,
1108 				const char *buf, size_t count)
1109 {
1110 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
1111 	struct wacom *wacom = hid_get_drvdata(hdev);
1112 	u8 new_speed;
1113 
1114 	if (kstrtou8(buf, 0, &new_speed))
1115 		return -EINVAL;
1116 
1117 	if (new_speed != 0 && new_speed != 1)
1118 		return -EINVAL;
1119 
1120 	wacom_bt_query_tablet_data(hdev, new_speed, &wacom->wacom_wac.features);
1121 
1122 	return count;
1123 }
1124 
1125 static DEVICE_ATTR(speed, DEV_ATTR_RW_PERM,
1126 		wacom_show_speed, wacom_store_speed);
1127 
1128 
wacom_show_remote_mode(struct kobject * kobj,struct kobj_attribute * kattr,char * buf,int index)1129 static ssize_t wacom_show_remote_mode(struct kobject *kobj,
1130 				      struct kobj_attribute *kattr,
1131 				      char *buf, int index)
1132 {
1133 	struct device *dev = container_of(kobj->parent, struct device, kobj);
1134 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
1135 	struct wacom *wacom = hid_get_drvdata(hdev);
1136 	u8 mode;
1137 
1138 	mode = wacom->led.select[index];
1139 	if (mode >= 0 && mode < 3)
1140 		return snprintf(buf, PAGE_SIZE, "%d\n", mode);
1141 	else
1142 		return snprintf(buf, PAGE_SIZE, "%d\n", -1);
1143 }
1144 
1145 #define DEVICE_EKR_ATTR_GROUP(SET_ID)					\
1146 static ssize_t wacom_show_remote##SET_ID##_mode(struct kobject *kobj,	\
1147 			       struct kobj_attribute *kattr, char *buf)	\
1148 {									\
1149 	return wacom_show_remote_mode(kobj, kattr, buf, SET_ID);	\
1150 }									\
1151 static struct kobj_attribute remote##SET_ID##_mode_attr = {		\
1152 	.attr = {.name = "remote_mode",					\
1153 		.mode = DEV_ATTR_RO_PERM},				\
1154 	.show = wacom_show_remote##SET_ID##_mode,			\
1155 };									\
1156 static struct attribute *remote##SET_ID##_serial_attrs[] = {		\
1157 	&remote##SET_ID##_mode_attr.attr,				\
1158 	NULL								\
1159 };									\
1160 static struct attribute_group remote##SET_ID##_serial_group = {		\
1161 	.name = NULL,							\
1162 	.attrs = remote##SET_ID##_serial_attrs,				\
1163 }
1164 
1165 DEVICE_EKR_ATTR_GROUP(0);
1166 DEVICE_EKR_ATTR_GROUP(1);
1167 DEVICE_EKR_ATTR_GROUP(2);
1168 DEVICE_EKR_ATTR_GROUP(3);
1169 DEVICE_EKR_ATTR_GROUP(4);
1170 
wacom_remote_create_attr_group(struct wacom * wacom,__u32 serial,int index)1171 int wacom_remote_create_attr_group(struct wacom *wacom, __u32 serial, int index)
1172 {
1173 	int error = 0;
1174 	char *buf;
1175 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1176 
1177 	wacom_wac->serial[index] = serial;
1178 
1179 	buf = kzalloc(WAC_REMOTE_SERIAL_MAX_STRLEN, GFP_KERNEL);
1180 	if (!buf)
1181 		return -ENOMEM;
1182 	snprintf(buf, WAC_REMOTE_SERIAL_MAX_STRLEN, "%d", serial);
1183 	wacom->remote_group[index].name = buf;
1184 
1185 	error = sysfs_create_group(wacom->remote_dir,
1186 				   &wacom->remote_group[index]);
1187 	if (error) {
1188 		hid_err(wacom->hdev,
1189 			"cannot create sysfs group err: %d\n", error);
1190 		kobject_put(wacom->remote_dir);
1191 		return error;
1192 	}
1193 
1194 	return 0;
1195 }
1196 
wacom_remote_destroy_attr_group(struct wacom * wacom,__u32 serial)1197 void wacom_remote_destroy_attr_group(struct wacom *wacom, __u32 serial)
1198 {
1199 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1200 	int i;
1201 
1202 	if (!serial)
1203 		return;
1204 
1205 	for (i = 0; i < WACOM_MAX_REMOTES; i++) {
1206 		if (wacom_wac->serial[i] == serial) {
1207 			wacom_wac->serial[i] = 0;
1208 			wacom->led.select[i] = WACOM_STATUS_UNKNOWN;
1209 			if (wacom->remote_group[i].name) {
1210 				sysfs_remove_group(wacom->remote_dir,
1211 						   &wacom->remote_group[i]);
1212 				kfree(wacom->remote_group[i].name);
1213 				wacom->remote_group[i].name = NULL;
1214 			}
1215 		}
1216 	}
1217 }
1218 
wacom_cmd_unpair_remote(struct wacom * wacom,unsigned char selector)1219 static int wacom_cmd_unpair_remote(struct wacom *wacom, unsigned char selector)
1220 {
1221 	const size_t buf_size = 2;
1222 	unsigned char *buf;
1223 	int retval;
1224 
1225 	buf = kzalloc(buf_size, GFP_KERNEL);
1226 	if (!buf)
1227 		return -ENOMEM;
1228 
1229 	buf[0] = WAC_CMD_DELETE_PAIRING;
1230 	buf[1] = selector;
1231 
1232 	retval = wacom_set_report(wacom->hdev, HID_OUTPUT_REPORT, buf,
1233 				  buf_size, WAC_CMD_RETRIES);
1234 	kfree(buf);
1235 
1236 	return retval;
1237 }
1238 
wacom_store_unpair_remote(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)1239 static ssize_t wacom_store_unpair_remote(struct kobject *kobj,
1240 					 struct kobj_attribute *attr,
1241 					 const char *buf, size_t count)
1242 {
1243 	unsigned char selector = 0;
1244 	struct device *dev = container_of(kobj->parent, struct device, kobj);
1245 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
1246 	struct wacom *wacom = hid_get_drvdata(hdev);
1247 	int err;
1248 
1249 	if (!strncmp(buf, "*\n", 2)) {
1250 		selector = WAC_CMD_UNPAIR_ALL;
1251 	} else {
1252 		hid_info(wacom->hdev, "remote: unrecognized unpair code: %s\n",
1253 			 buf);
1254 		return -1;
1255 	}
1256 
1257 	mutex_lock(&wacom->lock);
1258 
1259 	err = wacom_cmd_unpair_remote(wacom, selector);
1260 	mutex_unlock(&wacom->lock);
1261 
1262 	return err < 0 ? err : count;
1263 }
1264 
1265 static struct kobj_attribute unpair_remote_attr = {
1266 	.attr = {.name = "unpair_remote", .mode = 0200},
1267 	.store = wacom_store_unpair_remote,
1268 };
1269 
1270 static const struct attribute *remote_unpair_attrs[] = {
1271 	&unpair_remote_attr.attr,
1272 	NULL
1273 };
1274 
wacom_initialize_remote(struct wacom * wacom)1275 static int wacom_initialize_remote(struct wacom *wacom)
1276 {
1277 	int error = 0;
1278 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1279 	int i;
1280 
1281 	if (wacom->wacom_wac.features.type != REMOTE)
1282 		return 0;
1283 
1284 	wacom->remote_group[0] = remote0_serial_group;
1285 	wacom->remote_group[1] = remote1_serial_group;
1286 	wacom->remote_group[2] = remote2_serial_group;
1287 	wacom->remote_group[3] = remote3_serial_group;
1288 	wacom->remote_group[4] = remote4_serial_group;
1289 
1290 	wacom->remote_dir = kobject_create_and_add("wacom_remote",
1291 						   &wacom->hdev->dev.kobj);
1292 	if (!wacom->remote_dir)
1293 		return -ENOMEM;
1294 
1295 	error = sysfs_create_files(wacom->remote_dir, remote_unpair_attrs);
1296 
1297 	if (error) {
1298 		hid_err(wacom->hdev,
1299 			"cannot create sysfs group err: %d\n", error);
1300 		return error;
1301 	}
1302 
1303 	for (i = 0; i < WACOM_MAX_REMOTES; i++) {
1304 		wacom->led.select[i] = WACOM_STATUS_UNKNOWN;
1305 		wacom_wac->serial[i] = 0;
1306 	}
1307 
1308 	return 0;
1309 }
1310 
wacom_allocate_input(struct wacom * wacom)1311 static struct input_dev *wacom_allocate_input(struct wacom *wacom)
1312 {
1313 	struct input_dev *input_dev;
1314 	struct hid_device *hdev = wacom->hdev;
1315 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1316 
1317 	input_dev = input_allocate_device();
1318 	if (!input_dev)
1319 		return NULL;
1320 
1321 	input_dev->name = wacom_wac->features.name;
1322 	input_dev->phys = hdev->phys;
1323 	input_dev->dev.parent = &hdev->dev;
1324 	input_dev->open = wacom_open;
1325 	input_dev->close = wacom_close;
1326 	input_dev->uniq = hdev->uniq;
1327 	input_dev->id.bustype = hdev->bus;
1328 	input_dev->id.vendor  = hdev->vendor;
1329 	input_dev->id.product = wacom_wac->pid ? wacom_wac->pid : hdev->product;
1330 	input_dev->id.version = hdev->version;
1331 	input_set_drvdata(input_dev, wacom);
1332 
1333 	return input_dev;
1334 }
1335 
wacom_clean_inputs(struct wacom * wacom)1336 static void wacom_clean_inputs(struct wacom *wacom)
1337 {
1338 	if (wacom->wacom_wac.pen_input) {
1339 		if (wacom->wacom_wac.pen_registered)
1340 			input_unregister_device(wacom->wacom_wac.pen_input);
1341 		else
1342 			input_free_device(wacom->wacom_wac.pen_input);
1343 	}
1344 	if (wacom->wacom_wac.touch_input) {
1345 		if (wacom->wacom_wac.touch_registered)
1346 			input_unregister_device(wacom->wacom_wac.touch_input);
1347 		else
1348 			input_free_device(wacom->wacom_wac.touch_input);
1349 	}
1350 	if (wacom->wacom_wac.pad_input) {
1351 		if (wacom->wacom_wac.pad_registered)
1352 			input_unregister_device(wacom->wacom_wac.pad_input);
1353 		else
1354 			input_free_device(wacom->wacom_wac.pad_input);
1355 	}
1356 	if (wacom->remote_dir)
1357 		kobject_put(wacom->remote_dir);
1358 	wacom->wacom_wac.pen_input = NULL;
1359 	wacom->wacom_wac.touch_input = NULL;
1360 	wacom->wacom_wac.pad_input = NULL;
1361 	wacom_destroy_leds(wacom);
1362 }
1363 
wacom_allocate_inputs(struct wacom * wacom)1364 static int wacom_allocate_inputs(struct wacom *wacom)
1365 {
1366 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1367 
1368 	wacom_wac->pen_input = wacom_allocate_input(wacom);
1369 	wacom_wac->touch_input = wacom_allocate_input(wacom);
1370 	wacom_wac->pad_input = wacom_allocate_input(wacom);
1371 	if (!wacom_wac->pen_input || !wacom_wac->touch_input || !wacom_wac->pad_input) {
1372 		wacom_clean_inputs(wacom);
1373 		return -ENOMEM;
1374 	}
1375 
1376 	wacom_wac->pen_input->name = wacom_wac->pen_name;
1377 	wacom_wac->touch_input->name = wacom_wac->touch_name;
1378 	wacom_wac->pad_input->name = wacom_wac->pad_name;
1379 
1380 	return 0;
1381 }
1382 
wacom_register_inputs(struct wacom * wacom)1383 static int wacom_register_inputs(struct wacom *wacom)
1384 {
1385 	struct input_dev *pen_input_dev, *touch_input_dev, *pad_input_dev;
1386 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1387 	int error = 0;
1388 
1389 	pen_input_dev = wacom_wac->pen_input;
1390 	touch_input_dev = wacom_wac->touch_input;
1391 	pad_input_dev = wacom_wac->pad_input;
1392 
1393 	if (!pen_input_dev || !touch_input_dev || !pad_input_dev)
1394 		return -EINVAL;
1395 
1396 	error = wacom_setup_pen_input_capabilities(pen_input_dev, wacom_wac);
1397 	if (error) {
1398 		/* no pen in use on this interface */
1399 		input_free_device(pen_input_dev);
1400 		wacom_wac->pen_input = NULL;
1401 		pen_input_dev = NULL;
1402 	} else {
1403 		error = input_register_device(pen_input_dev);
1404 		if (error)
1405 			goto fail_register_pen_input;
1406 		wacom_wac->pen_registered = true;
1407 	}
1408 
1409 	error = wacom_setup_touch_input_capabilities(touch_input_dev, wacom_wac);
1410 	if (error) {
1411 		/* no touch in use on this interface */
1412 		input_free_device(touch_input_dev);
1413 		wacom_wac->touch_input = NULL;
1414 		touch_input_dev = NULL;
1415 	} else {
1416 		error = input_register_device(touch_input_dev);
1417 		if (error)
1418 			goto fail_register_touch_input;
1419 		wacom_wac->touch_registered = true;
1420 	}
1421 
1422 	error = wacom_setup_pad_input_capabilities(pad_input_dev, wacom_wac);
1423 	if (error) {
1424 		/* no pad in use on this interface */
1425 		input_free_device(pad_input_dev);
1426 		wacom_wac->pad_input = NULL;
1427 		pad_input_dev = NULL;
1428 	} else {
1429 		error = input_register_device(pad_input_dev);
1430 		if (error)
1431 			goto fail_register_pad_input;
1432 		wacom_wac->pad_registered = true;
1433 
1434 		error = wacom_initialize_leds(wacom);
1435 		if (error)
1436 			goto fail_leds;
1437 
1438 		error = wacom_initialize_remote(wacom);
1439 		if (error)
1440 			goto fail_remote;
1441 	}
1442 
1443 	return 0;
1444 
1445 fail_remote:
1446 	wacom_destroy_leds(wacom);
1447 fail_leds:
1448 	input_unregister_device(pad_input_dev);
1449 	pad_input_dev = NULL;
1450 	wacom_wac->pad_registered = false;
1451 fail_register_pad_input:
1452 	if (touch_input_dev)
1453 		input_unregister_device(touch_input_dev);
1454 	wacom_wac->touch_input = NULL;
1455 	wacom_wac->touch_registered = false;
1456 fail_register_touch_input:
1457 	if (pen_input_dev)
1458 		input_unregister_device(pen_input_dev);
1459 	wacom_wac->pen_input = NULL;
1460 	wacom_wac->pen_registered = false;
1461 fail_register_pen_input:
1462 	return error;
1463 }
1464 
1465 /*
1466  * Not all devices report physical dimensions from HID.
1467  * Compute the default from hardcoded logical dimension
1468  * and resolution before driver overwrites them.
1469  */
wacom_set_default_phy(struct wacom_features * features)1470 static void wacom_set_default_phy(struct wacom_features *features)
1471 {
1472 	if (features->x_resolution) {
1473 		features->x_phy = (features->x_max * 100) /
1474 					features->x_resolution;
1475 		features->y_phy = (features->y_max * 100) /
1476 					features->y_resolution;
1477 	}
1478 }
1479 
wacom_calculate_res(struct wacom_features * features)1480 static void wacom_calculate_res(struct wacom_features *features)
1481 {
1482 	/* set unit to "100th of a mm" for devices not reported by HID */
1483 	if (!features->unit) {
1484 		features->unit = 0x11;
1485 		features->unitExpo = -3;
1486 	}
1487 
1488 	features->x_resolution = wacom_calc_hid_res(features->x_max,
1489 						    features->x_phy,
1490 						    features->unit,
1491 						    features->unitExpo);
1492 	features->y_resolution = wacom_calc_hid_res(features->y_max,
1493 						    features->y_phy,
1494 						    features->unit,
1495 						    features->unitExpo);
1496 }
1497 
wacom_wireless_work(struct work_struct * work)1498 static void wacom_wireless_work(struct work_struct *work)
1499 {
1500 	struct wacom *wacom = container_of(work, struct wacom, work);
1501 	struct usb_device *usbdev = wacom->usbdev;
1502 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1503 	struct hid_device *hdev1, *hdev2;
1504 	struct wacom *wacom1, *wacom2;
1505 	struct wacom_wac *wacom_wac1, *wacom_wac2;
1506 	int error;
1507 
1508 	/*
1509 	 * Regardless if this is a disconnect or a new tablet,
1510 	 * remove any existing input and battery devices.
1511 	 */
1512 
1513 	wacom_destroy_battery(wacom);
1514 
1515 	if (!usbdev)
1516 		return;
1517 
1518 	/* Stylus interface */
1519 	hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
1520 	wacom1 = hid_get_drvdata(hdev1);
1521 	wacom_wac1 = &(wacom1->wacom_wac);
1522 	wacom_clean_inputs(wacom1);
1523 
1524 	/* Touch interface */
1525 	hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
1526 	wacom2 = hid_get_drvdata(hdev2);
1527 	wacom_wac2 = &(wacom2->wacom_wac);
1528 	wacom_clean_inputs(wacom2);
1529 
1530 	if (wacom_wac->pid == 0) {
1531 		hid_info(wacom->hdev, "wireless tablet disconnected\n");
1532 		wacom_wac1->shared->type = 0;
1533 	} else {
1534 		const struct hid_device_id *id = wacom_ids;
1535 
1536 		hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
1537 			 wacom_wac->pid);
1538 
1539 		while (id->bus) {
1540 			if (id->vendor == USB_VENDOR_ID_WACOM &&
1541 			    id->product == wacom_wac->pid)
1542 				break;
1543 			id++;
1544 		}
1545 
1546 		if (!id->bus) {
1547 			hid_info(wacom->hdev, "ignoring unknown PID.\n");
1548 			return;
1549 		}
1550 
1551 		/* Stylus interface */
1552 		wacom_wac1->features =
1553 			*((struct wacom_features *)id->driver_data);
1554 		wacom_wac1->features.device_type |= WACOM_DEVICETYPE_PEN;
1555 		wacom_set_default_phy(&wacom_wac1->features);
1556 		wacom_calculate_res(&wacom_wac1->features);
1557 		snprintf(wacom_wac1->pen_name, WACOM_NAME_MAX, "%s (WL) Pen",
1558 			 wacom_wac1->features.name);
1559 		if (wacom_wac1->features.type < BAMBOO_PEN ||
1560 		    wacom_wac1->features.type > BAMBOO_PT) {
1561 			snprintf(wacom_wac1->pad_name, WACOM_NAME_MAX, "%s (WL) Pad",
1562 				 wacom_wac1->features.name);
1563 			wacom_wac1->features.device_type |= WACOM_DEVICETYPE_PAD;
1564 		}
1565 		wacom_wac1->shared->touch_max = wacom_wac1->features.touch_max;
1566 		wacom_wac1->shared->type = wacom_wac1->features.type;
1567 		wacom_wac1->pid = wacom_wac->pid;
1568 		error = wacom_allocate_inputs(wacom1) ||
1569 			wacom_register_inputs(wacom1);
1570 		if (error)
1571 			goto fail;
1572 
1573 		/* Touch interface */
1574 		if (wacom_wac1->features.touch_max ||
1575 		    (wacom_wac1->features.type >= INTUOSHT &&
1576 		    wacom_wac1->features.type <= BAMBOO_PT)) {
1577 			wacom_wac2->features =
1578 				*((struct wacom_features *)id->driver_data);
1579 			wacom_wac2->features.pktlen = WACOM_PKGLEN_BBTOUCH3;
1580 			wacom_set_default_phy(&wacom_wac2->features);
1581 			wacom_wac2->features.x_max = wacom_wac2->features.y_max = 4096;
1582 			wacom_calculate_res(&wacom_wac2->features);
1583 			snprintf(wacom_wac2->touch_name, WACOM_NAME_MAX,
1584 				 "%s (WL) Finger",wacom_wac2->features.name);
1585 			if (wacom_wac1->features.touch_max)
1586 				wacom_wac2->features.device_type |= WACOM_DEVICETYPE_TOUCH;
1587 			if (wacom_wac1->features.type >= INTUOSHT &&
1588 			    wacom_wac1->features.type <= BAMBOO_PT) {
1589 				snprintf(wacom_wac2->pad_name, WACOM_NAME_MAX,
1590 					 "%s (WL) Pad",wacom_wac2->features.name);
1591 				wacom_wac2->features.device_type |= WACOM_DEVICETYPE_PAD;
1592 			}
1593 			wacom_wac2->pid = wacom_wac->pid;
1594 			error = wacom_allocate_inputs(wacom2) ||
1595 				wacom_register_inputs(wacom2);
1596 			if (error)
1597 				goto fail;
1598 
1599 			if ((wacom_wac1->features.type == INTUOSHT ||
1600 			    wacom_wac1->features.type == INTUOSHT2) &&
1601 			    wacom_wac1->features.touch_max)
1602 				wacom_wac->shared->touch_input = wacom_wac2->touch_input;
1603 		}
1604 
1605 		error = wacom_initialize_battery(wacom);
1606 		if (error)
1607 			goto fail;
1608 	}
1609 
1610 	return;
1611 
1612 fail:
1613 	wacom_clean_inputs(wacom1);
1614 	wacom_clean_inputs(wacom2);
1615 	return;
1616 }
1617 
wacom_battery_work(struct work_struct * work)1618 void wacom_battery_work(struct work_struct *work)
1619 {
1620 	struct wacom *wacom = container_of(work, struct wacom, work);
1621 
1622 	if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
1623 	     !wacom->battery) {
1624 		wacom_initialize_battery(wacom);
1625 	}
1626 	else if (!(wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
1627 		 wacom->battery) {
1628 		wacom_destroy_battery(wacom);
1629 	}
1630 }
1631 
wacom_compute_pktlen(struct hid_device * hdev)1632 static size_t wacom_compute_pktlen(struct hid_device *hdev)
1633 {
1634 	struct hid_report_enum *report_enum;
1635 	struct hid_report *report;
1636 	size_t size = 0;
1637 
1638 	report_enum = hdev->report_enum + HID_INPUT_REPORT;
1639 
1640 	list_for_each_entry(report, &report_enum->report_list, list) {
1641 		size_t report_size = hid_report_len(report);
1642 		if (report_size > size)
1643 			size = report_size;
1644 	}
1645 
1646 	return size;
1647 }
1648 
wacom_update_name(struct wacom * wacom)1649 static void wacom_update_name(struct wacom *wacom)
1650 {
1651 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1652 	struct wacom_features *features = &wacom_wac->features;
1653 	char name[WACOM_NAME_MAX];
1654 
1655 	/* Generic devices name unspecified */
1656 	if ((features->type == HID_GENERIC) && !strcmp("Wacom HID", features->name)) {
1657 		if (strstr(wacom->hdev->name, "Wacom") ||
1658 		    strstr(wacom->hdev->name, "wacom") ||
1659 		    strstr(wacom->hdev->name, "WACOM")) {
1660 			/* name is in HID descriptor, use it */
1661 			strlcpy(name, wacom->hdev->name, sizeof(name));
1662 
1663 			/* strip out excess whitespaces */
1664 			while (1) {
1665 				char *gap = strstr(name, "  ");
1666 				if (gap == NULL)
1667 					break;
1668 				/* shift everything including the terminator */
1669 				memmove(gap, gap+1, strlen(gap));
1670 			}
1671 			/* get rid of trailing whitespace */
1672 			if (name[strlen(name)-1] == ' ')
1673 				name[strlen(name)-1] = '\0';
1674 		} else {
1675 			/* no meaningful name retrieved. use product ID */
1676 			snprintf(name, sizeof(name),
1677 				 "%s %X", features->name, wacom->hdev->product);
1678 		}
1679 	} else {
1680 		strlcpy(name, features->name, sizeof(name));
1681 	}
1682 
1683 	/* Append the device type to the name */
1684 	snprintf(wacom_wac->pen_name, sizeof(wacom_wac->pen_name),
1685 		"%s Pen", name);
1686 	snprintf(wacom_wac->touch_name, sizeof(wacom_wac->touch_name),
1687 		"%s Finger", name);
1688 	snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
1689 		"%s Pad", name);
1690 }
1691 
wacom_probe(struct hid_device * hdev,const struct hid_device_id * id)1692 static int wacom_probe(struct hid_device *hdev,
1693 		const struct hid_device_id *id)
1694 {
1695 	struct wacom *wacom;
1696 	struct wacom_wac *wacom_wac;
1697 	struct wacom_features *features;
1698 	int error;
1699 	unsigned int connect_mask = HID_CONNECT_HIDRAW;
1700 
1701 	if (!id->driver_data)
1702 		return -EINVAL;
1703 
1704 	hdev->quirks |= HID_QUIRK_NO_INIT_REPORTS;
1705 
1706 	/* hid-core sets this quirk for the boot interface */
1707 	hdev->quirks &= ~HID_QUIRK_NOGET;
1708 
1709 	wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
1710 	if (!wacom)
1711 		return -ENOMEM;
1712 
1713 	hid_set_drvdata(hdev, wacom);
1714 	wacom->hdev = hdev;
1715 
1716 	/* ask for the report descriptor to be loaded by HID */
1717 	error = hid_parse(hdev);
1718 	if (error) {
1719 		hid_err(hdev, "parse failed\n");
1720 		goto fail_parse;
1721 	}
1722 
1723 	wacom_wac = &wacom->wacom_wac;
1724 	wacom_wac->features = *((struct wacom_features *)id->driver_data);
1725 	features = &wacom_wac->features;
1726 	features->pktlen = wacom_compute_pktlen(hdev);
1727 	if (features->pktlen > WACOM_PKGLEN_MAX) {
1728 		error = -EINVAL;
1729 		goto fail_pktlen;
1730 	}
1731 
1732 	if (features->check_for_hid_type && features->hid_type != hdev->type) {
1733 		error = -ENODEV;
1734 		goto fail_type;
1735 	}
1736 
1737 	if (hid_is_usb(hdev)) {
1738 		struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
1739 		struct usb_device *dev = interface_to_usbdev(intf);
1740 
1741 		wacom->usbdev = dev;
1742 		wacom->intf = intf;
1743 	}
1744 
1745 	mutex_init(&wacom->lock);
1746 	INIT_WORK(&wacom->work, wacom_wireless_work);
1747 
1748 	error = wacom_allocate_inputs(wacom);
1749 	if (error)
1750 		goto fail_allocate_inputs;
1751 
1752 	/*
1753 	 * Bamboo Pad has a generic hid handling for the Pen, and we switch it
1754 	 * into debug mode for the touch part.
1755 	 * We ignore the other interfaces.
1756 	 */
1757 	if (features->type == BAMBOO_PAD) {
1758 		if (features->pktlen == WACOM_PKGLEN_PENABLED) {
1759 			features->type = HID_GENERIC;
1760 		} else if ((features->pktlen != WACOM_PKGLEN_BPAD_TOUCH) &&
1761 			   (features->pktlen != WACOM_PKGLEN_BPAD_TOUCH_USB)) {
1762 			error = -ENODEV;
1763 			goto fail_shared_data;
1764 		}
1765 	}
1766 
1767 	/* set the default size in case we do not get them from hid */
1768 	wacom_set_default_phy(features);
1769 
1770 	/* Retrieve the physical and logical size for touch devices */
1771 	wacom_retrieve_hid_descriptor(hdev, features);
1772 	wacom_setup_device_quirks(wacom);
1773 
1774 	if (features->device_type == WACOM_DEVICETYPE_NONE &&
1775 	    features->type != WIRELESS) {
1776 		error = features->type == HID_GENERIC ? -ENODEV : 0;
1777 
1778 		dev_warn(&hdev->dev, "Unknown device_type for '%s'. %s.",
1779 			 hdev->name,
1780 			 error ? "Ignoring" : "Assuming pen");
1781 
1782 		if (error)
1783 			goto fail_shared_data;
1784 
1785 		features->device_type |= WACOM_DEVICETYPE_PEN;
1786 	}
1787 
1788 	wacom_calculate_res(features);
1789 
1790 	wacom_update_name(wacom);
1791 
1792 	error = wacom_add_shared_data(hdev);
1793 	if (error)
1794 		goto fail_shared_data;
1795 
1796 	if (!(features->device_type & WACOM_DEVICETYPE_WL_MONITOR) &&
1797 	     (features->quirks & WACOM_QUIRK_BATTERY)) {
1798 		error = wacom_initialize_battery(wacom);
1799 		if (error)
1800 			goto fail_battery;
1801 	}
1802 
1803 	error = wacom_register_inputs(wacom);
1804 	if (error)
1805 		goto fail_register_inputs;
1806 
1807 	if (hdev->bus == BUS_BLUETOOTH) {
1808 		error = device_create_file(&hdev->dev, &dev_attr_speed);
1809 		if (error)
1810 			hid_warn(hdev,
1811 				 "can't create sysfs speed attribute err: %d\n",
1812 				 error);
1813 	}
1814 
1815 	if (features->type == HID_GENERIC)
1816 		connect_mask |= HID_CONNECT_DRIVER;
1817 
1818 	/* Regular HID work starts now */
1819 	error = hid_hw_start(hdev, connect_mask);
1820 	if (error) {
1821 		hid_err(hdev, "hw start failed\n");
1822 		goto fail_hw_start;
1823 	}
1824 
1825 	/* Note that if query fails it is not a hard failure */
1826 	wacom_query_tablet_data(hdev, features);
1827 
1828 	/* touch only Bamboo doesn't support pen */
1829 	if ((features->type == BAMBOO_TOUCH) &&
1830 	    (features->device_type & WACOM_DEVICETYPE_PEN)) {
1831 		error = -ENODEV;
1832 		goto fail_hw_start;
1833 	}
1834 
1835 	/* pen only Bamboo neither support touch nor pad */
1836 	if ((features->type == BAMBOO_PEN) &&
1837 	    ((features->device_type & WACOM_DEVICETYPE_TOUCH) ||
1838 	    (features->device_type & WACOM_DEVICETYPE_PAD))) {
1839 		error = -ENODEV;
1840 		goto fail_hw_start;
1841 	}
1842 
1843 	if (features->device_type & WACOM_DEVICETYPE_WL_MONITOR)
1844 		error = hid_hw_open(hdev);
1845 
1846 	if ((wacom_wac->features.type == INTUOSHT ||
1847 	    wacom_wac->features.type == INTUOSHT2) &&
1848 	    (wacom_wac->features.device_type & WACOM_DEVICETYPE_TOUCH)) {
1849 			wacom_wac->shared->touch_input = wacom_wac->touch_input;
1850 	}
1851 
1852 	return 0;
1853 
1854 fail_hw_start:
1855 	if (hdev->bus == BUS_BLUETOOTH)
1856 		device_remove_file(&hdev->dev, &dev_attr_speed);
1857 fail_register_inputs:
1858 	wacom_clean_inputs(wacom);
1859 	wacom_destroy_battery(wacom);
1860 fail_battery:
1861 	wacom_remove_shared_data(wacom);
1862 fail_shared_data:
1863 	wacom_clean_inputs(wacom);
1864 fail_allocate_inputs:
1865 fail_type:
1866 fail_pktlen:
1867 fail_parse:
1868 	kfree(wacom);
1869 	hid_set_drvdata(hdev, NULL);
1870 	return error;
1871 }
1872 
wacom_remove(struct hid_device * hdev)1873 static void wacom_remove(struct hid_device *hdev)
1874 {
1875 	struct wacom *wacom = hid_get_drvdata(hdev);
1876 
1877 	hid_hw_stop(hdev);
1878 
1879 	cancel_work_sync(&wacom->work);
1880 	wacom_clean_inputs(wacom);
1881 	if (hdev->bus == BUS_BLUETOOTH)
1882 		device_remove_file(&hdev->dev, &dev_attr_speed);
1883 	wacom_destroy_battery(wacom);
1884 	wacom_remove_shared_data(wacom);
1885 
1886 	hid_set_drvdata(hdev, NULL);
1887 	kfree(wacom);
1888 }
1889 
1890 #ifdef CONFIG_PM
wacom_resume(struct hid_device * hdev)1891 static int wacom_resume(struct hid_device *hdev)
1892 {
1893 	struct wacom *wacom = hid_get_drvdata(hdev);
1894 	struct wacom_features *features = &wacom->wacom_wac.features;
1895 
1896 	mutex_lock(&wacom->lock);
1897 
1898 	/* switch to wacom mode first */
1899 	wacom_query_tablet_data(hdev, features);
1900 	wacom_led_control(wacom);
1901 
1902 	mutex_unlock(&wacom->lock);
1903 
1904 	return 0;
1905 }
1906 
wacom_reset_resume(struct hid_device * hdev)1907 static int wacom_reset_resume(struct hid_device *hdev)
1908 {
1909 	return wacom_resume(hdev);
1910 }
1911 #endif /* CONFIG_PM */
1912 
1913 static struct hid_driver wacom_driver = {
1914 	.name =		"wacom",
1915 	.id_table =	wacom_ids,
1916 	.probe =	wacom_probe,
1917 	.remove =	wacom_remove,
1918 	.report =	wacom_wac_report,
1919 #ifdef CONFIG_PM
1920 	.resume =	wacom_resume,
1921 	.reset_resume =	wacom_reset_resume,
1922 #endif
1923 	.raw_event =	wacom_raw_event,
1924 };
1925 module_hid_driver(wacom_driver);
1926 
1927 MODULE_VERSION(DRIVER_VERSION);
1928 MODULE_AUTHOR(DRIVER_AUTHOR);
1929 MODULE_DESCRIPTION(DRIVER_DESC);
1930 MODULE_LICENSE(DRIVER_LICENSE);
1931