xref: /openbmc/linux/drivers/hid/wacom_sys.c (revision d70420b914c98a3758674c6e9858810e0ab4ea30)
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"
16471d1714SBenjamin Tissoires #include <linux/hid.h>
17471d1714SBenjamin Tissoires 
18471d1714SBenjamin Tissoires #define WAC_MSG_RETRIES		5
19471d1714SBenjamin Tissoires 
20471d1714SBenjamin Tissoires #define WAC_CMD_LED_CONTROL	0x20
21471d1714SBenjamin Tissoires #define WAC_CMD_ICON_START	0x21
22471d1714SBenjamin Tissoires #define WAC_CMD_ICON_XFER	0x23
23471d1714SBenjamin Tissoires #define WAC_CMD_RETRIES		10
24471d1714SBenjamin Tissoires 
25471d1714SBenjamin Tissoires static int wacom_get_report(struct hid_device *hdev, u8 type, u8 id,
26471d1714SBenjamin Tissoires 			    void *buf, size_t size, unsigned int retries)
27471d1714SBenjamin Tissoires {
28471d1714SBenjamin Tissoires 	int retval;
29471d1714SBenjamin Tissoires 
30471d1714SBenjamin Tissoires 	do {
31471d1714SBenjamin Tissoires 		retval = hid_hw_raw_request(hdev, id, buf, size, type,
32471d1714SBenjamin Tissoires 				HID_REQ_GET_REPORT);
33471d1714SBenjamin Tissoires 	} while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);
34471d1714SBenjamin Tissoires 
35471d1714SBenjamin Tissoires 	return retval;
36471d1714SBenjamin Tissoires }
37471d1714SBenjamin Tissoires 
38471d1714SBenjamin Tissoires static int wacom_set_report(struct hid_device *hdev, u8 type, u8 id,
39471d1714SBenjamin Tissoires 			    void *buf, size_t size, unsigned int retries)
40471d1714SBenjamin Tissoires {
41471d1714SBenjamin Tissoires 	int retval;
42471d1714SBenjamin Tissoires 
43471d1714SBenjamin Tissoires 	do {
44471d1714SBenjamin Tissoires 		retval = hid_hw_raw_request(hdev, id, buf, size, type,
45471d1714SBenjamin Tissoires 				HID_REQ_SET_REPORT);
46471d1714SBenjamin Tissoires 	} while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);
47471d1714SBenjamin Tissoires 
48471d1714SBenjamin Tissoires 	return retval;
49471d1714SBenjamin Tissoires }
50471d1714SBenjamin Tissoires 
51471d1714SBenjamin Tissoires static int wacom_raw_event(struct hid_device *hdev, struct hid_report *report,
52471d1714SBenjamin Tissoires 		u8 *raw_data, int size)
53471d1714SBenjamin Tissoires {
54471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
55471d1714SBenjamin Tissoires 
56471d1714SBenjamin Tissoires 	if (size > WACOM_PKGLEN_MAX)
57471d1714SBenjamin Tissoires 		return 1;
58471d1714SBenjamin Tissoires 
59471d1714SBenjamin Tissoires 	memcpy(wacom->wacom_wac.data, raw_data, size);
60471d1714SBenjamin Tissoires 
61471d1714SBenjamin Tissoires 	wacom_wac_irq(&wacom->wacom_wac, size);
62471d1714SBenjamin Tissoires 
63471d1714SBenjamin Tissoires 	return 0;
64471d1714SBenjamin Tissoires }
65471d1714SBenjamin Tissoires 
66471d1714SBenjamin Tissoires static int wacom_open(struct input_dev *dev)
67471d1714SBenjamin Tissoires {
68471d1714SBenjamin Tissoires 	struct wacom *wacom = input_get_drvdata(dev);
69471d1714SBenjamin Tissoires 	int retval;
70471d1714SBenjamin Tissoires 
71471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
72471d1714SBenjamin Tissoires 	retval = hid_hw_open(wacom->hdev);
73471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
74471d1714SBenjamin Tissoires 
75471d1714SBenjamin Tissoires 	return retval;
76471d1714SBenjamin Tissoires }
77471d1714SBenjamin Tissoires 
78471d1714SBenjamin Tissoires static void wacom_close(struct input_dev *dev)
79471d1714SBenjamin Tissoires {
80471d1714SBenjamin Tissoires 	struct wacom *wacom = input_get_drvdata(dev);
81471d1714SBenjamin Tissoires 
82471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
83471d1714SBenjamin Tissoires 	hid_hw_close(wacom->hdev);
84471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
85471d1714SBenjamin Tissoires }
86471d1714SBenjamin Tissoires 
87471d1714SBenjamin Tissoires /*
88471d1714SBenjamin Tissoires  * Calculate the resolution of the X or Y axis using hidinput_calc_abs_res.
89471d1714SBenjamin Tissoires  */
90471d1714SBenjamin Tissoires static int wacom_calc_hid_res(int logical_extents, int physical_extents,
91471d1714SBenjamin Tissoires 			       unsigned unit, int exponent)
92471d1714SBenjamin Tissoires {
93471d1714SBenjamin Tissoires 	struct hid_field field = {
94471d1714SBenjamin Tissoires 		.logical_maximum = logical_extents,
95471d1714SBenjamin Tissoires 		.physical_maximum = physical_extents,
96471d1714SBenjamin Tissoires 		.unit = unit,
97471d1714SBenjamin Tissoires 		.unit_exponent = exponent,
98471d1714SBenjamin Tissoires 	};
99471d1714SBenjamin Tissoires 
100471d1714SBenjamin Tissoires 	return hidinput_calc_abs_res(&field, ABS_X);
101471d1714SBenjamin Tissoires }
102471d1714SBenjamin Tissoires 
103471d1714SBenjamin Tissoires static void wacom_feature_mapping(struct hid_device *hdev,
104471d1714SBenjamin Tissoires 		struct hid_field *field, struct hid_usage *usage)
105471d1714SBenjamin Tissoires {
106471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
107471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
108471d1714SBenjamin Tissoires 
109471d1714SBenjamin Tissoires 	switch (usage->hid) {
110471d1714SBenjamin Tissoires 	case HID_DG_CONTACTMAX:
111471d1714SBenjamin Tissoires 		/* leave touch_max as is if predefined */
112471d1714SBenjamin Tissoires 		if (!features->touch_max)
113471d1714SBenjamin Tissoires 			features->touch_max = field->value[0];
114471d1714SBenjamin Tissoires 		break;
115471d1714SBenjamin Tissoires 	}
116471d1714SBenjamin Tissoires }
117471d1714SBenjamin Tissoires 
118471d1714SBenjamin Tissoires /*
119471d1714SBenjamin Tissoires  * Interface Descriptor of wacom devices can be incomplete and
120471d1714SBenjamin Tissoires  * inconsistent so wacom_features table is used to store stylus
121471d1714SBenjamin Tissoires  * device's packet lengths, various maximum values, and tablet
122471d1714SBenjamin Tissoires  * resolution based on product ID's.
123471d1714SBenjamin Tissoires  *
124471d1714SBenjamin Tissoires  * For devices that contain 2 interfaces, wacom_features table is
125471d1714SBenjamin Tissoires  * inaccurate for the touch interface.  Since the Interface Descriptor
126471d1714SBenjamin Tissoires  * for touch interfaces has pretty complete data, this function exists
127471d1714SBenjamin Tissoires  * to query tablet for this missing information instead of hard coding in
128471d1714SBenjamin Tissoires  * an additional table.
129471d1714SBenjamin Tissoires  *
130471d1714SBenjamin Tissoires  * A typical Interface Descriptor for a stylus will contain a
131471d1714SBenjamin Tissoires  * boot mouse application collection that is not of interest and this
132471d1714SBenjamin Tissoires  * function will ignore it.
133471d1714SBenjamin Tissoires  *
134471d1714SBenjamin Tissoires  * It also contains a digitizer application collection that also is not
135471d1714SBenjamin Tissoires  * of interest since any information it contains would be duplicate
136471d1714SBenjamin Tissoires  * of what is in wacom_features. Usually it defines a report of an array
137471d1714SBenjamin Tissoires  * of bytes that could be used as max length of the stylus packet returned.
138471d1714SBenjamin Tissoires  * If it happens to define a Digitizer-Stylus Physical Collection then
139471d1714SBenjamin Tissoires  * the X and Y logical values contain valid data but it is ignored.
140471d1714SBenjamin Tissoires  *
141471d1714SBenjamin Tissoires  * A typical Interface Descriptor for a touch interface will contain a
142471d1714SBenjamin Tissoires  * Digitizer-Finger Physical Collection which will define both logical
143471d1714SBenjamin Tissoires  * X/Y maximum as well as the physical size of tablet. Since touch
144471d1714SBenjamin Tissoires  * interfaces haven't supported pressure or distance, this is enough
145471d1714SBenjamin Tissoires  * information to override invalid values in the wacom_features table.
146471d1714SBenjamin Tissoires  *
147471d1714SBenjamin Tissoires  * Intuos5 touch interface and 3rd gen Bamboo Touch do not contain useful
148471d1714SBenjamin Tissoires  * data. We deal with them after returning from this function.
149471d1714SBenjamin Tissoires  */
150471d1714SBenjamin Tissoires static void wacom_usage_mapping(struct hid_device *hdev,
151471d1714SBenjamin Tissoires 		struct hid_field *field, struct hid_usage *usage)
152471d1714SBenjamin Tissoires {
153471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
154471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
155471d1714SBenjamin Tissoires 	bool finger = (field->logical == HID_DG_FINGER) ||
156471d1714SBenjamin Tissoires 		      (field->physical == HID_DG_FINGER);
157471d1714SBenjamin Tissoires 	bool pen = (field->logical == HID_DG_STYLUS) ||
158471d1714SBenjamin Tissoires 		   (field->physical == HID_DG_STYLUS);
159471d1714SBenjamin Tissoires 
160471d1714SBenjamin Tissoires 	/*
161471d1714SBenjamin Tissoires 	* Requiring Stylus Usage will ignore boot mouse
162471d1714SBenjamin Tissoires 	* X/Y values and some cases of invalid Digitizer X/Y
163471d1714SBenjamin Tissoires 	* values commonly reported.
164471d1714SBenjamin Tissoires 	*/
165471d1714SBenjamin Tissoires 	if (!pen && !finger)
166471d1714SBenjamin Tissoires 		return;
167471d1714SBenjamin Tissoires 
168471d1714SBenjamin Tissoires 	if (finger && !features->touch_max)
169471d1714SBenjamin Tissoires 		/* touch device at least supports one touch point */
170471d1714SBenjamin Tissoires 		features->touch_max = 1;
171471d1714SBenjamin Tissoires 
172471d1714SBenjamin Tissoires 	switch (usage->hid) {
173471d1714SBenjamin Tissoires 	case HID_GD_X:
174471d1714SBenjamin Tissoires 		features->x_max = field->logical_maximum;
175471d1714SBenjamin Tissoires 		if (finger) {
176471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_FINGER;
177471d1714SBenjamin Tissoires 			features->x_phy = field->physical_maximum;
178471d1714SBenjamin Tissoires 			if (features->type != BAMBOO_PT) {
179471d1714SBenjamin Tissoires 				features->unit = field->unit;
180471d1714SBenjamin Tissoires 				features->unitExpo = field->unit_exponent;
181471d1714SBenjamin Tissoires 			}
182471d1714SBenjamin Tissoires 		} else {
183471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_PEN;
184471d1714SBenjamin Tissoires 		}
185471d1714SBenjamin Tissoires 		break;
186471d1714SBenjamin Tissoires 	case HID_GD_Y:
187471d1714SBenjamin Tissoires 		features->y_max = field->logical_maximum;
188471d1714SBenjamin Tissoires 		if (finger) {
189471d1714SBenjamin Tissoires 			features->y_phy = field->physical_maximum;
190471d1714SBenjamin Tissoires 			if (features->type != BAMBOO_PT) {
191471d1714SBenjamin Tissoires 				features->unit = field->unit;
192471d1714SBenjamin Tissoires 				features->unitExpo = field->unit_exponent;
193471d1714SBenjamin Tissoires 			}
194471d1714SBenjamin Tissoires 		}
195471d1714SBenjamin Tissoires 		break;
196471d1714SBenjamin Tissoires 	case HID_DG_TIPPRESSURE:
197471d1714SBenjamin Tissoires 		if (pen)
198471d1714SBenjamin Tissoires 			features->pressure_max = field->logical_maximum;
199471d1714SBenjamin Tissoires 		break;
200471d1714SBenjamin Tissoires 	}
201471d1714SBenjamin Tissoires }
202471d1714SBenjamin Tissoires 
203471d1714SBenjamin Tissoires static void wacom_parse_hid(struct hid_device *hdev,
204471d1714SBenjamin Tissoires 			   struct wacom_features *features)
205471d1714SBenjamin Tissoires {
206471d1714SBenjamin Tissoires 	struct hid_report_enum *rep_enum;
207471d1714SBenjamin Tissoires 	struct hid_report *hreport;
208471d1714SBenjamin Tissoires 	int i, j;
209471d1714SBenjamin Tissoires 
210471d1714SBenjamin Tissoires 	/* check features first */
211471d1714SBenjamin Tissoires 	rep_enum = &hdev->report_enum[HID_FEATURE_REPORT];
212471d1714SBenjamin Tissoires 	list_for_each_entry(hreport, &rep_enum->report_list, list) {
213471d1714SBenjamin Tissoires 		for (i = 0; i < hreport->maxfield; i++) {
214471d1714SBenjamin Tissoires 			/* Ignore if report count is out of bounds. */
215471d1714SBenjamin Tissoires 			if (hreport->field[i]->report_count < 1)
216471d1714SBenjamin Tissoires 				continue;
217471d1714SBenjamin Tissoires 
218471d1714SBenjamin Tissoires 			for (j = 0; j < hreport->field[i]->maxusage; j++) {
219471d1714SBenjamin Tissoires 				wacom_feature_mapping(hdev, hreport->field[i],
220471d1714SBenjamin Tissoires 						hreport->field[i]->usage + j);
221471d1714SBenjamin Tissoires 			}
222471d1714SBenjamin Tissoires 		}
223471d1714SBenjamin Tissoires 	}
224471d1714SBenjamin Tissoires 
225471d1714SBenjamin Tissoires 	/* now check the input usages */
226471d1714SBenjamin Tissoires 	rep_enum = &hdev->report_enum[HID_INPUT_REPORT];
227471d1714SBenjamin Tissoires 	list_for_each_entry(hreport, &rep_enum->report_list, list) {
228471d1714SBenjamin Tissoires 
229471d1714SBenjamin Tissoires 		if (!hreport->maxfield)
230471d1714SBenjamin Tissoires 			continue;
231471d1714SBenjamin Tissoires 
232471d1714SBenjamin Tissoires 		for (i = 0; i < hreport->maxfield; i++)
233471d1714SBenjamin Tissoires 			for (j = 0; j < hreport->field[i]->maxusage; j++)
234471d1714SBenjamin Tissoires 				wacom_usage_mapping(hdev, hreport->field[i],
235471d1714SBenjamin Tissoires 						hreport->field[i]->usage + j);
236471d1714SBenjamin Tissoires 	}
237471d1714SBenjamin Tissoires }
238471d1714SBenjamin Tissoires 
239471d1714SBenjamin Tissoires static int wacom_set_device_mode(struct hid_device *hdev, int report_id,
240471d1714SBenjamin Tissoires 		int length, int mode)
241471d1714SBenjamin Tissoires {
242471d1714SBenjamin Tissoires 	unsigned char *rep_data;
243471d1714SBenjamin Tissoires 	int error = -ENOMEM, limit = 0;
244471d1714SBenjamin Tissoires 
245471d1714SBenjamin Tissoires 	rep_data = kzalloc(length, GFP_KERNEL);
246471d1714SBenjamin Tissoires 	if (!rep_data)
247471d1714SBenjamin Tissoires 		return error;
248471d1714SBenjamin Tissoires 
249471d1714SBenjamin Tissoires 	do {
250471d1714SBenjamin Tissoires 		rep_data[0] = report_id;
251471d1714SBenjamin Tissoires 		rep_data[1] = mode;
252471d1714SBenjamin Tissoires 
253471d1714SBenjamin Tissoires 		error = wacom_set_report(hdev, HID_FEATURE_REPORT,
254471d1714SBenjamin Tissoires 		                         report_id, rep_data, length, 1);
255471d1714SBenjamin Tissoires 		if (error >= 0)
256471d1714SBenjamin Tissoires 			error = wacom_get_report(hdev, HID_FEATURE_REPORT,
257471d1714SBenjamin Tissoires 			                         report_id, rep_data, length, 1);
258471d1714SBenjamin Tissoires 	} while ((error < 0 || rep_data[1] != mode) && limit++ < WAC_MSG_RETRIES);
259471d1714SBenjamin Tissoires 
260471d1714SBenjamin Tissoires 	kfree(rep_data);
261471d1714SBenjamin Tissoires 
262471d1714SBenjamin Tissoires 	return error < 0 ? error : 0;
263471d1714SBenjamin Tissoires }
264471d1714SBenjamin Tissoires 
265471d1714SBenjamin Tissoires /*
266471d1714SBenjamin Tissoires  * Switch the tablet into its most-capable mode. Wacom tablets are
267471d1714SBenjamin Tissoires  * typically configured to power-up in a mode which sends mouse-like
268471d1714SBenjamin Tissoires  * reports to the OS. To get absolute position, pressure data, etc.
269471d1714SBenjamin Tissoires  * from the tablet, it is necessary to switch the tablet out of this
270471d1714SBenjamin Tissoires  * mode and into one which sends the full range of tablet data.
271471d1714SBenjamin Tissoires  */
272471d1714SBenjamin Tissoires static int wacom_query_tablet_data(struct hid_device *hdev,
273471d1714SBenjamin Tissoires 		struct wacom_features *features)
274471d1714SBenjamin Tissoires {
275471d1714SBenjamin Tissoires 	if (features->device_type == BTN_TOOL_FINGER) {
276471d1714SBenjamin Tissoires 		if (features->type > TABLETPC) {
277471d1714SBenjamin Tissoires 			/* MT Tablet PC touch */
278471d1714SBenjamin Tissoires 			return wacom_set_device_mode(hdev, 3, 4, 4);
279471d1714SBenjamin Tissoires 		}
280471d1714SBenjamin Tissoires 		else if (features->type == WACOM_24HDT || features->type == CINTIQ_HYBRID) {
281471d1714SBenjamin Tissoires 			return wacom_set_device_mode(hdev, 18, 3, 2);
282471d1714SBenjamin Tissoires 		}
283471d1714SBenjamin Tissoires 	} else if (features->device_type == BTN_TOOL_PEN) {
284471d1714SBenjamin Tissoires 		if (features->type <= BAMBOO_PT && features->type != WIRELESS) {
285471d1714SBenjamin Tissoires 			return wacom_set_device_mode(hdev, 2, 2, 2);
286471d1714SBenjamin Tissoires 		}
287471d1714SBenjamin Tissoires 	}
288471d1714SBenjamin Tissoires 
289471d1714SBenjamin Tissoires 	return 0;
290471d1714SBenjamin Tissoires }
291471d1714SBenjamin Tissoires 
292471d1714SBenjamin Tissoires static void wacom_retrieve_hid_descriptor(struct hid_device *hdev,
293471d1714SBenjamin Tissoires 					 struct wacom_features *features)
294471d1714SBenjamin Tissoires {
295471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
296471d1714SBenjamin Tissoires 	struct usb_interface *intf = wacom->intf;
297471d1714SBenjamin Tissoires 
298471d1714SBenjamin Tissoires 	/* default features */
299471d1714SBenjamin Tissoires 	features->device_type = BTN_TOOL_PEN;
300471d1714SBenjamin Tissoires 	features->x_fuzz = 4;
301471d1714SBenjamin Tissoires 	features->y_fuzz = 4;
302471d1714SBenjamin Tissoires 	features->pressure_fuzz = 0;
303471d1714SBenjamin Tissoires 	features->distance_fuzz = 0;
304471d1714SBenjamin Tissoires 
305471d1714SBenjamin Tissoires 	/*
306471d1714SBenjamin Tissoires 	 * The wireless device HID is basic and layout conflicts with
307471d1714SBenjamin Tissoires 	 * other tablets (monitor and touch interface can look like pen).
308471d1714SBenjamin Tissoires 	 * Skip the query for this type and modify defaults based on
309471d1714SBenjamin Tissoires 	 * interface number.
310471d1714SBenjamin Tissoires 	 */
311471d1714SBenjamin Tissoires 	if (features->type == WIRELESS) {
312471d1714SBenjamin Tissoires 		if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
313471d1714SBenjamin Tissoires 			features->device_type = 0;
314471d1714SBenjamin Tissoires 		} else if (intf->cur_altsetting->desc.bInterfaceNumber == 2) {
315471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_FINGER;
316471d1714SBenjamin Tissoires 			features->pktlen = WACOM_PKGLEN_BBTOUCH3;
317471d1714SBenjamin Tissoires 		}
318471d1714SBenjamin Tissoires 	}
319471d1714SBenjamin Tissoires 
320471d1714SBenjamin Tissoires 	/* only devices that support touch need to retrieve the info */
321471d1714SBenjamin Tissoires 	if (features->type < BAMBOO_PT)
322471d1714SBenjamin Tissoires 		return;
323471d1714SBenjamin Tissoires 
324471d1714SBenjamin Tissoires 	wacom_parse_hid(hdev, features);
325471d1714SBenjamin Tissoires }
326471d1714SBenjamin Tissoires 
327471d1714SBenjamin Tissoires struct wacom_hdev_data {
328471d1714SBenjamin Tissoires 	struct list_head list;
329471d1714SBenjamin Tissoires 	struct kref kref;
330471d1714SBenjamin Tissoires 	struct hid_device *dev;
331471d1714SBenjamin Tissoires 	struct wacom_shared shared;
332471d1714SBenjamin Tissoires };
333471d1714SBenjamin Tissoires 
334471d1714SBenjamin Tissoires static LIST_HEAD(wacom_udev_list);
335471d1714SBenjamin Tissoires static DEFINE_MUTEX(wacom_udev_list_lock);
336471d1714SBenjamin Tissoires 
337471d1714SBenjamin Tissoires static bool wacom_are_sibling(struct hid_device *hdev,
338471d1714SBenjamin Tissoires 		struct hid_device *sibling)
339471d1714SBenjamin Tissoires {
340471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
341471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
342471d1714SBenjamin Tissoires 	int vid = features->oVid;
343471d1714SBenjamin Tissoires 	int pid = features->oPid;
344471d1714SBenjamin Tissoires 	int n1,n2;
345471d1714SBenjamin Tissoires 
346471d1714SBenjamin Tissoires 	if (vid == 0 && pid == 0) {
347471d1714SBenjamin Tissoires 		vid = hdev->vendor;
348471d1714SBenjamin Tissoires 		pid = hdev->product;
349471d1714SBenjamin Tissoires 	}
350471d1714SBenjamin Tissoires 
351471d1714SBenjamin Tissoires 	if (vid != sibling->vendor || pid != sibling->product)
352471d1714SBenjamin Tissoires 		return false;
353471d1714SBenjamin Tissoires 
354471d1714SBenjamin Tissoires 	/* Compare the physical path. */
355471d1714SBenjamin Tissoires 	n1 = strrchr(hdev->phys, '.') - hdev->phys;
356471d1714SBenjamin Tissoires 	n2 = strrchr(sibling->phys, '.') - sibling->phys;
357471d1714SBenjamin Tissoires 	if (n1 != n2 || n1 <= 0 || n2 <= 0)
358471d1714SBenjamin Tissoires 		return false;
359471d1714SBenjamin Tissoires 
360471d1714SBenjamin Tissoires 	return !strncmp(hdev->phys, sibling->phys, n1);
361471d1714SBenjamin Tissoires }
362471d1714SBenjamin Tissoires 
363471d1714SBenjamin Tissoires static struct wacom_hdev_data *wacom_get_hdev_data(struct hid_device *hdev)
364471d1714SBenjamin Tissoires {
365471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
366471d1714SBenjamin Tissoires 
367471d1714SBenjamin Tissoires 	list_for_each_entry(data, &wacom_udev_list, list) {
368471d1714SBenjamin Tissoires 		if (wacom_are_sibling(hdev, data->dev)) {
369471d1714SBenjamin Tissoires 			kref_get(&data->kref);
370471d1714SBenjamin Tissoires 			return data;
371471d1714SBenjamin Tissoires 		}
372471d1714SBenjamin Tissoires 	}
373471d1714SBenjamin Tissoires 
374471d1714SBenjamin Tissoires 	return NULL;
375471d1714SBenjamin Tissoires }
376471d1714SBenjamin Tissoires 
377471d1714SBenjamin Tissoires static int wacom_add_shared_data(struct hid_device *hdev)
378471d1714SBenjamin Tissoires {
379471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
380471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
381471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
382471d1714SBenjamin Tissoires 	int retval = 0;
383471d1714SBenjamin Tissoires 
384471d1714SBenjamin Tissoires 	mutex_lock(&wacom_udev_list_lock);
385471d1714SBenjamin Tissoires 
386471d1714SBenjamin Tissoires 	data = wacom_get_hdev_data(hdev);
387471d1714SBenjamin Tissoires 	if (!data) {
388471d1714SBenjamin Tissoires 		data = kzalloc(sizeof(struct wacom_hdev_data), GFP_KERNEL);
389471d1714SBenjamin Tissoires 		if (!data) {
390471d1714SBenjamin Tissoires 			retval = -ENOMEM;
391471d1714SBenjamin Tissoires 			goto out;
392471d1714SBenjamin Tissoires 		}
393471d1714SBenjamin Tissoires 
394471d1714SBenjamin Tissoires 		kref_init(&data->kref);
395471d1714SBenjamin Tissoires 		data->dev = hdev;
396471d1714SBenjamin Tissoires 		list_add_tail(&data->list, &wacom_udev_list);
397471d1714SBenjamin Tissoires 	}
398471d1714SBenjamin Tissoires 
399471d1714SBenjamin Tissoires 	wacom_wac->shared = &data->shared;
400471d1714SBenjamin Tissoires 
401471d1714SBenjamin Tissoires out:
402471d1714SBenjamin Tissoires 	mutex_unlock(&wacom_udev_list_lock);
403471d1714SBenjamin Tissoires 	return retval;
404471d1714SBenjamin Tissoires }
405471d1714SBenjamin Tissoires 
406471d1714SBenjamin Tissoires static void wacom_release_shared_data(struct kref *kref)
407471d1714SBenjamin Tissoires {
408471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data =
409471d1714SBenjamin Tissoires 		container_of(kref, struct wacom_hdev_data, kref);
410471d1714SBenjamin Tissoires 
411471d1714SBenjamin Tissoires 	mutex_lock(&wacom_udev_list_lock);
412471d1714SBenjamin Tissoires 	list_del(&data->list);
413471d1714SBenjamin Tissoires 	mutex_unlock(&wacom_udev_list_lock);
414471d1714SBenjamin Tissoires 
415471d1714SBenjamin Tissoires 	kfree(data);
416471d1714SBenjamin Tissoires }
417471d1714SBenjamin Tissoires 
418471d1714SBenjamin Tissoires static void wacom_remove_shared_data(struct wacom_wac *wacom)
419471d1714SBenjamin Tissoires {
420471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
421471d1714SBenjamin Tissoires 
422471d1714SBenjamin Tissoires 	if (wacom->shared) {
423471d1714SBenjamin Tissoires 		data = container_of(wacom->shared, struct wacom_hdev_data, shared);
424471d1714SBenjamin Tissoires 		kref_put(&data->kref, wacom_release_shared_data);
425471d1714SBenjamin Tissoires 		wacom->shared = NULL;
426471d1714SBenjamin Tissoires 	}
427471d1714SBenjamin Tissoires }
428471d1714SBenjamin Tissoires 
429471d1714SBenjamin Tissoires static int wacom_led_control(struct wacom *wacom)
430471d1714SBenjamin Tissoires {
431471d1714SBenjamin Tissoires 	unsigned char *buf;
432471d1714SBenjamin Tissoires 	int retval;
433471d1714SBenjamin Tissoires 
434471d1714SBenjamin Tissoires 	buf = kzalloc(9, GFP_KERNEL);
435471d1714SBenjamin Tissoires 	if (!buf)
436471d1714SBenjamin Tissoires 		return -ENOMEM;
437471d1714SBenjamin Tissoires 
438471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.features.type >= INTUOS5S &&
439471d1714SBenjamin Tissoires 	    wacom->wacom_wac.features.type <= INTUOSPL) {
440471d1714SBenjamin Tissoires 		/*
441471d1714SBenjamin Tissoires 		 * Touch Ring and crop mark LED luminance may take on
442471d1714SBenjamin Tissoires 		 * one of four values:
443471d1714SBenjamin Tissoires 		 *    0 = Low; 1 = Medium; 2 = High; 3 = Off
444471d1714SBenjamin Tissoires 		 */
445471d1714SBenjamin Tissoires 		int ring_led = wacom->led.select[0] & 0x03;
446471d1714SBenjamin Tissoires 		int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
447471d1714SBenjamin Tissoires 		int crop_lum = 0;
448471d1714SBenjamin Tissoires 
449471d1714SBenjamin Tissoires 		buf[0] = WAC_CMD_LED_CONTROL;
450471d1714SBenjamin Tissoires 		buf[1] = (crop_lum << 4) | (ring_lum << 2) | (ring_led);
451471d1714SBenjamin Tissoires 	}
452471d1714SBenjamin Tissoires 	else {
453471d1714SBenjamin Tissoires 		int led = wacom->led.select[0] | 0x4;
454471d1714SBenjamin Tissoires 
455471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
456471d1714SBenjamin Tissoires 		    wacom->wacom_wac.features.type == WACOM_24HD)
457471d1714SBenjamin Tissoires 			led |= (wacom->led.select[1] << 4) | 0x40;
458471d1714SBenjamin Tissoires 
459471d1714SBenjamin Tissoires 		buf[0] = WAC_CMD_LED_CONTROL;
460471d1714SBenjamin Tissoires 		buf[1] = led;
461471d1714SBenjamin Tissoires 		buf[2] = wacom->led.llv;
462471d1714SBenjamin Tissoires 		buf[3] = wacom->led.hlv;
463471d1714SBenjamin Tissoires 		buf[4] = wacom->led.img_lum;
464471d1714SBenjamin Tissoires 	}
465471d1714SBenjamin Tissoires 
466471d1714SBenjamin Tissoires 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
467471d1714SBenjamin Tissoires 				  WAC_CMD_LED_CONTROL, buf, 9, WAC_CMD_RETRIES);
468471d1714SBenjamin Tissoires 	kfree(buf);
469471d1714SBenjamin Tissoires 
470471d1714SBenjamin Tissoires 	return retval;
471471d1714SBenjamin Tissoires }
472471d1714SBenjamin Tissoires 
473471d1714SBenjamin Tissoires static int wacom_led_putimage(struct wacom *wacom, int button_id, const void *img)
474471d1714SBenjamin Tissoires {
475471d1714SBenjamin Tissoires 	unsigned char *buf;
476471d1714SBenjamin Tissoires 	int i, retval;
477471d1714SBenjamin Tissoires 
478471d1714SBenjamin Tissoires 	buf = kzalloc(259, GFP_KERNEL);
479471d1714SBenjamin Tissoires 	if (!buf)
480471d1714SBenjamin Tissoires 		return -ENOMEM;
481471d1714SBenjamin Tissoires 
482471d1714SBenjamin Tissoires 	/* Send 'start' command */
483471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_START;
484471d1714SBenjamin Tissoires 	buf[1] = 1;
485471d1714SBenjamin Tissoires 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
486471d1714SBenjamin Tissoires 				  WAC_CMD_ICON_START, buf, 2, WAC_CMD_RETRIES);
487471d1714SBenjamin Tissoires 	if (retval < 0)
488471d1714SBenjamin Tissoires 		goto out;
489471d1714SBenjamin Tissoires 
490471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_XFER;
491471d1714SBenjamin Tissoires 	buf[1] = button_id & 0x07;
492471d1714SBenjamin Tissoires 	for (i = 0; i < 4; i++) {
493471d1714SBenjamin Tissoires 		buf[2] = i;
494471d1714SBenjamin Tissoires 		memcpy(buf + 3, img + i * 256, 256);
495471d1714SBenjamin Tissoires 
496471d1714SBenjamin Tissoires 		retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
497471d1714SBenjamin Tissoires 					  WAC_CMD_ICON_XFER,
498471d1714SBenjamin Tissoires 					  buf, 259, WAC_CMD_RETRIES);
499471d1714SBenjamin Tissoires 		if (retval < 0)
500471d1714SBenjamin Tissoires 			break;
501471d1714SBenjamin Tissoires 	}
502471d1714SBenjamin Tissoires 
503471d1714SBenjamin Tissoires 	/* Send 'stop' */
504471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_START;
505471d1714SBenjamin Tissoires 	buf[1] = 0;
506471d1714SBenjamin Tissoires 	wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, WAC_CMD_ICON_START,
507471d1714SBenjamin Tissoires 			 buf, 2, WAC_CMD_RETRIES);
508471d1714SBenjamin Tissoires 
509471d1714SBenjamin Tissoires out:
510471d1714SBenjamin Tissoires 	kfree(buf);
511471d1714SBenjamin Tissoires 	return retval;
512471d1714SBenjamin Tissoires }
513471d1714SBenjamin Tissoires 
514471d1714SBenjamin Tissoires static ssize_t wacom_led_select_store(struct device *dev, int set_id,
515471d1714SBenjamin Tissoires 				      const char *buf, size_t count)
516471d1714SBenjamin Tissoires {
517471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
518471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
519471d1714SBenjamin Tissoires 	unsigned int id;
520471d1714SBenjamin Tissoires 	int err;
521471d1714SBenjamin Tissoires 
522471d1714SBenjamin Tissoires 	err = kstrtouint(buf, 10, &id);
523471d1714SBenjamin Tissoires 	if (err)
524471d1714SBenjamin Tissoires 		return err;
525471d1714SBenjamin Tissoires 
526471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
527471d1714SBenjamin Tissoires 
528471d1714SBenjamin Tissoires 	wacom->led.select[set_id] = id & 0x3;
529471d1714SBenjamin Tissoires 	err = wacom_led_control(wacom);
530471d1714SBenjamin Tissoires 
531471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
532471d1714SBenjamin Tissoires 
533471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
534471d1714SBenjamin Tissoires }
535471d1714SBenjamin Tissoires 
536471d1714SBenjamin Tissoires #define DEVICE_LED_SELECT_ATTR(SET_ID)					\
537471d1714SBenjamin Tissoires static ssize_t wacom_led##SET_ID##_select_store(struct device *dev,	\
538471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
539471d1714SBenjamin Tissoires {									\
540471d1714SBenjamin Tissoires 	return wacom_led_select_store(dev, SET_ID, buf, count);		\
541471d1714SBenjamin Tissoires }									\
542471d1714SBenjamin Tissoires static ssize_t wacom_led##SET_ID##_select_show(struct device *dev,	\
543471d1714SBenjamin Tissoires 	struct device_attribute *attr, char *buf)			\
544471d1714SBenjamin Tissoires {									\
545471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
546471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);			\
547471d1714SBenjamin Tissoires 	return snprintf(buf, 2, "%d\n", wacom->led.select[SET_ID]);	\
548471d1714SBenjamin Tissoires }									\
549471d1714SBenjamin Tissoires static DEVICE_ATTR(status_led##SET_ID##_select, S_IWUSR | S_IRUSR,	\
550471d1714SBenjamin Tissoires 		    wacom_led##SET_ID##_select_show,			\
551471d1714SBenjamin Tissoires 		    wacom_led##SET_ID##_select_store)
552471d1714SBenjamin Tissoires 
553471d1714SBenjamin Tissoires DEVICE_LED_SELECT_ATTR(0);
554471d1714SBenjamin Tissoires DEVICE_LED_SELECT_ATTR(1);
555471d1714SBenjamin Tissoires 
556471d1714SBenjamin Tissoires static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
557471d1714SBenjamin Tissoires 				     const char *buf, size_t count)
558471d1714SBenjamin Tissoires {
559471d1714SBenjamin Tissoires 	unsigned int value;
560471d1714SBenjamin Tissoires 	int err;
561471d1714SBenjamin Tissoires 
562471d1714SBenjamin Tissoires 	err = kstrtouint(buf, 10, &value);
563471d1714SBenjamin Tissoires 	if (err)
564471d1714SBenjamin Tissoires 		return err;
565471d1714SBenjamin Tissoires 
566471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
567471d1714SBenjamin Tissoires 
568471d1714SBenjamin Tissoires 	*dest = value & 0x7f;
569471d1714SBenjamin Tissoires 	err = wacom_led_control(wacom);
570471d1714SBenjamin Tissoires 
571471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
572471d1714SBenjamin Tissoires 
573471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
574471d1714SBenjamin Tissoires }
575471d1714SBenjamin Tissoires 
576471d1714SBenjamin Tissoires #define DEVICE_LUMINANCE_ATTR(name, field)				\
577471d1714SBenjamin Tissoires static ssize_t wacom_##name##_luminance_store(struct device *dev,	\
578471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
579471d1714SBenjamin Tissoires {									\
580471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
581471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);			\
582471d1714SBenjamin Tissoires 									\
583471d1714SBenjamin Tissoires 	return wacom_luminance_store(wacom, &wacom->led.field,		\
584471d1714SBenjamin Tissoires 				     buf, count);			\
585471d1714SBenjamin Tissoires }									\
586471d1714SBenjamin Tissoires static DEVICE_ATTR(name##_luminance, S_IWUSR,				\
587471d1714SBenjamin Tissoires 		   NULL, wacom_##name##_luminance_store)
588471d1714SBenjamin Tissoires 
589471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(status0, llv);
590471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(status1, hlv);
591471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(buttons, img_lum);
592471d1714SBenjamin Tissoires 
593471d1714SBenjamin Tissoires static ssize_t wacom_button_image_store(struct device *dev, int button_id,
594471d1714SBenjamin Tissoires 					const char *buf, size_t count)
595471d1714SBenjamin Tissoires {
596471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
597471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
598471d1714SBenjamin Tissoires 	int err;
599471d1714SBenjamin Tissoires 
600471d1714SBenjamin Tissoires 	if (count != 1024)
601471d1714SBenjamin Tissoires 		return -EINVAL;
602471d1714SBenjamin Tissoires 
603471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
604471d1714SBenjamin Tissoires 
605471d1714SBenjamin Tissoires 	err = wacom_led_putimage(wacom, button_id, buf);
606471d1714SBenjamin Tissoires 
607471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
608471d1714SBenjamin Tissoires 
609471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
610471d1714SBenjamin Tissoires }
611471d1714SBenjamin Tissoires 
612471d1714SBenjamin Tissoires #define DEVICE_BTNIMG_ATTR(BUTTON_ID)					\
613471d1714SBenjamin Tissoires static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev,	\
614471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
615471d1714SBenjamin Tissoires {									\
616471d1714SBenjamin Tissoires 	return wacom_button_image_store(dev, BUTTON_ID, buf, count);	\
617471d1714SBenjamin Tissoires }									\
618471d1714SBenjamin Tissoires static DEVICE_ATTR(button##BUTTON_ID##_rawimg, S_IWUSR,			\
619471d1714SBenjamin Tissoires 		   NULL, wacom_btnimg##BUTTON_ID##_store)
620471d1714SBenjamin Tissoires 
621471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(0);
622471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(1);
623471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(2);
624471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(3);
625471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(4);
626471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(5);
627471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(6);
628471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(7);
629471d1714SBenjamin Tissoires 
630471d1714SBenjamin Tissoires static struct attribute *cintiq_led_attrs[] = {
631471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
632471d1714SBenjamin Tissoires 	&dev_attr_status_led1_select.attr,
633471d1714SBenjamin Tissoires 	NULL
634471d1714SBenjamin Tissoires };
635471d1714SBenjamin Tissoires 
636471d1714SBenjamin Tissoires static struct attribute_group cintiq_led_attr_group = {
637471d1714SBenjamin Tissoires 	.name = "wacom_led",
638471d1714SBenjamin Tissoires 	.attrs = cintiq_led_attrs,
639471d1714SBenjamin Tissoires };
640471d1714SBenjamin Tissoires 
641471d1714SBenjamin Tissoires static struct attribute *intuos4_led_attrs[] = {
642471d1714SBenjamin Tissoires 	&dev_attr_status0_luminance.attr,
643471d1714SBenjamin Tissoires 	&dev_attr_status1_luminance.attr,
644471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
645471d1714SBenjamin Tissoires 	&dev_attr_buttons_luminance.attr,
646471d1714SBenjamin Tissoires 	&dev_attr_button0_rawimg.attr,
647471d1714SBenjamin Tissoires 	&dev_attr_button1_rawimg.attr,
648471d1714SBenjamin Tissoires 	&dev_attr_button2_rawimg.attr,
649471d1714SBenjamin Tissoires 	&dev_attr_button3_rawimg.attr,
650471d1714SBenjamin Tissoires 	&dev_attr_button4_rawimg.attr,
651471d1714SBenjamin Tissoires 	&dev_attr_button5_rawimg.attr,
652471d1714SBenjamin Tissoires 	&dev_attr_button6_rawimg.attr,
653471d1714SBenjamin Tissoires 	&dev_attr_button7_rawimg.attr,
654471d1714SBenjamin Tissoires 	NULL
655471d1714SBenjamin Tissoires };
656471d1714SBenjamin Tissoires 
657471d1714SBenjamin Tissoires static struct attribute_group intuos4_led_attr_group = {
658471d1714SBenjamin Tissoires 	.name = "wacom_led",
659471d1714SBenjamin Tissoires 	.attrs = intuos4_led_attrs,
660471d1714SBenjamin Tissoires };
661471d1714SBenjamin Tissoires 
662471d1714SBenjamin Tissoires static struct attribute *intuos5_led_attrs[] = {
663471d1714SBenjamin Tissoires 	&dev_attr_status0_luminance.attr,
664471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
665471d1714SBenjamin Tissoires 	NULL
666471d1714SBenjamin Tissoires };
667471d1714SBenjamin Tissoires 
668471d1714SBenjamin Tissoires static struct attribute_group intuos5_led_attr_group = {
669471d1714SBenjamin Tissoires 	.name = "wacom_led",
670471d1714SBenjamin Tissoires 	.attrs = intuos5_led_attrs,
671471d1714SBenjamin Tissoires };
672471d1714SBenjamin Tissoires 
673471d1714SBenjamin Tissoires static int wacom_initialize_leds(struct wacom *wacom)
674471d1714SBenjamin Tissoires {
675471d1714SBenjamin Tissoires 	int error;
676471d1714SBenjamin Tissoires 
677471d1714SBenjamin Tissoires 	/* Initialize default values */
678471d1714SBenjamin Tissoires 	switch (wacom->wacom_wac.features.type) {
679471d1714SBenjamin Tissoires 	case INTUOS4S:
680471d1714SBenjamin Tissoires 	case INTUOS4:
681471d1714SBenjamin Tissoires 	case INTUOS4L:
682471d1714SBenjamin Tissoires 		wacom->led.select[0] = 0;
683471d1714SBenjamin Tissoires 		wacom->led.select[1] = 0;
684471d1714SBenjamin Tissoires 		wacom->led.llv = 10;
685471d1714SBenjamin Tissoires 		wacom->led.hlv = 20;
686471d1714SBenjamin Tissoires 		wacom->led.img_lum = 10;
687471d1714SBenjamin Tissoires 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
688471d1714SBenjamin Tissoires 					   &intuos4_led_attr_group);
689471d1714SBenjamin Tissoires 		break;
690471d1714SBenjamin Tissoires 
691471d1714SBenjamin Tissoires 	case WACOM_24HD:
692471d1714SBenjamin Tissoires 	case WACOM_21UX2:
693471d1714SBenjamin Tissoires 		wacom->led.select[0] = 0;
694471d1714SBenjamin Tissoires 		wacom->led.select[1] = 0;
695471d1714SBenjamin Tissoires 		wacom->led.llv = 0;
696471d1714SBenjamin Tissoires 		wacom->led.hlv = 0;
697471d1714SBenjamin Tissoires 		wacom->led.img_lum = 0;
698471d1714SBenjamin Tissoires 
699471d1714SBenjamin Tissoires 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
700471d1714SBenjamin Tissoires 					   &cintiq_led_attr_group);
701471d1714SBenjamin Tissoires 		break;
702471d1714SBenjamin Tissoires 
703471d1714SBenjamin Tissoires 	case INTUOS5S:
704471d1714SBenjamin Tissoires 	case INTUOS5:
705471d1714SBenjamin Tissoires 	case INTUOS5L:
706471d1714SBenjamin Tissoires 	case INTUOSPS:
707471d1714SBenjamin Tissoires 	case INTUOSPM:
708471d1714SBenjamin Tissoires 	case INTUOSPL:
709471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN) {
710471d1714SBenjamin Tissoires 			wacom->led.select[0] = 0;
711471d1714SBenjamin Tissoires 			wacom->led.select[1] = 0;
712471d1714SBenjamin Tissoires 			wacom->led.llv = 32;
713471d1714SBenjamin Tissoires 			wacom->led.hlv = 0;
714471d1714SBenjamin Tissoires 			wacom->led.img_lum = 0;
715471d1714SBenjamin Tissoires 
716471d1714SBenjamin Tissoires 			error = sysfs_create_group(&wacom->hdev->dev.kobj,
717471d1714SBenjamin Tissoires 						  &intuos5_led_attr_group);
718471d1714SBenjamin Tissoires 		} else
719471d1714SBenjamin Tissoires 			return 0;
720471d1714SBenjamin Tissoires 		break;
721471d1714SBenjamin Tissoires 
722471d1714SBenjamin Tissoires 	default:
723471d1714SBenjamin Tissoires 		return 0;
724471d1714SBenjamin Tissoires 	}
725471d1714SBenjamin Tissoires 
726471d1714SBenjamin Tissoires 	if (error) {
727471d1714SBenjamin Tissoires 		hid_err(wacom->hdev,
728471d1714SBenjamin Tissoires 			"cannot create sysfs group err: %d\n", error);
729471d1714SBenjamin Tissoires 		return error;
730471d1714SBenjamin Tissoires 	}
731471d1714SBenjamin Tissoires 	wacom_led_control(wacom);
732c757cbafSBenjamin Tissoires 	wacom->led_initialized = true;
733471d1714SBenjamin Tissoires 
734471d1714SBenjamin Tissoires 	return 0;
735471d1714SBenjamin Tissoires }
736471d1714SBenjamin Tissoires 
737471d1714SBenjamin Tissoires static void wacom_destroy_leds(struct wacom *wacom)
738471d1714SBenjamin Tissoires {
739c757cbafSBenjamin Tissoires 	if (!wacom->led_initialized)
740c757cbafSBenjamin Tissoires 		return;
741c757cbafSBenjamin Tissoires 
742c757cbafSBenjamin Tissoires 	wacom->led_initialized = false;
743c757cbafSBenjamin Tissoires 
744471d1714SBenjamin Tissoires 	switch (wacom->wacom_wac.features.type) {
745471d1714SBenjamin Tissoires 	case INTUOS4S:
746471d1714SBenjamin Tissoires 	case INTUOS4:
747471d1714SBenjamin Tissoires 	case INTUOS4L:
748471d1714SBenjamin Tissoires 		sysfs_remove_group(&wacom->hdev->dev.kobj,
749471d1714SBenjamin Tissoires 				   &intuos4_led_attr_group);
750471d1714SBenjamin Tissoires 		break;
751471d1714SBenjamin Tissoires 
752471d1714SBenjamin Tissoires 	case WACOM_24HD:
753471d1714SBenjamin Tissoires 	case WACOM_21UX2:
754471d1714SBenjamin Tissoires 		sysfs_remove_group(&wacom->hdev->dev.kobj,
755471d1714SBenjamin Tissoires 				   &cintiq_led_attr_group);
756471d1714SBenjamin Tissoires 		break;
757471d1714SBenjamin Tissoires 
758471d1714SBenjamin Tissoires 	case INTUOS5S:
759471d1714SBenjamin Tissoires 	case INTUOS5:
760471d1714SBenjamin Tissoires 	case INTUOS5L:
761471d1714SBenjamin Tissoires 	case INTUOSPS:
762471d1714SBenjamin Tissoires 	case INTUOSPM:
763471d1714SBenjamin Tissoires 	case INTUOSPL:
764471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN)
765471d1714SBenjamin Tissoires 			sysfs_remove_group(&wacom->hdev->dev.kobj,
766471d1714SBenjamin Tissoires 					   &intuos5_led_attr_group);
767471d1714SBenjamin Tissoires 		break;
768471d1714SBenjamin Tissoires 	}
769471d1714SBenjamin Tissoires }
770471d1714SBenjamin Tissoires 
771471d1714SBenjamin Tissoires static enum power_supply_property wacom_battery_props[] = {
772ac8d1010SBenjamin Tissoires 	POWER_SUPPLY_PROP_STATUS,
773471d1714SBenjamin Tissoires 	POWER_SUPPLY_PROP_SCOPE,
774471d1714SBenjamin Tissoires 	POWER_SUPPLY_PROP_CAPACITY
775471d1714SBenjamin Tissoires };
776471d1714SBenjamin Tissoires 
777471d1714SBenjamin Tissoires static int wacom_battery_get_property(struct power_supply *psy,
778471d1714SBenjamin Tissoires 				      enum power_supply_property psp,
779471d1714SBenjamin Tissoires 				      union power_supply_propval *val)
780471d1714SBenjamin Tissoires {
781471d1714SBenjamin Tissoires 	struct wacom *wacom = container_of(psy, struct wacom, battery);
782471d1714SBenjamin Tissoires 	int ret = 0;
783471d1714SBenjamin Tissoires 
784471d1714SBenjamin Tissoires 	switch (psp) {
785471d1714SBenjamin Tissoires 		case POWER_SUPPLY_PROP_SCOPE:
786471d1714SBenjamin Tissoires 			val->intval = POWER_SUPPLY_SCOPE_DEVICE;
787471d1714SBenjamin Tissoires 			break;
788471d1714SBenjamin Tissoires 		case POWER_SUPPLY_PROP_CAPACITY:
789471d1714SBenjamin Tissoires 			val->intval =
790ac8d1010SBenjamin Tissoires 				wacom->wacom_wac.battery_capacity;
791ac8d1010SBenjamin Tissoires 			break;
792ac8d1010SBenjamin Tissoires 		case POWER_SUPPLY_PROP_STATUS:
793ac8d1010SBenjamin Tissoires 			if (wacom->wacom_wac.bat_charging)
794ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_CHARGING;
795ac8d1010SBenjamin Tissoires 			else if (wacom->wacom_wac.battery_capacity == 100 &&
796ac8d1010SBenjamin Tissoires 				    wacom->wacom_wac.ps_connected)
797ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_FULL;
798ac8d1010SBenjamin Tissoires 			else
799ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
800471d1714SBenjamin Tissoires 			break;
801471d1714SBenjamin Tissoires 		default:
802471d1714SBenjamin Tissoires 			ret = -EINVAL;
803471d1714SBenjamin Tissoires 			break;
804471d1714SBenjamin Tissoires 	}
805471d1714SBenjamin Tissoires 
806471d1714SBenjamin Tissoires 	return ret;
807471d1714SBenjamin Tissoires }
808471d1714SBenjamin Tissoires 
809471d1714SBenjamin Tissoires static int wacom_initialize_battery(struct wacom *wacom)
810471d1714SBenjamin Tissoires {
811471d1714SBenjamin Tissoires 	int error = 0;
812*d70420b9SBenjamin Tissoires 	static atomic_t battery_no = ATOMIC_INIT(0);
813*d70420b9SBenjamin Tissoires 	unsigned long n;
814471d1714SBenjamin Tissoires 
815ac8d1010SBenjamin Tissoires 	if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) {
816*d70420b9SBenjamin Tissoires 		n = atomic_inc_return(&battery_no) - 1;
817471d1714SBenjamin Tissoires 		wacom->battery.properties = wacom_battery_props;
818471d1714SBenjamin Tissoires 		wacom->battery.num_properties = ARRAY_SIZE(wacom_battery_props);
819471d1714SBenjamin Tissoires 		wacom->battery.get_property = wacom_battery_get_property;
820*d70420b9SBenjamin Tissoires 		sprintf(wacom->wacom_wac.bat_name, "wacom_battery_%ld", n);
821*d70420b9SBenjamin Tissoires 		wacom->battery.name = wacom->wacom_wac.bat_name;
822471d1714SBenjamin Tissoires 		wacom->battery.type = POWER_SUPPLY_TYPE_BATTERY;
823471d1714SBenjamin Tissoires 		wacom->battery.use_for_apm = 0;
824471d1714SBenjamin Tissoires 
825471d1714SBenjamin Tissoires 		error = power_supply_register(&wacom->hdev->dev,
826471d1714SBenjamin Tissoires 					      &wacom->battery);
827471d1714SBenjamin Tissoires 
828471d1714SBenjamin Tissoires 		if (!error)
829471d1714SBenjamin Tissoires 			power_supply_powers(&wacom->battery,
830471d1714SBenjamin Tissoires 					    &wacom->hdev->dev);
831471d1714SBenjamin Tissoires 	}
832471d1714SBenjamin Tissoires 
833471d1714SBenjamin Tissoires 	return error;
834471d1714SBenjamin Tissoires }
835471d1714SBenjamin Tissoires 
836471d1714SBenjamin Tissoires static void wacom_destroy_battery(struct wacom *wacom)
837471d1714SBenjamin Tissoires {
838ac8d1010SBenjamin Tissoires 	if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
839471d1714SBenjamin Tissoires 	     wacom->battery.dev) {
840471d1714SBenjamin Tissoires 		power_supply_unregister(&wacom->battery);
841471d1714SBenjamin Tissoires 		wacom->battery.dev = NULL;
842471d1714SBenjamin Tissoires 	}
843471d1714SBenjamin Tissoires }
844471d1714SBenjamin Tissoires 
845471d1714SBenjamin Tissoires static struct input_dev *wacom_allocate_input(struct wacom *wacom)
846471d1714SBenjamin Tissoires {
847471d1714SBenjamin Tissoires 	struct input_dev *input_dev;
848471d1714SBenjamin Tissoires 	struct hid_device *hdev = wacom->hdev;
849471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
850471d1714SBenjamin Tissoires 
851471d1714SBenjamin Tissoires 	input_dev = input_allocate_device();
852471d1714SBenjamin Tissoires 	if (!input_dev)
853471d1714SBenjamin Tissoires 		return NULL;
854471d1714SBenjamin Tissoires 
855471d1714SBenjamin Tissoires 	input_dev->name = wacom_wac->name;
856471d1714SBenjamin Tissoires 	input_dev->phys = hdev->phys;
857471d1714SBenjamin Tissoires 	input_dev->dev.parent = &hdev->dev;
858471d1714SBenjamin Tissoires 	input_dev->open = wacom_open;
859471d1714SBenjamin Tissoires 	input_dev->close = wacom_close;
860471d1714SBenjamin Tissoires 	input_dev->uniq = hdev->uniq;
861471d1714SBenjamin Tissoires 	input_dev->id.bustype = hdev->bus;
862471d1714SBenjamin Tissoires 	input_dev->id.vendor  = hdev->vendor;
863471d1714SBenjamin Tissoires 	input_dev->id.product = hdev->product;
864471d1714SBenjamin Tissoires 	input_dev->id.version = hdev->version;
865471d1714SBenjamin Tissoires 	input_set_drvdata(input_dev, wacom);
866471d1714SBenjamin Tissoires 
867471d1714SBenjamin Tissoires 	return input_dev;
868471d1714SBenjamin Tissoires }
869471d1714SBenjamin Tissoires 
870471d1714SBenjamin Tissoires static void wacom_unregister_inputs(struct wacom *wacom)
871471d1714SBenjamin Tissoires {
872471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.input)
873471d1714SBenjamin Tissoires 		input_unregister_device(wacom->wacom_wac.input);
874471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.pad_input)
875471d1714SBenjamin Tissoires 		input_unregister_device(wacom->wacom_wac.pad_input);
876471d1714SBenjamin Tissoires 	wacom->wacom_wac.input = NULL;
877471d1714SBenjamin Tissoires 	wacom->wacom_wac.pad_input = NULL;
878471d1714SBenjamin Tissoires }
879471d1714SBenjamin Tissoires 
880471d1714SBenjamin Tissoires static int wacom_register_inputs(struct wacom *wacom)
881471d1714SBenjamin Tissoires {
882471d1714SBenjamin Tissoires 	struct input_dev *input_dev, *pad_input_dev;
883471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
884471d1714SBenjamin Tissoires 	int error;
885471d1714SBenjamin Tissoires 
886471d1714SBenjamin Tissoires 	input_dev = wacom_allocate_input(wacom);
887471d1714SBenjamin Tissoires 	pad_input_dev = wacom_allocate_input(wacom);
888471d1714SBenjamin Tissoires 	if (!input_dev || !pad_input_dev) {
889471d1714SBenjamin Tissoires 		error = -ENOMEM;
890471d1714SBenjamin Tissoires 		goto fail1;
891471d1714SBenjamin Tissoires 	}
892471d1714SBenjamin Tissoires 
893471d1714SBenjamin Tissoires 	wacom_wac->input = input_dev;
894471d1714SBenjamin Tissoires 	wacom_wac->pad_input = pad_input_dev;
895471d1714SBenjamin Tissoires 	wacom_wac->pad_input->name = wacom_wac->pad_name;
896471d1714SBenjamin Tissoires 
897471d1714SBenjamin Tissoires 	error = wacom_setup_input_capabilities(input_dev, wacom_wac);
898471d1714SBenjamin Tissoires 	if (error)
899471d1714SBenjamin Tissoires 		goto fail2;
900471d1714SBenjamin Tissoires 
901471d1714SBenjamin Tissoires 	error = input_register_device(input_dev);
902471d1714SBenjamin Tissoires 	if (error)
903471d1714SBenjamin Tissoires 		goto fail2;
904471d1714SBenjamin Tissoires 
905471d1714SBenjamin Tissoires 	error = wacom_setup_pad_input_capabilities(pad_input_dev, wacom_wac);
906471d1714SBenjamin Tissoires 	if (error) {
907471d1714SBenjamin Tissoires 		/* no pad in use on this interface */
908471d1714SBenjamin Tissoires 		input_free_device(pad_input_dev);
909471d1714SBenjamin Tissoires 		wacom_wac->pad_input = NULL;
910471d1714SBenjamin Tissoires 		pad_input_dev = NULL;
911471d1714SBenjamin Tissoires 	} else {
912471d1714SBenjamin Tissoires 		error = input_register_device(pad_input_dev);
913471d1714SBenjamin Tissoires 		if (error)
914471d1714SBenjamin Tissoires 			goto fail3;
915471d1714SBenjamin Tissoires 	}
916471d1714SBenjamin Tissoires 
917471d1714SBenjamin Tissoires 	return 0;
918471d1714SBenjamin Tissoires 
919471d1714SBenjamin Tissoires fail3:
920471d1714SBenjamin Tissoires 	input_unregister_device(input_dev);
921471d1714SBenjamin Tissoires 	input_dev = NULL;
922471d1714SBenjamin Tissoires fail2:
923471d1714SBenjamin Tissoires 	wacom_wac->input = NULL;
924471d1714SBenjamin Tissoires 	wacom_wac->pad_input = NULL;
925471d1714SBenjamin Tissoires fail1:
926471d1714SBenjamin Tissoires 	if (input_dev)
927471d1714SBenjamin Tissoires 		input_free_device(input_dev);
928471d1714SBenjamin Tissoires 	if (pad_input_dev)
929471d1714SBenjamin Tissoires 		input_free_device(pad_input_dev);
930471d1714SBenjamin Tissoires 	return error;
931471d1714SBenjamin Tissoires }
932471d1714SBenjamin Tissoires 
933471d1714SBenjamin Tissoires static void wacom_wireless_work(struct work_struct *work)
934471d1714SBenjamin Tissoires {
935471d1714SBenjamin Tissoires 	struct wacom *wacom = container_of(work, struct wacom, work);
936471d1714SBenjamin Tissoires 	struct usb_device *usbdev = wacom->usbdev;
937471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
938471d1714SBenjamin Tissoires 	struct hid_device *hdev1, *hdev2;
939471d1714SBenjamin Tissoires 	struct wacom *wacom1, *wacom2;
940471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac1, *wacom_wac2;
941471d1714SBenjamin Tissoires 	int error;
942471d1714SBenjamin Tissoires 
943471d1714SBenjamin Tissoires 	/*
944471d1714SBenjamin Tissoires 	 * Regardless if this is a disconnect or a new tablet,
945471d1714SBenjamin Tissoires 	 * remove any existing input and battery devices.
946471d1714SBenjamin Tissoires 	 */
947471d1714SBenjamin Tissoires 
948471d1714SBenjamin Tissoires 	wacom_destroy_battery(wacom);
949471d1714SBenjamin Tissoires 
950471d1714SBenjamin Tissoires 	/* Stylus interface */
951471d1714SBenjamin Tissoires 	hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
952471d1714SBenjamin Tissoires 	wacom1 = hid_get_drvdata(hdev1);
953471d1714SBenjamin Tissoires 	wacom_wac1 = &(wacom1->wacom_wac);
954471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom1);
955471d1714SBenjamin Tissoires 
956471d1714SBenjamin Tissoires 	/* Touch interface */
957471d1714SBenjamin Tissoires 	hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
958471d1714SBenjamin Tissoires 	wacom2 = hid_get_drvdata(hdev2);
959471d1714SBenjamin Tissoires 	wacom_wac2 = &(wacom2->wacom_wac);
960471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom2);
961471d1714SBenjamin Tissoires 
962471d1714SBenjamin Tissoires 	if (wacom_wac->pid == 0) {
963471d1714SBenjamin Tissoires 		hid_info(wacom->hdev, "wireless tablet disconnected\n");
964ac8d1010SBenjamin Tissoires 		wacom_wac1->shared->type = 0;
965471d1714SBenjamin Tissoires 	} else {
966471d1714SBenjamin Tissoires 		const struct hid_device_id *id = wacom_ids;
967471d1714SBenjamin Tissoires 
968471d1714SBenjamin Tissoires 		hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
969471d1714SBenjamin Tissoires 			 wacom_wac->pid);
970471d1714SBenjamin Tissoires 
971471d1714SBenjamin Tissoires 		while (id->bus) {
972471d1714SBenjamin Tissoires 			if (id->vendor == USB_VENDOR_ID_WACOM &&
973471d1714SBenjamin Tissoires 			    id->product == wacom_wac->pid)
974471d1714SBenjamin Tissoires 				break;
975471d1714SBenjamin Tissoires 			id++;
976471d1714SBenjamin Tissoires 		}
977471d1714SBenjamin Tissoires 
978471d1714SBenjamin Tissoires 		if (!id->bus) {
979471d1714SBenjamin Tissoires 			hid_info(wacom->hdev, "ignoring unknown PID.\n");
980471d1714SBenjamin Tissoires 			return;
981471d1714SBenjamin Tissoires 		}
982471d1714SBenjamin Tissoires 
983471d1714SBenjamin Tissoires 		/* Stylus interface */
984471d1714SBenjamin Tissoires 		wacom_wac1->features =
985471d1714SBenjamin Tissoires 			*((struct wacom_features *)id->driver_data);
986471d1714SBenjamin Tissoires 		wacom_wac1->features.device_type = BTN_TOOL_PEN;
987471d1714SBenjamin Tissoires 		snprintf(wacom_wac1->name, WACOM_NAME_MAX, "%s (WL) Pen",
988471d1714SBenjamin Tissoires 			 wacom_wac1->features.name);
989471d1714SBenjamin Tissoires 		snprintf(wacom_wac1->pad_name, WACOM_NAME_MAX, "%s (WL) Pad",
990471d1714SBenjamin Tissoires 			 wacom_wac1->features.name);
991471d1714SBenjamin Tissoires 		wacom_wac1->shared->touch_max = wacom_wac1->features.touch_max;
992471d1714SBenjamin Tissoires 		wacom_wac1->shared->type = wacom_wac1->features.type;
993471d1714SBenjamin Tissoires 		error = wacom_register_inputs(wacom1);
994471d1714SBenjamin Tissoires 		if (error)
995471d1714SBenjamin Tissoires 			goto fail;
996471d1714SBenjamin Tissoires 
997471d1714SBenjamin Tissoires 		/* Touch interface */
998471d1714SBenjamin Tissoires 		if (wacom_wac1->features.touch_max ||
999471d1714SBenjamin Tissoires 		    wacom_wac1->features.type == INTUOSHT) {
1000471d1714SBenjamin Tissoires 			wacom_wac2->features =
1001471d1714SBenjamin Tissoires 				*((struct wacom_features *)id->driver_data);
1002471d1714SBenjamin Tissoires 			wacom_wac2->features.pktlen = WACOM_PKGLEN_BBTOUCH3;
1003471d1714SBenjamin Tissoires 			wacom_wac2->features.device_type = BTN_TOOL_FINGER;
1004471d1714SBenjamin Tissoires 			wacom_wac2->features.x_max = wacom_wac2->features.y_max = 4096;
1005471d1714SBenjamin Tissoires 			if (wacom_wac2->features.touch_max)
1006471d1714SBenjamin Tissoires 				snprintf(wacom_wac2->name, WACOM_NAME_MAX,
1007471d1714SBenjamin Tissoires 					 "%s (WL) Finger",wacom_wac2->features.name);
1008471d1714SBenjamin Tissoires 			else
1009471d1714SBenjamin Tissoires 				snprintf(wacom_wac2->name, WACOM_NAME_MAX,
1010471d1714SBenjamin Tissoires 					 "%s (WL) Pad",wacom_wac2->features.name);
1011471d1714SBenjamin Tissoires 			snprintf(wacom_wac2->pad_name, WACOM_NAME_MAX,
1012471d1714SBenjamin Tissoires 				 "%s (WL) Pad", wacom_wac2->features.name);
1013471d1714SBenjamin Tissoires 			error = wacom_register_inputs(wacom2);
1014471d1714SBenjamin Tissoires 			if (error)
1015471d1714SBenjamin Tissoires 				goto fail;
1016471d1714SBenjamin Tissoires 
1017471d1714SBenjamin Tissoires 			if (wacom_wac1->features.type == INTUOSHT &&
1018471d1714SBenjamin Tissoires 			    wacom_wac1->features.touch_max)
1019471d1714SBenjamin Tissoires 				wacom_wac->shared->touch_input = wacom_wac2->input;
1020471d1714SBenjamin Tissoires 		}
1021471d1714SBenjamin Tissoires 
1022471d1714SBenjamin Tissoires 		error = wacom_initialize_battery(wacom);
1023471d1714SBenjamin Tissoires 		if (error)
1024471d1714SBenjamin Tissoires 			goto fail;
1025471d1714SBenjamin Tissoires 	}
1026471d1714SBenjamin Tissoires 
1027471d1714SBenjamin Tissoires 	return;
1028471d1714SBenjamin Tissoires 
1029471d1714SBenjamin Tissoires fail:
1030471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom1);
1031471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom2);
1032471d1714SBenjamin Tissoires 	return;
1033471d1714SBenjamin Tissoires }
1034471d1714SBenjamin Tissoires 
1035471d1714SBenjamin Tissoires /*
1036471d1714SBenjamin Tissoires  * Not all devices report physical dimensions from HID.
1037471d1714SBenjamin Tissoires  * Compute the default from hardcoded logical dimension
1038471d1714SBenjamin Tissoires  * and resolution before driver overwrites them.
1039471d1714SBenjamin Tissoires  */
1040471d1714SBenjamin Tissoires static void wacom_set_default_phy(struct wacom_features *features)
1041471d1714SBenjamin Tissoires {
1042471d1714SBenjamin Tissoires 	if (features->x_resolution) {
1043471d1714SBenjamin Tissoires 		features->x_phy = (features->x_max * 100) /
1044471d1714SBenjamin Tissoires 					features->x_resolution;
1045471d1714SBenjamin Tissoires 		features->y_phy = (features->y_max * 100) /
1046471d1714SBenjamin Tissoires 					features->y_resolution;
1047471d1714SBenjamin Tissoires 	}
1048471d1714SBenjamin Tissoires }
1049471d1714SBenjamin Tissoires 
1050471d1714SBenjamin Tissoires static void wacom_calculate_res(struct wacom_features *features)
1051471d1714SBenjamin Tissoires {
1052471d1714SBenjamin Tissoires 	features->x_resolution = wacom_calc_hid_res(features->x_max,
1053471d1714SBenjamin Tissoires 						    features->x_phy,
1054471d1714SBenjamin Tissoires 						    features->unit,
1055471d1714SBenjamin Tissoires 						    features->unitExpo);
1056471d1714SBenjamin Tissoires 	features->y_resolution = wacom_calc_hid_res(features->y_max,
1057471d1714SBenjamin Tissoires 						    features->y_phy,
1058471d1714SBenjamin Tissoires 						    features->unit,
1059471d1714SBenjamin Tissoires 						    features->unitExpo);
1060471d1714SBenjamin Tissoires }
1061471d1714SBenjamin Tissoires 
1062471d1714SBenjamin Tissoires static int wacom_hid_report_len(struct hid_report *report)
1063471d1714SBenjamin Tissoires {
1064471d1714SBenjamin Tissoires 	/* equivalent to DIV_ROUND_UP(report->size, 8) + !!(report->id > 0) */
1065471d1714SBenjamin Tissoires 	return ((report->size - 1) >> 3) + 1 + (report->id > 0);
1066471d1714SBenjamin Tissoires }
1067471d1714SBenjamin Tissoires 
1068471d1714SBenjamin Tissoires static size_t wacom_compute_pktlen(struct hid_device *hdev)
1069471d1714SBenjamin Tissoires {
1070471d1714SBenjamin Tissoires 	struct hid_report_enum *report_enum;
1071471d1714SBenjamin Tissoires 	struct hid_report *report;
1072471d1714SBenjamin Tissoires 	size_t size = 0;
1073471d1714SBenjamin Tissoires 
1074471d1714SBenjamin Tissoires 	report_enum = hdev->report_enum + HID_INPUT_REPORT;
1075471d1714SBenjamin Tissoires 
1076471d1714SBenjamin Tissoires 	list_for_each_entry(report, &report_enum->report_list, list) {
1077471d1714SBenjamin Tissoires 		size_t report_size = wacom_hid_report_len(report);
1078471d1714SBenjamin Tissoires 		if (report_size > size)
1079471d1714SBenjamin Tissoires 			size = report_size;
1080471d1714SBenjamin Tissoires 	}
1081471d1714SBenjamin Tissoires 
1082471d1714SBenjamin Tissoires 	return size;
1083471d1714SBenjamin Tissoires }
1084471d1714SBenjamin Tissoires 
1085471d1714SBenjamin Tissoires static int wacom_probe(struct hid_device *hdev,
1086471d1714SBenjamin Tissoires 		const struct hid_device_id *id)
1087471d1714SBenjamin Tissoires {
1088471d1714SBenjamin Tissoires 	struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
1089471d1714SBenjamin Tissoires 	struct usb_device *dev = interface_to_usbdev(intf);
1090471d1714SBenjamin Tissoires 	struct wacom *wacom;
1091471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac;
1092471d1714SBenjamin Tissoires 	struct wacom_features *features;
1093471d1714SBenjamin Tissoires 	int error;
1094471d1714SBenjamin Tissoires 
1095471d1714SBenjamin Tissoires 	if (!id->driver_data)
1096471d1714SBenjamin Tissoires 		return -EINVAL;
1097471d1714SBenjamin Tissoires 
1098471d1714SBenjamin Tissoires 	wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
1099471d1714SBenjamin Tissoires 	if (!wacom)
1100471d1714SBenjamin Tissoires 		return -ENOMEM;
1101471d1714SBenjamin Tissoires 
1102471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, wacom);
1103471d1714SBenjamin Tissoires 	wacom->hdev = hdev;
1104471d1714SBenjamin Tissoires 
1105471d1714SBenjamin Tissoires 	/* ask for the report descriptor to be loaded by HID */
1106471d1714SBenjamin Tissoires 	error = hid_parse(hdev);
1107471d1714SBenjamin Tissoires 	if (error) {
1108471d1714SBenjamin Tissoires 		hid_err(hdev, "parse failed\n");
1109471d1714SBenjamin Tissoires 		goto fail1;
1110471d1714SBenjamin Tissoires 	}
1111471d1714SBenjamin Tissoires 
1112471d1714SBenjamin Tissoires 	wacom_wac = &wacom->wacom_wac;
1113471d1714SBenjamin Tissoires 	wacom_wac->features = *((struct wacom_features *)id->driver_data);
1114471d1714SBenjamin Tissoires 	features = &wacom_wac->features;
1115471d1714SBenjamin Tissoires 	features->pktlen = wacom_compute_pktlen(hdev);
1116471d1714SBenjamin Tissoires 	if (features->pktlen > WACOM_PKGLEN_MAX) {
1117471d1714SBenjamin Tissoires 		error = -EINVAL;
1118471d1714SBenjamin Tissoires 		goto fail1;
1119471d1714SBenjamin Tissoires 	}
1120471d1714SBenjamin Tissoires 
1121471d1714SBenjamin Tissoires 	if (features->check_for_hid_type && features->hid_type != hdev->type) {
1122471d1714SBenjamin Tissoires 		error = -ENODEV;
1123471d1714SBenjamin Tissoires 		goto fail1;
1124471d1714SBenjamin Tissoires 	}
1125471d1714SBenjamin Tissoires 
1126471d1714SBenjamin Tissoires 	wacom->usbdev = dev;
1127471d1714SBenjamin Tissoires 	wacom->intf = intf;
1128471d1714SBenjamin Tissoires 	mutex_init(&wacom->lock);
1129471d1714SBenjamin Tissoires 	INIT_WORK(&wacom->work, wacom_wireless_work);
1130471d1714SBenjamin Tissoires 
1131471d1714SBenjamin Tissoires 	/* set the default size in case we do not get them from hid */
1132471d1714SBenjamin Tissoires 	wacom_set_default_phy(features);
1133471d1714SBenjamin Tissoires 
1134471d1714SBenjamin Tissoires 	/* Retrieve the physical and logical size for touch devices */
1135471d1714SBenjamin Tissoires 	wacom_retrieve_hid_descriptor(hdev, features);
1136471d1714SBenjamin Tissoires 
1137471d1714SBenjamin Tissoires 	/*
1138471d1714SBenjamin Tissoires 	 * Intuos5 has no useful data about its touch interface in its
1139471d1714SBenjamin Tissoires 	 * HID descriptor. If this is the touch interface (PacketSize
1140471d1714SBenjamin Tissoires 	 * of WACOM_PKGLEN_BBTOUCH3), override the table values.
1141471d1714SBenjamin Tissoires 	 */
1142471d1714SBenjamin Tissoires 	if (features->type >= INTUOS5S && features->type <= INTUOSHT) {
1143471d1714SBenjamin Tissoires 		if (features->pktlen == WACOM_PKGLEN_BBTOUCH3) {
1144471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_FINGER;
1145471d1714SBenjamin Tissoires 
1146471d1714SBenjamin Tissoires 			features->x_max = 4096;
1147471d1714SBenjamin Tissoires 			features->y_max = 4096;
1148471d1714SBenjamin Tissoires 		} else {
1149471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_PEN;
1150471d1714SBenjamin Tissoires 		}
1151471d1714SBenjamin Tissoires 	}
1152471d1714SBenjamin Tissoires 
1153471d1714SBenjamin Tissoires 	/*
1154471d1714SBenjamin Tissoires 	 * Same thing for Bamboo 3rd gen.
1155471d1714SBenjamin Tissoires 	 */
1156471d1714SBenjamin Tissoires 	if ((features->type == BAMBOO_PT) &&
1157471d1714SBenjamin Tissoires 	    (features->pktlen == WACOM_PKGLEN_BBTOUCH3) &&
1158471d1714SBenjamin Tissoires 	    (features->device_type == BTN_TOOL_PEN)) {
1159471d1714SBenjamin Tissoires 		features->device_type = BTN_TOOL_FINGER;
1160471d1714SBenjamin Tissoires 
1161471d1714SBenjamin Tissoires 		features->x_max = 4096;
1162471d1714SBenjamin Tissoires 		features->y_max = 4096;
1163471d1714SBenjamin Tissoires 	}
1164471d1714SBenjamin Tissoires 
1165471d1714SBenjamin Tissoires 	wacom_setup_device_quirks(features);
1166471d1714SBenjamin Tissoires 
1167471d1714SBenjamin Tissoires 	/* set unit to "100th of a mm" for devices not reported by HID */
1168471d1714SBenjamin Tissoires 	if (!features->unit) {
1169471d1714SBenjamin Tissoires 		features->unit = 0x11;
1170471d1714SBenjamin Tissoires 		features->unitExpo = -3;
1171471d1714SBenjamin Tissoires 	}
1172471d1714SBenjamin Tissoires 	wacom_calculate_res(features);
1173471d1714SBenjamin Tissoires 
1174471d1714SBenjamin Tissoires 	strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name));
1175471d1714SBenjamin Tissoires 	snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
1176471d1714SBenjamin Tissoires 		"%s Pad", features->name);
1177471d1714SBenjamin Tissoires 
1178471d1714SBenjamin Tissoires 	if (features->quirks & WACOM_QUIRK_MULTI_INPUT) {
1179471d1714SBenjamin Tissoires 		/* Append the device type to the name */
1180471d1714SBenjamin Tissoires 		if (features->device_type != BTN_TOOL_FINGER)
1181471d1714SBenjamin Tissoires 			strlcat(wacom_wac->name, " Pen", WACOM_NAME_MAX);
1182471d1714SBenjamin Tissoires 		else if (features->touch_max)
1183471d1714SBenjamin Tissoires 			strlcat(wacom_wac->name, " Finger", WACOM_NAME_MAX);
1184471d1714SBenjamin Tissoires 		else
1185471d1714SBenjamin Tissoires 			strlcat(wacom_wac->name, " Pad", WACOM_NAME_MAX);
1186471d1714SBenjamin Tissoires 
1187471d1714SBenjamin Tissoires 		error = wacom_add_shared_data(hdev);
1188471d1714SBenjamin Tissoires 		if (error)
1189471d1714SBenjamin Tissoires 			goto fail1;
1190471d1714SBenjamin Tissoires 	}
1191471d1714SBenjamin Tissoires 
1192471d1714SBenjamin Tissoires 	error = wacom_initialize_leds(wacom);
1193471d1714SBenjamin Tissoires 	if (error)
1194471d1714SBenjamin Tissoires 		goto fail2;
1195471d1714SBenjamin Tissoires 
1196471d1714SBenjamin Tissoires 	if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
1197471d1714SBenjamin Tissoires 		error = wacom_register_inputs(wacom);
1198471d1714SBenjamin Tissoires 		if (error)
1199471d1714SBenjamin Tissoires 			goto fail3;
1200471d1714SBenjamin Tissoires 	}
1201471d1714SBenjamin Tissoires 
1202471d1714SBenjamin Tissoires 	/* Note that if query fails it is not a hard failure */
1203471d1714SBenjamin Tissoires 	wacom_query_tablet_data(hdev, features);
1204471d1714SBenjamin Tissoires 
1205471d1714SBenjamin Tissoires 	/* Regular HID work starts now */
1206471d1714SBenjamin Tissoires 	error = hid_hw_start(hdev, HID_CONNECT_HIDRAW);
1207471d1714SBenjamin Tissoires 	if (error) {
1208471d1714SBenjamin Tissoires 		hid_err(hdev, "hw start failed\n");
1209471d1714SBenjamin Tissoires 		goto fail4;
1210471d1714SBenjamin Tissoires 	}
1211471d1714SBenjamin Tissoires 
1212471d1714SBenjamin Tissoires 	if (features->quirks & WACOM_QUIRK_MONITOR)
1213471d1714SBenjamin Tissoires 		error = hid_hw_open(hdev);
1214471d1714SBenjamin Tissoires 
1215471d1714SBenjamin Tissoires 	if (wacom_wac->features.type == INTUOSHT && wacom_wac->features.touch_max) {
1216471d1714SBenjamin Tissoires 		if (wacom_wac->features.device_type == BTN_TOOL_FINGER)
1217471d1714SBenjamin Tissoires 			wacom_wac->shared->touch_input = wacom_wac->input;
1218471d1714SBenjamin Tissoires 	}
1219471d1714SBenjamin Tissoires 
1220471d1714SBenjamin Tissoires 	return 0;
1221471d1714SBenjamin Tissoires 
1222471d1714SBenjamin Tissoires  fail4:	wacom_unregister_inputs(wacom);
1223471d1714SBenjamin Tissoires  fail3:	wacom_destroy_leds(wacom);
1224471d1714SBenjamin Tissoires  fail2:	wacom_remove_shared_data(wacom_wac);
1225471d1714SBenjamin Tissoires  fail1:	kfree(wacom);
1226471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, NULL);
1227471d1714SBenjamin Tissoires 	return error;
1228471d1714SBenjamin Tissoires }
1229471d1714SBenjamin Tissoires 
1230471d1714SBenjamin Tissoires static void wacom_remove(struct hid_device *hdev)
1231471d1714SBenjamin Tissoires {
1232471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
1233471d1714SBenjamin Tissoires 
1234471d1714SBenjamin Tissoires 	hid_hw_stop(hdev);
1235471d1714SBenjamin Tissoires 
1236471d1714SBenjamin Tissoires 	cancel_work_sync(&wacom->work);
1237471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom);
1238471d1714SBenjamin Tissoires 	wacom_destroy_battery(wacom);
1239471d1714SBenjamin Tissoires 	wacom_destroy_leds(wacom);
1240471d1714SBenjamin Tissoires 	wacom_remove_shared_data(&wacom->wacom_wac);
1241471d1714SBenjamin Tissoires 
1242471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, NULL);
1243471d1714SBenjamin Tissoires 	kfree(wacom);
1244471d1714SBenjamin Tissoires }
1245471d1714SBenjamin Tissoires 
1246471d1714SBenjamin Tissoires static int wacom_resume(struct hid_device *hdev)
1247471d1714SBenjamin Tissoires {
1248471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
1249471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
1250471d1714SBenjamin Tissoires 
1251471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
1252471d1714SBenjamin Tissoires 
1253471d1714SBenjamin Tissoires 	/* switch to wacom mode first */
1254471d1714SBenjamin Tissoires 	wacom_query_tablet_data(hdev, features);
1255471d1714SBenjamin Tissoires 	wacom_led_control(wacom);
1256471d1714SBenjamin Tissoires 
1257471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
1258471d1714SBenjamin Tissoires 
1259471d1714SBenjamin Tissoires 	return 0;
1260471d1714SBenjamin Tissoires }
1261471d1714SBenjamin Tissoires 
1262471d1714SBenjamin Tissoires static int wacom_reset_resume(struct hid_device *hdev)
1263471d1714SBenjamin Tissoires {
1264471d1714SBenjamin Tissoires 	return wacom_resume(hdev);
1265471d1714SBenjamin Tissoires }
1266471d1714SBenjamin Tissoires 
1267471d1714SBenjamin Tissoires static struct hid_driver wacom_driver = {
1268471d1714SBenjamin Tissoires 	.name =		"wacom",
1269471d1714SBenjamin Tissoires 	.id_table =	wacom_ids,
1270471d1714SBenjamin Tissoires 	.probe =	wacom_probe,
1271471d1714SBenjamin Tissoires 	.remove =	wacom_remove,
1272471d1714SBenjamin Tissoires #ifdef CONFIG_PM
1273471d1714SBenjamin Tissoires 	.resume =	wacom_resume,
1274471d1714SBenjamin Tissoires 	.reset_resume =	wacom_reset_resume,
1275471d1714SBenjamin Tissoires #endif
1276471d1714SBenjamin Tissoires 	.raw_event =	wacom_raw_event,
1277471d1714SBenjamin Tissoires };
1278471d1714SBenjamin Tissoires module_hid_driver(wacom_driver);
1279