xref: /openbmc/linux/drivers/hid/wacom_sys.c (revision 387142bb8fcb263771e1fa6b1a96e6a7ca36e820)
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 
265f81a1295SBenjamin Tissoires static int wacom_bt_query_tablet_data(struct hid_device *hdev, u8 speed,
266f81a1295SBenjamin Tissoires 		struct wacom_features *features)
267f81a1295SBenjamin Tissoires {
268*387142bbSBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
269*387142bbSBenjamin Tissoires 	int ret;
270*387142bbSBenjamin Tissoires 	u8 rep_data[2];
271*387142bbSBenjamin Tissoires 
272*387142bbSBenjamin Tissoires 	switch (features->type) {
273*387142bbSBenjamin Tissoires 	case GRAPHIRE_BT:
274*387142bbSBenjamin Tissoires 		rep_data[0] = 0x03;
275*387142bbSBenjamin Tissoires 		rep_data[1] = 0x00;
276*387142bbSBenjamin Tissoires 		ret = wacom_set_report(hdev, HID_FEATURE_REPORT,
277*387142bbSBenjamin Tissoires 					rep_data[0], rep_data, 2, 3);
278*387142bbSBenjamin Tissoires 
279*387142bbSBenjamin Tissoires 		if (ret >= 0) {
280*387142bbSBenjamin Tissoires 			rep_data[0] = speed == 0 ? 0x05 : 0x06;
281*387142bbSBenjamin Tissoires 			rep_data[1] = 0x00;
282*387142bbSBenjamin Tissoires 
283*387142bbSBenjamin Tissoires 			ret = wacom_set_report(hdev, HID_FEATURE_REPORT,
284*387142bbSBenjamin Tissoires 						rep_data[0], rep_data, 2, 3);
285*387142bbSBenjamin Tissoires 
286*387142bbSBenjamin Tissoires 			if (ret >= 0) {
287*387142bbSBenjamin Tissoires 				wacom->wacom_wac.bt_high_speed = speed;
288*387142bbSBenjamin Tissoires 				return 0;
289*387142bbSBenjamin Tissoires 			}
290*387142bbSBenjamin Tissoires 		}
291*387142bbSBenjamin Tissoires 
292*387142bbSBenjamin Tissoires 		/*
293*387142bbSBenjamin Tissoires 		 * Note that if the raw queries fail, it's not a hard failure
294*387142bbSBenjamin Tissoires 		 * and it is safe to continue
295*387142bbSBenjamin Tissoires 		 */
296*387142bbSBenjamin Tissoires 		hid_warn(hdev, "failed to poke device, command %d, err %d\n",
297*387142bbSBenjamin Tissoires 			 rep_data[0], ret);
298*387142bbSBenjamin Tissoires 		break;
299*387142bbSBenjamin Tissoires 	}
300*387142bbSBenjamin Tissoires 
301f81a1295SBenjamin Tissoires 	return 0;
302f81a1295SBenjamin Tissoires }
303f81a1295SBenjamin Tissoires 
304471d1714SBenjamin Tissoires /*
305471d1714SBenjamin Tissoires  * Switch the tablet into its most-capable mode. Wacom tablets are
306471d1714SBenjamin Tissoires  * typically configured to power-up in a mode which sends mouse-like
307471d1714SBenjamin Tissoires  * reports to the OS. To get absolute position, pressure data, etc.
308471d1714SBenjamin Tissoires  * from the tablet, it is necessary to switch the tablet out of this
309471d1714SBenjamin Tissoires  * mode and into one which sends the full range of tablet data.
310471d1714SBenjamin Tissoires  */
311471d1714SBenjamin Tissoires static int wacom_query_tablet_data(struct hid_device *hdev,
312471d1714SBenjamin Tissoires 		struct wacom_features *features)
313471d1714SBenjamin Tissoires {
314f81a1295SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH)
315f81a1295SBenjamin Tissoires 		return wacom_bt_query_tablet_data(hdev, 1, features);
316f81a1295SBenjamin Tissoires 
317471d1714SBenjamin Tissoires 	if (features->device_type == BTN_TOOL_FINGER) {
318471d1714SBenjamin Tissoires 		if (features->type > TABLETPC) {
319471d1714SBenjamin Tissoires 			/* MT Tablet PC touch */
320471d1714SBenjamin Tissoires 			return wacom_set_device_mode(hdev, 3, 4, 4);
321471d1714SBenjamin Tissoires 		}
322471d1714SBenjamin Tissoires 		else if (features->type == WACOM_24HDT || features->type == CINTIQ_HYBRID) {
323471d1714SBenjamin Tissoires 			return wacom_set_device_mode(hdev, 18, 3, 2);
324471d1714SBenjamin Tissoires 		}
325471d1714SBenjamin Tissoires 	} else if (features->device_type == BTN_TOOL_PEN) {
326471d1714SBenjamin Tissoires 		if (features->type <= BAMBOO_PT && features->type != WIRELESS) {
327471d1714SBenjamin Tissoires 			return wacom_set_device_mode(hdev, 2, 2, 2);
328471d1714SBenjamin Tissoires 		}
329471d1714SBenjamin Tissoires 	}
330471d1714SBenjamin Tissoires 
331471d1714SBenjamin Tissoires 	return 0;
332471d1714SBenjamin Tissoires }
333471d1714SBenjamin Tissoires 
334471d1714SBenjamin Tissoires static void wacom_retrieve_hid_descriptor(struct hid_device *hdev,
335471d1714SBenjamin Tissoires 					 struct wacom_features *features)
336471d1714SBenjamin Tissoires {
337471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
338471d1714SBenjamin Tissoires 	struct usb_interface *intf = wacom->intf;
339471d1714SBenjamin Tissoires 
340471d1714SBenjamin Tissoires 	/* default features */
341471d1714SBenjamin Tissoires 	features->device_type = BTN_TOOL_PEN;
342471d1714SBenjamin Tissoires 	features->x_fuzz = 4;
343471d1714SBenjamin Tissoires 	features->y_fuzz = 4;
344471d1714SBenjamin Tissoires 	features->pressure_fuzz = 0;
345471d1714SBenjamin Tissoires 	features->distance_fuzz = 0;
346471d1714SBenjamin Tissoires 
347471d1714SBenjamin Tissoires 	/*
348471d1714SBenjamin Tissoires 	 * The wireless device HID is basic and layout conflicts with
349471d1714SBenjamin Tissoires 	 * other tablets (monitor and touch interface can look like pen).
350471d1714SBenjamin Tissoires 	 * Skip the query for this type and modify defaults based on
351471d1714SBenjamin Tissoires 	 * interface number.
352471d1714SBenjamin Tissoires 	 */
353471d1714SBenjamin Tissoires 	if (features->type == WIRELESS) {
354471d1714SBenjamin Tissoires 		if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
355471d1714SBenjamin Tissoires 			features->device_type = 0;
356471d1714SBenjamin Tissoires 		} else if (intf->cur_altsetting->desc.bInterfaceNumber == 2) {
357471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_FINGER;
358471d1714SBenjamin Tissoires 			features->pktlen = WACOM_PKGLEN_BBTOUCH3;
359471d1714SBenjamin Tissoires 		}
360471d1714SBenjamin Tissoires 	}
361471d1714SBenjamin Tissoires 
362471d1714SBenjamin Tissoires 	/* only devices that support touch need to retrieve the info */
363471d1714SBenjamin Tissoires 	if (features->type < BAMBOO_PT)
364471d1714SBenjamin Tissoires 		return;
365471d1714SBenjamin Tissoires 
366471d1714SBenjamin Tissoires 	wacom_parse_hid(hdev, features);
367471d1714SBenjamin Tissoires }
368471d1714SBenjamin Tissoires 
369471d1714SBenjamin Tissoires struct wacom_hdev_data {
370471d1714SBenjamin Tissoires 	struct list_head list;
371471d1714SBenjamin Tissoires 	struct kref kref;
372471d1714SBenjamin Tissoires 	struct hid_device *dev;
373471d1714SBenjamin Tissoires 	struct wacom_shared shared;
374471d1714SBenjamin Tissoires };
375471d1714SBenjamin Tissoires 
376471d1714SBenjamin Tissoires static LIST_HEAD(wacom_udev_list);
377471d1714SBenjamin Tissoires static DEFINE_MUTEX(wacom_udev_list_lock);
378471d1714SBenjamin Tissoires 
379471d1714SBenjamin Tissoires static bool wacom_are_sibling(struct hid_device *hdev,
380471d1714SBenjamin Tissoires 		struct hid_device *sibling)
381471d1714SBenjamin Tissoires {
382471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
383471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
384471d1714SBenjamin Tissoires 	int vid = features->oVid;
385471d1714SBenjamin Tissoires 	int pid = features->oPid;
386471d1714SBenjamin Tissoires 	int n1,n2;
387471d1714SBenjamin Tissoires 
388471d1714SBenjamin Tissoires 	if (vid == 0 && pid == 0) {
389471d1714SBenjamin Tissoires 		vid = hdev->vendor;
390471d1714SBenjamin Tissoires 		pid = hdev->product;
391471d1714SBenjamin Tissoires 	}
392471d1714SBenjamin Tissoires 
393471d1714SBenjamin Tissoires 	if (vid != sibling->vendor || pid != sibling->product)
394471d1714SBenjamin Tissoires 		return false;
395471d1714SBenjamin Tissoires 
396471d1714SBenjamin Tissoires 	/* Compare the physical path. */
397471d1714SBenjamin Tissoires 	n1 = strrchr(hdev->phys, '.') - hdev->phys;
398471d1714SBenjamin Tissoires 	n2 = strrchr(sibling->phys, '.') - sibling->phys;
399471d1714SBenjamin Tissoires 	if (n1 != n2 || n1 <= 0 || n2 <= 0)
400471d1714SBenjamin Tissoires 		return false;
401471d1714SBenjamin Tissoires 
402471d1714SBenjamin Tissoires 	return !strncmp(hdev->phys, sibling->phys, n1);
403471d1714SBenjamin Tissoires }
404471d1714SBenjamin Tissoires 
405471d1714SBenjamin Tissoires static struct wacom_hdev_data *wacom_get_hdev_data(struct hid_device *hdev)
406471d1714SBenjamin Tissoires {
407471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
408471d1714SBenjamin Tissoires 
409471d1714SBenjamin Tissoires 	list_for_each_entry(data, &wacom_udev_list, list) {
410471d1714SBenjamin Tissoires 		if (wacom_are_sibling(hdev, data->dev)) {
411471d1714SBenjamin Tissoires 			kref_get(&data->kref);
412471d1714SBenjamin Tissoires 			return data;
413471d1714SBenjamin Tissoires 		}
414471d1714SBenjamin Tissoires 	}
415471d1714SBenjamin Tissoires 
416471d1714SBenjamin Tissoires 	return NULL;
417471d1714SBenjamin Tissoires }
418471d1714SBenjamin Tissoires 
419471d1714SBenjamin Tissoires static int wacom_add_shared_data(struct hid_device *hdev)
420471d1714SBenjamin Tissoires {
421471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
422471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
423471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
424471d1714SBenjamin Tissoires 	int retval = 0;
425471d1714SBenjamin Tissoires 
426471d1714SBenjamin Tissoires 	mutex_lock(&wacom_udev_list_lock);
427471d1714SBenjamin Tissoires 
428471d1714SBenjamin Tissoires 	data = wacom_get_hdev_data(hdev);
429471d1714SBenjamin Tissoires 	if (!data) {
430471d1714SBenjamin Tissoires 		data = kzalloc(sizeof(struct wacom_hdev_data), GFP_KERNEL);
431471d1714SBenjamin Tissoires 		if (!data) {
432471d1714SBenjamin Tissoires 			retval = -ENOMEM;
433471d1714SBenjamin Tissoires 			goto out;
434471d1714SBenjamin Tissoires 		}
435471d1714SBenjamin Tissoires 
436471d1714SBenjamin Tissoires 		kref_init(&data->kref);
437471d1714SBenjamin Tissoires 		data->dev = hdev;
438471d1714SBenjamin Tissoires 		list_add_tail(&data->list, &wacom_udev_list);
439471d1714SBenjamin Tissoires 	}
440471d1714SBenjamin Tissoires 
441471d1714SBenjamin Tissoires 	wacom_wac->shared = &data->shared;
442471d1714SBenjamin Tissoires 
443471d1714SBenjamin Tissoires out:
444471d1714SBenjamin Tissoires 	mutex_unlock(&wacom_udev_list_lock);
445471d1714SBenjamin Tissoires 	return retval;
446471d1714SBenjamin Tissoires }
447471d1714SBenjamin Tissoires 
448471d1714SBenjamin Tissoires static void wacom_release_shared_data(struct kref *kref)
449471d1714SBenjamin Tissoires {
450471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data =
451471d1714SBenjamin Tissoires 		container_of(kref, struct wacom_hdev_data, kref);
452471d1714SBenjamin Tissoires 
453471d1714SBenjamin Tissoires 	mutex_lock(&wacom_udev_list_lock);
454471d1714SBenjamin Tissoires 	list_del(&data->list);
455471d1714SBenjamin Tissoires 	mutex_unlock(&wacom_udev_list_lock);
456471d1714SBenjamin Tissoires 
457471d1714SBenjamin Tissoires 	kfree(data);
458471d1714SBenjamin Tissoires }
459471d1714SBenjamin Tissoires 
460471d1714SBenjamin Tissoires static void wacom_remove_shared_data(struct wacom_wac *wacom)
461471d1714SBenjamin Tissoires {
462471d1714SBenjamin Tissoires 	struct wacom_hdev_data *data;
463471d1714SBenjamin Tissoires 
464471d1714SBenjamin Tissoires 	if (wacom->shared) {
465471d1714SBenjamin Tissoires 		data = container_of(wacom->shared, struct wacom_hdev_data, shared);
466471d1714SBenjamin Tissoires 		kref_put(&data->kref, wacom_release_shared_data);
467471d1714SBenjamin Tissoires 		wacom->shared = NULL;
468471d1714SBenjamin Tissoires 	}
469471d1714SBenjamin Tissoires }
470471d1714SBenjamin Tissoires 
471471d1714SBenjamin Tissoires static int wacom_led_control(struct wacom *wacom)
472471d1714SBenjamin Tissoires {
473471d1714SBenjamin Tissoires 	unsigned char *buf;
474471d1714SBenjamin Tissoires 	int retval;
475471d1714SBenjamin Tissoires 
476471d1714SBenjamin Tissoires 	buf = kzalloc(9, GFP_KERNEL);
477471d1714SBenjamin Tissoires 	if (!buf)
478471d1714SBenjamin Tissoires 		return -ENOMEM;
479471d1714SBenjamin Tissoires 
480471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.features.type >= INTUOS5S &&
481471d1714SBenjamin Tissoires 	    wacom->wacom_wac.features.type <= INTUOSPL) {
482471d1714SBenjamin Tissoires 		/*
483471d1714SBenjamin Tissoires 		 * Touch Ring and crop mark LED luminance may take on
484471d1714SBenjamin Tissoires 		 * one of four values:
485471d1714SBenjamin Tissoires 		 *    0 = Low; 1 = Medium; 2 = High; 3 = Off
486471d1714SBenjamin Tissoires 		 */
487471d1714SBenjamin Tissoires 		int ring_led = wacom->led.select[0] & 0x03;
488471d1714SBenjamin Tissoires 		int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
489471d1714SBenjamin Tissoires 		int crop_lum = 0;
490471d1714SBenjamin Tissoires 
491471d1714SBenjamin Tissoires 		buf[0] = WAC_CMD_LED_CONTROL;
492471d1714SBenjamin Tissoires 		buf[1] = (crop_lum << 4) | (ring_lum << 2) | (ring_led);
493471d1714SBenjamin Tissoires 	}
494471d1714SBenjamin Tissoires 	else {
495471d1714SBenjamin Tissoires 		int led = wacom->led.select[0] | 0x4;
496471d1714SBenjamin Tissoires 
497471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
498471d1714SBenjamin Tissoires 		    wacom->wacom_wac.features.type == WACOM_24HD)
499471d1714SBenjamin Tissoires 			led |= (wacom->led.select[1] << 4) | 0x40;
500471d1714SBenjamin Tissoires 
501471d1714SBenjamin Tissoires 		buf[0] = WAC_CMD_LED_CONTROL;
502471d1714SBenjamin Tissoires 		buf[1] = led;
503471d1714SBenjamin Tissoires 		buf[2] = wacom->led.llv;
504471d1714SBenjamin Tissoires 		buf[3] = wacom->led.hlv;
505471d1714SBenjamin Tissoires 		buf[4] = wacom->led.img_lum;
506471d1714SBenjamin Tissoires 	}
507471d1714SBenjamin Tissoires 
508471d1714SBenjamin Tissoires 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
509471d1714SBenjamin Tissoires 				  WAC_CMD_LED_CONTROL, buf, 9, WAC_CMD_RETRIES);
510471d1714SBenjamin Tissoires 	kfree(buf);
511471d1714SBenjamin Tissoires 
512471d1714SBenjamin Tissoires 	return retval;
513471d1714SBenjamin Tissoires }
514471d1714SBenjamin Tissoires 
515471d1714SBenjamin Tissoires static int wacom_led_putimage(struct wacom *wacom, int button_id, const void *img)
516471d1714SBenjamin Tissoires {
517471d1714SBenjamin Tissoires 	unsigned char *buf;
518471d1714SBenjamin Tissoires 	int i, retval;
519471d1714SBenjamin Tissoires 
520471d1714SBenjamin Tissoires 	buf = kzalloc(259, GFP_KERNEL);
521471d1714SBenjamin Tissoires 	if (!buf)
522471d1714SBenjamin Tissoires 		return -ENOMEM;
523471d1714SBenjamin Tissoires 
524471d1714SBenjamin Tissoires 	/* Send 'start' command */
525471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_START;
526471d1714SBenjamin Tissoires 	buf[1] = 1;
527471d1714SBenjamin Tissoires 	retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
528471d1714SBenjamin Tissoires 				  WAC_CMD_ICON_START, buf, 2, WAC_CMD_RETRIES);
529471d1714SBenjamin Tissoires 	if (retval < 0)
530471d1714SBenjamin Tissoires 		goto out;
531471d1714SBenjamin Tissoires 
532471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_XFER;
533471d1714SBenjamin Tissoires 	buf[1] = button_id & 0x07;
534471d1714SBenjamin Tissoires 	for (i = 0; i < 4; i++) {
535471d1714SBenjamin Tissoires 		buf[2] = i;
536471d1714SBenjamin Tissoires 		memcpy(buf + 3, img + i * 256, 256);
537471d1714SBenjamin Tissoires 
538471d1714SBenjamin Tissoires 		retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
539471d1714SBenjamin Tissoires 					  WAC_CMD_ICON_XFER,
540471d1714SBenjamin Tissoires 					  buf, 259, WAC_CMD_RETRIES);
541471d1714SBenjamin Tissoires 		if (retval < 0)
542471d1714SBenjamin Tissoires 			break;
543471d1714SBenjamin Tissoires 	}
544471d1714SBenjamin Tissoires 
545471d1714SBenjamin Tissoires 	/* Send 'stop' */
546471d1714SBenjamin Tissoires 	buf[0] = WAC_CMD_ICON_START;
547471d1714SBenjamin Tissoires 	buf[1] = 0;
548471d1714SBenjamin Tissoires 	wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, WAC_CMD_ICON_START,
549471d1714SBenjamin Tissoires 			 buf, 2, WAC_CMD_RETRIES);
550471d1714SBenjamin Tissoires 
551471d1714SBenjamin Tissoires out:
552471d1714SBenjamin Tissoires 	kfree(buf);
553471d1714SBenjamin Tissoires 	return retval;
554471d1714SBenjamin Tissoires }
555471d1714SBenjamin Tissoires 
556471d1714SBenjamin Tissoires static ssize_t wacom_led_select_store(struct device *dev, int set_id,
557471d1714SBenjamin Tissoires 				      const char *buf, size_t count)
558471d1714SBenjamin Tissoires {
559471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
560471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
561471d1714SBenjamin Tissoires 	unsigned int id;
562471d1714SBenjamin Tissoires 	int err;
563471d1714SBenjamin Tissoires 
564471d1714SBenjamin Tissoires 	err = kstrtouint(buf, 10, &id);
565471d1714SBenjamin Tissoires 	if (err)
566471d1714SBenjamin Tissoires 		return err;
567471d1714SBenjamin Tissoires 
568471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
569471d1714SBenjamin Tissoires 
570471d1714SBenjamin Tissoires 	wacom->led.select[set_id] = id & 0x3;
571471d1714SBenjamin Tissoires 	err = wacom_led_control(wacom);
572471d1714SBenjamin Tissoires 
573471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
574471d1714SBenjamin Tissoires 
575471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
576471d1714SBenjamin Tissoires }
577471d1714SBenjamin Tissoires 
578471d1714SBenjamin Tissoires #define DEVICE_LED_SELECT_ATTR(SET_ID)					\
579471d1714SBenjamin Tissoires static ssize_t wacom_led##SET_ID##_select_store(struct device *dev,	\
580471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
581471d1714SBenjamin Tissoires {									\
582471d1714SBenjamin Tissoires 	return wacom_led_select_store(dev, SET_ID, buf, count);		\
583471d1714SBenjamin Tissoires }									\
584471d1714SBenjamin Tissoires static ssize_t wacom_led##SET_ID##_select_show(struct device *dev,	\
585471d1714SBenjamin Tissoires 	struct device_attribute *attr, char *buf)			\
586471d1714SBenjamin Tissoires {									\
587471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
588471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);			\
589471d1714SBenjamin Tissoires 	return snprintf(buf, 2, "%d\n", wacom->led.select[SET_ID]);	\
590471d1714SBenjamin Tissoires }									\
591471d1714SBenjamin Tissoires static DEVICE_ATTR(status_led##SET_ID##_select, S_IWUSR | S_IRUSR,	\
592471d1714SBenjamin Tissoires 		    wacom_led##SET_ID##_select_show,			\
593471d1714SBenjamin Tissoires 		    wacom_led##SET_ID##_select_store)
594471d1714SBenjamin Tissoires 
595471d1714SBenjamin Tissoires DEVICE_LED_SELECT_ATTR(0);
596471d1714SBenjamin Tissoires DEVICE_LED_SELECT_ATTR(1);
597471d1714SBenjamin Tissoires 
598471d1714SBenjamin Tissoires static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
599471d1714SBenjamin Tissoires 				     const char *buf, size_t count)
600471d1714SBenjamin Tissoires {
601471d1714SBenjamin Tissoires 	unsigned int value;
602471d1714SBenjamin Tissoires 	int err;
603471d1714SBenjamin Tissoires 
604471d1714SBenjamin Tissoires 	err = kstrtouint(buf, 10, &value);
605471d1714SBenjamin Tissoires 	if (err)
606471d1714SBenjamin Tissoires 		return err;
607471d1714SBenjamin Tissoires 
608471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
609471d1714SBenjamin Tissoires 
610471d1714SBenjamin Tissoires 	*dest = value & 0x7f;
611471d1714SBenjamin Tissoires 	err = wacom_led_control(wacom);
612471d1714SBenjamin Tissoires 
613471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
614471d1714SBenjamin Tissoires 
615471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
616471d1714SBenjamin Tissoires }
617471d1714SBenjamin Tissoires 
618471d1714SBenjamin Tissoires #define DEVICE_LUMINANCE_ATTR(name, field)				\
619471d1714SBenjamin Tissoires static ssize_t wacom_##name##_luminance_store(struct device *dev,	\
620471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
621471d1714SBenjamin Tissoires {									\
622471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
623471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);			\
624471d1714SBenjamin Tissoires 									\
625471d1714SBenjamin Tissoires 	return wacom_luminance_store(wacom, &wacom->led.field,		\
626471d1714SBenjamin Tissoires 				     buf, count);			\
627471d1714SBenjamin Tissoires }									\
628471d1714SBenjamin Tissoires static DEVICE_ATTR(name##_luminance, S_IWUSR,				\
629471d1714SBenjamin Tissoires 		   NULL, wacom_##name##_luminance_store)
630471d1714SBenjamin Tissoires 
631471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(status0, llv);
632471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(status1, hlv);
633471d1714SBenjamin Tissoires DEVICE_LUMINANCE_ATTR(buttons, img_lum);
634471d1714SBenjamin Tissoires 
635471d1714SBenjamin Tissoires static ssize_t wacom_button_image_store(struct device *dev, int button_id,
636471d1714SBenjamin Tissoires 					const char *buf, size_t count)
637471d1714SBenjamin Tissoires {
638471d1714SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
639471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
640471d1714SBenjamin Tissoires 	int err;
641471d1714SBenjamin Tissoires 
642471d1714SBenjamin Tissoires 	if (count != 1024)
643471d1714SBenjamin Tissoires 		return -EINVAL;
644471d1714SBenjamin Tissoires 
645471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
646471d1714SBenjamin Tissoires 
647471d1714SBenjamin Tissoires 	err = wacom_led_putimage(wacom, button_id, buf);
648471d1714SBenjamin Tissoires 
649471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
650471d1714SBenjamin Tissoires 
651471d1714SBenjamin Tissoires 	return err < 0 ? err : count;
652471d1714SBenjamin Tissoires }
653471d1714SBenjamin Tissoires 
654471d1714SBenjamin Tissoires #define DEVICE_BTNIMG_ATTR(BUTTON_ID)					\
655471d1714SBenjamin Tissoires static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev,	\
656471d1714SBenjamin Tissoires 	struct device_attribute *attr, const char *buf, size_t count)	\
657471d1714SBenjamin Tissoires {									\
658471d1714SBenjamin Tissoires 	return wacom_button_image_store(dev, BUTTON_ID, buf, count);	\
659471d1714SBenjamin Tissoires }									\
660471d1714SBenjamin Tissoires static DEVICE_ATTR(button##BUTTON_ID##_rawimg, S_IWUSR,			\
661471d1714SBenjamin Tissoires 		   NULL, wacom_btnimg##BUTTON_ID##_store)
662471d1714SBenjamin Tissoires 
663471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(0);
664471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(1);
665471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(2);
666471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(3);
667471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(4);
668471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(5);
669471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(6);
670471d1714SBenjamin Tissoires DEVICE_BTNIMG_ATTR(7);
671471d1714SBenjamin Tissoires 
672471d1714SBenjamin Tissoires static struct attribute *cintiq_led_attrs[] = {
673471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
674471d1714SBenjamin Tissoires 	&dev_attr_status_led1_select.attr,
675471d1714SBenjamin Tissoires 	NULL
676471d1714SBenjamin Tissoires };
677471d1714SBenjamin Tissoires 
678471d1714SBenjamin Tissoires static struct attribute_group cintiq_led_attr_group = {
679471d1714SBenjamin Tissoires 	.name = "wacom_led",
680471d1714SBenjamin Tissoires 	.attrs = cintiq_led_attrs,
681471d1714SBenjamin Tissoires };
682471d1714SBenjamin Tissoires 
683471d1714SBenjamin Tissoires static struct attribute *intuos4_led_attrs[] = {
684471d1714SBenjamin Tissoires 	&dev_attr_status0_luminance.attr,
685471d1714SBenjamin Tissoires 	&dev_attr_status1_luminance.attr,
686471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
687471d1714SBenjamin Tissoires 	&dev_attr_buttons_luminance.attr,
688471d1714SBenjamin Tissoires 	&dev_attr_button0_rawimg.attr,
689471d1714SBenjamin Tissoires 	&dev_attr_button1_rawimg.attr,
690471d1714SBenjamin Tissoires 	&dev_attr_button2_rawimg.attr,
691471d1714SBenjamin Tissoires 	&dev_attr_button3_rawimg.attr,
692471d1714SBenjamin Tissoires 	&dev_attr_button4_rawimg.attr,
693471d1714SBenjamin Tissoires 	&dev_attr_button5_rawimg.attr,
694471d1714SBenjamin Tissoires 	&dev_attr_button6_rawimg.attr,
695471d1714SBenjamin Tissoires 	&dev_attr_button7_rawimg.attr,
696471d1714SBenjamin Tissoires 	NULL
697471d1714SBenjamin Tissoires };
698471d1714SBenjamin Tissoires 
699471d1714SBenjamin Tissoires static struct attribute_group intuos4_led_attr_group = {
700471d1714SBenjamin Tissoires 	.name = "wacom_led",
701471d1714SBenjamin Tissoires 	.attrs = intuos4_led_attrs,
702471d1714SBenjamin Tissoires };
703471d1714SBenjamin Tissoires 
704471d1714SBenjamin Tissoires static struct attribute *intuos5_led_attrs[] = {
705471d1714SBenjamin Tissoires 	&dev_attr_status0_luminance.attr,
706471d1714SBenjamin Tissoires 	&dev_attr_status_led0_select.attr,
707471d1714SBenjamin Tissoires 	NULL
708471d1714SBenjamin Tissoires };
709471d1714SBenjamin Tissoires 
710471d1714SBenjamin Tissoires static struct attribute_group intuos5_led_attr_group = {
711471d1714SBenjamin Tissoires 	.name = "wacom_led",
712471d1714SBenjamin Tissoires 	.attrs = intuos5_led_attrs,
713471d1714SBenjamin Tissoires };
714471d1714SBenjamin Tissoires 
715471d1714SBenjamin Tissoires static int wacom_initialize_leds(struct wacom *wacom)
716471d1714SBenjamin Tissoires {
717471d1714SBenjamin Tissoires 	int error;
718471d1714SBenjamin Tissoires 
719471d1714SBenjamin Tissoires 	/* Initialize default values */
720471d1714SBenjamin Tissoires 	switch (wacom->wacom_wac.features.type) {
721471d1714SBenjamin Tissoires 	case INTUOS4S:
722471d1714SBenjamin Tissoires 	case INTUOS4:
723471d1714SBenjamin Tissoires 	case INTUOS4L:
724471d1714SBenjamin Tissoires 		wacom->led.select[0] = 0;
725471d1714SBenjamin Tissoires 		wacom->led.select[1] = 0;
726471d1714SBenjamin Tissoires 		wacom->led.llv = 10;
727471d1714SBenjamin Tissoires 		wacom->led.hlv = 20;
728471d1714SBenjamin Tissoires 		wacom->led.img_lum = 10;
729471d1714SBenjamin Tissoires 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
730471d1714SBenjamin Tissoires 					   &intuos4_led_attr_group);
731471d1714SBenjamin Tissoires 		break;
732471d1714SBenjamin Tissoires 
733471d1714SBenjamin Tissoires 	case WACOM_24HD:
734471d1714SBenjamin Tissoires 	case WACOM_21UX2:
735471d1714SBenjamin Tissoires 		wacom->led.select[0] = 0;
736471d1714SBenjamin Tissoires 		wacom->led.select[1] = 0;
737471d1714SBenjamin Tissoires 		wacom->led.llv = 0;
738471d1714SBenjamin Tissoires 		wacom->led.hlv = 0;
739471d1714SBenjamin Tissoires 		wacom->led.img_lum = 0;
740471d1714SBenjamin Tissoires 
741471d1714SBenjamin Tissoires 		error = sysfs_create_group(&wacom->hdev->dev.kobj,
742471d1714SBenjamin Tissoires 					   &cintiq_led_attr_group);
743471d1714SBenjamin Tissoires 		break;
744471d1714SBenjamin Tissoires 
745471d1714SBenjamin Tissoires 	case INTUOS5S:
746471d1714SBenjamin Tissoires 	case INTUOS5:
747471d1714SBenjamin Tissoires 	case INTUOS5L:
748471d1714SBenjamin Tissoires 	case INTUOSPS:
749471d1714SBenjamin Tissoires 	case INTUOSPM:
750471d1714SBenjamin Tissoires 	case INTUOSPL:
751471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN) {
752471d1714SBenjamin Tissoires 			wacom->led.select[0] = 0;
753471d1714SBenjamin Tissoires 			wacom->led.select[1] = 0;
754471d1714SBenjamin Tissoires 			wacom->led.llv = 32;
755471d1714SBenjamin Tissoires 			wacom->led.hlv = 0;
756471d1714SBenjamin Tissoires 			wacom->led.img_lum = 0;
757471d1714SBenjamin Tissoires 
758471d1714SBenjamin Tissoires 			error = sysfs_create_group(&wacom->hdev->dev.kobj,
759471d1714SBenjamin Tissoires 						  &intuos5_led_attr_group);
760471d1714SBenjamin Tissoires 		} else
761471d1714SBenjamin Tissoires 			return 0;
762471d1714SBenjamin Tissoires 		break;
763471d1714SBenjamin Tissoires 
764471d1714SBenjamin Tissoires 	default:
765471d1714SBenjamin Tissoires 		return 0;
766471d1714SBenjamin Tissoires 	}
767471d1714SBenjamin Tissoires 
768471d1714SBenjamin Tissoires 	if (error) {
769471d1714SBenjamin Tissoires 		hid_err(wacom->hdev,
770471d1714SBenjamin Tissoires 			"cannot create sysfs group err: %d\n", error);
771471d1714SBenjamin Tissoires 		return error;
772471d1714SBenjamin Tissoires 	}
773471d1714SBenjamin Tissoires 	wacom_led_control(wacom);
774c757cbafSBenjamin Tissoires 	wacom->led_initialized = true;
775471d1714SBenjamin Tissoires 
776471d1714SBenjamin Tissoires 	return 0;
777471d1714SBenjamin Tissoires }
778471d1714SBenjamin Tissoires 
779471d1714SBenjamin Tissoires static void wacom_destroy_leds(struct wacom *wacom)
780471d1714SBenjamin Tissoires {
781c757cbafSBenjamin Tissoires 	if (!wacom->led_initialized)
782c757cbafSBenjamin Tissoires 		return;
783c757cbafSBenjamin Tissoires 
784c757cbafSBenjamin Tissoires 	wacom->led_initialized = false;
785c757cbafSBenjamin Tissoires 
786471d1714SBenjamin Tissoires 	switch (wacom->wacom_wac.features.type) {
787471d1714SBenjamin Tissoires 	case INTUOS4S:
788471d1714SBenjamin Tissoires 	case INTUOS4:
789471d1714SBenjamin Tissoires 	case INTUOS4L:
790471d1714SBenjamin Tissoires 		sysfs_remove_group(&wacom->hdev->dev.kobj,
791471d1714SBenjamin Tissoires 				   &intuos4_led_attr_group);
792471d1714SBenjamin Tissoires 		break;
793471d1714SBenjamin Tissoires 
794471d1714SBenjamin Tissoires 	case WACOM_24HD:
795471d1714SBenjamin Tissoires 	case WACOM_21UX2:
796471d1714SBenjamin Tissoires 		sysfs_remove_group(&wacom->hdev->dev.kobj,
797471d1714SBenjamin Tissoires 				   &cintiq_led_attr_group);
798471d1714SBenjamin Tissoires 		break;
799471d1714SBenjamin Tissoires 
800471d1714SBenjamin Tissoires 	case INTUOS5S:
801471d1714SBenjamin Tissoires 	case INTUOS5:
802471d1714SBenjamin Tissoires 	case INTUOS5L:
803471d1714SBenjamin Tissoires 	case INTUOSPS:
804471d1714SBenjamin Tissoires 	case INTUOSPM:
805471d1714SBenjamin Tissoires 	case INTUOSPL:
806471d1714SBenjamin Tissoires 		if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN)
807471d1714SBenjamin Tissoires 			sysfs_remove_group(&wacom->hdev->dev.kobj,
808471d1714SBenjamin Tissoires 					   &intuos5_led_attr_group);
809471d1714SBenjamin Tissoires 		break;
810471d1714SBenjamin Tissoires 	}
811471d1714SBenjamin Tissoires }
812471d1714SBenjamin Tissoires 
813471d1714SBenjamin Tissoires static enum power_supply_property wacom_battery_props[] = {
814ac8d1010SBenjamin Tissoires 	POWER_SUPPLY_PROP_STATUS,
815471d1714SBenjamin Tissoires 	POWER_SUPPLY_PROP_SCOPE,
816471d1714SBenjamin Tissoires 	POWER_SUPPLY_PROP_CAPACITY
817471d1714SBenjamin Tissoires };
818471d1714SBenjamin Tissoires 
8197dbd229eSBenjamin Tissoires static enum power_supply_property wacom_ac_props[] = {
8207dbd229eSBenjamin Tissoires 	POWER_SUPPLY_PROP_PRESENT,
8217dbd229eSBenjamin Tissoires 	POWER_SUPPLY_PROP_ONLINE,
8227dbd229eSBenjamin Tissoires 	POWER_SUPPLY_PROP_SCOPE,
8237dbd229eSBenjamin Tissoires };
8247dbd229eSBenjamin Tissoires 
825471d1714SBenjamin Tissoires static int wacom_battery_get_property(struct power_supply *psy,
826471d1714SBenjamin Tissoires 				      enum power_supply_property psp,
827471d1714SBenjamin Tissoires 				      union power_supply_propval *val)
828471d1714SBenjamin Tissoires {
829471d1714SBenjamin Tissoires 	struct wacom *wacom = container_of(psy, struct wacom, battery);
830471d1714SBenjamin Tissoires 	int ret = 0;
831471d1714SBenjamin Tissoires 
832471d1714SBenjamin Tissoires 	switch (psp) {
833471d1714SBenjamin Tissoires 		case POWER_SUPPLY_PROP_SCOPE:
834471d1714SBenjamin Tissoires 			val->intval = POWER_SUPPLY_SCOPE_DEVICE;
835471d1714SBenjamin Tissoires 			break;
836471d1714SBenjamin Tissoires 		case POWER_SUPPLY_PROP_CAPACITY:
837471d1714SBenjamin Tissoires 			val->intval =
838ac8d1010SBenjamin Tissoires 				wacom->wacom_wac.battery_capacity;
839ac8d1010SBenjamin Tissoires 			break;
840ac8d1010SBenjamin Tissoires 		case POWER_SUPPLY_PROP_STATUS:
841ac8d1010SBenjamin Tissoires 			if (wacom->wacom_wac.bat_charging)
842ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_CHARGING;
843ac8d1010SBenjamin Tissoires 			else if (wacom->wacom_wac.battery_capacity == 100 &&
844ac8d1010SBenjamin Tissoires 				    wacom->wacom_wac.ps_connected)
845ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_FULL;
846ac8d1010SBenjamin Tissoires 			else
847ac8d1010SBenjamin Tissoires 				val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
848471d1714SBenjamin Tissoires 			break;
849471d1714SBenjamin Tissoires 		default:
850471d1714SBenjamin Tissoires 			ret = -EINVAL;
851471d1714SBenjamin Tissoires 			break;
852471d1714SBenjamin Tissoires 	}
853471d1714SBenjamin Tissoires 
854471d1714SBenjamin Tissoires 	return ret;
855471d1714SBenjamin Tissoires }
856471d1714SBenjamin Tissoires 
8577dbd229eSBenjamin Tissoires static int wacom_ac_get_property(struct power_supply *psy,
8587dbd229eSBenjamin Tissoires 				enum power_supply_property psp,
8597dbd229eSBenjamin Tissoires 				union power_supply_propval *val)
8607dbd229eSBenjamin Tissoires {
8617dbd229eSBenjamin Tissoires 	struct wacom *wacom = container_of(psy, struct wacom, ac);
8627dbd229eSBenjamin Tissoires 	int ret = 0;
8637dbd229eSBenjamin Tissoires 
8647dbd229eSBenjamin Tissoires 	switch (psp) {
8657dbd229eSBenjamin Tissoires 	case POWER_SUPPLY_PROP_PRESENT:
8667dbd229eSBenjamin Tissoires 		/* fall through */
8677dbd229eSBenjamin Tissoires 	case POWER_SUPPLY_PROP_ONLINE:
8687dbd229eSBenjamin Tissoires 		val->intval = wacom->wacom_wac.ps_connected;
8697dbd229eSBenjamin Tissoires 		break;
8707dbd229eSBenjamin Tissoires 	case POWER_SUPPLY_PROP_SCOPE:
8717dbd229eSBenjamin Tissoires 		val->intval = POWER_SUPPLY_SCOPE_DEVICE;
8727dbd229eSBenjamin Tissoires 		break;
8737dbd229eSBenjamin Tissoires 	default:
8747dbd229eSBenjamin Tissoires 		ret = -EINVAL;
8757dbd229eSBenjamin Tissoires 		break;
8767dbd229eSBenjamin Tissoires 	}
8777dbd229eSBenjamin Tissoires 	return ret;
8787dbd229eSBenjamin Tissoires }
8797dbd229eSBenjamin Tissoires 
880471d1714SBenjamin Tissoires static int wacom_initialize_battery(struct wacom *wacom)
881471d1714SBenjamin Tissoires {
882d70420b9SBenjamin Tissoires 	static atomic_t battery_no = ATOMIC_INIT(0);
8837dbd229eSBenjamin Tissoires 	int error;
884d70420b9SBenjamin Tissoires 	unsigned long n;
885471d1714SBenjamin Tissoires 
886ac8d1010SBenjamin Tissoires 	if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) {
887d70420b9SBenjamin Tissoires 		n = atomic_inc_return(&battery_no) - 1;
8887dbd229eSBenjamin Tissoires 
889471d1714SBenjamin Tissoires 		wacom->battery.properties = wacom_battery_props;
890471d1714SBenjamin Tissoires 		wacom->battery.num_properties = ARRAY_SIZE(wacom_battery_props);
891471d1714SBenjamin Tissoires 		wacom->battery.get_property = wacom_battery_get_property;
892d70420b9SBenjamin Tissoires 		sprintf(wacom->wacom_wac.bat_name, "wacom_battery_%ld", n);
893d70420b9SBenjamin Tissoires 		wacom->battery.name = wacom->wacom_wac.bat_name;
894471d1714SBenjamin Tissoires 		wacom->battery.type = POWER_SUPPLY_TYPE_BATTERY;
895471d1714SBenjamin Tissoires 		wacom->battery.use_for_apm = 0;
896471d1714SBenjamin Tissoires 
8977dbd229eSBenjamin Tissoires 		wacom->ac.properties = wacom_ac_props;
8987dbd229eSBenjamin Tissoires 		wacom->ac.num_properties = ARRAY_SIZE(wacom_ac_props);
8997dbd229eSBenjamin Tissoires 		wacom->ac.get_property = wacom_ac_get_property;
9007dbd229eSBenjamin Tissoires 		sprintf(wacom->wacom_wac.ac_name, "wacom_ac_%ld", n);
9017dbd229eSBenjamin Tissoires 		wacom->ac.name = wacom->wacom_wac.ac_name;
9027dbd229eSBenjamin Tissoires 		wacom->ac.type = POWER_SUPPLY_TYPE_MAINS;
9037dbd229eSBenjamin Tissoires 		wacom->ac.use_for_apm = 0;
9047dbd229eSBenjamin Tissoires 
905471d1714SBenjamin Tissoires 		error = power_supply_register(&wacom->hdev->dev,
906471d1714SBenjamin Tissoires 					      &wacom->battery);
9077dbd229eSBenjamin Tissoires 		if (error)
9087dbd229eSBenjamin Tissoires 			return error;
909471d1714SBenjamin Tissoires 
9107dbd229eSBenjamin Tissoires 		power_supply_powers(&wacom->battery, &wacom->hdev->dev);
9117dbd229eSBenjamin Tissoires 
9127dbd229eSBenjamin Tissoires 		error = power_supply_register(&wacom->hdev->dev, &wacom->ac);
9137dbd229eSBenjamin Tissoires 		if (error) {
9147dbd229eSBenjamin Tissoires 			power_supply_unregister(&wacom->battery);
9157dbd229eSBenjamin Tissoires 			return error;
916471d1714SBenjamin Tissoires 		}
917471d1714SBenjamin Tissoires 
9187dbd229eSBenjamin Tissoires 		power_supply_powers(&wacom->ac, &wacom->hdev->dev);
9197dbd229eSBenjamin Tissoires 	}
9207dbd229eSBenjamin Tissoires 
9217dbd229eSBenjamin Tissoires 	return 0;
922471d1714SBenjamin Tissoires }
923471d1714SBenjamin Tissoires 
924471d1714SBenjamin Tissoires static void wacom_destroy_battery(struct wacom *wacom)
925471d1714SBenjamin Tissoires {
926ac8d1010SBenjamin Tissoires 	if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
927471d1714SBenjamin Tissoires 	     wacom->battery.dev) {
928471d1714SBenjamin Tissoires 		power_supply_unregister(&wacom->battery);
929471d1714SBenjamin Tissoires 		wacom->battery.dev = NULL;
9307dbd229eSBenjamin Tissoires 		power_supply_unregister(&wacom->ac);
9317dbd229eSBenjamin Tissoires 		wacom->ac.dev = NULL;
932471d1714SBenjamin Tissoires 	}
933471d1714SBenjamin Tissoires }
934471d1714SBenjamin Tissoires 
935f81a1295SBenjamin Tissoires static ssize_t wacom_show_speed(struct device *dev,
936f81a1295SBenjamin Tissoires 				struct device_attribute
937f81a1295SBenjamin Tissoires 				*attr, char *buf)
938f81a1295SBenjamin Tissoires {
939f81a1295SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
940f81a1295SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
941f81a1295SBenjamin Tissoires 
942f81a1295SBenjamin Tissoires 	return snprintf(buf, PAGE_SIZE, "%i\n", wacom->wacom_wac.bt_high_speed);
943f81a1295SBenjamin Tissoires }
944f81a1295SBenjamin Tissoires 
945f81a1295SBenjamin Tissoires static ssize_t wacom_store_speed(struct device *dev,
946f81a1295SBenjamin Tissoires 				struct device_attribute *attr,
947f81a1295SBenjamin Tissoires 				const char *buf, size_t count)
948f81a1295SBenjamin Tissoires {
949f81a1295SBenjamin Tissoires 	struct hid_device *hdev = container_of(dev, struct hid_device, dev);
950f81a1295SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
951f81a1295SBenjamin Tissoires 	u8 new_speed;
952f81a1295SBenjamin Tissoires 
953f81a1295SBenjamin Tissoires 	if (kstrtou8(buf, 0, &new_speed))
954f81a1295SBenjamin Tissoires 		return -EINVAL;
955f81a1295SBenjamin Tissoires 
956f81a1295SBenjamin Tissoires 	if (new_speed != 0 && new_speed != 1)
957f81a1295SBenjamin Tissoires 		return -EINVAL;
958f81a1295SBenjamin Tissoires 
959f81a1295SBenjamin Tissoires 	wacom_bt_query_tablet_data(hdev, new_speed, &wacom->wacom_wac.features);
960f81a1295SBenjamin Tissoires 
961f81a1295SBenjamin Tissoires 	return count;
962f81a1295SBenjamin Tissoires }
963f81a1295SBenjamin Tissoires 
964f81a1295SBenjamin Tissoires static DEVICE_ATTR(speed, S_IRUGO | S_IWUSR | S_IWGRP,
965f81a1295SBenjamin Tissoires 		wacom_show_speed, wacom_store_speed);
966f81a1295SBenjamin Tissoires 
967471d1714SBenjamin Tissoires static struct input_dev *wacom_allocate_input(struct wacom *wacom)
968471d1714SBenjamin Tissoires {
969471d1714SBenjamin Tissoires 	struct input_dev *input_dev;
970471d1714SBenjamin Tissoires 	struct hid_device *hdev = wacom->hdev;
971471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
972471d1714SBenjamin Tissoires 
973471d1714SBenjamin Tissoires 	input_dev = input_allocate_device();
974471d1714SBenjamin Tissoires 	if (!input_dev)
975471d1714SBenjamin Tissoires 		return NULL;
976471d1714SBenjamin Tissoires 
977471d1714SBenjamin Tissoires 	input_dev->name = wacom_wac->name;
978471d1714SBenjamin Tissoires 	input_dev->phys = hdev->phys;
979471d1714SBenjamin Tissoires 	input_dev->dev.parent = &hdev->dev;
980471d1714SBenjamin Tissoires 	input_dev->open = wacom_open;
981471d1714SBenjamin Tissoires 	input_dev->close = wacom_close;
982471d1714SBenjamin Tissoires 	input_dev->uniq = hdev->uniq;
983471d1714SBenjamin Tissoires 	input_dev->id.bustype = hdev->bus;
984471d1714SBenjamin Tissoires 	input_dev->id.vendor  = hdev->vendor;
985471d1714SBenjamin Tissoires 	input_dev->id.product = hdev->product;
986471d1714SBenjamin Tissoires 	input_dev->id.version = hdev->version;
987471d1714SBenjamin Tissoires 	input_set_drvdata(input_dev, wacom);
988471d1714SBenjamin Tissoires 
989471d1714SBenjamin Tissoires 	return input_dev;
990471d1714SBenjamin Tissoires }
991471d1714SBenjamin Tissoires 
992471d1714SBenjamin Tissoires static void wacom_unregister_inputs(struct wacom *wacom)
993471d1714SBenjamin Tissoires {
994471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.input)
995471d1714SBenjamin Tissoires 		input_unregister_device(wacom->wacom_wac.input);
996471d1714SBenjamin Tissoires 	if (wacom->wacom_wac.pad_input)
997471d1714SBenjamin Tissoires 		input_unregister_device(wacom->wacom_wac.pad_input);
998471d1714SBenjamin Tissoires 	wacom->wacom_wac.input = NULL;
999471d1714SBenjamin Tissoires 	wacom->wacom_wac.pad_input = NULL;
1000471d1714SBenjamin Tissoires }
1001471d1714SBenjamin Tissoires 
1002471d1714SBenjamin Tissoires static int wacom_register_inputs(struct wacom *wacom)
1003471d1714SBenjamin Tissoires {
1004471d1714SBenjamin Tissoires 	struct input_dev *input_dev, *pad_input_dev;
1005471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
1006471d1714SBenjamin Tissoires 	int error;
1007471d1714SBenjamin Tissoires 
1008471d1714SBenjamin Tissoires 	input_dev = wacom_allocate_input(wacom);
1009471d1714SBenjamin Tissoires 	pad_input_dev = wacom_allocate_input(wacom);
1010471d1714SBenjamin Tissoires 	if (!input_dev || !pad_input_dev) {
1011471d1714SBenjamin Tissoires 		error = -ENOMEM;
1012471d1714SBenjamin Tissoires 		goto fail1;
1013471d1714SBenjamin Tissoires 	}
1014471d1714SBenjamin Tissoires 
1015471d1714SBenjamin Tissoires 	wacom_wac->input = input_dev;
1016471d1714SBenjamin Tissoires 	wacom_wac->pad_input = pad_input_dev;
1017471d1714SBenjamin Tissoires 	wacom_wac->pad_input->name = wacom_wac->pad_name;
1018471d1714SBenjamin Tissoires 
1019471d1714SBenjamin Tissoires 	error = wacom_setup_input_capabilities(input_dev, wacom_wac);
1020471d1714SBenjamin Tissoires 	if (error)
1021471d1714SBenjamin Tissoires 		goto fail2;
1022471d1714SBenjamin Tissoires 
1023471d1714SBenjamin Tissoires 	error = input_register_device(input_dev);
1024471d1714SBenjamin Tissoires 	if (error)
1025471d1714SBenjamin Tissoires 		goto fail2;
1026471d1714SBenjamin Tissoires 
1027471d1714SBenjamin Tissoires 	error = wacom_setup_pad_input_capabilities(pad_input_dev, wacom_wac);
1028471d1714SBenjamin Tissoires 	if (error) {
1029471d1714SBenjamin Tissoires 		/* no pad in use on this interface */
1030471d1714SBenjamin Tissoires 		input_free_device(pad_input_dev);
1031471d1714SBenjamin Tissoires 		wacom_wac->pad_input = NULL;
1032471d1714SBenjamin Tissoires 		pad_input_dev = NULL;
1033471d1714SBenjamin Tissoires 	} else {
1034471d1714SBenjamin Tissoires 		error = input_register_device(pad_input_dev);
1035471d1714SBenjamin Tissoires 		if (error)
1036471d1714SBenjamin Tissoires 			goto fail3;
1037471d1714SBenjamin Tissoires 	}
1038471d1714SBenjamin Tissoires 
1039471d1714SBenjamin Tissoires 	return 0;
1040471d1714SBenjamin Tissoires 
1041471d1714SBenjamin Tissoires fail3:
1042471d1714SBenjamin Tissoires 	input_unregister_device(input_dev);
1043471d1714SBenjamin Tissoires 	input_dev = NULL;
1044471d1714SBenjamin Tissoires fail2:
1045471d1714SBenjamin Tissoires 	wacom_wac->input = NULL;
1046471d1714SBenjamin Tissoires 	wacom_wac->pad_input = NULL;
1047471d1714SBenjamin Tissoires fail1:
1048471d1714SBenjamin Tissoires 	if (input_dev)
1049471d1714SBenjamin Tissoires 		input_free_device(input_dev);
1050471d1714SBenjamin Tissoires 	if (pad_input_dev)
1051471d1714SBenjamin Tissoires 		input_free_device(pad_input_dev);
1052471d1714SBenjamin Tissoires 	return error;
1053471d1714SBenjamin Tissoires }
1054471d1714SBenjamin Tissoires 
1055471d1714SBenjamin Tissoires static void wacom_wireless_work(struct work_struct *work)
1056471d1714SBenjamin Tissoires {
1057471d1714SBenjamin Tissoires 	struct wacom *wacom = container_of(work, struct wacom, work);
1058471d1714SBenjamin Tissoires 	struct usb_device *usbdev = wacom->usbdev;
1059471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac = &wacom->wacom_wac;
1060471d1714SBenjamin Tissoires 	struct hid_device *hdev1, *hdev2;
1061471d1714SBenjamin Tissoires 	struct wacom *wacom1, *wacom2;
1062471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac1, *wacom_wac2;
1063471d1714SBenjamin Tissoires 	int error;
1064471d1714SBenjamin Tissoires 
1065471d1714SBenjamin Tissoires 	/*
1066471d1714SBenjamin Tissoires 	 * Regardless if this is a disconnect or a new tablet,
1067471d1714SBenjamin Tissoires 	 * remove any existing input and battery devices.
1068471d1714SBenjamin Tissoires 	 */
1069471d1714SBenjamin Tissoires 
1070471d1714SBenjamin Tissoires 	wacom_destroy_battery(wacom);
1071471d1714SBenjamin Tissoires 
1072471d1714SBenjamin Tissoires 	/* Stylus interface */
1073471d1714SBenjamin Tissoires 	hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
1074471d1714SBenjamin Tissoires 	wacom1 = hid_get_drvdata(hdev1);
1075471d1714SBenjamin Tissoires 	wacom_wac1 = &(wacom1->wacom_wac);
1076471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom1);
1077471d1714SBenjamin Tissoires 
1078471d1714SBenjamin Tissoires 	/* Touch interface */
1079471d1714SBenjamin Tissoires 	hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
1080471d1714SBenjamin Tissoires 	wacom2 = hid_get_drvdata(hdev2);
1081471d1714SBenjamin Tissoires 	wacom_wac2 = &(wacom2->wacom_wac);
1082471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom2);
1083471d1714SBenjamin Tissoires 
1084471d1714SBenjamin Tissoires 	if (wacom_wac->pid == 0) {
1085471d1714SBenjamin Tissoires 		hid_info(wacom->hdev, "wireless tablet disconnected\n");
1086ac8d1010SBenjamin Tissoires 		wacom_wac1->shared->type = 0;
1087471d1714SBenjamin Tissoires 	} else {
1088471d1714SBenjamin Tissoires 		const struct hid_device_id *id = wacom_ids;
1089471d1714SBenjamin Tissoires 
1090471d1714SBenjamin Tissoires 		hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
1091471d1714SBenjamin Tissoires 			 wacom_wac->pid);
1092471d1714SBenjamin Tissoires 
1093471d1714SBenjamin Tissoires 		while (id->bus) {
1094471d1714SBenjamin Tissoires 			if (id->vendor == USB_VENDOR_ID_WACOM &&
1095471d1714SBenjamin Tissoires 			    id->product == wacom_wac->pid)
1096471d1714SBenjamin Tissoires 				break;
1097471d1714SBenjamin Tissoires 			id++;
1098471d1714SBenjamin Tissoires 		}
1099471d1714SBenjamin Tissoires 
1100471d1714SBenjamin Tissoires 		if (!id->bus) {
1101471d1714SBenjamin Tissoires 			hid_info(wacom->hdev, "ignoring unknown PID.\n");
1102471d1714SBenjamin Tissoires 			return;
1103471d1714SBenjamin Tissoires 		}
1104471d1714SBenjamin Tissoires 
1105471d1714SBenjamin Tissoires 		/* Stylus interface */
1106471d1714SBenjamin Tissoires 		wacom_wac1->features =
1107471d1714SBenjamin Tissoires 			*((struct wacom_features *)id->driver_data);
1108471d1714SBenjamin Tissoires 		wacom_wac1->features.device_type = BTN_TOOL_PEN;
1109471d1714SBenjamin Tissoires 		snprintf(wacom_wac1->name, WACOM_NAME_MAX, "%s (WL) Pen",
1110471d1714SBenjamin Tissoires 			 wacom_wac1->features.name);
1111471d1714SBenjamin Tissoires 		snprintf(wacom_wac1->pad_name, WACOM_NAME_MAX, "%s (WL) Pad",
1112471d1714SBenjamin Tissoires 			 wacom_wac1->features.name);
1113471d1714SBenjamin Tissoires 		wacom_wac1->shared->touch_max = wacom_wac1->features.touch_max;
1114471d1714SBenjamin Tissoires 		wacom_wac1->shared->type = wacom_wac1->features.type;
1115471d1714SBenjamin Tissoires 		error = wacom_register_inputs(wacom1);
1116471d1714SBenjamin Tissoires 		if (error)
1117471d1714SBenjamin Tissoires 			goto fail;
1118471d1714SBenjamin Tissoires 
1119471d1714SBenjamin Tissoires 		/* Touch interface */
1120471d1714SBenjamin Tissoires 		if (wacom_wac1->features.touch_max ||
1121471d1714SBenjamin Tissoires 		    wacom_wac1->features.type == INTUOSHT) {
1122471d1714SBenjamin Tissoires 			wacom_wac2->features =
1123471d1714SBenjamin Tissoires 				*((struct wacom_features *)id->driver_data);
1124471d1714SBenjamin Tissoires 			wacom_wac2->features.pktlen = WACOM_PKGLEN_BBTOUCH3;
1125471d1714SBenjamin Tissoires 			wacom_wac2->features.device_type = BTN_TOOL_FINGER;
1126471d1714SBenjamin Tissoires 			wacom_wac2->features.x_max = wacom_wac2->features.y_max = 4096;
1127471d1714SBenjamin Tissoires 			if (wacom_wac2->features.touch_max)
1128471d1714SBenjamin Tissoires 				snprintf(wacom_wac2->name, WACOM_NAME_MAX,
1129471d1714SBenjamin Tissoires 					 "%s (WL) Finger",wacom_wac2->features.name);
1130471d1714SBenjamin Tissoires 			else
1131471d1714SBenjamin Tissoires 				snprintf(wacom_wac2->name, WACOM_NAME_MAX,
1132471d1714SBenjamin Tissoires 					 "%s (WL) Pad",wacom_wac2->features.name);
1133471d1714SBenjamin Tissoires 			snprintf(wacom_wac2->pad_name, WACOM_NAME_MAX,
1134471d1714SBenjamin Tissoires 				 "%s (WL) Pad", wacom_wac2->features.name);
1135471d1714SBenjamin Tissoires 			error = wacom_register_inputs(wacom2);
1136471d1714SBenjamin Tissoires 			if (error)
1137471d1714SBenjamin Tissoires 				goto fail;
1138471d1714SBenjamin Tissoires 
1139471d1714SBenjamin Tissoires 			if (wacom_wac1->features.type == INTUOSHT &&
1140471d1714SBenjamin Tissoires 			    wacom_wac1->features.touch_max)
1141471d1714SBenjamin Tissoires 				wacom_wac->shared->touch_input = wacom_wac2->input;
1142471d1714SBenjamin Tissoires 		}
1143471d1714SBenjamin Tissoires 
1144471d1714SBenjamin Tissoires 		error = wacom_initialize_battery(wacom);
1145471d1714SBenjamin Tissoires 		if (error)
1146471d1714SBenjamin Tissoires 			goto fail;
1147471d1714SBenjamin Tissoires 	}
1148471d1714SBenjamin Tissoires 
1149471d1714SBenjamin Tissoires 	return;
1150471d1714SBenjamin Tissoires 
1151471d1714SBenjamin Tissoires fail:
1152471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom1);
1153471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom2);
1154471d1714SBenjamin Tissoires 	return;
1155471d1714SBenjamin Tissoires }
1156471d1714SBenjamin Tissoires 
1157471d1714SBenjamin Tissoires /*
1158471d1714SBenjamin Tissoires  * Not all devices report physical dimensions from HID.
1159471d1714SBenjamin Tissoires  * Compute the default from hardcoded logical dimension
1160471d1714SBenjamin Tissoires  * and resolution before driver overwrites them.
1161471d1714SBenjamin Tissoires  */
1162471d1714SBenjamin Tissoires static void wacom_set_default_phy(struct wacom_features *features)
1163471d1714SBenjamin Tissoires {
1164471d1714SBenjamin Tissoires 	if (features->x_resolution) {
1165471d1714SBenjamin Tissoires 		features->x_phy = (features->x_max * 100) /
1166471d1714SBenjamin Tissoires 					features->x_resolution;
1167471d1714SBenjamin Tissoires 		features->y_phy = (features->y_max * 100) /
1168471d1714SBenjamin Tissoires 					features->y_resolution;
1169471d1714SBenjamin Tissoires 	}
1170471d1714SBenjamin Tissoires }
1171471d1714SBenjamin Tissoires 
1172471d1714SBenjamin Tissoires static void wacom_calculate_res(struct wacom_features *features)
1173471d1714SBenjamin Tissoires {
1174471d1714SBenjamin Tissoires 	features->x_resolution = wacom_calc_hid_res(features->x_max,
1175471d1714SBenjamin Tissoires 						    features->x_phy,
1176471d1714SBenjamin Tissoires 						    features->unit,
1177471d1714SBenjamin Tissoires 						    features->unitExpo);
1178471d1714SBenjamin Tissoires 	features->y_resolution = wacom_calc_hid_res(features->y_max,
1179471d1714SBenjamin Tissoires 						    features->y_phy,
1180471d1714SBenjamin Tissoires 						    features->unit,
1181471d1714SBenjamin Tissoires 						    features->unitExpo);
1182471d1714SBenjamin Tissoires }
1183471d1714SBenjamin Tissoires 
1184471d1714SBenjamin Tissoires static int wacom_hid_report_len(struct hid_report *report)
1185471d1714SBenjamin Tissoires {
1186471d1714SBenjamin Tissoires 	/* equivalent to DIV_ROUND_UP(report->size, 8) + !!(report->id > 0) */
1187471d1714SBenjamin Tissoires 	return ((report->size - 1) >> 3) + 1 + (report->id > 0);
1188471d1714SBenjamin Tissoires }
1189471d1714SBenjamin Tissoires 
1190471d1714SBenjamin Tissoires static size_t wacom_compute_pktlen(struct hid_device *hdev)
1191471d1714SBenjamin Tissoires {
1192471d1714SBenjamin Tissoires 	struct hid_report_enum *report_enum;
1193471d1714SBenjamin Tissoires 	struct hid_report *report;
1194471d1714SBenjamin Tissoires 	size_t size = 0;
1195471d1714SBenjamin Tissoires 
1196471d1714SBenjamin Tissoires 	report_enum = hdev->report_enum + HID_INPUT_REPORT;
1197471d1714SBenjamin Tissoires 
1198471d1714SBenjamin Tissoires 	list_for_each_entry(report, &report_enum->report_list, list) {
1199471d1714SBenjamin Tissoires 		size_t report_size = wacom_hid_report_len(report);
1200471d1714SBenjamin Tissoires 		if (report_size > size)
1201471d1714SBenjamin Tissoires 			size = report_size;
1202471d1714SBenjamin Tissoires 	}
1203471d1714SBenjamin Tissoires 
1204471d1714SBenjamin Tissoires 	return size;
1205471d1714SBenjamin Tissoires }
1206471d1714SBenjamin Tissoires 
1207471d1714SBenjamin Tissoires static int wacom_probe(struct hid_device *hdev,
1208471d1714SBenjamin Tissoires 		const struct hid_device_id *id)
1209471d1714SBenjamin Tissoires {
1210471d1714SBenjamin Tissoires 	struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
1211471d1714SBenjamin Tissoires 	struct usb_device *dev = interface_to_usbdev(intf);
1212471d1714SBenjamin Tissoires 	struct wacom *wacom;
1213471d1714SBenjamin Tissoires 	struct wacom_wac *wacom_wac;
1214471d1714SBenjamin Tissoires 	struct wacom_features *features;
1215471d1714SBenjamin Tissoires 	int error;
1216471d1714SBenjamin Tissoires 
1217471d1714SBenjamin Tissoires 	if (!id->driver_data)
1218471d1714SBenjamin Tissoires 		return -EINVAL;
1219471d1714SBenjamin Tissoires 
1220471d1714SBenjamin Tissoires 	wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
1221471d1714SBenjamin Tissoires 	if (!wacom)
1222471d1714SBenjamin Tissoires 		return -ENOMEM;
1223471d1714SBenjamin Tissoires 
1224471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, wacom);
1225471d1714SBenjamin Tissoires 	wacom->hdev = hdev;
1226471d1714SBenjamin Tissoires 
1227471d1714SBenjamin Tissoires 	/* ask for the report descriptor to be loaded by HID */
1228471d1714SBenjamin Tissoires 	error = hid_parse(hdev);
1229471d1714SBenjamin Tissoires 	if (error) {
1230471d1714SBenjamin Tissoires 		hid_err(hdev, "parse failed\n");
1231471d1714SBenjamin Tissoires 		goto fail1;
1232471d1714SBenjamin Tissoires 	}
1233471d1714SBenjamin Tissoires 
1234471d1714SBenjamin Tissoires 	wacom_wac = &wacom->wacom_wac;
1235471d1714SBenjamin Tissoires 	wacom_wac->features = *((struct wacom_features *)id->driver_data);
1236471d1714SBenjamin Tissoires 	features = &wacom_wac->features;
1237471d1714SBenjamin Tissoires 	features->pktlen = wacom_compute_pktlen(hdev);
1238471d1714SBenjamin Tissoires 	if (features->pktlen > WACOM_PKGLEN_MAX) {
1239471d1714SBenjamin Tissoires 		error = -EINVAL;
1240471d1714SBenjamin Tissoires 		goto fail1;
1241471d1714SBenjamin Tissoires 	}
1242471d1714SBenjamin Tissoires 
1243471d1714SBenjamin Tissoires 	if (features->check_for_hid_type && features->hid_type != hdev->type) {
1244471d1714SBenjamin Tissoires 		error = -ENODEV;
1245471d1714SBenjamin Tissoires 		goto fail1;
1246471d1714SBenjamin Tissoires 	}
1247471d1714SBenjamin Tissoires 
1248471d1714SBenjamin Tissoires 	wacom->usbdev = dev;
1249471d1714SBenjamin Tissoires 	wacom->intf = intf;
1250471d1714SBenjamin Tissoires 	mutex_init(&wacom->lock);
1251471d1714SBenjamin Tissoires 	INIT_WORK(&wacom->work, wacom_wireless_work);
1252471d1714SBenjamin Tissoires 
1253471d1714SBenjamin Tissoires 	/* set the default size in case we do not get them from hid */
1254471d1714SBenjamin Tissoires 	wacom_set_default_phy(features);
1255471d1714SBenjamin Tissoires 
1256471d1714SBenjamin Tissoires 	/* Retrieve the physical and logical size for touch devices */
1257471d1714SBenjamin Tissoires 	wacom_retrieve_hid_descriptor(hdev, features);
1258471d1714SBenjamin Tissoires 
1259471d1714SBenjamin Tissoires 	/*
1260471d1714SBenjamin Tissoires 	 * Intuos5 has no useful data about its touch interface in its
1261471d1714SBenjamin Tissoires 	 * HID descriptor. If this is the touch interface (PacketSize
1262471d1714SBenjamin Tissoires 	 * of WACOM_PKGLEN_BBTOUCH3), override the table values.
1263471d1714SBenjamin Tissoires 	 */
1264471d1714SBenjamin Tissoires 	if (features->type >= INTUOS5S && features->type <= INTUOSHT) {
1265471d1714SBenjamin Tissoires 		if (features->pktlen == WACOM_PKGLEN_BBTOUCH3) {
1266471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_FINGER;
1267471d1714SBenjamin Tissoires 
1268471d1714SBenjamin Tissoires 			features->x_max = 4096;
1269471d1714SBenjamin Tissoires 			features->y_max = 4096;
1270471d1714SBenjamin Tissoires 		} else {
1271471d1714SBenjamin Tissoires 			features->device_type = BTN_TOOL_PEN;
1272471d1714SBenjamin Tissoires 		}
1273471d1714SBenjamin Tissoires 	}
1274471d1714SBenjamin Tissoires 
1275471d1714SBenjamin Tissoires 	/*
1276471d1714SBenjamin Tissoires 	 * Same thing for Bamboo 3rd gen.
1277471d1714SBenjamin Tissoires 	 */
1278471d1714SBenjamin Tissoires 	if ((features->type == BAMBOO_PT) &&
1279471d1714SBenjamin Tissoires 	    (features->pktlen == WACOM_PKGLEN_BBTOUCH3) &&
1280471d1714SBenjamin Tissoires 	    (features->device_type == BTN_TOOL_PEN)) {
1281471d1714SBenjamin Tissoires 		features->device_type = BTN_TOOL_FINGER;
1282471d1714SBenjamin Tissoires 
1283471d1714SBenjamin Tissoires 		features->x_max = 4096;
1284471d1714SBenjamin Tissoires 		features->y_max = 4096;
1285471d1714SBenjamin Tissoires 	}
1286471d1714SBenjamin Tissoires 
1287f81a1295SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH)
1288f81a1295SBenjamin Tissoires 		features->quirks |= WACOM_QUIRK_BATTERY;
1289f81a1295SBenjamin Tissoires 
1290471d1714SBenjamin Tissoires 	wacom_setup_device_quirks(features);
1291471d1714SBenjamin Tissoires 
1292471d1714SBenjamin Tissoires 	/* set unit to "100th of a mm" for devices not reported by HID */
1293471d1714SBenjamin Tissoires 	if (!features->unit) {
1294471d1714SBenjamin Tissoires 		features->unit = 0x11;
1295471d1714SBenjamin Tissoires 		features->unitExpo = -3;
1296471d1714SBenjamin Tissoires 	}
1297471d1714SBenjamin Tissoires 	wacom_calculate_res(features);
1298471d1714SBenjamin Tissoires 
1299471d1714SBenjamin Tissoires 	strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name));
1300471d1714SBenjamin Tissoires 	snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
1301471d1714SBenjamin Tissoires 		"%s Pad", features->name);
1302471d1714SBenjamin Tissoires 
1303471d1714SBenjamin Tissoires 	if (features->quirks & WACOM_QUIRK_MULTI_INPUT) {
1304471d1714SBenjamin Tissoires 		/* Append the device type to the name */
1305471d1714SBenjamin Tissoires 		if (features->device_type != BTN_TOOL_FINGER)
1306471d1714SBenjamin Tissoires 			strlcat(wacom_wac->name, " Pen", WACOM_NAME_MAX);
1307471d1714SBenjamin Tissoires 		else if (features->touch_max)
1308471d1714SBenjamin Tissoires 			strlcat(wacom_wac->name, " Finger", WACOM_NAME_MAX);
1309471d1714SBenjamin Tissoires 		else
1310471d1714SBenjamin Tissoires 			strlcat(wacom_wac->name, " Pad", WACOM_NAME_MAX);
1311471d1714SBenjamin Tissoires 
1312471d1714SBenjamin Tissoires 		error = wacom_add_shared_data(hdev);
1313471d1714SBenjamin Tissoires 		if (error)
1314471d1714SBenjamin Tissoires 			goto fail1;
1315471d1714SBenjamin Tissoires 	}
1316471d1714SBenjamin Tissoires 
1317471d1714SBenjamin Tissoires 	error = wacom_initialize_leds(wacom);
1318471d1714SBenjamin Tissoires 	if (error)
1319471d1714SBenjamin Tissoires 		goto fail2;
1320471d1714SBenjamin Tissoires 
1321f81a1295SBenjamin Tissoires 	if (!(features->quirks & WACOM_QUIRK_MONITOR) &&
1322f81a1295SBenjamin Tissoires 	     (features->quirks & WACOM_QUIRK_BATTERY)) {
1323f81a1295SBenjamin Tissoires 		error = wacom_initialize_battery(wacom);
1324f81a1295SBenjamin Tissoires 		if (error)
1325f81a1295SBenjamin Tissoires 			goto fail3;
1326f81a1295SBenjamin Tissoires 	}
1327f81a1295SBenjamin Tissoires 
1328471d1714SBenjamin Tissoires 	if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
1329471d1714SBenjamin Tissoires 		error = wacom_register_inputs(wacom);
1330471d1714SBenjamin Tissoires 		if (error)
1331f81a1295SBenjamin Tissoires 			goto fail4;
1332f81a1295SBenjamin Tissoires 	}
1333f81a1295SBenjamin Tissoires 
1334f81a1295SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH) {
1335f81a1295SBenjamin Tissoires 		error = device_create_file(&hdev->dev, &dev_attr_speed);
1336f81a1295SBenjamin Tissoires 		if (error)
1337f81a1295SBenjamin Tissoires 			hid_warn(hdev,
1338f81a1295SBenjamin Tissoires 				 "can't create sysfs speed attribute err: %d\n",
1339f81a1295SBenjamin Tissoires 				 error);
1340471d1714SBenjamin Tissoires 	}
1341471d1714SBenjamin Tissoires 
1342471d1714SBenjamin Tissoires 	/* Note that if query fails it is not a hard failure */
1343471d1714SBenjamin Tissoires 	wacom_query_tablet_data(hdev, features);
1344471d1714SBenjamin Tissoires 
1345471d1714SBenjamin Tissoires 	/* Regular HID work starts now */
1346471d1714SBenjamin Tissoires 	error = hid_hw_start(hdev, HID_CONNECT_HIDRAW);
1347471d1714SBenjamin Tissoires 	if (error) {
1348471d1714SBenjamin Tissoires 		hid_err(hdev, "hw start failed\n");
1349f81a1295SBenjamin Tissoires 		goto fail5;
1350471d1714SBenjamin Tissoires 	}
1351471d1714SBenjamin Tissoires 
1352471d1714SBenjamin Tissoires 	if (features->quirks & WACOM_QUIRK_MONITOR)
1353471d1714SBenjamin Tissoires 		error = hid_hw_open(hdev);
1354471d1714SBenjamin Tissoires 
1355471d1714SBenjamin Tissoires 	if (wacom_wac->features.type == INTUOSHT && wacom_wac->features.touch_max) {
1356471d1714SBenjamin Tissoires 		if (wacom_wac->features.device_type == BTN_TOOL_FINGER)
1357471d1714SBenjamin Tissoires 			wacom_wac->shared->touch_input = wacom_wac->input;
1358471d1714SBenjamin Tissoires 	}
1359471d1714SBenjamin Tissoires 
1360471d1714SBenjamin Tissoires 	return 0;
1361471d1714SBenjamin Tissoires 
1362f81a1295SBenjamin Tissoires  fail5:	if (hdev->bus == BUS_BLUETOOTH)
1363f81a1295SBenjamin Tissoires 		device_remove_file(&hdev->dev, &dev_attr_speed);
1364f81a1295SBenjamin Tissoires 	wacom_unregister_inputs(wacom);
1365f81a1295SBenjamin Tissoires  fail4:	wacom_destroy_battery(wacom);
1366471d1714SBenjamin Tissoires  fail3:	wacom_destroy_leds(wacom);
1367471d1714SBenjamin Tissoires  fail2:	wacom_remove_shared_data(wacom_wac);
1368471d1714SBenjamin Tissoires  fail1:	kfree(wacom);
1369471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, NULL);
1370471d1714SBenjamin Tissoires 	return error;
1371471d1714SBenjamin Tissoires }
1372471d1714SBenjamin Tissoires 
1373471d1714SBenjamin Tissoires static void wacom_remove(struct hid_device *hdev)
1374471d1714SBenjamin Tissoires {
1375471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
1376471d1714SBenjamin Tissoires 
1377471d1714SBenjamin Tissoires 	hid_hw_stop(hdev);
1378471d1714SBenjamin Tissoires 
1379471d1714SBenjamin Tissoires 	cancel_work_sync(&wacom->work);
1380471d1714SBenjamin Tissoires 	wacom_unregister_inputs(wacom);
1381f81a1295SBenjamin Tissoires 	if (hdev->bus == BUS_BLUETOOTH)
1382f81a1295SBenjamin Tissoires 		device_remove_file(&hdev->dev, &dev_attr_speed);
1383471d1714SBenjamin Tissoires 	wacom_destroy_battery(wacom);
1384471d1714SBenjamin Tissoires 	wacom_destroy_leds(wacom);
1385471d1714SBenjamin Tissoires 	wacom_remove_shared_data(&wacom->wacom_wac);
1386471d1714SBenjamin Tissoires 
1387471d1714SBenjamin Tissoires 	hid_set_drvdata(hdev, NULL);
1388471d1714SBenjamin Tissoires 	kfree(wacom);
1389471d1714SBenjamin Tissoires }
1390471d1714SBenjamin Tissoires 
1391471d1714SBenjamin Tissoires static int wacom_resume(struct hid_device *hdev)
1392471d1714SBenjamin Tissoires {
1393471d1714SBenjamin Tissoires 	struct wacom *wacom = hid_get_drvdata(hdev);
1394471d1714SBenjamin Tissoires 	struct wacom_features *features = &wacom->wacom_wac.features;
1395471d1714SBenjamin Tissoires 
1396471d1714SBenjamin Tissoires 	mutex_lock(&wacom->lock);
1397471d1714SBenjamin Tissoires 
1398471d1714SBenjamin Tissoires 	/* switch to wacom mode first */
1399471d1714SBenjamin Tissoires 	wacom_query_tablet_data(hdev, features);
1400471d1714SBenjamin Tissoires 	wacom_led_control(wacom);
1401471d1714SBenjamin Tissoires 
1402471d1714SBenjamin Tissoires 	mutex_unlock(&wacom->lock);
1403471d1714SBenjamin Tissoires 
1404471d1714SBenjamin Tissoires 	return 0;
1405471d1714SBenjamin Tissoires }
1406471d1714SBenjamin Tissoires 
1407471d1714SBenjamin Tissoires static int wacom_reset_resume(struct hid_device *hdev)
1408471d1714SBenjamin Tissoires {
1409471d1714SBenjamin Tissoires 	return wacom_resume(hdev);
1410471d1714SBenjamin Tissoires }
1411471d1714SBenjamin Tissoires 
1412471d1714SBenjamin Tissoires static struct hid_driver wacom_driver = {
1413471d1714SBenjamin Tissoires 	.name =		"wacom",
1414471d1714SBenjamin Tissoires 	.id_table =	wacom_ids,
1415471d1714SBenjamin Tissoires 	.probe =	wacom_probe,
1416471d1714SBenjamin Tissoires 	.remove =	wacom_remove,
1417471d1714SBenjamin Tissoires #ifdef CONFIG_PM
1418471d1714SBenjamin Tissoires 	.resume =	wacom_resume,
1419471d1714SBenjamin Tissoires 	.reset_resume =	wacom_reset_resume,
1420471d1714SBenjamin Tissoires #endif
1421471d1714SBenjamin Tissoires 	.raw_event =	wacom_raw_event,
1422471d1714SBenjamin Tissoires };
1423471d1714SBenjamin Tissoires module_hid_driver(wacom_driver);
1424