xref: /openbmc/linux/drivers/hid/hid-alps.c (revision 6a767685)
1 /*
2  *  Copyright (c) 2016 Masaki Ota <masaki.ota@jp.alps.com>
3  *
4  * This program is free software; you can redistribute it and/or modify it
5  * under the terms of the GNU General Public License as published by the Free
6  * Software Foundation; either version 2 of the License, or (at your option)
7  * any later version.
8  */
9 
10 #include <linux/kernel.h>
11 #include <linux/hid.h>
12 #include <linux/input.h>
13 #include <linux/input/mt.h>
14 #include <linux/module.h>
15 #include <asm/unaligned.h>
16 #include "hid-ids.h"
17 
18 /* ALPS Device Product ID */
19 #define HID_PRODUCT_ID_T3_BTNLESS	0xD0C0
20 #define HID_PRODUCT_ID_COSMO		0x1202
21 #define HID_PRODUCT_ID_U1_PTP_1		0x1207
22 #define HID_PRODUCT_ID_U1			0x1209
23 #define HID_PRODUCT_ID_U1_PTP_2		0x120A
24 #define HID_PRODUCT_ID_U1_DUAL		0x120B
25 #define HID_PRODUCT_ID_T4_BTNLESS	0x120C
26 
27 #define DEV_SINGLEPOINT				0x01
28 #define DEV_DUALPOINT				0x02
29 
30 #define U1_MOUSE_REPORT_ID			0x01 /* Mouse data ReportID */
31 #define U1_ABSOLUTE_REPORT_ID		0x03 /* Absolute data ReportID */
32 #define U1_FEATURE_REPORT_ID		0x05 /* Feature ReportID */
33 #define U1_SP_ABSOLUTE_REPORT_ID	0x06 /* Feature ReportID */
34 
35 #define U1_FEATURE_REPORT_LEN		0x08 /* Feature Report Length */
36 #define U1_FEATURE_REPORT_LEN_ALL	0x0A
37 #define U1_CMD_REGISTER_READ		0xD1
38 #define U1_CMD_REGISTER_WRITE		0xD2
39 
40 #define	U1_DEVTYPE_SP_SUPPORT		0x10 /* SP Support */
41 #define	U1_DISABLE_DEV				0x01
42 #define U1_TP_ABS_MODE				0x02
43 #define	U1_SP_ABS_MODE				0x80
44 
45 #define ADDRESS_U1_DEV_CTRL_1	0x00800040
46 #define ADDRESS_U1_DEVICE_TYP	0x00800043
47 #define ADDRESS_U1_NUM_SENS_X	0x00800047
48 #define ADDRESS_U1_NUM_SENS_Y	0x00800048
49 #define ADDRESS_U1_PITCH_SENS_X	0x00800049
50 #define ADDRESS_U1_PITCH_SENS_Y	0x0080004A
51 #define ADDRESS_U1_RESO_DWN_ABS 0x0080004E
52 #define ADDRESS_U1_PAD_BTN		0x00800052
53 #define ADDRESS_U1_SP_BTN		0x0080009F
54 
55 #define T4_INPUT_REPORT_LEN			sizeof(struct t4_input_report)
56 #define T4_FEATURE_REPORT_LEN		T4_INPUT_REPORT_LEN
57 #define T4_FEATURE_REPORT_ID		7
58 #define T4_CMD_REGISTER_READ			0x08
59 #define T4_CMD_REGISTER_WRITE			0x07
60 
61 #define T4_ADDRESS_BASE				0xC2C0
62 #define PRM_SYS_CONFIG_1			(T4_ADDRESS_BASE + 0x0002)
63 #define T4_PRM_FEED_CONFIG_1		(T4_ADDRESS_BASE + 0x0004)
64 #define T4_PRM_FEED_CONFIG_4		(T4_ADDRESS_BASE + 0x001A)
65 #define T4_PRM_ID_CONFIG_3			(T4_ADDRESS_BASE + 0x00B0)
66 
67 
68 #define T4_FEEDCFG4_ADVANCED_ABS_ENABLE			0x01
69 #define T4_I2C_ABS	0x78
70 
71 #define T4_COUNT_PER_ELECTRODE		256
72 #define MAX_TOUCHES	5
73 
74 enum dev_num {
75 	U1,
76 	T4,
77 	UNKNOWN,
78 };
79 /**
80  * struct u1_data
81  *
82  * @input: pointer to the kernel input device
83  * @input2: pointer to the kernel input2 device
84  * @hdev: pointer to the struct hid_device
85  *
86  * @dev_type: device type
87  * @max_fingers: total number of fingers
88  * @has_sp: boolean of sp existense
89  * @sp_btn_info: button information
90  * @x_active_len_mm: active area length of X (mm)
91  * @y_active_len_mm: active area length of Y (mm)
92  * @x_max: maximum x coordinate value
93  * @y_max: maximum y coordinate value
94  * @x_min: minimum x coordinate value
95  * @y_min: minimum y coordinate value
96  * @btn_cnt: number of buttons
97  * @sp_btn_cnt: number of stick buttons
98  */
99 struct alps_dev {
100 	struct input_dev *input;
101 	struct input_dev *input2;
102 	struct hid_device *hdev;
103 
104 	enum dev_num dev_type;
105 	u8  max_fingers;
106 	u8  has_sp;
107 	u8	sp_btn_info;
108 	u32	x_active_len_mm;
109 	u32	y_active_len_mm;
110 	u32	x_max;
111 	u32	y_max;
112 	u32	x_min;
113 	u32	y_min;
114 	u32	btn_cnt;
115 	u32	sp_btn_cnt;
116 };
117 
118 struct t4_contact_data {
119 	u8  palm;
120 	u8	x_lo;
121 	u8	x_hi;
122 	u8	y_lo;
123 	u8	y_hi;
124 };
125 
126 struct t4_input_report {
127 	u8  reportID;
128 	u8  numContacts;
129 	struct t4_contact_data contact[5];
130 	u8  button;
131 	u8  track[5];
132 	u8  zx[5], zy[5];
133 	u8  palmTime[5];
134 	u8  kilroy;
135 	u16 timeStamp;
136 };
137 
138 static u16 t4_calc_check_sum(u8 *buffer,
139 		unsigned long offset, unsigned long length)
140 {
141 	u16 sum1 = 0xFF, sum2 = 0xFF;
142 	unsigned long i = 0;
143 
144 	if (offset + length >= 50)
145 		return 0;
146 
147 	while (length > 0) {
148 		u32 tlen = length > 20 ? 20 : length;
149 
150 		length -= tlen;
151 
152 		do {
153 			sum1 += buffer[offset + i];
154 			sum2 += sum1;
155 			i++;
156 		} while (--tlen > 0);
157 
158 		sum1 = (sum1 & 0xFF) + (sum1 >> 8);
159 		sum2 = (sum2 & 0xFF) + (sum2 >> 8);
160 	}
161 
162 	sum1 = (sum1 & 0xFF) + (sum1 >> 8);
163 	sum2 = (sum2 & 0xFF) + (sum2 >> 8);
164 
165 	return(sum2 << 8 | sum1);
166 }
167 
168 static int t4_read_write_register(struct hid_device *hdev, u32 address,
169 	u8 *read_val, u8 write_val, bool read_flag)
170 {
171 	int ret;
172 	u16 check_sum;
173 	u8 *input;
174 	u8 *readbuf;
175 
176 	input = kzalloc(T4_FEATURE_REPORT_LEN, GFP_KERNEL);
177 	if (!input)
178 		return -ENOMEM;
179 
180 	input[0] = T4_FEATURE_REPORT_ID;
181 	if (read_flag) {
182 		input[1] = T4_CMD_REGISTER_READ;
183 		input[8] = 0x00;
184 	} else {
185 		input[1] = T4_CMD_REGISTER_WRITE;
186 		input[8] = write_val;
187 	}
188 	put_unaligned_le32(address, input + 2);
189 	input[6] = 1;
190 	input[7] = 0;
191 
192 	/* Calculate the checksum */
193 	check_sum = t4_calc_check_sum(input, 1, 8);
194 	input[9] = (u8)check_sum;
195 	input[10] = (u8)(check_sum >> 8);
196 	input[11] = 0;
197 
198 	ret = hid_hw_raw_request(hdev, T4_FEATURE_REPORT_ID, input,
199 			T4_FEATURE_REPORT_LEN,
200 			HID_FEATURE_REPORT, HID_REQ_SET_REPORT);
201 
202 	if (ret < 0) {
203 		dev_err(&hdev->dev, "failed to read command (%d)\n", ret);
204 		goto exit;
205 	}
206 
207 	readbuf = kzalloc(T4_FEATURE_REPORT_LEN, GFP_KERNEL);
208 	if (read_flag) {
209 		if (!readbuf) {
210 			ret = -ENOMEM;
211 			goto exit;
212 		}
213 
214 		ret = hid_hw_raw_request(hdev, T4_FEATURE_REPORT_ID, readbuf,
215 				T4_FEATURE_REPORT_LEN,
216 				HID_FEATURE_REPORT, HID_REQ_GET_REPORT);
217 		if (ret < 0) {
218 			dev_err(&hdev->dev, "failed read register (%d)\n", ret);
219 			goto exit_readbuf;
220 		}
221 
222 		if (*(u32 *)&readbuf[6] != address) {
223 			dev_err(&hdev->dev, "read register address error (%x,%x)\n",
224 			*(u32 *)&readbuf[6], address);
225 			goto exit_readbuf;
226 		}
227 
228 		if (*(u16 *)&readbuf[10] != 1) {
229 			dev_err(&hdev->dev, "read register size error (%x)\n",
230 			*(u16 *)&readbuf[10]);
231 			goto exit_readbuf;
232 		}
233 
234 		check_sum = t4_calc_check_sum(readbuf, 6, 7);
235 		if (*(u16 *)&readbuf[13] != check_sum) {
236 			dev_err(&hdev->dev, "read register checksum error (%x,%x)\n",
237 			*(u16 *)&readbuf[13], check_sum);
238 			goto exit_readbuf;
239 		}
240 
241 		*read_val = readbuf[12];
242 	}
243 
244 	ret = 0;
245 
246 exit_readbuf:
247 	kfree(readbuf);
248 exit:
249 	kfree(input);
250 	return ret;
251 }
252 
253 static int u1_read_write_register(struct hid_device *hdev, u32 address,
254 	u8 *read_val, u8 write_val, bool read_flag)
255 {
256 	int ret, i;
257 	u8 check_sum;
258 	u8 *input;
259 	u8 *readbuf;
260 
261 	input = kzalloc(U1_FEATURE_REPORT_LEN, GFP_KERNEL);
262 	if (!input)
263 		return -ENOMEM;
264 
265 	input[0] = U1_FEATURE_REPORT_ID;
266 	if (read_flag) {
267 		input[1] = U1_CMD_REGISTER_READ;
268 		input[6] = 0x00;
269 	} else {
270 		input[1] = U1_CMD_REGISTER_WRITE;
271 		input[6] = write_val;
272 	}
273 
274 	put_unaligned_le32(address, input + 2);
275 
276 	/* Calculate the checksum */
277 	check_sum = U1_FEATURE_REPORT_LEN_ALL;
278 	for (i = 0; i < U1_FEATURE_REPORT_LEN - 1; i++)
279 		check_sum += input[i];
280 
281 	input[7] = check_sum;
282 	ret = hid_hw_raw_request(hdev, U1_FEATURE_REPORT_ID, input,
283 			U1_FEATURE_REPORT_LEN,
284 			HID_FEATURE_REPORT, HID_REQ_SET_REPORT);
285 
286 	if (ret < 0) {
287 		dev_err(&hdev->dev, "failed to read command (%d)\n", ret);
288 		goto exit;
289 	}
290 
291 	if (read_flag) {
292 		readbuf = kzalloc(U1_FEATURE_REPORT_LEN, GFP_KERNEL);
293 		if (!readbuf) {
294 			ret = -ENOMEM;
295 			goto exit;
296 		}
297 
298 		ret = hid_hw_raw_request(hdev, U1_FEATURE_REPORT_ID, readbuf,
299 				U1_FEATURE_REPORT_LEN,
300 				HID_FEATURE_REPORT, HID_REQ_GET_REPORT);
301 
302 		if (ret < 0) {
303 			dev_err(&hdev->dev, "failed read register (%d)\n", ret);
304 			kfree(readbuf);
305 			goto exit;
306 		}
307 
308 		*read_val = readbuf[6];
309 
310 		kfree(readbuf);
311 	}
312 
313 	ret = 0;
314 
315 exit:
316 	kfree(input);
317 	return ret;
318 }
319 
320 static int t4_raw_event(struct alps_dev *hdata, u8 *data, int size)
321 {
322 	unsigned int x, y, z;
323 	int i;
324 	struct t4_input_report *p_report = (struct t4_input_report *)data;
325 
326 	if (!data)
327 		return 0;
328 	for (i = 0; i < hdata->max_fingers; i++) {
329 		x = p_report->contact[i].x_hi << 8 | p_report->contact[i].x_lo;
330 		y = p_report->contact[i].y_hi << 8 | p_report->contact[i].y_lo;
331 		y = hdata->y_max - y + hdata->y_min;
332 		z = (p_report->contact[i].palm < 0x80 &&
333 			p_report->contact[i].palm > 0) * 62;
334 		if (x == 0xffff) {
335 			x = 0;
336 			y = 0;
337 			z = 0;
338 		}
339 		input_mt_slot(hdata->input, i);
340 
341 		input_mt_report_slot_state(hdata->input,
342 			MT_TOOL_FINGER, z != 0);
343 
344 		if (!z)
345 			continue;
346 
347 		input_report_abs(hdata->input, ABS_MT_POSITION_X, x);
348 		input_report_abs(hdata->input, ABS_MT_POSITION_Y, y);
349 		input_report_abs(hdata->input, ABS_MT_PRESSURE, z);
350 	}
351 	input_mt_sync_frame(hdata->input);
352 
353 	input_report_key(hdata->input, BTN_LEFT, p_report->button);
354 
355 	input_sync(hdata->input);
356 	return 1;
357 }
358 
359 static int u1_raw_event(struct alps_dev *hdata, u8 *data, int size)
360 {
361 	unsigned int x, y, z;
362 	int i;
363 	short sp_x, sp_y;
364 
365 	if (!data)
366 		return 0;
367 	switch (data[0]) {
368 	case U1_MOUSE_REPORT_ID:
369 		break;
370 	case U1_FEATURE_REPORT_ID:
371 		break;
372 	case U1_ABSOLUTE_REPORT_ID:
373 		for (i = 0; i < hdata->max_fingers; i++) {
374 			u8 *contact = &data[i * 5];
375 
376 			x = get_unaligned_le16(contact + 3);
377 			y = get_unaligned_le16(contact + 5);
378 			z = contact[7] & 0x7F;
379 
380 			input_mt_slot(hdata->input, i);
381 
382 			if (z != 0) {
383 				input_mt_report_slot_state(hdata->input,
384 					MT_TOOL_FINGER, 1);
385 				input_report_abs(hdata->input,
386 					ABS_MT_POSITION_X, x);
387 				input_report_abs(hdata->input,
388 					ABS_MT_POSITION_Y, y);
389 				input_report_abs(hdata->input,
390 					ABS_MT_PRESSURE, z);
391 			} else {
392 				input_mt_report_slot_state(hdata->input,
393 					MT_TOOL_FINGER, 0);
394 			}
395 		}
396 
397 		input_mt_sync_frame(hdata->input);
398 
399 		input_report_key(hdata->input, BTN_LEFT,
400 			data[1] & 0x1);
401 		input_report_key(hdata->input, BTN_RIGHT,
402 			(data[1] & 0x2));
403 		input_report_key(hdata->input, BTN_MIDDLE,
404 			(data[1] & 0x4));
405 
406 		input_sync(hdata->input);
407 
408 		return 1;
409 
410 	case U1_SP_ABSOLUTE_REPORT_ID:
411 		sp_x = get_unaligned_le16(data+2);
412 		sp_y = get_unaligned_le16(data+4);
413 
414 		sp_x = sp_x / 8;
415 		sp_y = sp_y / 8;
416 
417 		input_report_rel(hdata->input2, REL_X, sp_x);
418 		input_report_rel(hdata->input2, REL_Y, sp_y);
419 
420 		input_report_key(hdata->input2, BTN_LEFT,
421 			data[1] & 0x1);
422 		input_report_key(hdata->input2, BTN_RIGHT,
423 			(data[1] & 0x2));
424 		input_report_key(hdata->input2, BTN_MIDDLE,
425 			(data[1] & 0x4));
426 
427 		input_sync(hdata->input2);
428 
429 		return 1;
430 	}
431 
432 	return 0;
433 }
434 
435 static int alps_raw_event(struct hid_device *hdev,
436 		struct hid_report *report, u8 *data, int size)
437 {
438 	int ret = 0;
439 	struct alps_dev *hdata = hid_get_drvdata(hdev);
440 
441 	switch (hdev->product) {
442 	case HID_PRODUCT_ID_T4_BTNLESS:
443 		ret = t4_raw_event(hdata, data, size);
444 		break;
445 	default:
446 		ret = u1_raw_event(hdata, data, size);
447 		break;
448 	}
449 	return ret;
450 }
451 
452 static int __maybe_unused alps_post_reset(struct hid_device *hdev)
453 {
454 	int ret = -1;
455 	struct alps_dev *data = hid_get_drvdata(hdev);
456 
457 	switch (data->dev_type) {
458 	case T4:
459 		ret = t4_read_write_register(hdev, T4_PRM_FEED_CONFIG_1,
460 			NULL, T4_I2C_ABS, false);
461 		ret = t4_read_write_register(hdev, T4_PRM_FEED_CONFIG_4,
462 			NULL, T4_FEEDCFG4_ADVANCED_ABS_ENABLE, false);
463 		break;
464 	case U1:
465 		ret = u1_read_write_register(hdev,
466 			ADDRESS_U1_DEV_CTRL_1, NULL,
467 			U1_TP_ABS_MODE | U1_SP_ABS_MODE, false);
468 		break;
469 	default:
470 		break;
471 	}
472 	return ret;
473 }
474 
475 static int __maybe_unused alps_post_resume(struct hid_device *hdev)
476 {
477 	return alps_post_reset(hdev);
478 }
479 
480 static int u1_init(struct hid_device *hdev, struct alps_dev *pri_data)
481 {
482 	int ret;
483 	u8 tmp, dev_ctrl, sen_line_num_x, sen_line_num_y;
484 	u8 pitch_x, pitch_y, resolution;
485 
486 	/* Device initialization */
487 	ret = u1_read_write_register(hdev, ADDRESS_U1_DEV_CTRL_1,
488 			&dev_ctrl, 0, true);
489 	if (ret < 0) {
490 		dev_err(&hdev->dev, "failed U1_DEV_CTRL_1 (%d)\n", ret);
491 		goto exit;
492 	}
493 
494 	dev_ctrl &= ~U1_DISABLE_DEV;
495 	dev_ctrl |= U1_TP_ABS_MODE;
496 	ret = u1_read_write_register(hdev, ADDRESS_U1_DEV_CTRL_1,
497 			NULL, dev_ctrl, false);
498 	if (ret < 0) {
499 		dev_err(&hdev->dev, "failed to change TP mode (%d)\n", ret);
500 		goto exit;
501 	}
502 
503 	ret = u1_read_write_register(hdev, ADDRESS_U1_NUM_SENS_X,
504 			&sen_line_num_x, 0, true);
505 	if (ret < 0) {
506 		dev_err(&hdev->dev, "failed U1_NUM_SENS_X (%d)\n", ret);
507 		goto exit;
508 	}
509 
510 	ret = u1_read_write_register(hdev, ADDRESS_U1_NUM_SENS_Y,
511 			&sen_line_num_y, 0, true);
512 		if (ret < 0) {
513 		dev_err(&hdev->dev, "failed U1_NUM_SENS_Y (%d)\n", ret);
514 		goto exit;
515 	}
516 
517 	ret = u1_read_write_register(hdev, ADDRESS_U1_PITCH_SENS_X,
518 			&pitch_x, 0, true);
519 	if (ret < 0) {
520 		dev_err(&hdev->dev, "failed U1_PITCH_SENS_X (%d)\n", ret);
521 		goto exit;
522 	}
523 
524 	ret = u1_read_write_register(hdev, ADDRESS_U1_PITCH_SENS_Y,
525 			&pitch_y, 0, true);
526 	if (ret < 0) {
527 		dev_err(&hdev->dev, "failed U1_PITCH_SENS_Y (%d)\n", ret);
528 		goto exit;
529 	}
530 
531 	ret = u1_read_write_register(hdev, ADDRESS_U1_RESO_DWN_ABS,
532 		&resolution, 0, true);
533 	if (ret < 0) {
534 		dev_err(&hdev->dev, "failed U1_RESO_DWN_ABS (%d)\n", ret);
535 		goto exit;
536 	}
537 	pri_data->x_active_len_mm =
538 		(pitch_x * (sen_line_num_x - 1)) / 10;
539 	pri_data->y_active_len_mm =
540 		(pitch_y * (sen_line_num_y - 1)) / 10;
541 
542 	pri_data->x_max =
543 		(resolution << 2) * (sen_line_num_x - 1);
544 	pri_data->x_min = 1;
545 	pri_data->y_max =
546 		(resolution << 2) * (sen_line_num_y - 1);
547 	pri_data->y_min = 1;
548 
549 	ret = u1_read_write_register(hdev, ADDRESS_U1_PAD_BTN,
550 			&tmp, 0, true);
551 	if (ret < 0) {
552 		dev_err(&hdev->dev, "failed U1_PAD_BTN (%d)\n", ret);
553 		goto exit;
554 	}
555 	if ((tmp & 0x0F) == (tmp & 0xF0) >> 4) {
556 		pri_data->btn_cnt = (tmp & 0x0F);
557 	} else {
558 		/* Button pad */
559 		pri_data->btn_cnt = 1;
560 	}
561 
562 	pri_data->has_sp = 0;
563 	/* Check StickPointer device */
564 	ret = u1_read_write_register(hdev, ADDRESS_U1_DEVICE_TYP,
565 			&tmp, 0, true);
566 	if (ret < 0) {
567 		dev_err(&hdev->dev, "failed U1_DEVICE_TYP (%d)\n", ret);
568 		goto exit;
569 	}
570 	if (tmp & U1_DEVTYPE_SP_SUPPORT) {
571 		dev_ctrl |= U1_SP_ABS_MODE;
572 		ret = u1_read_write_register(hdev, ADDRESS_U1_DEV_CTRL_1,
573 			NULL, dev_ctrl, false);
574 		if (ret < 0) {
575 			dev_err(&hdev->dev, "failed SP mode (%d)\n", ret);
576 			goto exit;
577 		}
578 
579 		ret = u1_read_write_register(hdev, ADDRESS_U1_SP_BTN,
580 			&pri_data->sp_btn_info, 0, true);
581 		if (ret < 0) {
582 			dev_err(&hdev->dev, "failed U1_SP_BTN (%d)\n", ret);
583 			goto exit;
584 		}
585 		pri_data->has_sp = 1;
586 	}
587 	pri_data->max_fingers = 5;
588 exit:
589 	return ret;
590 }
591 
592 static int T4_init(struct hid_device *hdev, struct alps_dev *pri_data)
593 {
594 	int ret;
595 	u8 tmp, sen_line_num_x, sen_line_num_y;
596 
597 	ret = t4_read_write_register(hdev, T4_PRM_ID_CONFIG_3, &tmp, 0, true);
598 	if (ret < 0) {
599 		dev_err(&hdev->dev, "failed T4_PRM_ID_CONFIG_3 (%d)\n", ret);
600 		goto exit;
601 	}
602 	sen_line_num_x = 16 + ((tmp & 0x0F)  | (tmp & 0x08 ? 0xF0 : 0));
603 	sen_line_num_y = 12 + (((tmp & 0xF0) >> 4)  | (tmp & 0x80 ? 0xF0 : 0));
604 
605 	pri_data->x_max = sen_line_num_x * T4_COUNT_PER_ELECTRODE;
606 	pri_data->x_min = T4_COUNT_PER_ELECTRODE;
607 	pri_data->y_max = sen_line_num_y * T4_COUNT_PER_ELECTRODE;
608 	pri_data->y_min = T4_COUNT_PER_ELECTRODE;
609 	pri_data->x_active_len_mm = pri_data->y_active_len_mm = 0;
610 	pri_data->btn_cnt = 1;
611 
612 	ret = t4_read_write_register(hdev, PRM_SYS_CONFIG_1, &tmp, 0, true);
613 	if (ret < 0) {
614 		dev_err(&hdev->dev, "failed PRM_SYS_CONFIG_1 (%d)\n", ret);
615 		goto exit;
616 	}
617 	tmp |= 0x02;
618 	ret = t4_read_write_register(hdev, PRM_SYS_CONFIG_1, NULL, tmp, false);
619 	if (ret < 0) {
620 		dev_err(&hdev->dev, "failed PRM_SYS_CONFIG_1 (%d)\n", ret);
621 		goto exit;
622 	}
623 
624 	ret = t4_read_write_register(hdev, T4_PRM_FEED_CONFIG_1,
625 					NULL, T4_I2C_ABS, false);
626 	if (ret < 0) {
627 		dev_err(&hdev->dev, "failed T4_PRM_FEED_CONFIG_1 (%d)\n", ret);
628 		goto exit;
629 	}
630 
631 	ret = t4_read_write_register(hdev, T4_PRM_FEED_CONFIG_4, NULL,
632 				T4_FEEDCFG4_ADVANCED_ABS_ENABLE, false);
633 	if (ret < 0) {
634 		dev_err(&hdev->dev, "failed T4_PRM_FEED_CONFIG_4 (%d)\n", ret);
635 		goto exit;
636 	}
637 	pri_data->max_fingers = 5;
638 	pri_data->has_sp = 0;
639 exit:
640 	return ret;
641 }
642 
643 static int alps_input_configured(struct hid_device *hdev, struct hid_input *hi)
644 {
645 	struct alps_dev *data = hid_get_drvdata(hdev);
646 	struct input_dev *input = hi->input, *input2;
647 	int ret;
648 	int res_x, res_y, i;
649 
650 	data->input = input;
651 
652 	hid_dbg(hdev, "Opening low level driver\n");
653 	ret = hid_hw_open(hdev);
654 	if (ret)
655 		return ret;
656 
657 	/* Allow incoming hid reports */
658 	hid_device_io_start(hdev);
659 	switch (data->dev_type) {
660 	case T4:
661 		ret = T4_init(hdev, data);
662 		break;
663 	case U1:
664 		ret = u1_init(hdev, data);
665 		break;
666 	default:
667 		break;
668 	}
669 
670 	if (ret)
671 		goto exit;
672 
673 	__set_bit(EV_ABS, input->evbit);
674 	input_set_abs_params(input, ABS_MT_POSITION_X,
675 						data->x_min, data->x_max, 0, 0);
676 	input_set_abs_params(input, ABS_MT_POSITION_Y,
677 						data->y_min, data->y_max, 0, 0);
678 
679 	if (data->x_active_len_mm && data->y_active_len_mm) {
680 		res_x = (data->x_max - 1) / data->x_active_len_mm;
681 		res_y = (data->y_max - 1) / data->y_active_len_mm;
682 
683 		input_abs_set_res(input, ABS_MT_POSITION_X, res_x);
684 		input_abs_set_res(input, ABS_MT_POSITION_Y, res_y);
685 	}
686 
687 	input_set_abs_params(input, ABS_MT_PRESSURE, 0, 64, 0, 0);
688 
689 	input_mt_init_slots(input, data->max_fingers, INPUT_MT_POINTER);
690 
691 	__set_bit(EV_KEY, input->evbit);
692 
693 	if (data->btn_cnt == 1)
694 		__set_bit(INPUT_PROP_BUTTONPAD, input->propbit);
695 
696 	for (i = 0; i < data->btn_cnt; i++)
697 		__set_bit(BTN_LEFT + i, input->keybit);
698 
699 	/* Stick device initialization */
700 	if (data->has_sp) {
701 		input2 = input_allocate_device();
702 		if (!input2) {
703 			input_free_device(input2);
704 			goto exit;
705 		}
706 
707 		data->input2 = input2;
708 		input2->phys = input->phys;
709 		input2->name = "DualPoint Stick";
710 		input2->id.bustype = BUS_I2C;
711 		input2->id.vendor  = input->id.vendor;
712 		input2->id.product = input->id.product;
713 		input2->id.version = input->id.version;
714 		input2->dev.parent = input->dev.parent;
715 
716 		__set_bit(EV_KEY, input2->evbit);
717 		data->sp_btn_cnt = (data->sp_btn_info & 0x0F);
718 		for (i = 0; i < data->sp_btn_cnt; i++)
719 			__set_bit(BTN_LEFT + i, input2->keybit);
720 
721 		__set_bit(EV_REL, input2->evbit);
722 		__set_bit(REL_X, input2->relbit);
723 		__set_bit(REL_Y, input2->relbit);
724 		__set_bit(INPUT_PROP_POINTER, input2->propbit);
725 		__set_bit(INPUT_PROP_POINTING_STICK, input2->propbit);
726 
727 		if (input_register_device(data->input2)) {
728 			input_free_device(input2);
729 			goto exit;
730 		}
731 	}
732 
733 exit:
734 	hid_device_io_stop(hdev);
735 	hid_hw_close(hdev);
736 	return ret;
737 }
738 
739 static int alps_input_mapping(struct hid_device *hdev,
740 		struct hid_input *hi, struct hid_field *field,
741 		struct hid_usage *usage, unsigned long **bit, int *max)
742 {
743 	return -1;
744 }
745 
746 static int alps_probe(struct hid_device *hdev, const struct hid_device_id *id)
747 {
748 	struct alps_dev *data = NULL;
749 	int ret;
750 	data = devm_kzalloc(&hdev->dev, sizeof(struct alps_dev), GFP_KERNEL);
751 	if (!data)
752 		return -ENOMEM;
753 
754 	data->hdev = hdev;
755 	hid_set_drvdata(hdev, data);
756 
757 	hdev->quirks |= HID_QUIRK_NO_INIT_REPORTS;
758 
759 	ret = hid_parse(hdev);
760 	if (ret) {
761 		hid_err(hdev, "parse failed\n");
762 		return ret;
763 	}
764 
765 	switch (hdev->product) {
766 	case HID_DEVICE_ID_ALPS_T4_BTNLESS:
767 		data->dev_type = T4;
768 		break;
769 	case HID_DEVICE_ID_ALPS_U1_DUAL:
770 	case HID_DEVICE_ID_ALPS_U1:
771 		data->dev_type = U1;
772 		break;
773 	default:
774 		data->dev_type = UNKNOWN;
775 	}
776 
777 	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
778 	if (ret) {
779 		hid_err(hdev, "hw start failed\n");
780 		return ret;
781 	}
782 
783 	return 0;
784 }
785 
786 static void alps_remove(struct hid_device *hdev)
787 {
788 	hid_hw_stop(hdev);
789 }
790 
791 static const struct hid_device_id alps_id[] = {
792 	{ HID_DEVICE(HID_BUS_ANY, HID_GROUP_ANY,
793 		USB_VENDOR_ID_ALPS_JP, HID_DEVICE_ID_ALPS_U1_DUAL) },
794 	{ HID_DEVICE(HID_BUS_ANY, HID_GROUP_ANY,
795 		USB_VENDOR_ID_ALPS_JP, HID_DEVICE_ID_ALPS_U1) },
796 	{ HID_DEVICE(HID_BUS_ANY, HID_GROUP_ANY,
797 		USB_VENDOR_ID_ALPS_JP, HID_DEVICE_ID_ALPS_T4_BTNLESS) },
798 	{ }
799 };
800 MODULE_DEVICE_TABLE(hid, alps_id);
801 
802 static struct hid_driver alps_driver = {
803 	.name = "hid-alps",
804 	.id_table		= alps_id,
805 	.probe			= alps_probe,
806 	.remove			= alps_remove,
807 	.raw_event		= alps_raw_event,
808 	.input_mapping		= alps_input_mapping,
809 	.input_configured	= alps_input_configured,
810 #ifdef CONFIG_PM
811 	.resume			= alps_post_resume,
812 	.reset_resume		= alps_post_reset,
813 #endif
814 };
815 
816 module_hid_driver(alps_driver);
817 
818 MODULE_AUTHOR("Masaki Ota <masaki.ota@jp.alps.com>");
819 MODULE_DESCRIPTION("ALPS HID driver");
820 MODULE_LICENSE("GPL");
821