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