xref: /openbmc/linux/drivers/hid/wacom_sys.c (revision 6005a13c90a31501f3c21797b567e845c7098f25)
1471d1714SBenjamin Tissoires /*
2471d1714SBenjamin Tissoires  * drivers/input/tablet/wacom_sys.c
3471d1714SBenjamin Tissoires  *
4471d1714SBenjamin Tissoires  *  USB Wacom tablet support - system specific code
5471d1714SBenjamin Tissoires  */
6471d1714SBenjamin Tissoires 
7471d1714SBenjamin Tissoires /*
8471d1714SBenjamin Tissoires  * This program is free software; you can redistribute it and/or modify
9471d1714SBenjamin Tissoires  * it under the terms of the GNU General Public License as published by
10471d1714SBenjamin Tissoires  * the Free Software Foundation; either version 2 of the License, or
11471d1714SBenjamin Tissoires  * (at your option) any later version.
12471d1714SBenjamin Tissoires  */
13471d1714SBenjamin Tissoires 
14471d1714SBenjamin Tissoires #include "wacom_wac.h"
15471d1714SBenjamin Tissoires #include "wacom.h"
16b58ba1baSJason Gerecke #include <linux/input/mt.h>
17471d1714SBenjamin Tissoires 
18471d1714SBenjamin Tissoires #define WAC_MSG_RETRIES		5
19471d1714SBenjamin Tissoires 
20912ca216SPing Cheng #define WAC_CMD_WL_LED_CONTROL	0x03
21471d1714SBenjamin Tissoires #define WAC_CMD_LED_CONTROL	0x20
22471d1714SBenjamin Tissoires #define WAC_CMD_ICON_START	0x21
23471d1714SBenjamin Tissoires #define WAC_CMD_ICON_XFER	0x23
24849e2f06SBenjamin Tissoires #define WAC_CMD_ICON_BT_XFER	0x26
25471d1714SBenjamin Tissoires #define WAC_CMD_RETRIES		10
2672b236d6SAaron Skomra #define WAC_CMD_DELETE_PAIRING	0x20
2772b236d6SAaron Skomra #define WAC_CMD_UNPAIR_ALL	0xFF
28471d1714SBenjamin Tissoires 
29e0984bc3SPing Cheng #define DEV_ATTR_RW_PERM (S_IRUGO | S_IWUSR | S_IWGRP)
30e0984bc3SPing Cheng #define DEV_ATTR_WO_PERM (S_IWUSR | S_IWGRP)
3172b236d6SAaron Skomra #define DEV_ATTR_RO_PERM (S_IRUSR | S_IRGRP)
32e0984bc3SPing Cheng 
33c64d8834SPing Cheng static int wacom_get_report(struct hid_device *hdev, u8 type, u8 *buf,
34c64d8834SPing Cheng 			    size_t size, unsigned int retries)
35471d1714SBenjamin Tissoires {
36471d1714SBenjamin Tissoires 	int retval;
37471d1714SBenjamin Tissoires 
38471d1714SBenjamin Tissoires 	do {
39c64d8834SPing Cheng 		retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
40471d1714SBenjamin Tissoires 				HID_REQ_GET_REPORT);
41aef3156dSJason Gerecke 	} while ((retval == -ETIMEDOUT || retval == -EAGAIN) && --retries);
42aef3156dSJason Gerecke 
43aef3156dSJason Gerecke 	if (retval < 0)
44aef3156dSJason Gerecke 		hid_err(hdev, "wacom_get_report: ran out of retries "
45aef3156dSJason Gerecke 			"(last error = %d)\n", retval);
46471d1714SBenjamin Tissoires 
47471d1714SBenjamin Tissoires 	return retval;
48471d1714SBenjamin Tissoires }
49471d1714SBenjamin Tissoires 
50296b7378SPrzemo Firszt static int wacom_set_report(struct hid_device *hdev, u8 type, u8 *buf,
51296b7378SPrzemo Firszt 			    size_t size, unsigned int retries)
52471d1714SBenjamin Tissoires {
53471d1714SBenjamin Tissoires 	int retval;
54471d1714SBenjamin Tissoires 
55471d1714SBenjamin Tissoires 	do {
56296b7378SPrzemo Firszt 		retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
57471d1714SBenjamin Tissoires 				HID_REQ_SET_REPORT);
58aef3156dSJason Gerecke 	} while ((retval == -ETIMEDOUT || retval == -EAGAIN) && --retries);
59aef3156dSJason Gerecke 
60aef3156dSJason Gerecke 	if (retval < 0)
61aef3156dSJason Gerecke 		hid_err(hdev, "wacom_set_report: ran out of retries "
62aef3156dSJason Gerecke 			"(last error = %d)\n", retval);
63471d1714SBenjamin Tissoires 
64471d1714SBenjamin Tissoires 	return retval;
65471d1714SBenjamin Tissoires }
66471d1714SBenjamin Tissoires 
67471d1714SBenjamin Tissoires static int wacom_raw_event(struct hid_device *hdev, struct hid_report *report,
68471d1714SBenjamin Tissoires 		u8 *raw_data, int size)
69471d1714SBenjamin Tissoires {
70471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
71471d1714SBenjamin Tissoires 
72471d1714SBenjamin Tissoires 	if (size > WACOM_PKGLEN_MAX)
73471d1714SBenjamin Tissoires 		return 1;
74471d1714SBenjamin Tissoires 
75471d1714SBenjamin Tissoires 	memcpy(wacom->wacom_wac.data, raw_data, size);
76471d1714SBenjamin Tissoires 
77471d1714SBenjamin Tissoires 	wacom_wac_irq(&wacom->wacom_wac, size);
78471d1714SBenjamin Tissoires 
79471d1714SBenjamin Tissoires 	return 0;
80471d1714SBenjamin Tissoires }
81471d1714SBenjamin Tissoires 
82471d1714SBenjamin Tissoires static int wacom_open(struct input_dev *dev)
83471d1714SBenjamin Tissoires {
84471d1714SBenjamin Tissoires 	struct wacom *wacom = input_get_drvdata(dev);
85471d1714SBenjamin Tissoires 
86dff67416SBenjamin Tissoires 	return hid_hw_open(wacom->hdev);
87471d1714SBenjamin Tissoires }
88471d1714SBenjamin Tissoires 
89471d1714SBenjamin Tissoires static void wacom_close(struct input_dev *dev)
90471d1714SBenjamin Tissoires {
91471d1714SBenjamin Tissoires 	struct wacom *wacom = input_get_drvdata(dev);
92471d1714SBenjamin Tissoires 
933dad188eSBenjamin Tissoires 	/*
943dad188eSBenjamin Tissoires 	 * wacom->hdev should never be null, but surprisingly, I had the case
953dad188eSBenjamin Tissoires 	 * once while unplugging the Wacom Wireless Receiver.
963dad188eSBenjamin Tissoires 	 */
973dad188eSBenjamin Tissoires 	if (wacom->hdev)
98471d1714SBenjamin Tissoires 		hid_hw_close(wacom->hdev);
99471d1714SBenjamin Tissoires }
100471d1714SBenjamin Tissoires 
101471d1714SBenjamin Tissoires /*
102471d1714SBenjamin Tissoires  * Calculate the resolution of the X or Y axis using hidinput_calc_abs_res.
103471d1714SBenjamin Tissoires  */
104471d1714SBenjamin Tissoires static int wacom_calc_hid_res(int logical_extents, int physical_extents,
105471d1714SBenjamin Tissoires 			       unsigned unit, int exponent)
106471d1714SBenjamin Tissoires {
107471d1714SBenjamin Tissoires 	struct hid_field field = {
108471d1714SBenjamin Tissoires 		.logical_maximum = logical_extents,
109471d1714SBenjamin Tissoires 		.physical_maximum = physical_extents,
110471d1714SBenjamin Tissoires 		.unit = unit,
111471d1714SBenjamin Tissoires 		.unit_exponent = exponent,
112471d1714SBenjamin Tissoires 	};
113471d1714SBenjamin Tissoires 
114471d1714SBenjamin Tissoires 	return hidinput_calc_abs_res(&field, ABS_X);
115471d1714SBenjamin Tissoires }
116471d1714SBenjamin Tissoires 
117471d1714SBenjamin Tissoires static void wacom_feature_mapping(struct hid_device *hdev,
118471d1714SBenjamin Tissoires 		struct hid_field *field, struct hid_usage *usage)
119471d1714SBenjamin Tissoires {
120471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
121471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
1225ae6e89fSBenjamin Tissoires 	struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
1238ffffd52SBenjamin Tissoires 	u8 *data;
1248ffffd52SBenjamin Tissoires 	int ret;
125471d1714SBenjamin Tissoires 
126471d1714SBenjamin Tissoires 	switch (usage->hid) {
127471d1714SBenjamin Tissoires 	case HID_DG_CONTACTMAX:
128471d1714SBenjamin Tissoires 		/* leave touch_max as is if predefined */
1298ffffd52SBenjamin Tissoires 		if (!features->touch_max) {
1308ffffd52SBenjamin Tissoires 			/* read manually */
1318ffffd52SBenjamin Tissoires 			data = kzalloc(2, GFP_KERNEL);
1328ffffd52SBenjamin Tissoires 			if (!data)
1338ffffd52SBenjamin Tissoires 				break;
1348ffffd52SBenjamin Tissoires 			data[0] = field->report->id;
1358ffffd52SBenjamin Tissoires 			ret = wacom_get_report(hdev, HID_FEATURE_REPORT,
13605e8fd92SJason Gerecke 						data, 2, WAC_CMD_RETRIES);
13705e8fd92SJason Gerecke 			if (ret == 2) {
1388ffffd52SBenjamin Tissoires 				features->touch_max = data[1];
13905e8fd92SJason Gerecke 			} else {
14005e8fd92SJason Gerecke 				features->touch_max = 16;
14105e8fd92SJason Gerecke 				hid_warn(hdev, "wacom_feature_mapping: "
14205e8fd92SJason Gerecke 					 "could not get HID_DG_CONTACTMAX, "
14305e8fd92SJason Gerecke 					 "defaulting to %d\n",
14405e8fd92SJason Gerecke 					  features->touch_max);
14505e8fd92SJason Gerecke 			}
1468ffffd52SBenjamin Tissoires 			kfree(data);
1478ffffd52SBenjamin Tissoires 		}
148471d1714SBenjamin Tissoires 		break;
1495ae6e89fSBenjamin Tissoires 	case HID_DG_INPUTMODE:
1505ae6e89fSBenjamin Tissoires 		/* Ignore if value index is out of bounds. */
1515ae6e89fSBenjamin Tissoires 		if (usage->usage_index >= field->report_count) {
1525ae6e89fSBenjamin Tissoires 			dev_err(&hdev->dev, "HID_DG_INPUTMODE out of range\n");
1535ae6e89fSBenjamin Tissoires 			break;
1545ae6e89fSBenjamin Tissoires 		}
1555ae6e89fSBenjamin Tissoires 
1565ae6e89fSBenjamin Tissoires 		hid_data->inputmode = field->report->id;
1575ae6e89fSBenjamin Tissoires 		hid_data->inputmode_index = usage->usage_index;
1585ae6e89fSBenjamin Tissoires 		break;
159326ea2a9SJason Gerecke 
160326ea2a9SJason Gerecke 	case HID_UP_DIGITIZER:
161326ea2a9SJason Gerecke 		if (field->report->id == 0x0B &&
1628de82280SJason Gerecke 		    (field->application == WACOM_HID_G9_PEN ||
1638de82280SJason Gerecke 		     field->application == WACOM_HID_G11_PEN)) {
164326ea2a9SJason Gerecke 			wacom->wacom_wac.mode_report = field->report->id;
165326ea2a9SJason Gerecke 			wacom->wacom_wac.mode_value = 0;
166326ea2a9SJason Gerecke 		}
167326ea2a9SJason Gerecke 		break;
168326ea2a9SJason Gerecke 
1698de82280SJason Gerecke 	case WACOM_HID_UP_G9:
1708de82280SJason Gerecke 	case WACOM_HID_UP_G11:
171326ea2a9SJason Gerecke 		if (field->report->id == 0x03 &&
1728de82280SJason Gerecke 		    (field->application == WACOM_HID_G9_TOUCHSCREEN ||
1738de82280SJason Gerecke 		     field->application == WACOM_HID_G11_TOUCHSCREEN)) {
174326ea2a9SJason Gerecke 			wacom->wacom_wac.mode_report = field->report->id;
175326ea2a9SJason Gerecke 			wacom->wacom_wac.mode_value = 0;
176326ea2a9SJason Gerecke 		}
177326ea2a9SJason Gerecke 		break;
178471d1714SBenjamin Tissoires 	}
179471d1714SBenjamin Tissoires }
180471d1714SBenjamin Tissoires 
181471d1714SBenjamin Tissoires /*
182471d1714SBenjamin Tissoires  * Interface Descriptor of wacom devices can be incomplete and
183471d1714SBenjamin Tissoires  * inconsistent so wacom_features table is used to store stylus
184471d1714SBenjamin Tissoires  * device's packet lengths, various maximum values, and tablet
185471d1714SBenjamin Tissoires  * resolution based on product ID's.
186471d1714SBenjamin Tissoires  *
187471d1714SBenjamin Tissoires  * For devices that contain 2 interfaces, wacom_features table is
188471d1714SBenjamin Tissoires  * inaccurate for the touch interface.  Since the Interface Descriptor
189471d1714SBenjamin Tissoires  * for touch interfaces has pretty complete data, this function exists
190471d1714SBenjamin Tissoires  * to query tablet for this missing information instead of hard coding in
191471d1714SBenjamin Tissoires  * an additional table.
192471d1714SBenjamin Tissoires  *
193471d1714SBenjamin Tissoires  * A typical Interface Descriptor for a stylus will contain a
194471d1714SBenjamin Tissoires  * boot mouse application collection that is not of interest and this
195471d1714SBenjamin Tissoires  * function will ignore it.
196471d1714SBenjamin Tissoires  *
197471d1714SBenjamin Tissoires  * It also contains a digitizer application collection that also is not
198471d1714SBenjamin Tissoires  * of interest since any information it contains would be duplicate
199471d1714SBenjamin Tissoires  * of what is in wacom_features. Usually it defines a report of an array
200471d1714SBenjamin Tissoires  * of bytes that could be used as max length of the stylus packet returned.
201471d1714SBenjamin Tissoires  * If it happens to define a Digitizer-Stylus Physical Collection then
202471d1714SBenjamin Tissoires  * the X and Y logical values contain valid data but it is ignored.
203471d1714SBenjamin Tissoires  *
204471d1714SBenjamin Tissoires  * A typical Interface Descriptor for a touch interface will contain a
205471d1714SBenjamin Tissoires  * Digitizer-Finger Physical Collection which will define both logical
206471d1714SBenjamin Tissoires  * X/Y maximum as well as the physical size of tablet. Since touch
207471d1714SBenjamin Tissoires  * interfaces haven't supported pressure or distance, this is enough
208471d1714SBenjamin Tissoires  * information to override invalid values in the wacom_features table.
209471d1714SBenjamin Tissoires  *
210471d1714SBenjamin Tissoires  * Intuos5 touch interface and 3rd gen Bamboo Touch do not contain useful
211471d1714SBenjamin Tissoires  * data. We deal with them after returning from this function.
212471d1714SBenjamin Tissoires  */
213471d1714SBenjamin Tissoires static void wacom_usage_mapping(struct hid_device *hdev,
214471d1714SBenjamin Tissoires 		struct hid_field *field, struct hid_usage *usage)
215471d1714SBenjamin Tissoires {
216471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
217471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
218d97a5522SBenjamin Tissoires 	bool finger = WACOM_FINGER_FIELD(field);
219d97a5522SBenjamin Tissoires 	bool pen = WACOM_PEN_FIELD(field);
220471d1714SBenjamin Tissoires 
221471d1714SBenjamin Tissoires 	/*
222471d1714SBenjamin Tissoires 	* Requiring Stylus Usage will ignore boot mouse
223471d1714SBenjamin Tissoires 	* X/Y values and some cases of invalid Digitizer X/Y
224471d1714SBenjamin Tissoires 	* values commonly reported.
225471d1714SBenjamin Tissoires 	*/
226042628abSJason Gerecke 	if (pen)
227aa86b18cSJason Gerecke 		features->device_type |= WACOM_DEVICETYPE_PEN;
228042628abSJason Gerecke 	else if (finger)
229aa86b18cSJason Gerecke 		features->device_type |= WACOM_DEVICETYPE_TOUCH;
230042628abSJason Gerecke 	else
231471d1714SBenjamin Tissoires 		return;
232471d1714SBenjamin Tissoires 
23330ebc1aeSPing Cheng 	/*
23430ebc1aeSPing Cheng 	 * Bamboo models do not support HID_DG_CONTACTMAX.
23530ebc1aeSPing Cheng 	 * And, Bamboo Pen only descriptor contains touch.
23630ebc1aeSPing Cheng 	 */
2373b164a00SPing Cheng 	if (features->type > BAMBOO_PT) {
23830ebc1aeSPing Cheng 		/* ISDv4 touch devices at least supports one touch point */
239471d1714SBenjamin Tissoires 		if (finger && !features->touch_max)
240471d1714SBenjamin Tissoires 			features->touch_max = 1;
24130ebc1aeSPing Cheng 	}
242471d1714SBenjamin Tissoires 
243*6005a13cSJason Gerecke 	/*
244*6005a13cSJason Gerecke 	 * ISDv4 devices which predate HID's adoption of the
245*6005a13cSJason Gerecke 	 * HID_DG_BARELSWITCH2 usage use 0x000D0000 in its
246*6005a13cSJason Gerecke 	 * position instead. We can accurately detect if a
247*6005a13cSJason Gerecke 	 * usage with that value should be HID_DG_BARRELSWITCH2
248*6005a13cSJason Gerecke 	 * based on the surrounding usages, which have remained
249*6005a13cSJason Gerecke 	 * constant across generations.
250*6005a13cSJason Gerecke 	 */
251*6005a13cSJason Gerecke 	if (features->type == HID_GENERIC &&
252*6005a13cSJason Gerecke 	    usage->hid == 0x000D0000 &&
253*6005a13cSJason Gerecke 	    field->application == HID_DG_PEN &&
254*6005a13cSJason Gerecke 	    field->physical == HID_DG_STYLUS) {
255*6005a13cSJason Gerecke 		int i = usage->usage_index;
256*6005a13cSJason Gerecke 
257*6005a13cSJason Gerecke 		if (i-4 >= 0 && i+1 < field->maxusage &&
258*6005a13cSJason Gerecke 		    field->usage[i-4].hid == HID_DG_TIPSWITCH &&
259*6005a13cSJason Gerecke 		    field->usage[i-3].hid == HID_DG_BARRELSWITCH &&
260*6005a13cSJason Gerecke 		    field->usage[i-2].hid == HID_DG_ERASER &&
261*6005a13cSJason Gerecke 		    field->usage[i-1].hid == HID_DG_INVERT &&
262*6005a13cSJason Gerecke 		    field->usage[i+1].hid == HID_DG_INRANGE) {
263*6005a13cSJason Gerecke 			usage->hid = HID_DG_BARRELSWITCH2;
264*6005a13cSJason Gerecke 		}
265*6005a13cSJason Gerecke 	}
266*6005a13cSJason Gerecke 
267471d1714SBenjamin Tissoires 	switch (usage->hid) {
268471d1714SBenjamin Tissoires 	case HID_GD_X:
269471d1714SBenjamin Tissoires 		features->x_max = field->logical_maximum;
270471d1714SBenjamin Tissoires 		if (finger) {
271471d1714SBenjamin Tissoires 			features->x_phy = field->physical_maximum;
2723b164a00SPing Cheng 			if ((features->type != BAMBOO_PT) &&
2733b164a00SPing Cheng 			    (features->type != BAMBOO_TOUCH)) {
274471d1714SBenjamin Tissoires 				features->unit = field->unit;
275471d1714SBenjamin Tissoires 				features->unitExpo = field->unit_exponent;
276471d1714SBenjamin Tissoires 			}
277471d1714SBenjamin Tissoires 		}
278471d1714SBenjamin Tissoires 		break;
279471d1714SBenjamin Tissoires 	case HID_GD_Y:
280471d1714SBenjamin Tissoires 		features->y_max = field->logical_maximum;
281471d1714SBenjamin Tissoires 		if (finger) {
282471d1714SBenjamin Tissoires 			features->y_phy = field->physical_maximum;
2833b164a00SPing Cheng 			if ((features->type != BAMBOO_PT) &&
2843b164a00SPing Cheng 			    (features->type != BAMBOO_TOUCH)) {
285471d1714SBenjamin Tissoires 				features->unit = field->unit;
286471d1714SBenjamin Tissoires 				features->unitExpo = field->unit_exponent;
287471d1714SBenjamin Tissoires 			}
288471d1714SBenjamin Tissoires 		}
289471d1714SBenjamin Tissoires 		break;
290471d1714SBenjamin Tissoires 	case HID_DG_TIPPRESSURE:
291471d1714SBenjamin Tissoires 		if (pen)
292471d1714SBenjamin Tissoires 			features->pressure_max = field->logical_maximum;
293471d1714SBenjamin Tissoires 		break;
294471d1714SBenjamin Tissoires 	}
2957704ac93SBenjamin Tissoires 
2967704ac93SBenjamin Tissoires 	if (features->type == HID_GENERIC)
2977704ac93SBenjamin Tissoires 		wacom_wac_usage_mapping(hdev, field, usage);
298471d1714SBenjamin Tissoires }
299471d1714SBenjamin Tissoires 
300b58ba1baSJason Gerecke static void wacom_post_parse_hid(struct hid_device *hdev,
301b58ba1baSJason Gerecke 				 struct wacom_features *features)
302b58ba1baSJason Gerecke {
303b58ba1baSJason Gerecke 	struct wacom *wacom = hid_get_drvdata(hdev);
304b58ba1baSJason Gerecke 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
305b58ba1baSJason Gerecke 
306b58ba1baSJason Gerecke 	if (features->type == HID_GENERIC) {
307b58ba1baSJason Gerecke 		/* Any last-minute generic device setup */
308b58ba1baSJason Gerecke 		if (features->touch_max > 1) {
3092a6cdbddSJason Gerecke 			input_mt_init_slots(wacom_wac->touch_input, wacom_wac->features.touch_max,
310b58ba1baSJason Gerecke 				    INPUT_MT_DIRECT);
311b58ba1baSJason Gerecke 		}
312b58ba1baSJason Gerecke 	}
313b58ba1baSJason Gerecke }
314b58ba1baSJason Gerecke 
315471d1714SBenjamin Tissoires static void wacom_parse_hid(struct hid_device *hdev,
316471d1714SBenjamin Tissoires 			   struct wacom_features *features)
317471d1714SBenjamin Tissoires {
318471d1714SBenjamin Tissoires 	struct hid_report_enum *rep_enum;
319471d1714SBenjamin Tissoires 	struct hid_report *hreport;
320471d1714SBenjamin Tissoires 	int i, j;
321471d1714SBenjamin Tissoires 
322471d1714SBenjamin Tissoires 	/* check features first */
323471d1714SBenjamin Tissoires 	rep_enum = &hdev->report_enum[HID_FEATURE_REPORT];
324471d1714SBenjamin Tissoires 	list_for_each_entry(hreport, &rep_enum->report_list, list) {
325471d1714SBenjamin Tissoires 		for (i = 0; i < hreport->maxfield; i++) {
326471d1714SBenjamin Tissoires 			/* Ignore if report count is out of bounds. */
327471d1714SBenjamin Tissoires 			if (hreport->field[i]->report_count < 1)
328471d1714SBenjamin Tissoires 				continue;
329471d1714SBenjamin Tissoires 
330471d1714SBenjamin Tissoires 			for (j = 0; j < hreport->field[i]->maxusage; j++) {
331471d1714SBenjamin Tissoires 				wacom_feature_mapping(hdev, hreport->field[i],
332471d1714SBenjamin Tissoires 						hreport->field[i]->usage + j);
333471d1714SBenjamin Tissoires 			}
334471d1714SBenjamin Tissoires 		}
335471d1714SBenjamin Tissoires 	}
336471d1714SBenjamin Tissoires 
337471d1714SBenjamin Tissoires 	/* now check the input usages */
338471d1714SBenjamin Tissoires 	rep_enum = &hdev->report_enum[HID_INPUT_REPORT];
339471d1714SBenjamin Tissoires 	list_for_each_entry(hreport, &rep_enum->report_list, list) {
340471d1714SBenjamin Tissoires 
341471d1714SBenjamin Tissoires 		if (!hreport->maxfield)
342471d1714SBenjamin Tissoires 			continue;
343471d1714SBenjamin Tissoires 
344471d1714SBenjamin Tissoires 		for (i = 0; i < hreport->maxfield; i++)
345471d1714SBenjamin Tissoires 			for (j = 0; j < hreport->field[i]->maxusage; j++)
346471d1714SBenjamin Tissoires 				wacom_usage_mapping(hdev, hreport->field[i],
347471d1714SBenjamin Tissoires 						hreport->field[i]->usage + j);
348471d1714SBenjamin Tissoires 	}
349b58ba1baSJason Gerecke 
350b58ba1baSJason Gerecke 	wacom_post_parse_hid(hdev, features);
351471d1714SBenjamin Tissoires }
352471d1714SBenjamin Tissoires 
3535ae6e89fSBenjamin Tissoires static int wacom_hid_set_device_mode(struct hid_device *hdev)
3545ae6e89fSBenjamin Tissoires {
3555ae6e89fSBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
3565ae6e89fSBenjamin Tissoires 	struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
3575ae6e89fSBenjamin Tissoires 	struct hid_report *r;
3585ae6e89fSBenjamin Tissoires 	struct hid_report_enum *re;
3595ae6e89fSBenjamin Tissoires 
3605ae6e89fSBenjamin Tissoires 	if (hid_data->inputmode < 0)
3615ae6e89fSBenjamin Tissoires 		return 0;
3625ae6e89fSBenjamin Tissoires 
3635ae6e89fSBenjamin Tissoires 	re = &(hdev->report_enum[HID_FEATURE_REPORT]);
3645ae6e89fSBenjamin Tissoires 	r = re->report_id_hash[hid_data->inputmode];
3655ae6e89fSBenjamin Tissoires 	if (r) {
3665ae6e89fSBenjamin Tissoires 		r->field[0]->value[hid_data->inputmode_index] = 2;
3675ae6e89fSBenjamin Tissoires 		hid_hw_request(hdev, r, HID_REQ_SET_REPORT);
3685ae6e89fSBenjamin Tissoires 	}
3695ae6e89fSBenjamin Tissoires 	return 0;
3705ae6e89fSBenjamin Tissoires }
3715ae6e89fSBenjamin Tissoires 
372326ea2a9SJason Gerecke static int wacom_set_device_mode(struct hid_device *hdev,
373326ea2a9SJason Gerecke 				 struct wacom_wac *wacom_wac)
374471d1714SBenjamin Tissoires {
375326ea2a9SJason Gerecke 	u8 *rep_data;
376326ea2a9SJason Gerecke 	struct hid_report *r;
377326ea2a9SJason Gerecke 	struct hid_report_enum *re;
378326ea2a9SJason Gerecke 	int length;
379471d1714SBenjamin Tissoires 	int error = -ENOMEM, limit = 0;
380471d1714SBenjamin Tissoires 
381326ea2a9SJason Gerecke 	if (wacom_wac->mode_report < 0)
382326ea2a9SJason Gerecke 		return 0;
383326ea2a9SJason Gerecke 
384326ea2a9SJason Gerecke 	re = &(hdev->report_enum[HID_FEATURE_REPORT]);
385326ea2a9SJason Gerecke 	r = re->report_id_hash[wacom_wac->mode_report];
386326ea2a9SJason Gerecke 	if (!r)
387326ea2a9SJason Gerecke 		return -EINVAL;
388326ea2a9SJason Gerecke 
389326ea2a9SJason Gerecke 	rep_data = hid_alloc_report_buf(r, GFP_KERNEL);
390471d1714SBenjamin Tissoires 	if (!rep_data)
391326ea2a9SJason Gerecke 		return -ENOMEM;
392326ea2a9SJason Gerecke 
393326ea2a9SJason Gerecke 	length = hid_report_len(r);
394471d1714SBenjamin Tissoires 
395471d1714SBenjamin Tissoires 	do {
396326ea2a9SJason Gerecke 		rep_data[0] = wacom_wac->mode_report;
397326ea2a9SJason Gerecke 		rep_data[1] = wacom_wac->mode_value;
398471d1714SBenjamin Tissoires 
399296b7378SPrzemo Firszt 		error = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data,
400296b7378SPrzemo Firszt 					 length, 1);
401471d1714SBenjamin Tissoires 		if (error >= 0)
402471d1714SBenjamin Tissoires 			error = wacom_get_report(hdev, HID_FEATURE_REPORT,
403c64d8834SPing Cheng 			                         rep_data, length, 1);
404326ea2a9SJason Gerecke 	} while (error >= 0 &&
405326ea2a9SJason Gerecke 		 rep_data[1] != wacom_wac->mode_report &&
406326ea2a9SJason Gerecke 		 limit++ < WAC_MSG_RETRIES);
407471d1714SBenjamin Tissoires 
408471d1714SBenjamin Tissoires 	kfree(rep_data);
409471d1714SBenjamin Tissoires 
410471d1714SBenjamin Tissoires 	return error < 0 ? error : 0;
411471d1714SBenjamin Tissoires }
412471d1714SBenjamin Tissoires 
413f81a1295SBenjamin Tissoires static int wacom_bt_query_tablet_data(struct hid_device *hdev, u8 speed,
414f81a1295SBenjamin Tissoires 		struct wacom_features *features)
415f81a1295SBenjamin Tissoires {
416387142bbSBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
417387142bbSBenjamin Tissoires 	int ret;
418387142bbSBenjamin Tissoires 	u8 rep_data[2];
419387142bbSBenjamin Tissoires 
420387142bbSBenjamin Tissoires 	switch (features->type) {
421387142bbSBenjamin Tissoires 	case GRAPHIRE_BT:
422387142bbSBenjamin Tissoires 		rep_data[0] = 0x03;
423387142bbSBenjamin Tissoires 		rep_data[1] = 0x00;
424296b7378SPrzemo Firszt 		ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
425296b7378SPrzemo Firszt 					3);
426387142bbSBenjamin Tissoires 
427387142bbSBenjamin Tissoires 		if (ret >= 0) {
428387142bbSBenjamin Tissoires 			rep_data[0] = speed == 0 ? 0x05 : 0x06;
429387142bbSBenjamin Tissoires 			rep_data[1] = 0x00;
430387142bbSBenjamin Tissoires 
431387142bbSBenjamin Tissoires 			ret = wacom_set_report(hdev, HID_FEATURE_REPORT,
432296b7378SPrzemo Firszt 						rep_data, 2, 3);
433387142bbSBenjamin Tissoires 
434387142bbSBenjamin Tissoires 			if (ret >= 0) {
435387142bbSBenjamin Tissoires 				wacom->wacom_wac.bt_high_speed = speed;
436387142bbSBenjamin Tissoires 				return 0;
437387142bbSBenjamin Tissoires 			}
438387142bbSBenjamin Tissoires 		}
439387142bbSBenjamin Tissoires 
440387142bbSBenjamin Tissoires 		/*
441387142bbSBenjamin Tissoires 		 * Note that if the raw queries fail, it's not a hard failure
442387142bbSBenjamin Tissoires 		 * and it is safe to continue
443387142bbSBenjamin Tissoires 		 */
444387142bbSBenjamin Tissoires 		hid_warn(hdev, "failed to poke device, command %d, err %d\n",
445387142bbSBenjamin Tissoires 			 rep_data[0], ret);
446387142bbSBenjamin Tissoires 		break;
44781af7e61SBenjamin Tissoires 	case INTUOS4WL:
44881af7e61SBenjamin Tissoires 		if (speed == 1)
44981af7e61SBenjamin Tissoires 			wacom->wacom_wac.bt_features &= ~0x20;
45081af7e61SBenjamin Tissoires 		else
45181af7e61SBenjamin Tissoires 			wacom->wacom_wac.bt_features |= 0x20;
45281af7e61SBenjamin Tissoires 
45381af7e61SBenjamin Tissoires 		rep_data[0] = 0x03;
45481af7e61SBenjamin Tissoires 		rep_data[1] = wacom->wacom_wac.bt_features;
45581af7e61SBenjamin Tissoires 
456296b7378SPrzemo Firszt 		ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
457296b7378SPrzemo Firszt 					1);
45881af7e61SBenjamin Tissoires 		if (ret >= 0)
45981af7e61SBenjamin Tissoires 			wacom->wacom_wac.bt_high_speed = speed;
46081af7e61SBenjamin Tissoires 		break;
461387142bbSBenjamin Tissoires 	}
462387142bbSBenjamin Tissoires 
463f81a1295SBenjamin Tissoires 	return 0;
464f81a1295SBenjamin Tissoires }
465f81a1295SBenjamin Tissoires 
466471d1714SBenjamin Tissoires /*
467471d1714SBenjamin Tissoires  * Switch the tablet into its most-capable mode. Wacom tablets are
468471d1714SBenjamin Tissoires  * typically configured to power-up in a mode which sends mouse-like
469471d1714SBenjamin Tissoires  * reports to the OS. To get absolute position, pressure data, etc.
470471d1714SBenjamin Tissoires  * from the tablet, it is necessary to switch the tablet out of this
471471d1714SBenjamin Tissoires  * mode and into one which sends the full range of tablet data.
472471d1714SBenjamin Tissoires  */
473471d1714SBenjamin Tissoires static int wacom_query_tablet_data(struct hid_device *hdev,
474471d1714SBenjamin Tissoires 		struct wacom_features *features)
475471d1714SBenjamin Tissoires {
476326ea2a9SJason Gerecke 	struct wacom *wacom = hid_get_drvdata(hdev);
477326ea2a9SJason Gerecke 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
478326ea2a9SJason Gerecke 
479f81a1295SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH)
480f81a1295SBenjamin Tissoires 		return wacom_bt_query_tablet_data(hdev, 1, features);
481f81a1295SBenjamin Tissoires 
482326ea2a9SJason Gerecke 	if (features->type != HID_GENERIC) {
483aa86b18cSJason Gerecke 		if (features->device_type & WACOM_DEVICETYPE_TOUCH) {
484471d1714SBenjamin Tissoires 			if (features->type > TABLETPC) {
485471d1714SBenjamin Tissoires 				/* MT Tablet PC touch */
486326ea2a9SJason Gerecke 				wacom_wac->mode_report = 3;
487326ea2a9SJason Gerecke 				wacom_wac->mode_value = 4;
488326ea2a9SJason Gerecke 			} else if (features->type == WACOM_24HDT) {
489326ea2a9SJason Gerecke 				wacom_wac->mode_report = 18;
490326ea2a9SJason Gerecke 				wacom_wac->mode_value = 2;
491326ea2a9SJason Gerecke 			} else if (features->type == WACOM_27QHDT) {
492326ea2a9SJason Gerecke 				wacom_wac->mode_report = 131;
493326ea2a9SJason Gerecke 				wacom_wac->mode_value = 2;
494326ea2a9SJason Gerecke 			} else if (features->type == BAMBOO_PAD) {
495326ea2a9SJason Gerecke 				wacom_wac->mode_report = 2;
496326ea2a9SJason Gerecke 				wacom_wac->mode_value = 2;
4978c97a765SBenjamin Tissoires 			}
498aa86b18cSJason Gerecke 		} else if (features->device_type & WACOM_DEVICETYPE_PEN) {
4997adb91bdSPing Cheng 			if (features->type <= BAMBOO_PT) {
500326ea2a9SJason Gerecke 				wacom_wac->mode_report = 2;
501326ea2a9SJason Gerecke 				wacom_wac->mode_value = 2;
502471d1714SBenjamin Tissoires 			}
503471d1714SBenjamin Tissoires 		}
504326ea2a9SJason Gerecke 	}
505326ea2a9SJason Gerecke 
506326ea2a9SJason Gerecke 	wacom_set_device_mode(hdev, wacom_wac);
507326ea2a9SJason Gerecke 
508326ea2a9SJason Gerecke 	if (features->type == HID_GENERIC)
509326ea2a9SJason Gerecke 		return wacom_hid_set_device_mode(hdev);
510471d1714SBenjamin Tissoires 
511471d1714SBenjamin Tissoires 	return 0;
512471d1714SBenjamin Tissoires }
513471d1714SBenjamin Tissoires 
514471d1714SBenjamin Tissoires static void wacom_retrieve_hid_descriptor(struct hid_device *hdev,
515471d1714SBenjamin Tissoires 					 struct wacom_features *features)
516471d1714SBenjamin Tissoires {
517471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
518471d1714SBenjamin Tissoires 	struct usb_interface *intf = wacom->intf;
519471d1714SBenjamin Tissoires 
520471d1714SBenjamin Tissoires 	/* default features */
521471d1714SBenjamin Tissoires 	features->x_fuzz = 4;
522471d1714SBenjamin Tissoires 	features->y_fuzz = 4;
523471d1714SBenjamin Tissoires 	features->pressure_fuzz = 0;
524bef7e200SJason Gerecke 	features->distance_fuzz = 1;
525bef7e200SJason Gerecke 	features->tilt_fuzz = 1;
526471d1714SBenjamin Tissoires 
527471d1714SBenjamin Tissoires 	/*
528471d1714SBenjamin Tissoires 	 * The wireless device HID is basic and layout conflicts with
529471d1714SBenjamin Tissoires 	 * other tablets (monitor and touch interface can look like pen).
530471d1714SBenjamin Tissoires 	 * Skip the query for this type and modify defaults based on
531471d1714SBenjamin Tissoires 	 * interface number.
532471d1714SBenjamin Tissoires 	 */
533471d1714SBenjamin Tissoires 	if (features->type == WIRELESS) {
5343f14a63aSJason Gerecke 		if (intf->cur_altsetting->desc.bInterfaceNumber == 0)
535ccad85ccSJason Gerecke 			features->device_type = WACOM_DEVICETYPE_WL_MONITOR;
5363f14a63aSJason Gerecke 		else
537aa86b18cSJason Gerecke 			features->device_type = WACOM_DEVICETYPE_NONE;
5383f14a63aSJason Gerecke 		return;
539471d1714SBenjamin Tissoires 	}
540471d1714SBenjamin Tissoires 
541471d1714SBenjamin Tissoires 	wacom_parse_hid(hdev, features);
542471d1714SBenjamin Tissoires }
543471d1714SBenjamin Tissoires 
544471d1714SBenjamin Tissoires struct wacom_hdev_data {
545471d1714SBenjamin Tissoires 	struct list_head list;
546471d1714SBenjamin Tissoires 	struct kref kref;
547471d1714SBenjamin Tissoires 	struct hid_device *dev;
548471d1714SBenjamin Tissoires 	struct wacom_shared shared;
549471d1714SBenjamin Tissoires };
550471d1714SBenjamin Tissoires 
551471d1714SBenjamin Tissoires static LIST_HEAD(wacom_udev_list);
552471d1714SBenjamin Tissoires static DEFINE_MUTEX(wacom_udev_list_lock);
553471d1714SBenjamin Tissoires 
55441372d5dSJason Gerecke static bool compare_device_paths(struct hid_device *hdev_a,
55541372d5dSJason Gerecke 		struct hid_device *hdev_b, char separator)
55641372d5dSJason Gerecke {
55741372d5dSJason Gerecke 	int n1 = strrchr(hdev_a->phys, separator) - hdev_a->phys;
55841372d5dSJason Gerecke 	int n2 = strrchr(hdev_b->phys, separator) - hdev_b->phys;
55941372d5dSJason Gerecke 
56041372d5dSJason Gerecke 	if (n1 != n2 || n1 <= 0 || n2 <= 0)
56141372d5dSJason Gerecke 		return false;
56241372d5dSJason Gerecke 
56341372d5dSJason Gerecke 	return !strncmp(hdev_a->phys, hdev_b->phys, n1);
56441372d5dSJason Gerecke }
56541372d5dSJason Gerecke 
566471d1714SBenjamin Tissoires static bool wacom_are_sibling(struct hid_device *hdev,
567471d1714SBenjamin Tissoires 		struct hid_device *sibling)
568471d1714SBenjamin Tissoires {
569471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
570471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
57141372d5dSJason Gerecke 	struct wacom *sibling_wacom = hid_get_drvdata(sibling);
57241372d5dSJason Gerecke 	struct wacom_features *sibling_features = &sibling_wacom->wacom_wac.features;
57341372d5dSJason Gerecke 	__u32 oVid = features->oVid ? features->oVid : hdev->vendor;
57441372d5dSJason Gerecke 	__u32 oPid = features->oPid ? features->oPid : hdev->product;
575471d1714SBenjamin Tissoires 
57641372d5dSJason Gerecke 	/* The defined oVid/oPid must match that of the sibling */
57741372d5dSJason Gerecke 	if (features->oVid != HID_ANY_ID && sibling->vendor != oVid)
57841372d5dSJason Gerecke 		return false;
57941372d5dSJason Gerecke 	if (features->oPid != HID_ANY_ID && sibling->product != oPid)
58041372d5dSJason Gerecke 		return false;
58141372d5dSJason Gerecke 
58241372d5dSJason Gerecke 	/*
58341372d5dSJason Gerecke 	 * Devices with the same VID/PID must share the same physical
58441372d5dSJason Gerecke 	 * device path, while those with different VID/PID must share
58541372d5dSJason Gerecke 	 * the same physical parent device path.
58641372d5dSJason Gerecke 	 */
58741372d5dSJason Gerecke 	if (hdev->vendor == sibling->vendor && hdev->product == sibling->product) {
58841372d5dSJason Gerecke 		if (!compare_device_paths(hdev, sibling, '/'))
58941372d5dSJason Gerecke 			return false;
59041372d5dSJason Gerecke 	} else {
59141372d5dSJason Gerecke 		if (!compare_device_paths(hdev, sibling, '.'))
59241372d5dSJason Gerecke 			return false;
593471d1714SBenjamin Tissoires 	}
594471d1714SBenjamin Tissoires 
59541372d5dSJason Gerecke 	/* Skip the remaining heuristics unless you are a HID_GENERIC device */
59641372d5dSJason Gerecke 	if (features->type != HID_GENERIC)
59741372d5dSJason Gerecke 		return true;
59841372d5dSJason Gerecke 
59941372d5dSJason Gerecke 	/*
60041372d5dSJason Gerecke 	 * Direct-input devices may not be siblings of indirect-input
60141372d5dSJason Gerecke 	 * devices.
60241372d5dSJason Gerecke 	 */
60341372d5dSJason Gerecke 	if ((features->device_type & WACOM_DEVICETYPE_DIRECT) &&
60441372d5dSJason Gerecke 	    !(sibling_features->device_type & WACOM_DEVICETYPE_DIRECT))
605471d1714SBenjamin Tissoires 		return false;
606471d1714SBenjamin Tissoires 
60741372d5dSJason Gerecke 	/*
60841372d5dSJason Gerecke 	 * Indirect-input devices may not be siblings of direct-input
60941372d5dSJason Gerecke 	 * devices.
61041372d5dSJason Gerecke 	 */
61141372d5dSJason Gerecke 	if (!(features->device_type & WACOM_DEVICETYPE_DIRECT) &&
61241372d5dSJason Gerecke 	    (sibling_features->device_type & WACOM_DEVICETYPE_DIRECT))
613471d1714SBenjamin Tissoires 		return false;
614471d1714SBenjamin Tissoires 
61541372d5dSJason Gerecke 	/* Pen devices may only be siblings of touch devices */
61641372d5dSJason Gerecke 	if ((features->device_type & WACOM_DEVICETYPE_PEN) &&
61741372d5dSJason Gerecke 	    !(sibling_features->device_type & WACOM_DEVICETYPE_TOUCH))
61841372d5dSJason Gerecke 		return false;
61941372d5dSJason Gerecke 
62041372d5dSJason Gerecke 	/* Touch devices may only be siblings of pen devices */
62141372d5dSJason Gerecke 	if ((features->device_type & WACOM_DEVICETYPE_TOUCH) &&
62241372d5dSJason Gerecke 	    !(sibling_features->device_type & WACOM_DEVICETYPE_PEN))
62341372d5dSJason Gerecke 		return false;
62441372d5dSJason Gerecke 
62541372d5dSJason Gerecke 	/*
62641372d5dSJason Gerecke 	 * No reason could be found for these two devices to NOT be
62741372d5dSJason Gerecke 	 * siblings, so there's a good chance they ARE siblings
62841372d5dSJason Gerecke 	 */
62941372d5dSJason Gerecke 	return true;
630471d1714SBenjamin Tissoires }
631471d1714SBenjamin Tissoires 
632471d1714SBenjamin Tissoires static struct wacom_hdev_data *wacom_get_hdev_data(struct hid_device *hdev)
633471d1714SBenjamin Tissoires {
634471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
635471d1714SBenjamin Tissoires 
63641372d5dSJason Gerecke 	/* Try to find an already-probed interface from the same device */
63741372d5dSJason Gerecke 	list_for_each_entry(data, &wacom_udev_list, list) {
63841372d5dSJason Gerecke 		if (compare_device_paths(hdev, data->dev, '/'))
63941372d5dSJason Gerecke 			return data;
64041372d5dSJason Gerecke 	}
64141372d5dSJason Gerecke 
64241372d5dSJason Gerecke 	/* Fallback to finding devices that appear to be "siblings" */
643471d1714SBenjamin Tissoires 	list_for_each_entry(data, &wacom_udev_list, list) {
644471d1714SBenjamin Tissoires 		if (wacom_are_sibling(hdev, data->dev)) {
645471d1714SBenjamin Tissoires 			kref_get(&data->kref);
646471d1714SBenjamin Tissoires 			return data;
647471d1714SBenjamin Tissoires 		}
648471d1714SBenjamin Tissoires 	}
649471d1714SBenjamin Tissoires 
650471d1714SBenjamin Tissoires 	return NULL;
651471d1714SBenjamin Tissoires }
652471d1714SBenjamin Tissoires 
6531c817c83SBenjamin Tissoires static void wacom_release_shared_data(struct kref *kref)
6541c817c83SBenjamin Tissoires {
6551c817c83SBenjamin Tissoires 	struct wacom_hdev_data *data =
6561c817c83SBenjamin Tissoires 		container_of(kref, struct wacom_hdev_data, kref);
6571c817c83SBenjamin Tissoires 
6581c817c83SBenjamin Tissoires 	mutex_lock(&wacom_udev_list_lock);
6591c817c83SBenjamin Tissoires 	list_del(&data->list);
6601c817c83SBenjamin Tissoires 	mutex_unlock(&wacom_udev_list_lock);
6611c817c83SBenjamin Tissoires 
6621c817c83SBenjamin Tissoires 	kfree(data);
6631c817c83SBenjamin Tissoires }
6641c817c83SBenjamin Tissoires 
6651c817c83SBenjamin Tissoires static void wacom_remove_shared_data(void *res)
6661c817c83SBenjamin Tissoires {
6671c817c83SBenjamin Tissoires 	struct wacom *wacom = res;
6681c817c83SBenjamin Tissoires 	struct wacom_hdev_data *data;
6691c817c83SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
6701c817c83SBenjamin Tissoires 
6711c817c83SBenjamin Tissoires 	if (wacom_wac->shared) {
6721c817c83SBenjamin Tissoires 		data = container_of(wacom_wac->shared, struct wacom_hdev_data,
6731c817c83SBenjamin Tissoires 				    shared);
6741c817c83SBenjamin Tissoires 
6751c817c83SBenjamin Tissoires 		if (wacom_wac->shared->touch == wacom->hdev)
6761c817c83SBenjamin Tissoires 			wacom_wac->shared->touch = NULL;
6771c817c83SBenjamin Tissoires 		else if (wacom_wac->shared->pen == wacom->hdev)
6781c817c83SBenjamin Tissoires 			wacom_wac->shared->pen = NULL;
6791c817c83SBenjamin Tissoires 
6801c817c83SBenjamin Tissoires 		kref_put(&data->kref, wacom_release_shared_data);
6811c817c83SBenjamin Tissoires 		wacom_wac->shared = NULL;
6821c817c83SBenjamin Tissoires 	}
6831c817c83SBenjamin Tissoires }
6841c817c83SBenjamin Tissoires 
685471d1714SBenjamin Tissoires static int wacom_add_shared_data(struct hid_device *hdev)
686471d1714SBenjamin Tissoires {
687471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
688471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
689471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
690471d1714SBenjamin Tissoires 	int retval = 0;
691471d1714SBenjamin Tissoires 
692471d1714SBenjamin Tissoires 	mutex_lock(&wacom_udev_list_lock);
693471d1714SBenjamin Tissoires 
694471d1714SBenjamin Tissoires 	data = wacom_get_hdev_data(hdev);
695471d1714SBenjamin Tissoires 	if (!data) {
696471d1714SBenjamin Tissoires 		data = kzalloc(sizeof(struct wacom_hdev_data), GFP_KERNEL);
697471d1714SBenjamin Tissoires 		if (!data) {
698471d1714SBenjamin Tissoires 			retval = -ENOMEM;
699471d1714SBenjamin Tissoires 			goto out;
700471d1714SBenjamin Tissoires 		}
701471d1714SBenjamin Tissoires 
702471d1714SBenjamin Tissoires 		kref_init(&data->kref);
703471d1714SBenjamin Tissoires 		data->dev = hdev;
704471d1714SBenjamin Tissoires 		list_add_tail(&data->list, &wacom_udev_list);
705471d1714SBenjamin Tissoires 	}
706471d1714SBenjamin Tissoires 
707471d1714SBenjamin Tissoires 	wacom_wac->shared = &data->shared;
708471d1714SBenjamin Tissoires 
7091c817c83SBenjamin Tissoires 	retval = devm_add_action(&hdev->dev, wacom_remove_shared_data, wacom);
7101c817c83SBenjamin Tissoires 	if (retval) {
7111c817c83SBenjamin Tissoires 		mutex_unlock(&wacom_udev_list_lock);
7121c817c83SBenjamin Tissoires 		wacom_remove_shared_data(wacom);
7131c817c83SBenjamin Tissoires 		return retval;
7141c817c83SBenjamin Tissoires 	}
7151c817c83SBenjamin Tissoires 
716aa86b18cSJason Gerecke 	if (wacom_wac->features.device_type & WACOM_DEVICETYPE_TOUCH)
717a97ac104SBenjamin Tissoires 		wacom_wac->shared->touch = hdev;
718aa86b18cSJason Gerecke 	else if (wacom_wac->features.device_type & WACOM_DEVICETYPE_PEN)
719a97ac104SBenjamin Tissoires 		wacom_wac->shared->pen = hdev;
720a97ac104SBenjamin Tissoires 
721471d1714SBenjamin Tissoires out:
722471d1714SBenjamin Tissoires 	mutex_unlock(&wacom_udev_list_lock);
723471d1714SBenjamin Tissoires 	return retval;
724471d1714SBenjamin Tissoires }
725471d1714SBenjamin Tissoires 
726471d1714SBenjamin Tissoires static int wacom_led_control(struct wacom *wacom)
727471d1714SBenjamin Tissoires {
728471d1714SBenjamin Tissoires 	unsigned char *buf;
729471d1714SBenjamin Tissoires 	int retval;
730912ca216SPing Cheng 	unsigned char report_id = WAC_CMD_LED_CONTROL;
731912ca216SPing Cheng 	int buf_size = 9;
732471d1714SBenjamin Tissoires 
73397f5541fSBenjamin Tissoires 	if (!hid_get_drvdata(wacom->hdev))
73497f5541fSBenjamin Tissoires 		return -ENODEV;
73597f5541fSBenjamin Tissoires 
736a50aac71SBenjamin Tissoires 	if (!wacom->led.groups)
737a50aac71SBenjamin Tissoires 		return -ENOTSUPP;
738a50aac71SBenjamin Tissoires 
739912ca216SPing Cheng 	if (wacom->wacom_wac.pid) { /* wireless connected */
740912ca216SPing Cheng 		report_id = WAC_CMD_WL_LED_CONTROL;
741912ca216SPing Cheng 		buf_size = 13;
742912ca216SPing Cheng 	}
743912ca216SPing Cheng 	buf = kzalloc(buf_size, GFP_KERNEL);
744471d1714SBenjamin Tissoires 	if (!buf)
745471d1714SBenjamin Tissoires 		return -ENOMEM;
746471d1714SBenjamin Tissoires 
747471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.features.type >= INTUOS5S &&
748471d1714SBenjamin Tissoires 	    wacom->wacom_wac.features.type <= INTUOSPL) {
749471d1714SBenjamin Tissoires 		/*
750471d1714SBenjamin Tissoires 		 * Touch Ring and crop mark LED luminance may take on
751471d1714SBenjamin Tissoires 		 * one of four values:
752471d1714SBenjamin Tissoires 		 *    0 = Low; 1 = Medium; 2 = High; 3 = Off
753471d1714SBenjamin Tissoires 		 */
754a50aac71SBenjamin Tissoires 		int ring_led = wacom->led.groups[0].select & 0x03;
755471d1714SBenjamin Tissoires 		int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
756471d1714SBenjamin Tissoires 		int crop_lum = 0;
757912ca216SPing Cheng 		unsigned char led_bits = (crop_lum << 4) | (ring_lum << 2) | (ring_led);
758471d1714SBenjamin Tissoires 
759912ca216SPing Cheng 		buf[0] = report_id;
760912ca216SPing Cheng 		if (wacom->wacom_wac.pid) {
761912ca216SPing Cheng 			wacom_get_report(wacom->hdev, HID_FEATURE_REPORT,
762912ca216SPing Cheng 					 buf, buf_size, WAC_CMD_RETRIES);
763912ca216SPing Cheng 			buf[0] = report_id;
764912ca216SPing Cheng 			buf[4] = led_bits;
765912ca216SPing Cheng 		} else
766912ca216SPing Cheng 			buf[1] = led_bits;
767471d1714SBenjamin Tissoires 	}
768471d1714SBenjamin Tissoires 	else {
769a50aac71SBenjamin Tissoires 		int led = wacom->led.groups[0].select | 0x4;
770471d1714SBenjamin Tissoires 
771471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
772471d1714SBenjamin Tissoires 		    wacom->wacom_wac.features.type == WACOM_24HD)
773a50aac71SBenjamin Tissoires 			led |= (wacom->led.groups[1].select << 4) | 0x40;
774471d1714SBenjamin Tissoires 
775912ca216SPing Cheng 		buf[0] = report_id;
776471d1714SBenjamin Tissoires 		buf[1] = led;
777471d1714SBenjamin Tissoires 		buf[2] = wacom->led.llv;
778471d1714SBenjamin Tissoires 		buf[3] = wacom->led.hlv;
779471d1714SBenjamin Tissoires 		buf[4] = wacom->led.img_lum;
780471d1714SBenjamin Tissoires 	}
781471d1714SBenjamin Tissoires 
782912ca216SPing Cheng 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, buf_size,
783296b7378SPrzemo Firszt 				  WAC_CMD_RETRIES);
784471d1714SBenjamin Tissoires 	kfree(buf);
785471d1714SBenjamin Tissoires 
786471d1714SBenjamin Tissoires 	return retval;
787471d1714SBenjamin Tissoires }
788471d1714SBenjamin Tissoires 
789849e2f06SBenjamin Tissoires static int wacom_led_putimage(struct wacom *wacom, int button_id, u8 xfer_id,
790849e2f06SBenjamin Tissoires 		const unsigned len, const void *img)
791471d1714SBenjamin Tissoires {
792471d1714SBenjamin Tissoires 	unsigned char *buf;
793471d1714SBenjamin Tissoires 	int i, retval;
794849e2f06SBenjamin Tissoires 	const unsigned chunk_len = len / 4; /* 4 chunks are needed to be sent */
795471d1714SBenjamin Tissoires 
796849e2f06SBenjamin Tissoires 	buf = kzalloc(chunk_len + 3 , GFP_KERNEL);
797471d1714SBenjamin Tissoires 	if (!buf)
798471d1714SBenjamin Tissoires 		return -ENOMEM;
799471d1714SBenjamin Tissoires 
800471d1714SBenjamin Tissoires 	/* Send 'start' command */
801471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_START;
802471d1714SBenjamin Tissoires 	buf[1] = 1;
803296b7378SPrzemo Firszt 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
804296b7378SPrzemo Firszt 				  WAC_CMD_RETRIES);
805471d1714SBenjamin Tissoires 	if (retval < 0)
806471d1714SBenjamin Tissoires 		goto out;
807471d1714SBenjamin Tissoires 
808849e2f06SBenjamin Tissoires 	buf[0] = xfer_id;
809471d1714SBenjamin Tissoires 	buf[1] = button_id & 0x07;
810471d1714SBenjamin Tissoires 	for (i = 0; i < 4; i++) {
811471d1714SBenjamin Tissoires 		buf[2] = i;
812849e2f06SBenjamin Tissoires 		memcpy(buf + 3, img + i * chunk_len, chunk_len);
813471d1714SBenjamin Tissoires 
814471d1714SBenjamin Tissoires 		retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
815296b7378SPrzemo Firszt 					  buf, chunk_len + 3, WAC_CMD_RETRIES);
816471d1714SBenjamin Tissoires 		if (retval < 0)
817471d1714SBenjamin Tissoires 			break;
818471d1714SBenjamin Tissoires 	}
819471d1714SBenjamin Tissoires 
820471d1714SBenjamin Tissoires 	/* Send 'stop' */
821471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_START;
822471d1714SBenjamin Tissoires 	buf[1] = 0;
823296b7378SPrzemo Firszt 	wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
824296b7378SPrzemo Firszt 			 WAC_CMD_RETRIES);
825471d1714SBenjamin Tissoires 
826471d1714SBenjamin Tissoires out:
827471d1714SBenjamin Tissoires 	kfree(buf);
828471d1714SBenjamin Tissoires 	return retval;
829471d1714SBenjamin Tissoires }
830471d1714SBenjamin Tissoires 
831471d1714SBenjamin Tissoires static ssize_t wacom_led_select_store(struct device *dev, int set_id,
832471d1714SBenjamin Tissoires 				      const char *buf, size_t count)
833471d1714SBenjamin Tissoires {
834ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);
835471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
836471d1714SBenjamin Tissoires 	unsigned int id;
837471d1714SBenjamin Tissoires 	int err;
838471d1714SBenjamin Tissoires 
839471d1714SBenjamin Tissoires 	err = kstrtouint(buf, 10, &id);
840471d1714SBenjamin Tissoires 	if (err)
841471d1714SBenjamin Tissoires 		return err;
842471d1714SBenjamin Tissoires 
843471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
844471d1714SBenjamin Tissoires 
845a50aac71SBenjamin Tissoires 	wacom->led.groups[set_id].select = id & 0x3;
846471d1714SBenjamin Tissoires 	err = wacom_led_control(wacom);
847471d1714SBenjamin Tissoires 
848471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
849471d1714SBenjamin Tissoires 
850471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
851471d1714SBenjamin Tissoires }
852471d1714SBenjamin Tissoires 
853471d1714SBenjamin Tissoires #define DEVICE_LED_SELECT_ATTR(SET_ID)					\
854471d1714SBenjamin Tissoires static ssize_t wacom_led##SET_ID##_select_store(struct device *dev,	\
855471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
856471d1714SBenjamin Tissoires {									\
857471d1714SBenjamin Tissoires 	return wacom_led_select_store(dev, SET_ID, buf, count);		\
858471d1714SBenjamin Tissoires }									\
859471d1714SBenjamin Tissoires static ssize_t wacom_led##SET_ID##_select_show(struct device *dev,	\
860471d1714SBenjamin Tissoires 	struct device_attribute *attr, char *buf)			\
861471d1714SBenjamin Tissoires {									\
862ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);\
863471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);			\
86437449adcSPing Cheng 	return scnprintf(buf, PAGE_SIZE, "%d\n",			\
865a50aac71SBenjamin Tissoires 			 wacom->led.groups[SET_ID].select);		\
866471d1714SBenjamin Tissoires }									\
867e0984bc3SPing Cheng static DEVICE_ATTR(status_led##SET_ID##_select, DEV_ATTR_RW_PERM,	\
868471d1714SBenjamin Tissoires 		    wacom_led##SET_ID##_select_show,			\
869471d1714SBenjamin Tissoires 		    wacom_led##SET_ID##_select_store)
870471d1714SBenjamin Tissoires 
871471d1714SBenjamin Tissoires DEVICE_LED_SELECT_ATTR(0);
872471d1714SBenjamin Tissoires DEVICE_LED_SELECT_ATTR(1);
873471d1714SBenjamin Tissoires 
874471d1714SBenjamin Tissoires static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
875471d1714SBenjamin Tissoires 				     const char *buf, size_t count)
876471d1714SBenjamin Tissoires {
877471d1714SBenjamin Tissoires 	unsigned int value;
878471d1714SBenjamin Tissoires 	int err;
879471d1714SBenjamin Tissoires 
880471d1714SBenjamin Tissoires 	err = kstrtouint(buf, 10, &value);
881471d1714SBenjamin Tissoires 	if (err)
882471d1714SBenjamin Tissoires 		return err;
883471d1714SBenjamin Tissoires 
884471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
885471d1714SBenjamin Tissoires 
886471d1714SBenjamin Tissoires 	*dest = value & 0x7f;
887471d1714SBenjamin Tissoires 	err = wacom_led_control(wacom);
888471d1714SBenjamin Tissoires 
889471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
890471d1714SBenjamin Tissoires 
891471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
892471d1714SBenjamin Tissoires }
893471d1714SBenjamin Tissoires 
894471d1714SBenjamin Tissoires #define DEVICE_LUMINANCE_ATTR(name, field)				\
895471d1714SBenjamin Tissoires static ssize_t wacom_##name##_luminance_store(struct device *dev,	\
896471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
897471d1714SBenjamin Tissoires {									\
898ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);\
899471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);			\
900471d1714SBenjamin Tissoires 									\
901471d1714SBenjamin Tissoires 	return wacom_luminance_store(wacom, &wacom->led.field,		\
902471d1714SBenjamin Tissoires 				     buf, count);			\
903471d1714SBenjamin Tissoires }									\
90437449adcSPing Cheng static ssize_t wacom_##name##_luminance_show(struct device *dev,	\
90537449adcSPing Cheng 	struct device_attribute *attr, char *buf)			\
90637449adcSPing Cheng {									\
90737449adcSPing Cheng 	struct wacom *wacom = dev_get_drvdata(dev);			\
90837449adcSPing Cheng 	return scnprintf(buf, PAGE_SIZE, "%d\n", wacom->led.field);	\
90937449adcSPing Cheng }									\
910e0984bc3SPing Cheng static DEVICE_ATTR(name##_luminance, DEV_ATTR_RW_PERM,			\
91137449adcSPing Cheng 		   wacom_##name##_luminance_show,			\
91237449adcSPing Cheng 		   wacom_##name##_luminance_store)
913471d1714SBenjamin Tissoires 
914471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(status0, llv);
915471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(status1, hlv);
916471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(buttons, img_lum);
917471d1714SBenjamin Tissoires 
918471d1714SBenjamin Tissoires static ssize_t wacom_button_image_store(struct device *dev, int button_id,
919471d1714SBenjamin Tissoires 					const char *buf, size_t count)
920471d1714SBenjamin Tissoires {
921ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);
922471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
923471d1714SBenjamin Tissoires 	int err;
924849e2f06SBenjamin Tissoires 	unsigned len;
925849e2f06SBenjamin Tissoires 	u8 xfer_id;
926471d1714SBenjamin Tissoires 
927849e2f06SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH) {
928849e2f06SBenjamin Tissoires 		len = 256;
929849e2f06SBenjamin Tissoires 		xfer_id = WAC_CMD_ICON_BT_XFER;
930849e2f06SBenjamin Tissoires 	} else {
931849e2f06SBenjamin Tissoires 		len = 1024;
932849e2f06SBenjamin Tissoires 		xfer_id = WAC_CMD_ICON_XFER;
933849e2f06SBenjamin Tissoires 	}
934849e2f06SBenjamin Tissoires 
935849e2f06SBenjamin Tissoires 	if (count != len)
936471d1714SBenjamin Tissoires 		return -EINVAL;
937471d1714SBenjamin Tissoires 
938471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
939471d1714SBenjamin Tissoires 
940849e2f06SBenjamin Tissoires 	err = wacom_led_putimage(wacom, button_id, xfer_id, len, buf);
941471d1714SBenjamin Tissoires 
942471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
943471d1714SBenjamin Tissoires 
944471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
945471d1714SBenjamin Tissoires }
946471d1714SBenjamin Tissoires 
947471d1714SBenjamin Tissoires #define DEVICE_BTNIMG_ATTR(BUTTON_ID)					\
948471d1714SBenjamin Tissoires static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev,	\
949471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
950471d1714SBenjamin Tissoires {									\
951471d1714SBenjamin Tissoires 	return wacom_button_image_store(dev, BUTTON_ID, buf, count);	\
952471d1714SBenjamin Tissoires }									\
953e0984bc3SPing Cheng static DEVICE_ATTR(button##BUTTON_ID##_rawimg, DEV_ATTR_WO_PERM,	\
954471d1714SBenjamin Tissoires 		   NULL, wacom_btnimg##BUTTON_ID##_store)
955471d1714SBenjamin Tissoires 
956471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(0);
957471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(1);
958471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(2);
959471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(3);
960471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(4);
961471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(5);
962471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(6);
963471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(7);
964471d1714SBenjamin Tissoires 
965471d1714SBenjamin Tissoires static struct attribute *cintiq_led_attrs[] = {
966471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
967471d1714SBenjamin Tissoires 	&dev_attr_status_led1_select.attr,
968471d1714SBenjamin Tissoires 	NULL
969471d1714SBenjamin Tissoires };
970471d1714SBenjamin Tissoires 
971471d1714SBenjamin Tissoires static struct attribute_group cintiq_led_attr_group = {
972471d1714SBenjamin Tissoires 	.name = "wacom_led",
973471d1714SBenjamin Tissoires 	.attrs = cintiq_led_attrs,
974471d1714SBenjamin Tissoires };
975471d1714SBenjamin Tissoires 
976471d1714SBenjamin Tissoires static struct attribute *intuos4_led_attrs[] = {
977471d1714SBenjamin Tissoires 	&dev_attr_status0_luminance.attr,
978471d1714SBenjamin Tissoires 	&dev_attr_status1_luminance.attr,
979471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
980471d1714SBenjamin Tissoires 	&dev_attr_buttons_luminance.attr,
981471d1714SBenjamin Tissoires 	&dev_attr_button0_rawimg.attr,
982471d1714SBenjamin Tissoires 	&dev_attr_button1_rawimg.attr,
983471d1714SBenjamin Tissoires 	&dev_attr_button2_rawimg.attr,
984471d1714SBenjamin Tissoires 	&dev_attr_button3_rawimg.attr,
985471d1714SBenjamin Tissoires 	&dev_attr_button4_rawimg.attr,
986471d1714SBenjamin Tissoires 	&dev_attr_button5_rawimg.attr,
987471d1714SBenjamin Tissoires 	&dev_attr_button6_rawimg.attr,
988471d1714SBenjamin Tissoires 	&dev_attr_button7_rawimg.attr,
989471d1714SBenjamin Tissoires 	NULL
990471d1714SBenjamin Tissoires };
991471d1714SBenjamin Tissoires 
992471d1714SBenjamin Tissoires static struct attribute_group intuos4_led_attr_group = {
993471d1714SBenjamin Tissoires 	.name = "wacom_led",
994471d1714SBenjamin Tissoires 	.attrs = intuos4_led_attrs,
995471d1714SBenjamin Tissoires };
996471d1714SBenjamin Tissoires 
997471d1714SBenjamin Tissoires static struct attribute *intuos5_led_attrs[] = {
998471d1714SBenjamin Tissoires 	&dev_attr_status0_luminance.attr,
999471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
1000471d1714SBenjamin Tissoires 	NULL
1001471d1714SBenjamin Tissoires };
1002471d1714SBenjamin Tissoires 
1003471d1714SBenjamin Tissoires static struct attribute_group intuos5_led_attr_group = {
1004471d1714SBenjamin Tissoires 	.name = "wacom_led",
1005471d1714SBenjamin Tissoires 	.attrs = intuos5_led_attrs,
1006471d1714SBenjamin Tissoires };
1007471d1714SBenjamin Tissoires 
10082df68a88SBenjamin Tissoires struct wacom_sysfs_group_devres {
10092df68a88SBenjamin Tissoires 	struct attribute_group *group;
10102df68a88SBenjamin Tissoires 	struct kobject *root;
10112df68a88SBenjamin Tissoires };
10122df68a88SBenjamin Tissoires 
10132df68a88SBenjamin Tissoires static void wacom_devm_sysfs_group_release(struct device *dev, void *res)
10142df68a88SBenjamin Tissoires {
10152df68a88SBenjamin Tissoires 	struct wacom_sysfs_group_devres *devres = res;
10162df68a88SBenjamin Tissoires 	struct kobject *kobj = devres->root;
10172df68a88SBenjamin Tissoires 
10182df68a88SBenjamin Tissoires 	dev_dbg(dev, "%s: dropping reference to %s\n",
10192df68a88SBenjamin Tissoires 		__func__, devres->group->name);
10202df68a88SBenjamin Tissoires 	sysfs_remove_group(kobj, devres->group);
10212df68a88SBenjamin Tissoires }
10222df68a88SBenjamin Tissoires 
1023f9036bd4SBenjamin Tissoires static int __wacom_devm_sysfs_create_group(struct wacom *wacom,
1024f9036bd4SBenjamin Tissoires 					   struct kobject *root,
10252df68a88SBenjamin Tissoires 					   struct attribute_group *group)
10262df68a88SBenjamin Tissoires {
10272df68a88SBenjamin Tissoires 	struct wacom_sysfs_group_devres *devres;
10282df68a88SBenjamin Tissoires 	int error;
10292df68a88SBenjamin Tissoires 
10302df68a88SBenjamin Tissoires 	devres = devres_alloc(wacom_devm_sysfs_group_release,
10312df68a88SBenjamin Tissoires 			      sizeof(struct wacom_sysfs_group_devres),
10322df68a88SBenjamin Tissoires 			      GFP_KERNEL);
10332df68a88SBenjamin Tissoires 	if (!devres)
10342df68a88SBenjamin Tissoires 		return -ENOMEM;
10352df68a88SBenjamin Tissoires 
10362df68a88SBenjamin Tissoires 	devres->group = group;
1037f9036bd4SBenjamin Tissoires 	devres->root = root;
10382df68a88SBenjamin Tissoires 
10392df68a88SBenjamin Tissoires 	error = sysfs_create_group(devres->root, group);
10402df68a88SBenjamin Tissoires 	if (error)
10412df68a88SBenjamin Tissoires 		return error;
10422df68a88SBenjamin Tissoires 
10432df68a88SBenjamin Tissoires 	devres_add(&wacom->hdev->dev, devres);
10442df68a88SBenjamin Tissoires 
10452df68a88SBenjamin Tissoires 	return 0;
10462df68a88SBenjamin Tissoires }
10472df68a88SBenjamin Tissoires 
1048f9036bd4SBenjamin Tissoires static int wacom_devm_sysfs_create_group(struct wacom *wacom,
1049f9036bd4SBenjamin Tissoires 					 struct attribute_group *group)
1050f9036bd4SBenjamin Tissoires {
1051f9036bd4SBenjamin Tissoires 	return __wacom_devm_sysfs_create_group(wacom, &wacom->hdev->dev.kobj,
1052f9036bd4SBenjamin Tissoires 					       group);
1053f9036bd4SBenjamin Tissoires }
1054f9036bd4SBenjamin Tissoires 
105534736aa9SBenjamin Tissoires enum led_brightness wacom_leds_brightness_get(struct wacom_led *led)
105697f5541fSBenjamin Tissoires {
105797f5541fSBenjamin Tissoires 	struct wacom *wacom = led->wacom;
105897f5541fSBenjamin Tissoires 
105997f5541fSBenjamin Tissoires 	if (wacom->led.max_hlv)
106097f5541fSBenjamin Tissoires 		return led->hlv * LED_FULL / wacom->led.max_hlv;
106197f5541fSBenjamin Tissoires 
106297f5541fSBenjamin Tissoires 	if (wacom->led.max_llv)
106397f5541fSBenjamin Tissoires 		return led->llv * LED_FULL / wacom->led.max_llv;
106497f5541fSBenjamin Tissoires 
106597f5541fSBenjamin Tissoires 	/* device doesn't support brightness tuning */
106697f5541fSBenjamin Tissoires 	return LED_FULL;
106797f5541fSBenjamin Tissoires }
106897f5541fSBenjamin Tissoires 
106997f5541fSBenjamin Tissoires static enum led_brightness __wacom_led_brightness_get(struct led_classdev *cdev)
107097f5541fSBenjamin Tissoires {
107197f5541fSBenjamin Tissoires 	struct wacom_led *led = container_of(cdev, struct wacom_led, cdev);
107297f5541fSBenjamin Tissoires 	struct wacom *wacom = led->wacom;
107397f5541fSBenjamin Tissoires 
107497f5541fSBenjamin Tissoires 	if (wacom->led.groups[led->group].select != led->id)
107597f5541fSBenjamin Tissoires 		return LED_OFF;
107697f5541fSBenjamin Tissoires 
107797f5541fSBenjamin Tissoires 	return wacom_leds_brightness_get(led);
107897f5541fSBenjamin Tissoires }
107997f5541fSBenjamin Tissoires 
108097f5541fSBenjamin Tissoires static int wacom_led_brightness_set(struct led_classdev *cdev,
108197f5541fSBenjamin Tissoires 				    enum led_brightness brightness)
108297f5541fSBenjamin Tissoires {
108397f5541fSBenjamin Tissoires 	struct wacom_led *led = container_of(cdev, struct wacom_led, cdev);
108497f5541fSBenjamin Tissoires 	struct wacom *wacom = led->wacom;
108597f5541fSBenjamin Tissoires 	int error;
108697f5541fSBenjamin Tissoires 
108797f5541fSBenjamin Tissoires 	mutex_lock(&wacom->lock);
108897f5541fSBenjamin Tissoires 
108997f5541fSBenjamin Tissoires 	if (!wacom->led.groups || (brightness == LED_OFF &&
109097f5541fSBenjamin Tissoires 	    wacom->led.groups[led->group].select != led->id)) {
109197f5541fSBenjamin Tissoires 		error = 0;
109297f5541fSBenjamin Tissoires 		goto out;
109397f5541fSBenjamin Tissoires 	}
109497f5541fSBenjamin Tissoires 
109597f5541fSBenjamin Tissoires 	led->llv = wacom->led.llv = wacom->led.max_llv * brightness / LED_FULL;
109697f5541fSBenjamin Tissoires 	led->hlv = wacom->led.hlv = wacom->led.max_hlv * brightness / LED_FULL;
109797f5541fSBenjamin Tissoires 
109897f5541fSBenjamin Tissoires 	wacom->led.groups[led->group].select = led->id;
109997f5541fSBenjamin Tissoires 
110097f5541fSBenjamin Tissoires 	error = wacom_led_control(wacom);
110197f5541fSBenjamin Tissoires 
110297f5541fSBenjamin Tissoires out:
110397f5541fSBenjamin Tissoires 	mutex_unlock(&wacom->lock);
110497f5541fSBenjamin Tissoires 
110597f5541fSBenjamin Tissoires 	return error;
110697f5541fSBenjamin Tissoires }
110797f5541fSBenjamin Tissoires 
110897f5541fSBenjamin Tissoires static void wacom_led_readonly_brightness_set(struct led_classdev *cdev,
110997f5541fSBenjamin Tissoires 					       enum led_brightness brightness)
111097f5541fSBenjamin Tissoires {
111197f5541fSBenjamin Tissoires }
111297f5541fSBenjamin Tissoires 
111397f5541fSBenjamin Tissoires static int wacom_led_register_one(struct device *dev, struct wacom *wacom,
111497f5541fSBenjamin Tissoires 				  struct wacom_led *led, unsigned int group,
111597f5541fSBenjamin Tissoires 				  unsigned int id, bool read_only)
111697f5541fSBenjamin Tissoires {
111797f5541fSBenjamin Tissoires 	int error;
111897f5541fSBenjamin Tissoires 	char *name;
111997f5541fSBenjamin Tissoires 
112097f5541fSBenjamin Tissoires 	name = devm_kasprintf(dev, GFP_KERNEL,
112197f5541fSBenjamin Tissoires 			      "%s::wacom-%d.%d",
112297f5541fSBenjamin Tissoires 			      dev_name(dev),
112397f5541fSBenjamin Tissoires 			      group,
112497f5541fSBenjamin Tissoires 			      id);
112597f5541fSBenjamin Tissoires 	if (!name)
112697f5541fSBenjamin Tissoires 		return -ENOMEM;
112797f5541fSBenjamin Tissoires 
112834736aa9SBenjamin Tissoires 	if (!read_only) {
112934736aa9SBenjamin Tissoires 		led->trigger.name = name;
113034736aa9SBenjamin Tissoires 		error = devm_led_trigger_register(dev, &led->trigger);
113134736aa9SBenjamin Tissoires 		if (error) {
113234736aa9SBenjamin Tissoires 			hid_err(wacom->hdev,
113334736aa9SBenjamin Tissoires 				"failed to register LED trigger %s: %d\n",
113434736aa9SBenjamin Tissoires 				led->cdev.name, error);
113534736aa9SBenjamin Tissoires 			return error;
113634736aa9SBenjamin Tissoires 		}
113734736aa9SBenjamin Tissoires 	}
113834736aa9SBenjamin Tissoires 
113997f5541fSBenjamin Tissoires 	led->group = group;
114097f5541fSBenjamin Tissoires 	led->id = id;
114197f5541fSBenjamin Tissoires 	led->wacom = wacom;
114297f5541fSBenjamin Tissoires 	led->llv = wacom->led.llv;
114397f5541fSBenjamin Tissoires 	led->hlv = wacom->led.hlv;
114497f5541fSBenjamin Tissoires 	led->cdev.name = name;
114597f5541fSBenjamin Tissoires 	led->cdev.max_brightness = LED_FULL;
114697f5541fSBenjamin Tissoires 	led->cdev.flags = LED_HW_PLUGGABLE;
114797f5541fSBenjamin Tissoires 	led->cdev.brightness_get = __wacom_led_brightness_get;
114834736aa9SBenjamin Tissoires 	if (!read_only) {
114997f5541fSBenjamin Tissoires 		led->cdev.brightness_set_blocking = wacom_led_brightness_set;
115034736aa9SBenjamin Tissoires 		led->cdev.default_trigger = led->cdev.name;
115134736aa9SBenjamin Tissoires 	} else {
115297f5541fSBenjamin Tissoires 		led->cdev.brightness_set = wacom_led_readonly_brightness_set;
115334736aa9SBenjamin Tissoires 	}
115497f5541fSBenjamin Tissoires 
115597f5541fSBenjamin Tissoires 	error = devm_led_classdev_register(dev, &led->cdev);
115697f5541fSBenjamin Tissoires 	if (error) {
115797f5541fSBenjamin Tissoires 		hid_err(wacom->hdev,
115897f5541fSBenjamin Tissoires 			"failed to register LED %s: %d\n",
115997f5541fSBenjamin Tissoires 			led->cdev.name, error);
116097f5541fSBenjamin Tissoires 		led->cdev.name = NULL;
116197f5541fSBenjamin Tissoires 		return error;
116297f5541fSBenjamin Tissoires 	}
116397f5541fSBenjamin Tissoires 
116497f5541fSBenjamin Tissoires 	return 0;
116597f5541fSBenjamin Tissoires }
116697f5541fSBenjamin Tissoires 
1167589e5060SBenjamin Tissoires static void wacom_led_groups_release_one(void *data)
1168589e5060SBenjamin Tissoires {
1169589e5060SBenjamin Tissoires 	struct wacom_group_leds *group = data;
1170589e5060SBenjamin Tissoires 
1171589e5060SBenjamin Tissoires 	devres_release_group(group->dev, group);
1172589e5060SBenjamin Tissoires }
1173589e5060SBenjamin Tissoires 
117497f5541fSBenjamin Tissoires static int wacom_led_groups_alloc_and_register_one(struct device *dev,
117597f5541fSBenjamin Tissoires 						   struct wacom *wacom,
117697f5541fSBenjamin Tissoires 						   int group_id, int count,
117797f5541fSBenjamin Tissoires 						   bool read_only)
117897f5541fSBenjamin Tissoires {
117997f5541fSBenjamin Tissoires 	struct wacom_led *leds;
118097f5541fSBenjamin Tissoires 	int i, error;
118197f5541fSBenjamin Tissoires 
118297f5541fSBenjamin Tissoires 	if (group_id >= wacom->led.count || count <= 0)
118397f5541fSBenjamin Tissoires 		return -EINVAL;
118497f5541fSBenjamin Tissoires 
118597f5541fSBenjamin Tissoires 	if (!devres_open_group(dev, &wacom->led.groups[group_id], GFP_KERNEL))
118697f5541fSBenjamin Tissoires 		return -ENOMEM;
118797f5541fSBenjamin Tissoires 
118897f5541fSBenjamin Tissoires 	leds = devm_kzalloc(dev, sizeof(struct wacom_led) * count, GFP_KERNEL);
118997f5541fSBenjamin Tissoires 	if (!leds) {
119097f5541fSBenjamin Tissoires 		error = -ENOMEM;
119197f5541fSBenjamin Tissoires 		goto err;
119297f5541fSBenjamin Tissoires 	}
119397f5541fSBenjamin Tissoires 
119497f5541fSBenjamin Tissoires 	wacom->led.groups[group_id].leds = leds;
119597f5541fSBenjamin Tissoires 	wacom->led.groups[group_id].count = count;
119697f5541fSBenjamin Tissoires 
119797f5541fSBenjamin Tissoires 	for (i = 0; i < count; i++) {
119897f5541fSBenjamin Tissoires 		error = wacom_led_register_one(dev, wacom, &leds[i],
119997f5541fSBenjamin Tissoires 					       group_id, i, read_only);
120097f5541fSBenjamin Tissoires 		if (error)
120197f5541fSBenjamin Tissoires 			goto err;
120297f5541fSBenjamin Tissoires 	}
120397f5541fSBenjamin Tissoires 
1204589e5060SBenjamin Tissoires 	wacom->led.groups[group_id].dev = dev;
1205589e5060SBenjamin Tissoires 
1206589e5060SBenjamin Tissoires 	devres_close_group(dev, &wacom->led.groups[group_id]);
1207589e5060SBenjamin Tissoires 
1208589e5060SBenjamin Tissoires 	/*
1209589e5060SBenjamin Tissoires 	 * There is a bug (?) in devm_led_classdev_register() in which its
1210589e5060SBenjamin Tissoires 	 * increments the refcount of the parent. If the parent is an input
1211589e5060SBenjamin Tissoires 	 * device, that means the ref count never reaches 0 when
1212589e5060SBenjamin Tissoires 	 * devm_input_device_release() gets called.
1213589e5060SBenjamin Tissoires 	 * This means that the LEDs are still there after disconnect.
1214589e5060SBenjamin Tissoires 	 * Manually force the release of the group so that the leds are released
1215589e5060SBenjamin Tissoires 	 * once we are done using them.
1216589e5060SBenjamin Tissoires 	 */
1217589e5060SBenjamin Tissoires 	error = devm_add_action_or_reset(&wacom->hdev->dev,
1218589e5060SBenjamin Tissoires 					 wacom_led_groups_release_one,
1219589e5060SBenjamin Tissoires 					 &wacom->led.groups[group_id]);
1220589e5060SBenjamin Tissoires 	if (error)
1221589e5060SBenjamin Tissoires 		return error;
1222589e5060SBenjamin Tissoires 
122397f5541fSBenjamin Tissoires 	return 0;
122497f5541fSBenjamin Tissoires 
122597f5541fSBenjamin Tissoires err:
122697f5541fSBenjamin Tissoires 	devres_release_group(dev, &wacom->led.groups[group_id]);
122797f5541fSBenjamin Tissoires 	return error;
122897f5541fSBenjamin Tissoires }
122997f5541fSBenjamin Tissoires 
123034736aa9SBenjamin Tissoires struct wacom_led *wacom_led_find(struct wacom *wacom, unsigned int group_id,
123134736aa9SBenjamin Tissoires 				 unsigned int id)
123234736aa9SBenjamin Tissoires {
123334736aa9SBenjamin Tissoires 	struct wacom_group_leds *group;
123434736aa9SBenjamin Tissoires 
123534736aa9SBenjamin Tissoires 	if (group_id >= wacom->led.count)
123634736aa9SBenjamin Tissoires 		return NULL;
123734736aa9SBenjamin Tissoires 
123834736aa9SBenjamin Tissoires 	group = &wacom->led.groups[group_id];
123934736aa9SBenjamin Tissoires 
124034736aa9SBenjamin Tissoires 	if (!group->leds)
124134736aa9SBenjamin Tissoires 		return NULL;
124234736aa9SBenjamin Tissoires 
124334736aa9SBenjamin Tissoires 	id %= group->count;
124434736aa9SBenjamin Tissoires 
124534736aa9SBenjamin Tissoires 	return &group->leds[id];
124634736aa9SBenjamin Tissoires }
124734736aa9SBenjamin Tissoires 
124834736aa9SBenjamin Tissoires /**
124934736aa9SBenjamin Tissoires  * wacom_led_next: gives the next available led with a wacom trigger.
125034736aa9SBenjamin Tissoires  *
125134736aa9SBenjamin Tissoires  * returns the next available struct wacom_led which has its default trigger
125234736aa9SBenjamin Tissoires  * or the current one if none is available.
125334736aa9SBenjamin Tissoires  */
125434736aa9SBenjamin Tissoires struct wacom_led *wacom_led_next(struct wacom *wacom, struct wacom_led *cur)
125534736aa9SBenjamin Tissoires {
125634736aa9SBenjamin Tissoires 	struct wacom_led *next_led;
125734736aa9SBenjamin Tissoires 	int group, next;
125834736aa9SBenjamin Tissoires 
125934736aa9SBenjamin Tissoires 	if (!wacom || !cur)
126034736aa9SBenjamin Tissoires 		return NULL;
126134736aa9SBenjamin Tissoires 
126234736aa9SBenjamin Tissoires 	group = cur->group;
126334736aa9SBenjamin Tissoires 	next = cur->id;
126434736aa9SBenjamin Tissoires 
126534736aa9SBenjamin Tissoires 	do {
126634736aa9SBenjamin Tissoires 		next_led = wacom_led_find(wacom, group, ++next);
126734736aa9SBenjamin Tissoires 		if (!next_led || next_led == cur)
126834736aa9SBenjamin Tissoires 			return next_led;
126934736aa9SBenjamin Tissoires 	} while (next_led->cdev.trigger != &next_led->trigger);
127034736aa9SBenjamin Tissoires 
127134736aa9SBenjamin Tissoires 	return next_led;
127234736aa9SBenjamin Tissoires }
127334736aa9SBenjamin Tissoires 
1274a50aac71SBenjamin Tissoires static void wacom_led_groups_release(void *data)
1275a50aac71SBenjamin Tissoires {
1276a50aac71SBenjamin Tissoires 	struct wacom *wacom = data;
1277a50aac71SBenjamin Tissoires 
1278a50aac71SBenjamin Tissoires 	wacom->led.groups = NULL;
127997f5541fSBenjamin Tissoires 	wacom->led.count = 0;
1280a50aac71SBenjamin Tissoires }
1281a50aac71SBenjamin Tissoires 
1282a50aac71SBenjamin Tissoires static int wacom_led_groups_allocate(struct wacom *wacom, int count)
1283a50aac71SBenjamin Tissoires {
128497f5541fSBenjamin Tissoires 	struct device *dev = &wacom->hdev->dev;
1285a50aac71SBenjamin Tissoires 	struct wacom_group_leds *groups;
1286a50aac71SBenjamin Tissoires 	int error;
1287a50aac71SBenjamin Tissoires 
128897f5541fSBenjamin Tissoires 	groups = devm_kzalloc(dev, sizeof(struct wacom_group_leds) * count,
1289a50aac71SBenjamin Tissoires 			      GFP_KERNEL);
1290a50aac71SBenjamin Tissoires 	if (!groups)
1291a50aac71SBenjamin Tissoires 		return -ENOMEM;
1292a50aac71SBenjamin Tissoires 
129397f5541fSBenjamin Tissoires 	error = devm_add_action_or_reset(dev, wacom_led_groups_release, wacom);
1294a50aac71SBenjamin Tissoires 	if (error)
1295a50aac71SBenjamin Tissoires 		return error;
1296a50aac71SBenjamin Tissoires 
1297a50aac71SBenjamin Tissoires 	wacom->led.groups = groups;
129897f5541fSBenjamin Tissoires 	wacom->led.count = count;
129997f5541fSBenjamin Tissoires 
130097f5541fSBenjamin Tissoires 	return 0;
130197f5541fSBenjamin Tissoires }
130297f5541fSBenjamin Tissoires 
130397f5541fSBenjamin Tissoires static int wacom_leds_alloc_and_register(struct wacom *wacom, int group_count,
130497f5541fSBenjamin Tissoires 					 int led_per_group, bool read_only)
130597f5541fSBenjamin Tissoires {
130697f5541fSBenjamin Tissoires 	struct device *dev;
130797f5541fSBenjamin Tissoires 	int i, error;
130897f5541fSBenjamin Tissoires 
130997f5541fSBenjamin Tissoires 	if (!wacom->wacom_wac.pad_input)
131097f5541fSBenjamin Tissoires 		return -EINVAL;
131197f5541fSBenjamin Tissoires 
131297f5541fSBenjamin Tissoires 	dev = &wacom->wacom_wac.pad_input->dev;
131397f5541fSBenjamin Tissoires 
131497f5541fSBenjamin Tissoires 	error = wacom_led_groups_allocate(wacom, group_count);
131597f5541fSBenjamin Tissoires 	if (error)
131697f5541fSBenjamin Tissoires 		return error;
131797f5541fSBenjamin Tissoires 
131897f5541fSBenjamin Tissoires 	for (i = 0; i < group_count; i++) {
131997f5541fSBenjamin Tissoires 		error = wacom_led_groups_alloc_and_register_one(dev, wacom, i,
132097f5541fSBenjamin Tissoires 								led_per_group,
132197f5541fSBenjamin Tissoires 								read_only);
132297f5541fSBenjamin Tissoires 		if (error)
132397f5541fSBenjamin Tissoires 			return error;
132497f5541fSBenjamin Tissoires 	}
1325a50aac71SBenjamin Tissoires 
1326a50aac71SBenjamin Tissoires 	return 0;
1327a50aac71SBenjamin Tissoires }
1328a50aac71SBenjamin Tissoires 
1329471d1714SBenjamin Tissoires static int wacom_initialize_leds(struct wacom *wacom)
1330471d1714SBenjamin Tissoires {
1331471d1714SBenjamin Tissoires 	int error;
1332471d1714SBenjamin Tissoires 
1333862cf553SJason Gerecke 	if (!(wacom->wacom_wac.features.device_type & WACOM_DEVICETYPE_PAD))
1334862cf553SJason Gerecke 		return 0;
1335862cf553SJason Gerecke 
1336471d1714SBenjamin Tissoires 	/* Initialize default values */
1337471d1714SBenjamin Tissoires 	switch (wacom->wacom_wac.features.type) {
1338471d1714SBenjamin Tissoires 	case INTUOS4S:
1339471d1714SBenjamin Tissoires 	case INTUOS4:
134081af7e61SBenjamin Tissoires 	case INTUOS4WL:
1341471d1714SBenjamin Tissoires 	case INTUOS4L:
1342471d1714SBenjamin Tissoires 		wacom->led.llv = 10;
1343471d1714SBenjamin Tissoires 		wacom->led.hlv = 20;
134497f5541fSBenjamin Tissoires 		wacom->led.max_llv = 127;
134597f5541fSBenjamin Tissoires 		wacom->led.max_hlv = 127;
1346471d1714SBenjamin Tissoires 		wacom->led.img_lum = 10;
1347a50aac71SBenjamin Tissoires 
134897f5541fSBenjamin Tissoires 		error = wacom_leds_alloc_and_register(wacom, 1, 4, false);
1349a50aac71SBenjamin Tissoires 		if (error) {
1350a50aac71SBenjamin Tissoires 			hid_err(wacom->hdev,
1351a50aac71SBenjamin Tissoires 				"cannot create leds err: %d\n", error);
1352a50aac71SBenjamin Tissoires 			return error;
1353a50aac71SBenjamin Tissoires 		}
1354a50aac71SBenjamin Tissoires 
13552df68a88SBenjamin Tissoires 		error = wacom_devm_sysfs_create_group(wacom,
1356471d1714SBenjamin Tissoires 						      &intuos4_led_attr_group);
1357471d1714SBenjamin Tissoires 		break;
1358471d1714SBenjamin Tissoires 
1359471d1714SBenjamin Tissoires 	case WACOM_24HD:
1360471d1714SBenjamin Tissoires 	case WACOM_21UX2:
1361471d1714SBenjamin Tissoires 		wacom->led.llv = 0;
1362471d1714SBenjamin Tissoires 		wacom->led.hlv = 0;
1363471d1714SBenjamin Tissoires 		wacom->led.img_lum = 0;
1364471d1714SBenjamin Tissoires 
136597f5541fSBenjamin Tissoires 		error = wacom_leds_alloc_and_register(wacom, 2, 4, false);
1366a50aac71SBenjamin Tissoires 		if (error) {
1367a50aac71SBenjamin Tissoires 			hid_err(wacom->hdev,
1368a50aac71SBenjamin Tissoires 				"cannot create leds err: %d\n", error);
1369a50aac71SBenjamin Tissoires 			return error;
1370a50aac71SBenjamin Tissoires 		}
1371a50aac71SBenjamin Tissoires 
13722df68a88SBenjamin Tissoires 		error = wacom_devm_sysfs_create_group(wacom,
1373471d1714SBenjamin Tissoires 						      &cintiq_led_attr_group);
1374471d1714SBenjamin Tissoires 		break;
1375471d1714SBenjamin Tissoires 
1376471d1714SBenjamin Tissoires 	case INTUOS5S:
1377471d1714SBenjamin Tissoires 	case INTUOS5:
1378471d1714SBenjamin Tissoires 	case INTUOS5L:
1379471d1714SBenjamin Tissoires 	case INTUOSPS:
1380471d1714SBenjamin Tissoires 	case INTUOSPM:
1381471d1714SBenjamin Tissoires 	case INTUOSPL:
1382471d1714SBenjamin Tissoires 		wacom->led.llv = 32;
138397f5541fSBenjamin Tissoires 		wacom->led.max_llv = 96;
1384471d1714SBenjamin Tissoires 
138597f5541fSBenjamin Tissoires 		error = wacom_leds_alloc_and_register(wacom, 1, 4, false);
1386a50aac71SBenjamin Tissoires 		if (error) {
1387a50aac71SBenjamin Tissoires 			hid_err(wacom->hdev,
1388a50aac71SBenjamin Tissoires 				"cannot create leds err: %d\n", error);
1389a50aac71SBenjamin Tissoires 			return error;
1390a50aac71SBenjamin Tissoires 		}
1391a50aac71SBenjamin Tissoires 
13922df68a88SBenjamin Tissoires 		error = wacom_devm_sysfs_create_group(wacom,
1393471d1714SBenjamin Tissoires 						      &intuos5_led_attr_group);
1394471d1714SBenjamin Tissoires 		break;
1395471d1714SBenjamin Tissoires 
1396a50aac71SBenjamin Tissoires 	case REMOTE:
139797f5541fSBenjamin Tissoires 		wacom->led.llv = 255;
139897f5541fSBenjamin Tissoires 		wacom->led.max_llv = 255;
1399a50aac71SBenjamin Tissoires 		error = wacom_led_groups_allocate(wacom, 5);
1400a50aac71SBenjamin Tissoires 		if (error) {
1401a50aac71SBenjamin Tissoires 			hid_err(wacom->hdev,
1402a50aac71SBenjamin Tissoires 				"cannot create leds err: %d\n", error);
1403a50aac71SBenjamin Tissoires 			return error;
1404a50aac71SBenjamin Tissoires 		}
1405a50aac71SBenjamin Tissoires 		return 0;
1406a50aac71SBenjamin Tissoires 
1407471d1714SBenjamin Tissoires 	default:
1408471d1714SBenjamin Tissoires 		return 0;
1409471d1714SBenjamin Tissoires 	}
1410471d1714SBenjamin Tissoires 
1411471d1714SBenjamin Tissoires 	if (error) {
1412471d1714SBenjamin Tissoires 		hid_err(wacom->hdev,
1413471d1714SBenjamin Tissoires 			"cannot create sysfs group err: %d\n", error);
1414471d1714SBenjamin Tissoires 		return error;
1415471d1714SBenjamin Tissoires 	}
1416471d1714SBenjamin Tissoires 	wacom_led_control(wacom);
1417471d1714SBenjamin Tissoires 
1418471d1714SBenjamin Tissoires 	return 0;
1419471d1714SBenjamin Tissoires }
1420471d1714SBenjamin Tissoires 
1421471d1714SBenjamin Tissoires static enum power_supply_property wacom_battery_props[] = {
14229956953eSBenjamin Tissoires 	POWER_SUPPLY_PROP_MODEL_NAME,
142371fa641eSJason Gerecke 	POWER_SUPPLY_PROP_PRESENT,
1424ac8d1010SBenjamin Tissoires 	POWER_SUPPLY_PROP_STATUS,
1425471d1714SBenjamin Tissoires 	POWER_SUPPLY_PROP_SCOPE,
1426471d1714SBenjamin Tissoires 	POWER_SUPPLY_PROP_CAPACITY
1427471d1714SBenjamin Tissoires };
1428471d1714SBenjamin Tissoires 
1429471d1714SBenjamin Tissoires static int wacom_battery_get_property(struct power_supply *psy,
1430471d1714SBenjamin Tissoires 				      enum power_supply_property psp,
1431471d1714SBenjamin Tissoires 				      union power_supply_propval *val)
1432471d1714SBenjamin Tissoires {
143359d69bc8SBenjamin Tissoires 	struct wacom_battery *battery = power_supply_get_drvdata(psy);
1434471d1714SBenjamin Tissoires 	int ret = 0;
1435471d1714SBenjamin Tissoires 
1436471d1714SBenjamin Tissoires 	switch (psp) {
14379956953eSBenjamin Tissoires 		case POWER_SUPPLY_PROP_MODEL_NAME:
14389956953eSBenjamin Tissoires 			val->strval = battery->wacom->wacom_wac.name;
14399956953eSBenjamin Tissoires 			break;
144071fa641eSJason Gerecke 		case POWER_SUPPLY_PROP_PRESENT:
144159d69bc8SBenjamin Tissoires 			val->intval = battery->bat_connected;
144271fa641eSJason Gerecke 			break;
1443471d1714SBenjamin Tissoires 		case POWER_SUPPLY_PROP_SCOPE:
1444471d1714SBenjamin Tissoires 			val->intval = POWER_SUPPLY_SCOPE_DEVICE;
1445471d1714SBenjamin Tissoires 			break;
1446471d1714SBenjamin Tissoires 		case POWER_SUPPLY_PROP_CAPACITY:
144759d69bc8SBenjamin Tissoires 			val->intval = battery->battery_capacity;
1448ac8d1010SBenjamin Tissoires 			break;
1449ac8d1010SBenjamin Tissoires 		case POWER_SUPPLY_PROP_STATUS:
145059d69bc8SBenjamin Tissoires 			if (battery->bat_charging)
1451ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_CHARGING;
145259d69bc8SBenjamin Tissoires 			else if (battery->battery_capacity == 100 &&
145359d69bc8SBenjamin Tissoires 				    battery->ps_connected)
1454ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_FULL;
145559d69bc8SBenjamin Tissoires 			else if (battery->ps_connected)
1456b0882cb7SJason Gerecke 				val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
1457ac8d1010SBenjamin Tissoires 			else
1458ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
1459471d1714SBenjamin Tissoires 			break;
1460471d1714SBenjamin Tissoires 		default:
1461471d1714SBenjamin Tissoires 			ret = -EINVAL;
1462471d1714SBenjamin Tissoires 			break;
1463471d1714SBenjamin Tissoires 	}
1464471d1714SBenjamin Tissoires 
1465471d1714SBenjamin Tissoires 	return ret;
1466471d1714SBenjamin Tissoires }
1467471d1714SBenjamin Tissoires 
146859d69bc8SBenjamin Tissoires static int __wacom_initialize_battery(struct wacom *wacom,
146959d69bc8SBenjamin Tissoires 				      struct wacom_battery *battery)
1470471d1714SBenjamin Tissoires {
1471d70420b9SBenjamin Tissoires 	static atomic_t battery_no = ATOMIC_INIT(0);
1472b189da90SBenjamin Tissoires 	struct device *dev = &wacom->hdev->dev;
147359d69bc8SBenjamin Tissoires 	struct power_supply_config psy_cfg = { .drv_data = battery, };
1474136ae5e9SBenjamin Tissoires 	struct power_supply *ps_bat;
147559d69bc8SBenjamin Tissoires 	struct power_supply_desc *bat_desc = &battery->bat_desc;
1476d70420b9SBenjamin Tissoires 	unsigned long n;
1477b189da90SBenjamin Tissoires 	int error;
1478b189da90SBenjamin Tissoires 
1479b189da90SBenjamin Tissoires 	if (!devres_open_group(dev, bat_desc, GFP_KERNEL))
1480b189da90SBenjamin Tissoires 		return -ENOMEM;
1481471d1714SBenjamin Tissoires 
14829956953eSBenjamin Tissoires 	battery->wacom = wacom;
14839956953eSBenjamin Tissoires 
1484d70420b9SBenjamin Tissoires 	n = atomic_inc_return(&battery_no) - 1;
14857dbd229eSBenjamin Tissoires 
1486297d716fSKrzysztof Kozlowski 	bat_desc->properties = wacom_battery_props;
1487297d716fSKrzysztof Kozlowski 	bat_desc->num_properties = ARRAY_SIZE(wacom_battery_props);
1488297d716fSKrzysztof Kozlowski 	bat_desc->get_property = wacom_battery_get_property;
148959d69bc8SBenjamin Tissoires 	sprintf(battery->bat_name, "wacom_battery_%ld", n);
149059d69bc8SBenjamin Tissoires 	bat_desc->name = battery->bat_name;
149196983296SBenjamin Tissoires 	bat_desc->type = POWER_SUPPLY_TYPE_USB;
1492297d716fSKrzysztof Kozlowski 	bat_desc->use_for_apm = 0;
1493471d1714SBenjamin Tissoires 
149459d69bc8SBenjamin Tissoires 	ps_bat = devm_power_supply_register(dev, bat_desc, &psy_cfg);
149559d69bc8SBenjamin Tissoires 	if (IS_ERR(ps_bat)) {
149659d69bc8SBenjamin Tissoires 		error = PTR_ERR(ps_bat);
1497b189da90SBenjamin Tissoires 		goto err;
1498b189da90SBenjamin Tissoires 	}
1499471d1714SBenjamin Tissoires 
150059d69bc8SBenjamin Tissoires 	power_supply_powers(ps_bat, &wacom->hdev->dev);
150159d69bc8SBenjamin Tissoires 
150259d69bc8SBenjamin Tissoires 	battery->battery = ps_bat;
15037dbd229eSBenjamin Tissoires 
1504b189da90SBenjamin Tissoires 	devres_close_group(dev, bat_desc);
15057dbd229eSBenjamin Tissoires 	return 0;
1506b189da90SBenjamin Tissoires 
1507b189da90SBenjamin Tissoires err:
1508b189da90SBenjamin Tissoires 	devres_release_group(dev, bat_desc);
1509b189da90SBenjamin Tissoires 	return error;
1510471d1714SBenjamin Tissoires }
1511471d1714SBenjamin Tissoires 
151259d69bc8SBenjamin Tissoires static int wacom_initialize_battery(struct wacom *wacom)
151359d69bc8SBenjamin Tissoires {
151459d69bc8SBenjamin Tissoires 	if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY)
151559d69bc8SBenjamin Tissoires 		return __wacom_initialize_battery(wacom, &wacom->battery);
151659d69bc8SBenjamin Tissoires 
151759d69bc8SBenjamin Tissoires 	return 0;
151859d69bc8SBenjamin Tissoires }
151959d69bc8SBenjamin Tissoires 
1520471d1714SBenjamin Tissoires static void wacom_destroy_battery(struct wacom *wacom)
1521471d1714SBenjamin Tissoires {
152259d69bc8SBenjamin Tissoires 	if (wacom->battery.battery) {
152359d69bc8SBenjamin Tissoires 		devres_release_group(&wacom->hdev->dev,
152459d69bc8SBenjamin Tissoires 				     &wacom->battery.bat_desc);
152559d69bc8SBenjamin Tissoires 		wacom->battery.battery = NULL;
1526471d1714SBenjamin Tissoires 	}
1527471d1714SBenjamin Tissoires }
1528471d1714SBenjamin Tissoires 
1529f81a1295SBenjamin Tissoires static ssize_t wacom_show_speed(struct device *dev,
1530f81a1295SBenjamin Tissoires 				struct device_attribute
1531f81a1295SBenjamin Tissoires 				*attr, char *buf)
1532f81a1295SBenjamin Tissoires {
1533ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);
1534f81a1295SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
1535f81a1295SBenjamin Tissoires 
1536f81a1295SBenjamin Tissoires 	return snprintf(buf, PAGE_SIZE, "%i\n", wacom->wacom_wac.bt_high_speed);
1537f81a1295SBenjamin Tissoires }
1538f81a1295SBenjamin Tissoires 
1539f81a1295SBenjamin Tissoires static ssize_t wacom_store_speed(struct device *dev,
1540f81a1295SBenjamin Tissoires 				struct device_attribute *attr,
1541f81a1295SBenjamin Tissoires 				const char *buf, size_t count)
1542f81a1295SBenjamin Tissoires {
1543ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);
1544f81a1295SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
1545f81a1295SBenjamin Tissoires 	u8 new_speed;
1546f81a1295SBenjamin Tissoires 
1547f81a1295SBenjamin Tissoires 	if (kstrtou8(buf, 0, &new_speed))
1548f81a1295SBenjamin Tissoires 		return -EINVAL;
1549f81a1295SBenjamin Tissoires 
1550f81a1295SBenjamin Tissoires 	if (new_speed != 0 && new_speed != 1)
1551f81a1295SBenjamin Tissoires 		return -EINVAL;
1552f81a1295SBenjamin Tissoires 
1553f81a1295SBenjamin Tissoires 	wacom_bt_query_tablet_data(hdev, new_speed, &wacom->wacom_wac.features);
1554f81a1295SBenjamin Tissoires 
1555f81a1295SBenjamin Tissoires 	return count;
1556f81a1295SBenjamin Tissoires }
1557f81a1295SBenjamin Tissoires 
1558e0984bc3SPing Cheng static DEVICE_ATTR(speed, DEV_ATTR_RW_PERM,
1559f81a1295SBenjamin Tissoires 		wacom_show_speed, wacom_store_speed);
1560f81a1295SBenjamin Tissoires 
156172b236d6SAaron Skomra 
156272b236d6SAaron Skomra static ssize_t wacom_show_remote_mode(struct kobject *kobj,
156372b236d6SAaron Skomra 				      struct kobj_attribute *kattr,
156472b236d6SAaron Skomra 				      char *buf, int index)
156572b236d6SAaron Skomra {
15662cf83833SGeliang Tang 	struct device *dev = kobj_to_dev(kobj->parent);
1567ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);
156872b236d6SAaron Skomra 	struct wacom *wacom = hid_get_drvdata(hdev);
156972b236d6SAaron Skomra 	u8 mode;
157072b236d6SAaron Skomra 
1571a50aac71SBenjamin Tissoires 	mode = wacom->led.groups[index].select;
157272b236d6SAaron Skomra 	if (mode >= 0 && mode < 3)
157372b236d6SAaron Skomra 		return snprintf(buf, PAGE_SIZE, "%d\n", mode);
157472b236d6SAaron Skomra 	else
157572b236d6SAaron Skomra 		return snprintf(buf, PAGE_SIZE, "%d\n", -1);
157672b236d6SAaron Skomra }
157772b236d6SAaron Skomra 
157872b236d6SAaron Skomra #define DEVICE_EKR_ATTR_GROUP(SET_ID)					\
157972b236d6SAaron Skomra static ssize_t wacom_show_remote##SET_ID##_mode(struct kobject *kobj,	\
158072b236d6SAaron Skomra 			       struct kobj_attribute *kattr, char *buf)	\
158172b236d6SAaron Skomra {									\
158272b236d6SAaron Skomra 	return wacom_show_remote_mode(kobj, kattr, buf, SET_ID);	\
158372b236d6SAaron Skomra }									\
158472b236d6SAaron Skomra static struct kobj_attribute remote##SET_ID##_mode_attr = {		\
158572b236d6SAaron Skomra 	.attr = {.name = "remote_mode",					\
158672b236d6SAaron Skomra 		.mode = DEV_ATTR_RO_PERM},				\
158772b236d6SAaron Skomra 	.show = wacom_show_remote##SET_ID##_mode,			\
158872b236d6SAaron Skomra };									\
158972b236d6SAaron Skomra static struct attribute *remote##SET_ID##_serial_attrs[] = {		\
159072b236d6SAaron Skomra 	&remote##SET_ID##_mode_attr.attr,				\
159172b236d6SAaron Skomra 	NULL								\
159272b236d6SAaron Skomra };									\
159372b236d6SAaron Skomra static struct attribute_group remote##SET_ID##_serial_group = {		\
159472b236d6SAaron Skomra 	.name = NULL,							\
159572b236d6SAaron Skomra 	.attrs = remote##SET_ID##_serial_attrs,				\
159672b236d6SAaron Skomra }
159772b236d6SAaron Skomra 
159872b236d6SAaron Skomra DEVICE_EKR_ATTR_GROUP(0);
159972b236d6SAaron Skomra DEVICE_EKR_ATTR_GROUP(1);
160072b236d6SAaron Skomra DEVICE_EKR_ATTR_GROUP(2);
160172b236d6SAaron Skomra DEVICE_EKR_ATTR_GROUP(3);
160272b236d6SAaron Skomra DEVICE_EKR_ATTR_GROUP(4);
160372b236d6SAaron Skomra 
1604e6f2813aSBenjamin Tissoires static int wacom_remote_create_attr_group(struct wacom *wacom, __u32 serial,
1605e6f2813aSBenjamin Tissoires 					  int index)
160672b236d6SAaron Skomra {
160772b236d6SAaron Skomra 	int error = 0;
160883e6b40eSBenjamin Tissoires 	struct wacom_remote *remote = wacom->remote;
160972b236d6SAaron Skomra 
1610e7749f6eSBenjamin Tissoires 	remote->remotes[index].group.name = devm_kasprintf(&wacom->hdev->dev,
1611c1f5409bSBenjamin Tissoires 							  GFP_KERNEL,
1612c1f5409bSBenjamin Tissoires 							  "%d", serial);
1613e7749f6eSBenjamin Tissoires 	if (!remote->remotes[index].group.name)
161472b236d6SAaron Skomra 		return -ENOMEM;
161572b236d6SAaron Skomra 
1616f9036bd4SBenjamin Tissoires 	error = __wacom_devm_sysfs_create_group(wacom, remote->remote_dir,
1617e7749f6eSBenjamin Tissoires 						&remote->remotes[index].group);
161872b236d6SAaron Skomra 	if (error) {
1619e7749f6eSBenjamin Tissoires 		remote->remotes[index].group.name = NULL;
162072b236d6SAaron Skomra 		hid_err(wacom->hdev,
162172b236d6SAaron Skomra 			"cannot create sysfs group err: %d\n", error);
162272b236d6SAaron Skomra 		return error;
162372b236d6SAaron Skomra 	}
162472b236d6SAaron Skomra 
162572b236d6SAaron Skomra 	return 0;
162672b236d6SAaron Skomra }
162772b236d6SAaron Skomra 
162872b236d6SAaron Skomra static int wacom_cmd_unpair_remote(struct wacom *wacom, unsigned char selector)
162972b236d6SAaron Skomra {
163072b236d6SAaron Skomra 	const size_t buf_size = 2;
163172b236d6SAaron Skomra 	unsigned char *buf;
163272b236d6SAaron Skomra 	int retval;
163372b236d6SAaron Skomra 
163472b236d6SAaron Skomra 	buf = kzalloc(buf_size, GFP_KERNEL);
163572b236d6SAaron Skomra 	if (!buf)
163672b236d6SAaron Skomra 		return -ENOMEM;
163772b236d6SAaron Skomra 
163872b236d6SAaron Skomra 	buf[0] = WAC_CMD_DELETE_PAIRING;
163972b236d6SAaron Skomra 	buf[1] = selector;
164072b236d6SAaron Skomra 
164172b236d6SAaron Skomra 	retval = wacom_set_report(wacom->hdev, HID_OUTPUT_REPORT, buf,
164272b236d6SAaron Skomra 				  buf_size, WAC_CMD_RETRIES);
164372b236d6SAaron Skomra 	kfree(buf);
164472b236d6SAaron Skomra 
164572b236d6SAaron Skomra 	return retval;
164672b236d6SAaron Skomra }
164772b236d6SAaron Skomra 
164872b236d6SAaron Skomra static ssize_t wacom_store_unpair_remote(struct kobject *kobj,
164972b236d6SAaron Skomra 					 struct kobj_attribute *attr,
165072b236d6SAaron Skomra 					 const char *buf, size_t count)
165172b236d6SAaron Skomra {
165272b236d6SAaron Skomra 	unsigned char selector = 0;
16532cf83833SGeliang Tang 	struct device *dev = kobj_to_dev(kobj->parent);
1654ee79a8f8SGeliang Tang 	struct hid_device *hdev = to_hid_device(dev);
165572b236d6SAaron Skomra 	struct wacom *wacom = hid_get_drvdata(hdev);
165672b236d6SAaron Skomra 	int err;
165772b236d6SAaron Skomra 
165872b236d6SAaron Skomra 	if (!strncmp(buf, "*\n", 2)) {
165972b236d6SAaron Skomra 		selector = WAC_CMD_UNPAIR_ALL;
166072b236d6SAaron Skomra 	} else {
166172b236d6SAaron Skomra 		hid_info(wacom->hdev, "remote: unrecognized unpair code: %s\n",
166272b236d6SAaron Skomra 			 buf);
166372b236d6SAaron Skomra 		return -1;
166472b236d6SAaron Skomra 	}
166572b236d6SAaron Skomra 
166672b236d6SAaron Skomra 	mutex_lock(&wacom->lock);
166772b236d6SAaron Skomra 
166872b236d6SAaron Skomra 	err = wacom_cmd_unpair_remote(wacom, selector);
166972b236d6SAaron Skomra 	mutex_unlock(&wacom->lock);
167072b236d6SAaron Skomra 
167172b236d6SAaron Skomra 	return err < 0 ? err : count;
167272b236d6SAaron Skomra }
167372b236d6SAaron Skomra 
167472b236d6SAaron Skomra static struct kobj_attribute unpair_remote_attr = {
167572b236d6SAaron Skomra 	.attr = {.name = "unpair_remote", .mode = 0200},
167672b236d6SAaron Skomra 	.store = wacom_store_unpair_remote,
167772b236d6SAaron Skomra };
167872b236d6SAaron Skomra 
167972b236d6SAaron Skomra static const struct attribute *remote_unpair_attrs[] = {
168072b236d6SAaron Skomra 	&unpair_remote_attr.attr,
168172b236d6SAaron Skomra 	NULL
168272b236d6SAaron Skomra };
168372b236d6SAaron Skomra 
168483e6b40eSBenjamin Tissoires static void wacom_remotes_destroy(void *data)
168583e6b40eSBenjamin Tissoires {
168683e6b40eSBenjamin Tissoires 	struct wacom *wacom = data;
168783e6b40eSBenjamin Tissoires 	struct wacom_remote *remote = wacom->remote;
168883e6b40eSBenjamin Tissoires 
168983e6b40eSBenjamin Tissoires 	if (!remote)
169083e6b40eSBenjamin Tissoires 		return;
169183e6b40eSBenjamin Tissoires 
169283e6b40eSBenjamin Tissoires 	kobject_put(remote->remote_dir);
169383e6b40eSBenjamin Tissoires 	kfifo_free(&remote->remote_fifo);
169483e6b40eSBenjamin Tissoires 	wacom->remote = NULL;
169583e6b40eSBenjamin Tissoires }
169683e6b40eSBenjamin Tissoires 
169783e6b40eSBenjamin Tissoires static int wacom_initialize_remotes(struct wacom *wacom)
169872b236d6SAaron Skomra {
169972b236d6SAaron Skomra 	int error = 0;
170083e6b40eSBenjamin Tissoires 	struct wacom_remote *remote;
170172b236d6SAaron Skomra 	int i;
170272b236d6SAaron Skomra 
170372b236d6SAaron Skomra 	if (wacom->wacom_wac.features.type != REMOTE)
170472b236d6SAaron Skomra 		return 0;
170572b236d6SAaron Skomra 
170683e6b40eSBenjamin Tissoires 	remote = devm_kzalloc(&wacom->hdev->dev, sizeof(*wacom->remote),
170783e6b40eSBenjamin Tissoires 			      GFP_KERNEL);
170883e6b40eSBenjamin Tissoires 	if (!remote)
170972b236d6SAaron Skomra 		return -ENOMEM;
171072b236d6SAaron Skomra 
171183e6b40eSBenjamin Tissoires 	wacom->remote = remote;
171283e6b40eSBenjamin Tissoires 
171383e6b40eSBenjamin Tissoires 	spin_lock_init(&remote->remote_lock);
171483e6b40eSBenjamin Tissoires 
171583e6b40eSBenjamin Tissoires 	error = kfifo_alloc(&remote->remote_fifo,
171683e6b40eSBenjamin Tissoires 			5 * sizeof(struct wacom_remote_data),
171783e6b40eSBenjamin Tissoires 			GFP_KERNEL);
171883e6b40eSBenjamin Tissoires 	if (error) {
171983e6b40eSBenjamin Tissoires 		hid_err(wacom->hdev, "failed allocating remote_fifo\n");
172083e6b40eSBenjamin Tissoires 		return -ENOMEM;
172183e6b40eSBenjamin Tissoires 	}
172283e6b40eSBenjamin Tissoires 
1723e7749f6eSBenjamin Tissoires 	remote->remotes[0].group = remote0_serial_group;
1724e7749f6eSBenjamin Tissoires 	remote->remotes[1].group = remote1_serial_group;
1725e7749f6eSBenjamin Tissoires 	remote->remotes[2].group = remote2_serial_group;
1726e7749f6eSBenjamin Tissoires 	remote->remotes[3].group = remote3_serial_group;
1727e7749f6eSBenjamin Tissoires 	remote->remotes[4].group = remote4_serial_group;
172883e6b40eSBenjamin Tissoires 
172983e6b40eSBenjamin Tissoires 	remote->remote_dir = kobject_create_and_add("wacom_remote",
173083e6b40eSBenjamin Tissoires 						    &wacom->hdev->dev.kobj);
173183e6b40eSBenjamin Tissoires 	if (!remote->remote_dir)
173283e6b40eSBenjamin Tissoires 		return -ENOMEM;
173383e6b40eSBenjamin Tissoires 
173483e6b40eSBenjamin Tissoires 	error = sysfs_create_files(remote->remote_dir, remote_unpair_attrs);
173572b236d6SAaron Skomra 
173672b236d6SAaron Skomra 	if (error) {
173772b236d6SAaron Skomra 		hid_err(wacom->hdev,
173872b236d6SAaron Skomra 			"cannot create sysfs group err: %d\n", error);
173972b236d6SAaron Skomra 		return error;
174072b236d6SAaron Skomra 	}
174172b236d6SAaron Skomra 
174272b236d6SAaron Skomra 	for (i = 0; i < WACOM_MAX_REMOTES; i++) {
1743a50aac71SBenjamin Tissoires 		wacom->led.groups[i].select = WACOM_STATUS_UNKNOWN;
1744e7749f6eSBenjamin Tissoires 		remote->remotes[i].serial = 0;
174572b236d6SAaron Skomra 	}
174672b236d6SAaron Skomra 
174783e6b40eSBenjamin Tissoires 	error = devm_add_action_or_reset(&wacom->hdev->dev,
174883e6b40eSBenjamin Tissoires 					 wacom_remotes_destroy, wacom);
174983e6b40eSBenjamin Tissoires 	if (error)
175083e6b40eSBenjamin Tissoires 		return error;
175183e6b40eSBenjamin Tissoires 
175272b236d6SAaron Skomra 	return 0;
175372b236d6SAaron Skomra }
175472b236d6SAaron Skomra 
1755471d1714SBenjamin Tissoires static struct input_dev *wacom_allocate_input(struct wacom *wacom)
1756471d1714SBenjamin Tissoires {
1757471d1714SBenjamin Tissoires 	struct input_dev *input_dev;
1758471d1714SBenjamin Tissoires 	struct hid_device *hdev = wacom->hdev;
1759471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1760471d1714SBenjamin Tissoires 
17613dad188eSBenjamin Tissoires 	input_dev = devm_input_allocate_device(&hdev->dev);
1762471d1714SBenjamin Tissoires 	if (!input_dev)
1763471d1714SBenjamin Tissoires 		return NULL;
1764471d1714SBenjamin Tissoires 
17652bdd163cSJason Gerecke 	input_dev->name = wacom_wac->features.name;
1766471d1714SBenjamin Tissoires 	input_dev->phys = hdev->phys;
1767471d1714SBenjamin Tissoires 	input_dev->dev.parent = &hdev->dev;
1768471d1714SBenjamin Tissoires 	input_dev->open = wacom_open;
1769471d1714SBenjamin Tissoires 	input_dev->close = wacom_close;
1770471d1714SBenjamin Tissoires 	input_dev->uniq = hdev->uniq;
1771471d1714SBenjamin Tissoires 	input_dev->id.bustype = hdev->bus;
1772471d1714SBenjamin Tissoires 	input_dev->id.vendor  = hdev->vendor;
177312969e3bSBenjamin Tissoires 	input_dev->id.product = wacom_wac->pid ? wacom_wac->pid : hdev->product;
1774471d1714SBenjamin Tissoires 	input_dev->id.version = hdev->version;
1775471d1714SBenjamin Tissoires 	input_set_drvdata(input_dev, wacom);
1776471d1714SBenjamin Tissoires 
1777471d1714SBenjamin Tissoires 	return input_dev;
1778471d1714SBenjamin Tissoires }
1779471d1714SBenjamin Tissoires 
1780d9f2d203SJason Gerecke static int wacom_allocate_inputs(struct wacom *wacom)
1781d9f2d203SJason Gerecke {
1782d9f2d203SJason Gerecke 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1783d9f2d203SJason Gerecke 
1784d9f2d203SJason Gerecke 	wacom_wac->pen_input = wacom_allocate_input(wacom);
1785d9f2d203SJason Gerecke 	wacom_wac->touch_input = wacom_allocate_input(wacom);
1786d9f2d203SJason Gerecke 	wacom_wac->pad_input = wacom_allocate_input(wacom);
17873dad188eSBenjamin Tissoires 	if (!wacom_wac->pen_input ||
17883dad188eSBenjamin Tissoires 	    !wacom_wac->touch_input ||
17893dad188eSBenjamin Tissoires 	    !wacom_wac->pad_input)
1790d9f2d203SJason Gerecke 		return -ENOMEM;
1791d9f2d203SJason Gerecke 
17922bdd163cSJason Gerecke 	wacom_wac->pen_input->name = wacom_wac->pen_name;
1793d9f2d203SJason Gerecke 	wacom_wac->touch_input->name = wacom_wac->touch_name;
1794d9f2d203SJason Gerecke 	wacom_wac->pad_input->name = wacom_wac->pad_name;
1795d9f2d203SJason Gerecke 
1796d9f2d203SJason Gerecke 	return 0;
1797d9f2d203SJason Gerecke }
1798d9f2d203SJason Gerecke 
1799471d1714SBenjamin Tissoires static int wacom_register_inputs(struct wacom *wacom)
1800471d1714SBenjamin Tissoires {
18012a6cdbddSJason Gerecke 	struct input_dev *pen_input_dev, *touch_input_dev, *pad_input_dev;
1802471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
18032636a3f2SJason Gerecke 	int error = 0;
1804471d1714SBenjamin Tissoires 
18052a6cdbddSJason Gerecke 	pen_input_dev = wacom_wac->pen_input;
18062a6cdbddSJason Gerecke 	touch_input_dev = wacom_wac->touch_input;
18072546dacdSBenjamin Tissoires 	pad_input_dev = wacom_wac->pad_input;
1808471d1714SBenjamin Tissoires 
18092a6cdbddSJason Gerecke 	if (!pen_input_dev || !touch_input_dev || !pad_input_dev)
18102546dacdSBenjamin Tissoires 		return -EINVAL;
1811471d1714SBenjamin Tissoires 
18122a6cdbddSJason Gerecke 	error = wacom_setup_pen_input_capabilities(pen_input_dev, wacom_wac);
18132a6cdbddSJason Gerecke 	if (error) {
18142a6cdbddSJason Gerecke 		/* no pen in use on this interface */
18152a6cdbddSJason Gerecke 		input_free_device(pen_input_dev);
18162a6cdbddSJason Gerecke 		wacom_wac->pen_input = NULL;
18172a6cdbddSJason Gerecke 		pen_input_dev = NULL;
18182a6cdbddSJason Gerecke 	} else {
18192a6cdbddSJason Gerecke 		error = input_register_device(pen_input_dev);
1820471d1714SBenjamin Tissoires 		if (error)
18213dad188eSBenjamin Tissoires 			goto fail;
18222a6cdbddSJason Gerecke 	}
18232a6cdbddSJason Gerecke 
18242a6cdbddSJason Gerecke 	error = wacom_setup_touch_input_capabilities(touch_input_dev, wacom_wac);
18252a6cdbddSJason Gerecke 	if (error) {
18262a6cdbddSJason Gerecke 		/* no touch in use on this interface */
18272a6cdbddSJason Gerecke 		input_free_device(touch_input_dev);
18282a6cdbddSJason Gerecke 		wacom_wac->touch_input = NULL;
18292a6cdbddSJason Gerecke 		touch_input_dev = NULL;
18302a6cdbddSJason Gerecke 	} else {
18312a6cdbddSJason Gerecke 		error = input_register_device(touch_input_dev);
18322a6cdbddSJason Gerecke 		if (error)
18333dad188eSBenjamin Tissoires 			goto fail;
183430ebc1aeSPing Cheng 	}
1835471d1714SBenjamin Tissoires 
1836471d1714SBenjamin Tissoires 	error = wacom_setup_pad_input_capabilities(pad_input_dev, wacom_wac);
1837471d1714SBenjamin Tissoires 	if (error) {
1838471d1714SBenjamin Tissoires 		/* no pad in use on this interface */
1839471d1714SBenjamin Tissoires 		input_free_device(pad_input_dev);
1840471d1714SBenjamin Tissoires 		wacom_wac->pad_input = NULL;
1841471d1714SBenjamin Tissoires 		pad_input_dev = NULL;
1842471d1714SBenjamin Tissoires 	} else {
1843471d1714SBenjamin Tissoires 		error = input_register_device(pad_input_dev);
1844471d1714SBenjamin Tissoires 		if (error)
18453dad188eSBenjamin Tissoires 			goto fail;
1846471d1714SBenjamin Tissoires 	}
1847471d1714SBenjamin Tissoires 
1848471d1714SBenjamin Tissoires 	return 0;
1849471d1714SBenjamin Tissoires 
18503dad188eSBenjamin Tissoires fail:
18513dad188eSBenjamin Tissoires 	wacom_wac->pad_input = NULL;
18522a6cdbddSJason Gerecke 	wacom_wac->touch_input = NULL;
18532a6cdbddSJason Gerecke 	wacom_wac->pen_input = NULL;
1854471d1714SBenjamin Tissoires 	return error;
1855471d1714SBenjamin Tissoires }
1856471d1714SBenjamin Tissoires 
18570be01712SJason Gerecke /*
18580be01712SJason Gerecke  * Not all devices report physical dimensions from HID.
18590be01712SJason Gerecke  * Compute the default from hardcoded logical dimension
18600be01712SJason Gerecke  * and resolution before driver overwrites them.
18610be01712SJason Gerecke  */
18620be01712SJason Gerecke static void wacom_set_default_phy(struct wacom_features *features)
18630be01712SJason Gerecke {
18640be01712SJason Gerecke 	if (features->x_resolution) {
18650be01712SJason Gerecke 		features->x_phy = (features->x_max * 100) /
18660be01712SJason Gerecke 					features->x_resolution;
18670be01712SJason Gerecke 		features->y_phy = (features->y_max * 100) /
18680be01712SJason Gerecke 					features->y_resolution;
18690be01712SJason Gerecke 	}
18700be01712SJason Gerecke }
18710be01712SJason Gerecke 
18720be01712SJason Gerecke static void wacom_calculate_res(struct wacom_features *features)
18730be01712SJason Gerecke {
18740be01712SJason Gerecke 	/* set unit to "100th of a mm" for devices not reported by HID */
18750be01712SJason Gerecke 	if (!features->unit) {
18760be01712SJason Gerecke 		features->unit = 0x11;
18770be01712SJason Gerecke 		features->unitExpo = -3;
18780be01712SJason Gerecke 	}
18790be01712SJason Gerecke 
18800be01712SJason Gerecke 	features->x_resolution = wacom_calc_hid_res(features->x_max,
18810be01712SJason Gerecke 						    features->x_phy,
18820be01712SJason Gerecke 						    features->unit,
18830be01712SJason Gerecke 						    features->unitExpo);
18840be01712SJason Gerecke 	features->y_resolution = wacom_calc_hid_res(features->y_max,
18850be01712SJason Gerecke 						    features->y_phy,
18860be01712SJason Gerecke 						    features->unit,
18870be01712SJason Gerecke 						    features->unitExpo);
18880be01712SJason Gerecke }
18890be01712SJason Gerecke 
1890fce9957dSJason Gerecke void wacom_battery_work(struct work_struct *work)
1891fce9957dSJason Gerecke {
1892d17d1f17SBenjamin Tissoires 	struct wacom *wacom = container_of(work, struct wacom, battery_work);
1893fce9957dSJason Gerecke 
1894fce9957dSJason Gerecke 	if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
189559d69bc8SBenjamin Tissoires 	     !wacom->battery.battery) {
1896fce9957dSJason Gerecke 		wacom_initialize_battery(wacom);
1897fce9957dSJason Gerecke 	}
1898fce9957dSJason Gerecke 	else if (!(wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
189959d69bc8SBenjamin Tissoires 		 wacom->battery.battery) {
1900fce9957dSJason Gerecke 		wacom_destroy_battery(wacom);
1901fce9957dSJason Gerecke 	}
1902fce9957dSJason Gerecke }
1903fce9957dSJason Gerecke 
1904471d1714SBenjamin Tissoires static size_t wacom_compute_pktlen(struct hid_device *hdev)
1905471d1714SBenjamin Tissoires {
1906471d1714SBenjamin Tissoires 	struct hid_report_enum *report_enum;
1907471d1714SBenjamin Tissoires 	struct hid_report *report;
1908471d1714SBenjamin Tissoires 	size_t size = 0;
1909471d1714SBenjamin Tissoires 
1910471d1714SBenjamin Tissoires 	report_enum = hdev->report_enum + HID_INPUT_REPORT;
1911471d1714SBenjamin Tissoires 
1912471d1714SBenjamin Tissoires 	list_for_each_entry(report, &report_enum->report_list, list) {
1913dabb05c6SMathieu Magnaudet 		size_t report_size = hid_report_len(report);
1914471d1714SBenjamin Tissoires 		if (report_size > size)
1915471d1714SBenjamin Tissoires 			size = report_size;
1916471d1714SBenjamin Tissoires 	}
1917471d1714SBenjamin Tissoires 
1918471d1714SBenjamin Tissoires 	return size;
1919471d1714SBenjamin Tissoires }
1920471d1714SBenjamin Tissoires 
1921fd5f92b6SBenjamin Tissoires static void wacom_update_name(struct wacom *wacom, const char *suffix)
1922c24eab4eSPing Cheng {
1923c24eab4eSPing Cheng 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1924c24eab4eSPing Cheng 	struct wacom_features *features = &wacom_wac->features;
192544b5250bSJason Gerecke 	char name[WACOM_NAME_MAX];
1926c24eab4eSPing Cheng 
1927c24eab4eSPing Cheng 	/* Generic devices name unspecified */
1928c24eab4eSPing Cheng 	if ((features->type == HID_GENERIC) && !strcmp("Wacom HID", features->name)) {
1929c24eab4eSPing Cheng 		if (strstr(wacom->hdev->name, "Wacom") ||
1930c24eab4eSPing Cheng 		    strstr(wacom->hdev->name, "wacom") ||
1931c24eab4eSPing Cheng 		    strstr(wacom->hdev->name, "WACOM")) {
1932c24eab4eSPing Cheng 			/* name is in HID descriptor, use it */
193344b5250bSJason Gerecke 			strlcpy(name, wacom->hdev->name, sizeof(name));
1934c24eab4eSPing Cheng 
1935c24eab4eSPing Cheng 			/* strip out excess whitespaces */
1936c24eab4eSPing Cheng 			while (1) {
193744b5250bSJason Gerecke 				char *gap = strstr(name, "  ");
1938c24eab4eSPing Cheng 				if (gap == NULL)
1939c24eab4eSPing Cheng 					break;
1940c24eab4eSPing Cheng 				/* shift everything including the terminator */
1941c24eab4eSPing Cheng 				memmove(gap, gap+1, strlen(gap));
1942c24eab4eSPing Cheng 			}
1943c24eab4eSPing Cheng 			/* get rid of trailing whitespace */
194444b5250bSJason Gerecke 			if (name[strlen(name)-1] == ' ')
194544b5250bSJason Gerecke 				name[strlen(name)-1] = '\0';
1946c24eab4eSPing Cheng 		} else {
1947c24eab4eSPing Cheng 			/* no meaningful name retrieved. use product ID */
194844b5250bSJason Gerecke 			snprintf(name, sizeof(name),
1949c24eab4eSPing Cheng 				 "%s %X", features->name, wacom->hdev->product);
1950c24eab4eSPing Cheng 		}
1951c24eab4eSPing Cheng 	} else {
195244b5250bSJason Gerecke 		strlcpy(name, features->name, sizeof(name));
1953c24eab4eSPing Cheng 	}
1954c24eab4eSPing Cheng 
19559956953eSBenjamin Tissoires 	snprintf(wacom_wac->name, sizeof(wacom_wac->name), "%s%s",
19569956953eSBenjamin Tissoires 		 name, suffix);
19579956953eSBenjamin Tissoires 
1958c24eab4eSPing Cheng 	/* Append the device type to the name */
19592a6cdbddSJason Gerecke 	snprintf(wacom_wac->pen_name, sizeof(wacom_wac->pen_name),
1960fd5f92b6SBenjamin Tissoires 		"%s%s Pen", name, suffix);
19612a6cdbddSJason Gerecke 	snprintf(wacom_wac->touch_name, sizeof(wacom_wac->touch_name),
1962fd5f92b6SBenjamin Tissoires 		"%s%s Finger", name, suffix);
1963c24eab4eSPing Cheng 	snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
1964fd5f92b6SBenjamin Tissoires 		"%s%s Pad", name, suffix);
19658d80f790SJason Gerecke }
1966c24eab4eSPing Cheng 
196784dfbd7fSBenjamin Tissoires static void wacom_release_resources(struct wacom *wacom)
196884dfbd7fSBenjamin Tissoires {
196984dfbd7fSBenjamin Tissoires 	struct hid_device *hdev = wacom->hdev;
197084dfbd7fSBenjamin Tissoires 
197184dfbd7fSBenjamin Tissoires 	if (!wacom->resources)
197284dfbd7fSBenjamin Tissoires 		return;
197384dfbd7fSBenjamin Tissoires 
197484dfbd7fSBenjamin Tissoires 	devres_release_group(&hdev->dev, wacom);
197584dfbd7fSBenjamin Tissoires 
197684dfbd7fSBenjamin Tissoires 	wacom->resources = false;
197784dfbd7fSBenjamin Tissoires 
197884dfbd7fSBenjamin Tissoires 	wacom->wacom_wac.pen_input = NULL;
197984dfbd7fSBenjamin Tissoires 	wacom->wacom_wac.touch_input = NULL;
198084dfbd7fSBenjamin Tissoires 	wacom->wacom_wac.pad_input = NULL;
198184dfbd7fSBenjamin Tissoires }
198284dfbd7fSBenjamin Tissoires 
1983fd5f92b6SBenjamin Tissoires static int wacom_parse_and_register(struct wacom *wacom, bool wireless)
1984471d1714SBenjamin Tissoires {
1985c58ac3a8SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1986c58ac3a8SBenjamin Tissoires 	struct wacom_features *features = &wacom_wac->features;
1987c58ac3a8SBenjamin Tissoires 	struct hid_device *hdev = wacom->hdev;
1988471d1714SBenjamin Tissoires 	int error;
19897704ac93SBenjamin Tissoires 	unsigned int connect_mask = HID_CONNECT_HIDRAW;
1990471d1714SBenjamin Tissoires 
1991471d1714SBenjamin Tissoires 	features->pktlen = wacom_compute_pktlen(hdev);
1992c58ac3a8SBenjamin Tissoires 	if (features->pktlen > WACOM_PKGLEN_MAX)
1993c58ac3a8SBenjamin Tissoires 		return -EINVAL;
1994471d1714SBenjamin Tissoires 
199584dfbd7fSBenjamin Tissoires 	if (!devres_open_group(&hdev->dev, wacom, GFP_KERNEL))
199684dfbd7fSBenjamin Tissoires 		return -ENOMEM;
199784dfbd7fSBenjamin Tissoires 
199884dfbd7fSBenjamin Tissoires 	wacom->resources = true;
199984dfbd7fSBenjamin Tissoires 
2000494078b0SBenjamin Tissoires 	error = wacom_allocate_inputs(wacom);
2001494078b0SBenjamin Tissoires 	if (error)
20023888b0d5SBenjamin Tissoires 		goto fail;
2003494078b0SBenjamin Tissoires 
20048c97a765SBenjamin Tissoires 	/*
20058c97a765SBenjamin Tissoires 	 * Bamboo Pad has a generic hid handling for the Pen, and we switch it
20068c97a765SBenjamin Tissoires 	 * into debug mode for the touch part.
20078c97a765SBenjamin Tissoires 	 * We ignore the other interfaces.
20088c97a765SBenjamin Tissoires 	 */
20098c97a765SBenjamin Tissoires 	if (features->type == BAMBOO_PAD) {
20108c97a765SBenjamin Tissoires 		if (features->pktlen == WACOM_PKGLEN_PENABLED) {
20118c97a765SBenjamin Tissoires 			features->type = HID_GENERIC;
20128c97a765SBenjamin Tissoires 		} else if ((features->pktlen != WACOM_PKGLEN_BPAD_TOUCH) &&
20138c97a765SBenjamin Tissoires 			   (features->pktlen != WACOM_PKGLEN_BPAD_TOUCH_USB)) {
20148c97a765SBenjamin Tissoires 			error = -ENODEV;
20153888b0d5SBenjamin Tissoires 			goto fail;
20168c97a765SBenjamin Tissoires 		}
20178c97a765SBenjamin Tissoires 	}
20188c97a765SBenjamin Tissoires 
2019471d1714SBenjamin Tissoires 	/* set the default size in case we do not get them from hid */
2020471d1714SBenjamin Tissoires 	wacom_set_default_phy(features);
2021471d1714SBenjamin Tissoires 
2022471d1714SBenjamin Tissoires 	/* Retrieve the physical and logical size for touch devices */
2023471d1714SBenjamin Tissoires 	wacom_retrieve_hid_descriptor(hdev, features);
202442f4f272SPing Cheng 	wacom_setup_device_quirks(wacom);
2025042628abSJason Gerecke 
2026aa86b18cSJason Gerecke 	if (features->device_type == WACOM_DEVICETYPE_NONE &&
2027aa86b18cSJason Gerecke 	    features->type != WIRELESS) {
20288e116d31SJason Gerecke 		error = features->type == HID_GENERIC ? -ENODEV : 0;
20298e116d31SJason Gerecke 
2030042628abSJason Gerecke 		dev_warn(&hdev->dev, "Unknown device_type for '%s'. %s.",
20318e116d31SJason Gerecke 			 hdev->name,
20328e116d31SJason Gerecke 			 error ? "Ignoring" : "Assuming pen");
20338e116d31SJason Gerecke 
20348e116d31SJason Gerecke 		if (error)
20353888b0d5SBenjamin Tissoires 			goto fail;
2036042628abSJason Gerecke 
2037aa86b18cSJason Gerecke 		features->device_type |= WACOM_DEVICETYPE_PEN;
2038042628abSJason Gerecke 	}
2039042628abSJason Gerecke 
2040471d1714SBenjamin Tissoires 	wacom_calculate_res(features);
2041471d1714SBenjamin Tissoires 
2042fd5f92b6SBenjamin Tissoires 	wacom_update_name(wacom, wireless ? " (WL)" : "");
2043471d1714SBenjamin Tissoires 
2044471d1714SBenjamin Tissoires 	error = wacom_add_shared_data(hdev);
2045471d1714SBenjamin Tissoires 	if (error)
20463888b0d5SBenjamin Tissoires 		goto fail;
2047471d1714SBenjamin Tissoires 
2048ccad85ccSJason Gerecke 	if (!(features->device_type & WACOM_DEVICETYPE_WL_MONITOR) &&
2049f81a1295SBenjamin Tissoires 	     (features->quirks & WACOM_QUIRK_BATTERY)) {
2050f81a1295SBenjamin Tissoires 		error = wacom_initialize_battery(wacom);
2051f81a1295SBenjamin Tissoires 		if (error)
20523888b0d5SBenjamin Tissoires 			goto fail;
2053f81a1295SBenjamin Tissoires 	}
2054f81a1295SBenjamin Tissoires 
2055494078b0SBenjamin Tissoires 	error = wacom_register_inputs(wacom);
2056471d1714SBenjamin Tissoires 	if (error)
20573888b0d5SBenjamin Tissoires 		goto fail;
2058f81a1295SBenjamin Tissoires 
2059b62f6465SBenjamin Tissoires 	if (wacom->wacom_wac.features.device_type & WACOM_DEVICETYPE_PAD) {
206085d2c77bSBenjamin Tissoires 		error = wacom_initialize_leds(wacom);
206185d2c77bSBenjamin Tissoires 		if (error)
20623888b0d5SBenjamin Tissoires 			goto fail;
206385d2c77bSBenjamin Tissoires 
206483e6b40eSBenjamin Tissoires 		error = wacom_initialize_remotes(wacom);
2065b62f6465SBenjamin Tissoires 		if (error)
20663888b0d5SBenjamin Tissoires 			goto fail;
2067b62f6465SBenjamin Tissoires 	}
2068b62f6465SBenjamin Tissoires 
20697704ac93SBenjamin Tissoires 	if (features->type == HID_GENERIC)
20707704ac93SBenjamin Tissoires 		connect_mask |= HID_CONNECT_DRIVER;
20717704ac93SBenjamin Tissoires 
2072471d1714SBenjamin Tissoires 	/* Regular HID work starts now */
20737704ac93SBenjamin Tissoires 	error = hid_hw_start(hdev, connect_mask);
2074471d1714SBenjamin Tissoires 	if (error) {
2075471d1714SBenjamin Tissoires 		hid_err(hdev, "hw start failed\n");
20763888b0d5SBenjamin Tissoires 		goto fail;
2077471d1714SBenjamin Tissoires 	}
2078471d1714SBenjamin Tissoires 
2079fd5f92b6SBenjamin Tissoires 	if (!wireless) {
208086e88f0eSJason Gerecke 		/* Note that if query fails it is not a hard failure */
208186e88f0eSJason Gerecke 		wacom_query_tablet_data(hdev, features);
2082fd5f92b6SBenjamin Tissoires 	}
208386e88f0eSJason Gerecke 
208486e88f0eSJason Gerecke 	/* touch only Bamboo doesn't support pen */
208586e88f0eSJason Gerecke 	if ((features->type == BAMBOO_TOUCH) &&
208686e88f0eSJason Gerecke 	    (features->device_type & WACOM_DEVICETYPE_PEN)) {
208786e88f0eSJason Gerecke 		error = -ENODEV;
2088b62f6465SBenjamin Tissoires 		goto fail_quirks;
208986e88f0eSJason Gerecke 	}
209086e88f0eSJason Gerecke 
209186e88f0eSJason Gerecke 	/* pen only Bamboo neither support touch nor pad */
209286e88f0eSJason Gerecke 	if ((features->type == BAMBOO_PEN) &&
209386e88f0eSJason Gerecke 	    ((features->device_type & WACOM_DEVICETYPE_TOUCH) ||
209486e88f0eSJason Gerecke 	    (features->device_type & WACOM_DEVICETYPE_PAD))) {
209586e88f0eSJason Gerecke 		error = -ENODEV;
2096b62f6465SBenjamin Tissoires 		goto fail_quirks;
209786e88f0eSJason Gerecke 	}
209886e88f0eSJason Gerecke 
2099ccad85ccSJason Gerecke 	if (features->device_type & WACOM_DEVICETYPE_WL_MONITOR)
2100471d1714SBenjamin Tissoires 		error = hid_hw_open(hdev);
2101471d1714SBenjamin Tissoires 
2102eda01dabSPing Cheng 	if ((wacom_wac->features.type == INTUOSHT ||
2103eda01dabSPing Cheng 	     wacom_wac->features.type == INTUOSHT2) &&
2104eda01dabSPing Cheng 	    (wacom_wac->features.device_type & WACOM_DEVICETYPE_TOUCH)) {
210597f9afa4SBenjamin Tissoires 		wacom_wac->shared->type = wacom_wac->features.type;
21062a6cdbddSJason Gerecke 		wacom_wac->shared->touch_input = wacom_wac->touch_input;
2107471d1714SBenjamin Tissoires 	}
2108471d1714SBenjamin Tissoires 
210984dfbd7fSBenjamin Tissoires 	devres_close_group(&hdev->dev, wacom);
211084dfbd7fSBenjamin Tissoires 
2111471d1714SBenjamin Tissoires 	return 0;
2112471d1714SBenjamin Tissoires 
2113b62f6465SBenjamin Tissoires fail_quirks:
2114c58ac3a8SBenjamin Tissoires 	hid_hw_stop(hdev);
21153888b0d5SBenjamin Tissoires fail:
211684dfbd7fSBenjamin Tissoires 	wacom_release_resources(wacom);
2117c58ac3a8SBenjamin Tissoires 	return error;
2118c58ac3a8SBenjamin Tissoires }
2119c58ac3a8SBenjamin Tissoires 
2120a2f091afSBenjamin Tissoires static void wacom_wireless_work(struct work_struct *work)
2121a2f091afSBenjamin Tissoires {
2122d17d1f17SBenjamin Tissoires 	struct wacom *wacom = container_of(work, struct wacom, wireless_work);
2123a2f091afSBenjamin Tissoires 	struct usb_device *usbdev = wacom->usbdev;
2124a2f091afSBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
2125a2f091afSBenjamin Tissoires 	struct hid_device *hdev1, *hdev2;
2126a2f091afSBenjamin Tissoires 	struct wacom *wacom1, *wacom2;
2127a2f091afSBenjamin Tissoires 	struct wacom_wac *wacom_wac1, *wacom_wac2;
2128a2f091afSBenjamin Tissoires 	int error;
2129a2f091afSBenjamin Tissoires 
2130a2f091afSBenjamin Tissoires 	/*
2131a2f091afSBenjamin Tissoires 	 * Regardless if this is a disconnect or a new tablet,
2132a2f091afSBenjamin Tissoires 	 * remove any existing input and battery devices.
2133a2f091afSBenjamin Tissoires 	 */
2134a2f091afSBenjamin Tissoires 
2135a2f091afSBenjamin Tissoires 	wacom_destroy_battery(wacom);
2136a2f091afSBenjamin Tissoires 
2137a2f091afSBenjamin Tissoires 	/* Stylus interface */
2138a2f091afSBenjamin Tissoires 	hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
2139a2f091afSBenjamin Tissoires 	wacom1 = hid_get_drvdata(hdev1);
2140a2f091afSBenjamin Tissoires 	wacom_wac1 = &(wacom1->wacom_wac);
214184dfbd7fSBenjamin Tissoires 	wacom_release_resources(wacom1);
2142a2f091afSBenjamin Tissoires 
2143a2f091afSBenjamin Tissoires 	/* Touch interface */
2144a2f091afSBenjamin Tissoires 	hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
2145a2f091afSBenjamin Tissoires 	wacom2 = hid_get_drvdata(hdev2);
2146a2f091afSBenjamin Tissoires 	wacom_wac2 = &(wacom2->wacom_wac);
214784dfbd7fSBenjamin Tissoires 	wacom_release_resources(wacom2);
2148a2f091afSBenjamin Tissoires 
2149a2f091afSBenjamin Tissoires 	if (wacom_wac->pid == 0) {
2150a2f091afSBenjamin Tissoires 		hid_info(wacom->hdev, "wireless tablet disconnected\n");
2151a2f091afSBenjamin Tissoires 	} else {
2152a2f091afSBenjamin Tissoires 		const struct hid_device_id *id = wacom_ids;
2153a2f091afSBenjamin Tissoires 
2154a2f091afSBenjamin Tissoires 		hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
2155a2f091afSBenjamin Tissoires 			 wacom_wac->pid);
2156a2f091afSBenjamin Tissoires 
2157a2f091afSBenjamin Tissoires 		while (id->bus) {
2158a2f091afSBenjamin Tissoires 			if (id->vendor == USB_VENDOR_ID_WACOM &&
2159a2f091afSBenjamin Tissoires 			    id->product == wacom_wac->pid)
2160a2f091afSBenjamin Tissoires 				break;
2161a2f091afSBenjamin Tissoires 			id++;
2162a2f091afSBenjamin Tissoires 		}
2163a2f091afSBenjamin Tissoires 
2164a2f091afSBenjamin Tissoires 		if (!id->bus) {
2165a2f091afSBenjamin Tissoires 			hid_info(wacom->hdev, "ignoring unknown PID.\n");
2166a2f091afSBenjamin Tissoires 			return;
2167a2f091afSBenjamin Tissoires 		}
2168a2f091afSBenjamin Tissoires 
2169a2f091afSBenjamin Tissoires 		/* Stylus interface */
2170a2f091afSBenjamin Tissoires 		wacom_wac1->features =
2171a2f091afSBenjamin Tissoires 			*((struct wacom_features *)id->driver_data);
2172fd5f92b6SBenjamin Tissoires 
2173a2f091afSBenjamin Tissoires 		wacom_wac1->pid = wacom_wac->pid;
2174fd5f92b6SBenjamin Tissoires 		hid_hw_stop(hdev1);
2175fd5f92b6SBenjamin Tissoires 		error = wacom_parse_and_register(wacom1, true);
2176a2f091afSBenjamin Tissoires 		if (error)
2177a2f091afSBenjamin Tissoires 			goto fail;
2178a2f091afSBenjamin Tissoires 
2179a2f091afSBenjamin Tissoires 		/* Touch interface */
2180a2f091afSBenjamin Tissoires 		if (wacom_wac1->features.touch_max ||
2181a2f091afSBenjamin Tissoires 		    (wacom_wac1->features.type >= INTUOSHT &&
2182a2f091afSBenjamin Tissoires 		    wacom_wac1->features.type <= BAMBOO_PT)) {
2183a2f091afSBenjamin Tissoires 			wacom_wac2->features =
2184a2f091afSBenjamin Tissoires 				*((struct wacom_features *)id->driver_data);
2185a2f091afSBenjamin Tissoires 			wacom_wac2->pid = wacom_wac->pid;
2186fd5f92b6SBenjamin Tissoires 			hid_hw_stop(hdev2);
2187fd5f92b6SBenjamin Tissoires 			error = wacom_parse_and_register(wacom2, true);
2188a2f091afSBenjamin Tissoires 			if (error)
2189a2f091afSBenjamin Tissoires 				goto fail;
2190a2f091afSBenjamin Tissoires 		}
2191a2f091afSBenjamin Tissoires 
21929956953eSBenjamin Tissoires 		strlcpy(wacom_wac->name, wacom_wac1->name,
21939956953eSBenjamin Tissoires 			sizeof(wacom_wac->name));
2194a2f091afSBenjamin Tissoires 		error = wacom_initialize_battery(wacom);
2195a2f091afSBenjamin Tissoires 		if (error)
2196a2f091afSBenjamin Tissoires 			goto fail;
2197a2f091afSBenjamin Tissoires 	}
2198a2f091afSBenjamin Tissoires 
2199a2f091afSBenjamin Tissoires 	return;
2200a2f091afSBenjamin Tissoires 
2201a2f091afSBenjamin Tissoires fail:
220284dfbd7fSBenjamin Tissoires 	wacom_release_resources(wacom1);
220384dfbd7fSBenjamin Tissoires 	wacom_release_resources(wacom2);
2204a2f091afSBenjamin Tissoires 	return;
2205a2f091afSBenjamin Tissoires }
2206a2f091afSBenjamin Tissoires 
220704bfa27bSBenjamin Tissoires static void wacom_remote_destroy_one(struct wacom *wacom, unsigned int index)
220804bfa27bSBenjamin Tissoires {
220904bfa27bSBenjamin Tissoires 	struct wacom_remote *remote = wacom->remote;
2210e7749f6eSBenjamin Tissoires 	u32 serial = remote->remotes[index].serial;
221104bfa27bSBenjamin Tissoires 	int i;
22127c35dc3cSBenjamin Tissoires 	unsigned long flags;
22137c35dc3cSBenjamin Tissoires 
22147c35dc3cSBenjamin Tissoires 	spin_lock_irqsave(&remote->remote_lock, flags);
22157c35dc3cSBenjamin Tissoires 	remote->remotes[index].registered = false;
22167c35dc3cSBenjamin Tissoires 	spin_unlock_irqrestore(&remote->remote_lock, flags);
221704bfa27bSBenjamin Tissoires 
22189f1015d4SBenjamin Tissoires 	if (remote->remotes[index].battery.battery)
22199f1015d4SBenjamin Tissoires 		devres_release_group(&wacom->hdev->dev,
22209f1015d4SBenjamin Tissoires 				     &remote->remotes[index].battery.bat_desc);
22219f1015d4SBenjamin Tissoires 
2222e7749f6eSBenjamin Tissoires 	if (remote->remotes[index].group.name)
2223e7749f6eSBenjamin Tissoires 		devres_release_group(&wacom->hdev->dev,
2224e7749f6eSBenjamin Tissoires 				     &remote->remotes[index]);
222504bfa27bSBenjamin Tissoires 
222604bfa27bSBenjamin Tissoires 	for (i = 0; i < WACOM_MAX_REMOTES; i++) {
2227e7749f6eSBenjamin Tissoires 		if (remote->remotes[i].serial == serial) {
2228e7749f6eSBenjamin Tissoires 			remote->remotes[i].serial = 0;
2229e7749f6eSBenjamin Tissoires 			remote->remotes[i].group.name = NULL;
22307c35dc3cSBenjamin Tissoires 			remote->remotes[i].registered = false;
22319f1015d4SBenjamin Tissoires 			remote->remotes[i].battery.battery = NULL;
223204bfa27bSBenjamin Tissoires 			wacom->led.groups[i].select = WACOM_STATUS_UNKNOWN;
223304bfa27bSBenjamin Tissoires 		}
223404bfa27bSBenjamin Tissoires 	}
223504bfa27bSBenjamin Tissoires }
223604bfa27bSBenjamin Tissoires 
223704bfa27bSBenjamin Tissoires static int wacom_remote_create_one(struct wacom *wacom, u32 serial,
223804bfa27bSBenjamin Tissoires 				   unsigned int index)
223904bfa27bSBenjamin Tissoires {
224004bfa27bSBenjamin Tissoires 	struct wacom_remote *remote = wacom->remote;
2241f9036bd4SBenjamin Tissoires 	struct device *dev = &wacom->hdev->dev;
224204bfa27bSBenjamin Tissoires 	int error, k;
224304bfa27bSBenjamin Tissoires 
224404bfa27bSBenjamin Tissoires 	/* A remote can pair more than once with an EKR,
224504bfa27bSBenjamin Tissoires 	 * check to make sure this serial isn't already paired.
224604bfa27bSBenjamin Tissoires 	 */
224704bfa27bSBenjamin Tissoires 	for (k = 0; k < WACOM_MAX_REMOTES; k++) {
2248e7749f6eSBenjamin Tissoires 		if (remote->remotes[k].serial == serial)
224904bfa27bSBenjamin Tissoires 			break;
225004bfa27bSBenjamin Tissoires 	}
225104bfa27bSBenjamin Tissoires 
225204bfa27bSBenjamin Tissoires 	if (k < WACOM_MAX_REMOTES) {
2253e7749f6eSBenjamin Tissoires 		remote->remotes[index].serial = serial;
225404bfa27bSBenjamin Tissoires 		return 0;
225504bfa27bSBenjamin Tissoires 	}
225604bfa27bSBenjamin Tissoires 
2257e7749f6eSBenjamin Tissoires 	if (!devres_open_group(dev, &remote->remotes[index], GFP_KERNEL))
2258f9036bd4SBenjamin Tissoires 		return -ENOMEM;
2259f9036bd4SBenjamin Tissoires 
226004bfa27bSBenjamin Tissoires 	error = wacom_remote_create_attr_group(wacom, serial, index);
226104bfa27bSBenjamin Tissoires 	if (error)
2262f9036bd4SBenjamin Tissoires 		goto fail;
226304bfa27bSBenjamin Tissoires 
22647c35dc3cSBenjamin Tissoires 	remote->remotes[index].input = wacom_allocate_input(wacom);
22657c35dc3cSBenjamin Tissoires 	if (!remote->remotes[index].input) {
22667c35dc3cSBenjamin Tissoires 		error = -ENOMEM;
22677c35dc3cSBenjamin Tissoires 		goto fail;
22687c35dc3cSBenjamin Tissoires 	}
22697c35dc3cSBenjamin Tissoires 	remote->remotes[index].input->uniq = remote->remotes[index].group.name;
22707c35dc3cSBenjamin Tissoires 	remote->remotes[index].input->name = wacom->wacom_wac.pad_name;
22717c35dc3cSBenjamin Tissoires 
22727c35dc3cSBenjamin Tissoires 	if (!remote->remotes[index].input->name) {
22737c35dc3cSBenjamin Tissoires 		error = -EINVAL;
22747c35dc3cSBenjamin Tissoires 		goto fail;
22757c35dc3cSBenjamin Tissoires 	}
22767c35dc3cSBenjamin Tissoires 
22777c35dc3cSBenjamin Tissoires 	error = wacom_setup_pad_input_capabilities(remote->remotes[index].input,
22787c35dc3cSBenjamin Tissoires 						   &wacom->wacom_wac);
22797c35dc3cSBenjamin Tissoires 	if (error)
22807c35dc3cSBenjamin Tissoires 		goto fail;
22817c35dc3cSBenjamin Tissoires 
2282e7749f6eSBenjamin Tissoires 	remote->remotes[index].serial = serial;
228304bfa27bSBenjamin Tissoires 
22847c35dc3cSBenjamin Tissoires 	error = input_register_device(remote->remotes[index].input);
22857c35dc3cSBenjamin Tissoires 	if (error)
22867c35dc3cSBenjamin Tissoires 		goto fail;
22877c35dc3cSBenjamin Tissoires 
228897f5541fSBenjamin Tissoires 	error = wacom_led_groups_alloc_and_register_one(
228997f5541fSBenjamin Tissoires 					&remote->remotes[index].input->dev,
229097f5541fSBenjamin Tissoires 					wacom, index, 3, true);
229197f5541fSBenjamin Tissoires 	if (error)
229297f5541fSBenjamin Tissoires 		goto fail;
229397f5541fSBenjamin Tissoires 
22947c35dc3cSBenjamin Tissoires 	remote->remotes[index].registered = true;
22957c35dc3cSBenjamin Tissoires 
2296e7749f6eSBenjamin Tissoires 	devres_close_group(dev, &remote->remotes[index]);
229704bfa27bSBenjamin Tissoires 	return 0;
2298f9036bd4SBenjamin Tissoires 
2299f9036bd4SBenjamin Tissoires fail:
2300e7749f6eSBenjamin Tissoires 	devres_release_group(dev, &remote->remotes[index]);
2301e7749f6eSBenjamin Tissoires 	remote->remotes[index].serial = 0;
2302f9036bd4SBenjamin Tissoires 	return error;
230304bfa27bSBenjamin Tissoires }
230404bfa27bSBenjamin Tissoires 
23059f1015d4SBenjamin Tissoires static int wacom_remote_attach_battery(struct wacom *wacom, int index)
23069f1015d4SBenjamin Tissoires {
23079f1015d4SBenjamin Tissoires 	struct wacom_remote *remote = wacom->remote;
23089f1015d4SBenjamin Tissoires 	int error;
23099f1015d4SBenjamin Tissoires 
23109f1015d4SBenjamin Tissoires 	if (!remote->remotes[index].registered)
23119f1015d4SBenjamin Tissoires 		return 0;
23129f1015d4SBenjamin Tissoires 
23139f1015d4SBenjamin Tissoires 	if (remote->remotes[index].battery.battery)
23149f1015d4SBenjamin Tissoires 		return 0;
23159f1015d4SBenjamin Tissoires 
23169f1015d4SBenjamin Tissoires 	if (wacom->led.groups[index].select == WACOM_STATUS_UNKNOWN)
23179f1015d4SBenjamin Tissoires 		return 0;
23189f1015d4SBenjamin Tissoires 
23199f1015d4SBenjamin Tissoires 	error = __wacom_initialize_battery(wacom,
23209f1015d4SBenjamin Tissoires 					&wacom->remote->remotes[index].battery);
23219f1015d4SBenjamin Tissoires 	if (error)
23229f1015d4SBenjamin Tissoires 		return error;
23239f1015d4SBenjamin Tissoires 
23249f1015d4SBenjamin Tissoires 	return 0;
23259f1015d4SBenjamin Tissoires }
23269f1015d4SBenjamin Tissoires 
2327e6f2813aSBenjamin Tissoires static void wacom_remote_work(struct work_struct *work)
2328e6f2813aSBenjamin Tissoires {
2329e6f2813aSBenjamin Tissoires 	struct wacom *wacom = container_of(work, struct wacom, remote_work);
233083e6b40eSBenjamin Tissoires 	struct wacom_remote *remote = wacom->remote;
2331e6f2813aSBenjamin Tissoires 	struct wacom_remote_data data;
2332e6f2813aSBenjamin Tissoires 	unsigned long flags;
2333e6f2813aSBenjamin Tissoires 	unsigned int count;
2334e6f2813aSBenjamin Tissoires 	u32 serial;
233504bfa27bSBenjamin Tissoires 	int i;
2336e6f2813aSBenjamin Tissoires 
233783e6b40eSBenjamin Tissoires 	spin_lock_irqsave(&remote->remote_lock, flags);
2338e6f2813aSBenjamin Tissoires 
233983e6b40eSBenjamin Tissoires 	count = kfifo_out(&remote->remote_fifo, &data, sizeof(data));
2340e6f2813aSBenjamin Tissoires 
2341e6f2813aSBenjamin Tissoires 	if (count != sizeof(data)) {
2342e6f2813aSBenjamin Tissoires 		hid_err(wacom->hdev,
2343e6f2813aSBenjamin Tissoires 			"workitem triggered without status available\n");
234483e6b40eSBenjamin Tissoires 		spin_unlock_irqrestore(&remote->remote_lock, flags);
2345e6f2813aSBenjamin Tissoires 		return;
2346e6f2813aSBenjamin Tissoires 	}
2347e6f2813aSBenjamin Tissoires 
234883e6b40eSBenjamin Tissoires 	if (!kfifo_is_empty(&remote->remote_fifo))
2349e6f2813aSBenjamin Tissoires 		wacom_schedule_work(&wacom->wacom_wac, WACOM_WORKER_REMOTE);
2350e6f2813aSBenjamin Tissoires 
235183e6b40eSBenjamin Tissoires 	spin_unlock_irqrestore(&remote->remote_lock, flags);
2352e6f2813aSBenjamin Tissoires 
2353e6f2813aSBenjamin Tissoires 	for (i = 0; i < WACOM_MAX_REMOTES; i++) {
2354e6f2813aSBenjamin Tissoires 		serial = data.remote[i].serial;
2355e6f2813aSBenjamin Tissoires 		if (data.remote[i].connected) {
2356e6f2813aSBenjamin Tissoires 
23579f1015d4SBenjamin Tissoires 			if (remote->remotes[i].serial == serial) {
23589f1015d4SBenjamin Tissoires 				wacom_remote_attach_battery(wacom, i);
2359e6f2813aSBenjamin Tissoires 				continue;
23609f1015d4SBenjamin Tissoires 			}
2361e6f2813aSBenjamin Tissoires 
2362e7749f6eSBenjamin Tissoires 			if (remote->remotes[i].serial)
236304bfa27bSBenjamin Tissoires 				wacom_remote_destroy_one(wacom, i);
2364e6f2813aSBenjamin Tissoires 
236504bfa27bSBenjamin Tissoires 			wacom_remote_create_one(wacom, serial, i);
2366e6f2813aSBenjamin Tissoires 
2367e7749f6eSBenjamin Tissoires 		} else if (remote->remotes[i].serial) {
236804bfa27bSBenjamin Tissoires 			wacom_remote_destroy_one(wacom, i);
2369e6f2813aSBenjamin Tissoires 		}
2370e6f2813aSBenjamin Tissoires 	}
2371e6f2813aSBenjamin Tissoires }
2372e6f2813aSBenjamin Tissoires 
2373c58ac3a8SBenjamin Tissoires static int wacom_probe(struct hid_device *hdev,
2374c58ac3a8SBenjamin Tissoires 		const struct hid_device_id *id)
2375c58ac3a8SBenjamin Tissoires {
2376c58ac3a8SBenjamin Tissoires 	struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
2377c58ac3a8SBenjamin Tissoires 	struct usb_device *dev = interface_to_usbdev(intf);
2378c58ac3a8SBenjamin Tissoires 	struct wacom *wacom;
2379c58ac3a8SBenjamin Tissoires 	struct wacom_wac *wacom_wac;
2380c58ac3a8SBenjamin Tissoires 	struct wacom_features *features;
2381c58ac3a8SBenjamin Tissoires 	int error;
2382c58ac3a8SBenjamin Tissoires 
2383c58ac3a8SBenjamin Tissoires 	if (!id->driver_data)
2384c58ac3a8SBenjamin Tissoires 		return -EINVAL;
2385c58ac3a8SBenjamin Tissoires 
2386c58ac3a8SBenjamin Tissoires 	hdev->quirks |= HID_QUIRK_NO_INIT_REPORTS;
2387c58ac3a8SBenjamin Tissoires 
2388c58ac3a8SBenjamin Tissoires 	/* hid-core sets this quirk for the boot interface */
2389c58ac3a8SBenjamin Tissoires 	hdev->quirks &= ~HID_QUIRK_NOGET;
2390c58ac3a8SBenjamin Tissoires 
239119b64330SBenjamin Tissoires 	wacom = devm_kzalloc(&hdev->dev, sizeof(struct wacom), GFP_KERNEL);
2392c58ac3a8SBenjamin Tissoires 	if (!wacom)
2393c58ac3a8SBenjamin Tissoires 		return -ENOMEM;
2394c58ac3a8SBenjamin Tissoires 
2395c58ac3a8SBenjamin Tissoires 	hid_set_drvdata(hdev, wacom);
2396c58ac3a8SBenjamin Tissoires 	wacom->hdev = hdev;
2397c58ac3a8SBenjamin Tissoires 
2398c58ac3a8SBenjamin Tissoires 	wacom_wac = &wacom->wacom_wac;
2399c58ac3a8SBenjamin Tissoires 	wacom_wac->features = *((struct wacom_features *)id->driver_data);
2400c58ac3a8SBenjamin Tissoires 	features = &wacom_wac->features;
2401c58ac3a8SBenjamin Tissoires 
2402c58ac3a8SBenjamin Tissoires 	if (features->check_for_hid_type && features->hid_type != hdev->type) {
2403c58ac3a8SBenjamin Tissoires 		error = -ENODEV;
24043888b0d5SBenjamin Tissoires 		goto fail;
2405c58ac3a8SBenjamin Tissoires 	}
2406c58ac3a8SBenjamin Tissoires 
2407c6fa1aebSJason Gerecke 	wacom_wac->hid_data.inputmode = -1;
2408326ea2a9SJason Gerecke 	wacom_wac->mode_report = -1;
2409c6fa1aebSJason Gerecke 
2410c58ac3a8SBenjamin Tissoires 	wacom->usbdev = dev;
2411c58ac3a8SBenjamin Tissoires 	wacom->intf = intf;
2412c58ac3a8SBenjamin Tissoires 	mutex_init(&wacom->lock);
2413d17d1f17SBenjamin Tissoires 	INIT_WORK(&wacom->wireless_work, wacom_wireless_work);
2414d17d1f17SBenjamin Tissoires 	INIT_WORK(&wacom->battery_work, wacom_battery_work);
2415e6f2813aSBenjamin Tissoires 	INIT_WORK(&wacom->remote_work, wacom_remote_work);
2416c58ac3a8SBenjamin Tissoires 
2417c58ac3a8SBenjamin Tissoires 	/* ask for the report descriptor to be loaded by HID */
2418c58ac3a8SBenjamin Tissoires 	error = hid_parse(hdev);
2419c58ac3a8SBenjamin Tissoires 	if (error) {
2420c58ac3a8SBenjamin Tissoires 		hid_err(hdev, "parse failed\n");
24213888b0d5SBenjamin Tissoires 		goto fail;
2422c58ac3a8SBenjamin Tissoires 	}
2423c58ac3a8SBenjamin Tissoires 
2424fd5f92b6SBenjamin Tissoires 	error = wacom_parse_and_register(wacom, false);
2425c58ac3a8SBenjamin Tissoires 	if (error)
24263888b0d5SBenjamin Tissoires 		goto fail;
2427c58ac3a8SBenjamin Tissoires 
2428c58ac3a8SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH) {
2429c58ac3a8SBenjamin Tissoires 		error = device_create_file(&hdev->dev, &dev_attr_speed);
2430c58ac3a8SBenjamin Tissoires 		if (error)
2431c58ac3a8SBenjamin Tissoires 			hid_warn(hdev,
2432c58ac3a8SBenjamin Tissoires 				 "can't create sysfs speed attribute err: %d\n",
2433c58ac3a8SBenjamin Tissoires 				 error);
2434c58ac3a8SBenjamin Tissoires 	}
2435c58ac3a8SBenjamin Tissoires 
2436c58ac3a8SBenjamin Tissoires 	return 0;
2437c58ac3a8SBenjamin Tissoires 
24383888b0d5SBenjamin Tissoires fail:
2439471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, NULL);
2440471d1714SBenjamin Tissoires 	return error;
2441471d1714SBenjamin Tissoires }
2442471d1714SBenjamin Tissoires 
2443471d1714SBenjamin Tissoires static void wacom_remove(struct hid_device *hdev)
2444471d1714SBenjamin Tissoires {
2445471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
2446f6205161SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
2447f6205161SBenjamin Tissoires 	struct wacom_features *features = &wacom_wac->features;
2448f6205161SBenjamin Tissoires 
2449f6205161SBenjamin Tissoires 	if (features->device_type & WACOM_DEVICETYPE_WL_MONITOR)
2450f6205161SBenjamin Tissoires 		hid_hw_close(hdev);
2451471d1714SBenjamin Tissoires 
2452471d1714SBenjamin Tissoires 	hid_hw_stop(hdev);
2453471d1714SBenjamin Tissoires 
2454d17d1f17SBenjamin Tissoires 	cancel_work_sync(&wacom->wireless_work);
2455d17d1f17SBenjamin Tissoires 	cancel_work_sync(&wacom->battery_work);
2456e6f2813aSBenjamin Tissoires 	cancel_work_sync(&wacom->remote_work);
2457f81a1295SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH)
2458f81a1295SBenjamin Tissoires 		device_remove_file(&hdev->dev, &dev_attr_speed);
2459471d1714SBenjamin Tissoires 
2460471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, NULL);
2461471d1714SBenjamin Tissoires }
2462471d1714SBenjamin Tissoires 
246341a74581SGeert Uytterhoeven #ifdef CONFIG_PM
2464471d1714SBenjamin Tissoires static int wacom_resume(struct hid_device *hdev)
2465471d1714SBenjamin Tissoires {
2466471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
2467471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
2468471d1714SBenjamin Tissoires 
2469471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
2470471d1714SBenjamin Tissoires 
2471471d1714SBenjamin Tissoires 	/* switch to wacom mode first */
2472471d1714SBenjamin Tissoires 	wacom_query_tablet_data(hdev, features);
2473471d1714SBenjamin Tissoires 	wacom_led_control(wacom);
2474471d1714SBenjamin Tissoires 
2475471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
2476471d1714SBenjamin Tissoires 
2477471d1714SBenjamin Tissoires 	return 0;
2478471d1714SBenjamin Tissoires }
2479471d1714SBenjamin Tissoires 
2480471d1714SBenjamin Tissoires static int wacom_reset_resume(struct hid_device *hdev)
2481471d1714SBenjamin Tissoires {
2482471d1714SBenjamin Tissoires 	return wacom_resume(hdev);
2483471d1714SBenjamin Tissoires }
248441a74581SGeert Uytterhoeven #endif /* CONFIG_PM */
2485471d1714SBenjamin Tissoires 
2486471d1714SBenjamin Tissoires static struct hid_driver wacom_driver = {
2487471d1714SBenjamin Tissoires 	.name =		"wacom",
2488471d1714SBenjamin Tissoires 	.id_table =	wacom_ids,
2489471d1714SBenjamin Tissoires 	.probe =	wacom_probe,
2490471d1714SBenjamin Tissoires 	.remove =	wacom_remove,
24917704ac93SBenjamin Tissoires 	.report =	wacom_wac_report,
2492471d1714SBenjamin Tissoires #ifdef CONFIG_PM
2493471d1714SBenjamin Tissoires 	.resume =	wacom_resume,
2494471d1714SBenjamin Tissoires 	.reset_resume =	wacom_reset_resume,
2495471d1714SBenjamin Tissoires #endif
2496471d1714SBenjamin Tissoires 	.raw_event =	wacom_raw_event,
2497471d1714SBenjamin Tissoires };
2498471d1714SBenjamin Tissoires module_hid_driver(wacom_driver);
2499f2e0a7d4SBenjamin Tissoires 
2500f2e0a7d4SBenjamin Tissoires MODULE_VERSION(DRIVER_VERSION);
2501f2e0a7d4SBenjamin Tissoires MODULE_AUTHOR(DRIVER_AUTHOR);
2502f2e0a7d4SBenjamin Tissoires MODULE_DESCRIPTION(DRIVER_DESC);
2503f2e0a7d4SBenjamin Tissoires MODULE_LICENSE(DRIVER_LICENSE);
2504