1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*-
3 * Finger Sensing Pad PS/2 mouse driver.
4 *
5 * Copyright (C) 2005-2007 Asia Vital Components Co., Ltd.
6 * Copyright (C) 2005-2012 Tai-hwa Liang, Sentelic Corporation.
7 */
8
9 #include <linux/module.h>
10 #include <linux/input.h>
11 #include <linux/input/mt.h>
12 #include <linux/ctype.h>
13 #include <linux/libps2.h>
14 #include <linux/serio.h>
15 #include <linux/jiffies.h>
16 #include <linux/slab.h>
17
18 #include "psmouse.h"
19 #include "sentelic.h"
20
21 /*
22 * Timeout for FSP PS/2 command only (in milliseconds).
23 */
24 #define FSP_CMD_TIMEOUT 200
25 #define FSP_CMD_TIMEOUT2 30
26
27 #define GET_ABS_X(packet) ((packet[1] << 2) | ((packet[3] >> 2) & 0x03))
28 #define GET_ABS_Y(packet) ((packet[2] << 2) | (packet[3] & 0x03))
29
30 /** Driver version. */
31 static const char fsp_drv_ver[] = "1.1.0-K";
32
33 /*
34 * Make sure that the value being sent to FSP will not conflict with
35 * possible sample rate values.
36 */
fsp_test_swap_cmd(unsigned char reg_val)37 static unsigned char fsp_test_swap_cmd(unsigned char reg_val)
38 {
39 switch (reg_val) {
40 case 10: case 20: case 40: case 60: case 80: case 100: case 200:
41 /*
42 * The requested value being sent to FSP matched to possible
43 * sample rates, swap the given value such that the hardware
44 * wouldn't get confused.
45 */
46 return (reg_val >> 4) | (reg_val << 4);
47 default:
48 return reg_val; /* swap isn't necessary */
49 }
50 }
51
52 /*
53 * Make sure that the value being sent to FSP will not conflict with certain
54 * commands.
55 */
fsp_test_invert_cmd(unsigned char reg_val)56 static unsigned char fsp_test_invert_cmd(unsigned char reg_val)
57 {
58 switch (reg_val) {
59 case 0xe9: case 0xee: case 0xf2: case 0xff:
60 /*
61 * The requested value being sent to FSP matched to certain
62 * commands, inverse the given value such that the hardware
63 * wouldn't get confused.
64 */
65 return ~reg_val;
66 default:
67 return reg_val; /* inversion isn't necessary */
68 }
69 }
70
fsp_reg_read(struct psmouse * psmouse,int reg_addr,int * reg_val)71 static int fsp_reg_read(struct psmouse *psmouse, int reg_addr, int *reg_val)
72 {
73 struct ps2dev *ps2dev = &psmouse->ps2dev;
74 unsigned char param[3];
75 unsigned char addr;
76 int rc = -1;
77
78 /*
79 * We need to shut off the device and switch it into command
80 * mode so we don't confuse our protocol handler. We don't need
81 * to do that for writes because sysfs set helper does this for
82 * us.
83 */
84 psmouse_deactivate(psmouse);
85
86 ps2_begin_command(ps2dev);
87
88 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
89 goto out;
90
91 /* should return 0xfe(request for resending) */
92 ps2_sendbyte(ps2dev, 0x66, FSP_CMD_TIMEOUT2);
93 /* should return 0xfc(failed) */
94 ps2_sendbyte(ps2dev, 0x88, FSP_CMD_TIMEOUT2);
95
96 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
97 goto out;
98
99 if ((addr = fsp_test_invert_cmd(reg_addr)) != reg_addr) {
100 ps2_sendbyte(ps2dev, 0x68, FSP_CMD_TIMEOUT2);
101 } else if ((addr = fsp_test_swap_cmd(reg_addr)) != reg_addr) {
102 /* swapping is required */
103 ps2_sendbyte(ps2dev, 0xcc, FSP_CMD_TIMEOUT2);
104 /* expect 0xfe */
105 } else {
106 /* swapping isn't necessary */
107 ps2_sendbyte(ps2dev, 0x66, FSP_CMD_TIMEOUT2);
108 /* expect 0xfe */
109 }
110 /* should return 0xfc(failed) */
111 ps2_sendbyte(ps2dev, addr, FSP_CMD_TIMEOUT);
112
113 if (__ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO) < 0)
114 goto out;
115
116 *reg_val = param[2];
117 rc = 0;
118
119 out:
120 ps2_end_command(ps2dev);
121 psmouse_activate(psmouse);
122 psmouse_dbg(psmouse,
123 "READ REG: 0x%02x is 0x%02x (rc = %d)\n",
124 reg_addr, *reg_val, rc);
125 return rc;
126 }
127
fsp_reg_write(struct psmouse * psmouse,int reg_addr,int reg_val)128 static int fsp_reg_write(struct psmouse *psmouse, int reg_addr, int reg_val)
129 {
130 struct ps2dev *ps2dev = &psmouse->ps2dev;
131 unsigned char v;
132 int rc = -1;
133
134 ps2_begin_command(ps2dev);
135
136 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
137 goto out;
138
139 if ((v = fsp_test_invert_cmd(reg_addr)) != reg_addr) {
140 /* inversion is required */
141 ps2_sendbyte(ps2dev, 0x74, FSP_CMD_TIMEOUT2);
142 } else {
143 if ((v = fsp_test_swap_cmd(reg_addr)) != reg_addr) {
144 /* swapping is required */
145 ps2_sendbyte(ps2dev, 0x77, FSP_CMD_TIMEOUT2);
146 } else {
147 /* swapping isn't necessary */
148 ps2_sendbyte(ps2dev, 0x55, FSP_CMD_TIMEOUT2);
149 }
150 }
151 /* write the register address in correct order */
152 ps2_sendbyte(ps2dev, v, FSP_CMD_TIMEOUT2);
153
154 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
155 goto out;
156
157 if ((v = fsp_test_invert_cmd(reg_val)) != reg_val) {
158 /* inversion is required */
159 ps2_sendbyte(ps2dev, 0x47, FSP_CMD_TIMEOUT2);
160 } else if ((v = fsp_test_swap_cmd(reg_val)) != reg_val) {
161 /* swapping is required */
162 ps2_sendbyte(ps2dev, 0x44, FSP_CMD_TIMEOUT2);
163 } else {
164 /* swapping isn't necessary */
165 ps2_sendbyte(ps2dev, 0x33, FSP_CMD_TIMEOUT2);
166 }
167
168 /* write the register value in correct order */
169 ps2_sendbyte(ps2dev, v, FSP_CMD_TIMEOUT2);
170 rc = 0;
171
172 out:
173 ps2_end_command(ps2dev);
174 psmouse_dbg(psmouse,
175 "WRITE REG: 0x%02x to 0x%02x (rc = %d)\n",
176 reg_addr, reg_val, rc);
177 return rc;
178 }
179
180 /* Enable register clock gating for writing certain registers */
fsp_reg_write_enable(struct psmouse * psmouse,bool enable)181 static int fsp_reg_write_enable(struct psmouse *psmouse, bool enable)
182 {
183 int v, nv;
184
185 if (fsp_reg_read(psmouse, FSP_REG_SYSCTL1, &v) == -1)
186 return -1;
187
188 if (enable)
189 nv = v | FSP_BIT_EN_REG_CLK;
190 else
191 nv = v & ~FSP_BIT_EN_REG_CLK;
192
193 /* only write if necessary */
194 if (nv != v)
195 if (fsp_reg_write(psmouse, FSP_REG_SYSCTL1, nv) == -1)
196 return -1;
197
198 return 0;
199 }
200
fsp_page_reg_read(struct psmouse * psmouse,int * reg_val)201 static int fsp_page_reg_read(struct psmouse *psmouse, int *reg_val)
202 {
203 struct ps2dev *ps2dev = &psmouse->ps2dev;
204 unsigned char param[3];
205 int rc = -1;
206
207 psmouse_deactivate(psmouse);
208
209 ps2_begin_command(ps2dev);
210
211 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
212 goto out;
213
214 ps2_sendbyte(ps2dev, 0x66, FSP_CMD_TIMEOUT2);
215 ps2_sendbyte(ps2dev, 0x88, FSP_CMD_TIMEOUT2);
216
217 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
218 goto out;
219
220 ps2_sendbyte(ps2dev, 0x83, FSP_CMD_TIMEOUT2);
221 ps2_sendbyte(ps2dev, 0x88, FSP_CMD_TIMEOUT2);
222
223 /* get the returned result */
224 if (__ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO))
225 goto out;
226
227 *reg_val = param[2];
228 rc = 0;
229
230 out:
231 ps2_end_command(ps2dev);
232 psmouse_activate(psmouse);
233 psmouse_dbg(psmouse,
234 "READ PAGE REG: 0x%02x (rc = %d)\n",
235 *reg_val, rc);
236 return rc;
237 }
238
fsp_page_reg_write(struct psmouse * psmouse,int reg_val)239 static int fsp_page_reg_write(struct psmouse *psmouse, int reg_val)
240 {
241 struct ps2dev *ps2dev = &psmouse->ps2dev;
242 unsigned char v;
243 int rc = -1;
244
245 ps2_begin_command(ps2dev);
246
247 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
248 goto out;
249
250 ps2_sendbyte(ps2dev, 0x38, FSP_CMD_TIMEOUT2);
251 ps2_sendbyte(ps2dev, 0x88, FSP_CMD_TIMEOUT2);
252
253 if (ps2_sendbyte(ps2dev, 0xf3, FSP_CMD_TIMEOUT) < 0)
254 goto out;
255
256 if ((v = fsp_test_invert_cmd(reg_val)) != reg_val) {
257 ps2_sendbyte(ps2dev, 0x47, FSP_CMD_TIMEOUT2);
258 } else if ((v = fsp_test_swap_cmd(reg_val)) != reg_val) {
259 /* swapping is required */
260 ps2_sendbyte(ps2dev, 0x44, FSP_CMD_TIMEOUT2);
261 } else {
262 /* swapping isn't necessary */
263 ps2_sendbyte(ps2dev, 0x33, FSP_CMD_TIMEOUT2);
264 }
265
266 ps2_sendbyte(ps2dev, v, FSP_CMD_TIMEOUT2);
267 rc = 0;
268
269 out:
270 ps2_end_command(ps2dev);
271 psmouse_dbg(psmouse,
272 "WRITE PAGE REG: to 0x%02x (rc = %d)\n",
273 reg_val, rc);
274 return rc;
275 }
276
fsp_get_version(struct psmouse * psmouse,int * version)277 static int fsp_get_version(struct psmouse *psmouse, int *version)
278 {
279 if (fsp_reg_read(psmouse, FSP_REG_VERSION, version))
280 return -EIO;
281
282 return 0;
283 }
284
fsp_get_revision(struct psmouse * psmouse,int * rev)285 static int fsp_get_revision(struct psmouse *psmouse, int *rev)
286 {
287 if (fsp_reg_read(psmouse, FSP_REG_REVISION, rev))
288 return -EIO;
289
290 return 0;
291 }
292
fsp_get_sn(struct psmouse * psmouse,int * sn)293 static int fsp_get_sn(struct psmouse *psmouse, int *sn)
294 {
295 int v0, v1, v2;
296 int rc = -EIO;
297
298 /* production number since Cx is available at: 0x0b40 ~ 0x0b42 */
299 if (fsp_page_reg_write(psmouse, FSP_PAGE_0B))
300 goto out;
301 if (fsp_reg_read(psmouse, FSP_REG_SN0, &v0))
302 goto out;
303 if (fsp_reg_read(psmouse, FSP_REG_SN1, &v1))
304 goto out;
305 if (fsp_reg_read(psmouse, FSP_REG_SN2, &v2))
306 goto out;
307 *sn = (v0 << 16) | (v1 << 8) | v2;
308 rc = 0;
309 out:
310 fsp_page_reg_write(psmouse, FSP_PAGE_DEFAULT);
311 return rc;
312 }
313
fsp_get_buttons(struct psmouse * psmouse,int * btn)314 static int fsp_get_buttons(struct psmouse *psmouse, int *btn)
315 {
316 static const int buttons[] = {
317 0x16, /* Left/Middle/Right/Forward/Backward & Scroll Up/Down */
318 0x06, /* Left/Middle/Right & Scroll Up/Down/Right/Left */
319 0x04, /* Left/Middle/Right & Scroll Up/Down */
320 0x02, /* Left/Middle/Right */
321 };
322 int val;
323
324 if (fsp_reg_read(psmouse, FSP_REG_TMOD_STATUS, &val) == -1)
325 return -EIO;
326
327 *btn = buttons[(val & 0x30) >> 4];
328 return 0;
329 }
330
331 /* Enable on-pad command tag output */
fsp_opc_tag_enable(struct psmouse * psmouse,bool enable)332 static int fsp_opc_tag_enable(struct psmouse *psmouse, bool enable)
333 {
334 int v, nv;
335 int res = 0;
336
337 if (fsp_reg_read(psmouse, FSP_REG_OPC_QDOWN, &v) == -1) {
338 psmouse_err(psmouse, "Unable get OPC state.\n");
339 return -EIO;
340 }
341
342 if (enable)
343 nv = v | FSP_BIT_EN_OPC_TAG;
344 else
345 nv = v & ~FSP_BIT_EN_OPC_TAG;
346
347 /* only write if necessary */
348 if (nv != v) {
349 fsp_reg_write_enable(psmouse, true);
350 res = fsp_reg_write(psmouse, FSP_REG_OPC_QDOWN, nv);
351 fsp_reg_write_enable(psmouse, false);
352 }
353
354 if (res != 0) {
355 psmouse_err(psmouse, "Unable to enable OPC tag.\n");
356 res = -EIO;
357 }
358
359 return res;
360 }
361
fsp_onpad_vscr(struct psmouse * psmouse,bool enable)362 static int fsp_onpad_vscr(struct psmouse *psmouse, bool enable)
363 {
364 struct fsp_data *pad = psmouse->private;
365 int val;
366
367 if (fsp_reg_read(psmouse, FSP_REG_ONPAD_CTL, &val))
368 return -EIO;
369
370 pad->vscroll = enable;
371
372 if (enable)
373 val |= (FSP_BIT_FIX_VSCR | FSP_BIT_ONPAD_ENABLE);
374 else
375 val &= ~FSP_BIT_FIX_VSCR;
376
377 if (fsp_reg_write(psmouse, FSP_REG_ONPAD_CTL, val))
378 return -EIO;
379
380 return 0;
381 }
382
fsp_onpad_hscr(struct psmouse * psmouse,bool enable)383 static int fsp_onpad_hscr(struct psmouse *psmouse, bool enable)
384 {
385 struct fsp_data *pad = psmouse->private;
386 int val, v2;
387
388 if (fsp_reg_read(psmouse, FSP_REG_ONPAD_CTL, &val))
389 return -EIO;
390
391 if (fsp_reg_read(psmouse, FSP_REG_SYSCTL5, &v2))
392 return -EIO;
393
394 pad->hscroll = enable;
395
396 if (enable) {
397 val |= (FSP_BIT_FIX_HSCR | FSP_BIT_ONPAD_ENABLE);
398 v2 |= FSP_BIT_EN_MSID6;
399 } else {
400 val &= ~FSP_BIT_FIX_HSCR;
401 v2 &= ~(FSP_BIT_EN_MSID6 | FSP_BIT_EN_MSID7 | FSP_BIT_EN_MSID8);
402 }
403
404 if (fsp_reg_write(psmouse, FSP_REG_ONPAD_CTL, val))
405 return -EIO;
406
407 /* reconfigure horizontal scrolling packet output */
408 if (fsp_reg_write(psmouse, FSP_REG_SYSCTL5, v2))
409 return -EIO;
410
411 return 0;
412 }
413
414 /*
415 * Write device specific initial parameters.
416 *
417 * ex: 0xab 0xcd - write oxcd into register 0xab
418 */
fsp_attr_set_setreg(struct psmouse * psmouse,void * data,const char * buf,size_t count)419 static ssize_t fsp_attr_set_setreg(struct psmouse *psmouse, void *data,
420 const char *buf, size_t count)
421 {
422 unsigned int reg, val;
423 char *rest;
424 ssize_t retval;
425
426 reg = simple_strtoul(buf, &rest, 16);
427 if (rest == buf || *rest != ' ' || reg > 0xff)
428 return -EINVAL;
429
430 retval = kstrtouint(rest + 1, 16, &val);
431 if (retval)
432 return retval;
433
434 if (val > 0xff)
435 return -EINVAL;
436
437 if (fsp_reg_write_enable(psmouse, true))
438 return -EIO;
439
440 retval = fsp_reg_write(psmouse, reg, val) < 0 ? -EIO : count;
441
442 fsp_reg_write_enable(psmouse, false);
443
444 return retval;
445 }
446
447 PSMOUSE_DEFINE_WO_ATTR(setreg, S_IWUSR, NULL, fsp_attr_set_setreg);
448
fsp_attr_show_getreg(struct psmouse * psmouse,void * data,char * buf)449 static ssize_t fsp_attr_show_getreg(struct psmouse *psmouse,
450 void *data, char *buf)
451 {
452 struct fsp_data *pad = psmouse->private;
453
454 return sprintf(buf, "%02x%02x\n", pad->last_reg, pad->last_val);
455 }
456
457 /*
458 * Read a register from device.
459 *
460 * ex: 0xab -- read content from register 0xab
461 */
fsp_attr_set_getreg(struct psmouse * psmouse,void * data,const char * buf,size_t count)462 static ssize_t fsp_attr_set_getreg(struct psmouse *psmouse, void *data,
463 const char *buf, size_t count)
464 {
465 struct fsp_data *pad = psmouse->private;
466 unsigned int reg, val;
467 int err;
468
469 err = kstrtouint(buf, 16, ®);
470 if (err)
471 return err;
472
473 if (reg > 0xff)
474 return -EINVAL;
475
476 if (fsp_reg_read(psmouse, reg, &val))
477 return -EIO;
478
479 pad->last_reg = reg;
480 pad->last_val = val;
481
482 return count;
483 }
484
485 PSMOUSE_DEFINE_ATTR(getreg, S_IWUSR | S_IRUGO, NULL,
486 fsp_attr_show_getreg, fsp_attr_set_getreg);
487
fsp_attr_show_pagereg(struct psmouse * psmouse,void * data,char * buf)488 static ssize_t fsp_attr_show_pagereg(struct psmouse *psmouse,
489 void *data, char *buf)
490 {
491 int val = 0;
492
493 if (fsp_page_reg_read(psmouse, &val))
494 return -EIO;
495
496 return sprintf(buf, "%02x\n", val);
497 }
498
fsp_attr_set_pagereg(struct psmouse * psmouse,void * data,const char * buf,size_t count)499 static ssize_t fsp_attr_set_pagereg(struct psmouse *psmouse, void *data,
500 const char *buf, size_t count)
501 {
502 unsigned int val;
503 int err;
504
505 err = kstrtouint(buf, 16, &val);
506 if (err)
507 return err;
508
509 if (val > 0xff)
510 return -EINVAL;
511
512 if (fsp_page_reg_write(psmouse, val))
513 return -EIO;
514
515 return count;
516 }
517
518 PSMOUSE_DEFINE_ATTR(page, S_IWUSR | S_IRUGO, NULL,
519 fsp_attr_show_pagereg, fsp_attr_set_pagereg);
520
fsp_attr_show_vscroll(struct psmouse * psmouse,void * data,char * buf)521 static ssize_t fsp_attr_show_vscroll(struct psmouse *psmouse,
522 void *data, char *buf)
523 {
524 struct fsp_data *pad = psmouse->private;
525
526 return sprintf(buf, "%d\n", pad->vscroll);
527 }
528
fsp_attr_set_vscroll(struct psmouse * psmouse,void * data,const char * buf,size_t count)529 static ssize_t fsp_attr_set_vscroll(struct psmouse *psmouse, void *data,
530 const char *buf, size_t count)
531 {
532 unsigned int val;
533 int err;
534
535 err = kstrtouint(buf, 10, &val);
536 if (err)
537 return err;
538
539 if (val > 1)
540 return -EINVAL;
541
542 fsp_onpad_vscr(psmouse, val);
543
544 return count;
545 }
546
547 PSMOUSE_DEFINE_ATTR(vscroll, S_IWUSR | S_IRUGO, NULL,
548 fsp_attr_show_vscroll, fsp_attr_set_vscroll);
549
fsp_attr_show_hscroll(struct psmouse * psmouse,void * data,char * buf)550 static ssize_t fsp_attr_show_hscroll(struct psmouse *psmouse,
551 void *data, char *buf)
552 {
553 struct fsp_data *pad = psmouse->private;
554
555 return sprintf(buf, "%d\n", pad->hscroll);
556 }
557
fsp_attr_set_hscroll(struct psmouse * psmouse,void * data,const char * buf,size_t count)558 static ssize_t fsp_attr_set_hscroll(struct psmouse *psmouse, void *data,
559 const char *buf, size_t count)
560 {
561 unsigned int val;
562 int err;
563
564 err = kstrtouint(buf, 10, &val);
565 if (err)
566 return err;
567
568 if (val > 1)
569 return -EINVAL;
570
571 fsp_onpad_hscr(psmouse, val);
572
573 return count;
574 }
575
576 PSMOUSE_DEFINE_ATTR(hscroll, S_IWUSR | S_IRUGO, NULL,
577 fsp_attr_show_hscroll, fsp_attr_set_hscroll);
578
fsp_attr_show_flags(struct psmouse * psmouse,void * data,char * buf)579 static ssize_t fsp_attr_show_flags(struct psmouse *psmouse,
580 void *data, char *buf)
581 {
582 struct fsp_data *pad = psmouse->private;
583
584 return sprintf(buf, "%c\n",
585 pad->flags & FSPDRV_FLAG_EN_OPC ? 'C' : 'c');
586 }
587
fsp_attr_set_flags(struct psmouse * psmouse,void * data,const char * buf,size_t count)588 static ssize_t fsp_attr_set_flags(struct psmouse *psmouse, void *data,
589 const char *buf, size_t count)
590 {
591 struct fsp_data *pad = psmouse->private;
592 size_t i;
593
594 for (i = 0; i < count; i++) {
595 switch (buf[i]) {
596 case 'C':
597 pad->flags |= FSPDRV_FLAG_EN_OPC;
598 break;
599 case 'c':
600 pad->flags &= ~FSPDRV_FLAG_EN_OPC;
601 break;
602 default:
603 return -EINVAL;
604 }
605 }
606 return count;
607 }
608
609 PSMOUSE_DEFINE_ATTR(flags, S_IWUSR | S_IRUGO, NULL,
610 fsp_attr_show_flags, fsp_attr_set_flags);
611
fsp_attr_show_ver(struct psmouse * psmouse,void * data,char * buf)612 static ssize_t fsp_attr_show_ver(struct psmouse *psmouse,
613 void *data, char *buf)
614 {
615 return sprintf(buf, "Sentelic FSP kernel module %s\n", fsp_drv_ver);
616 }
617
618 PSMOUSE_DEFINE_RO_ATTR(ver, S_IRUGO, NULL, fsp_attr_show_ver);
619
620 static struct attribute *fsp_attributes[] = {
621 &psmouse_attr_setreg.dattr.attr,
622 &psmouse_attr_getreg.dattr.attr,
623 &psmouse_attr_page.dattr.attr,
624 &psmouse_attr_vscroll.dattr.attr,
625 &psmouse_attr_hscroll.dattr.attr,
626 &psmouse_attr_flags.dattr.attr,
627 &psmouse_attr_ver.dattr.attr,
628 NULL
629 };
630
631 static struct attribute_group fsp_attribute_group = {
632 .attrs = fsp_attributes,
633 };
634
635 #ifdef FSP_DEBUG
fsp_packet_debug(struct psmouse * psmouse,unsigned char packet[])636 static void fsp_packet_debug(struct psmouse *psmouse, unsigned char packet[])
637 {
638 static unsigned int ps2_packet_cnt;
639 static unsigned int ps2_last_second;
640 unsigned int jiffies_msec;
641 const char *packet_type = "UNKNOWN";
642 unsigned short abs_x = 0, abs_y = 0;
643
644 /* Interpret & dump the packet data. */
645 switch (packet[0] >> FSP_PKT_TYPE_SHIFT) {
646 case FSP_PKT_TYPE_ABS:
647 packet_type = "Absolute";
648 abs_x = GET_ABS_X(packet);
649 abs_y = GET_ABS_Y(packet);
650 break;
651 case FSP_PKT_TYPE_NORMAL:
652 packet_type = "Normal";
653 break;
654 case FSP_PKT_TYPE_NOTIFY:
655 packet_type = "Notify";
656 break;
657 case FSP_PKT_TYPE_NORMAL_OPC:
658 packet_type = "Normal-OPC";
659 break;
660 }
661
662 ps2_packet_cnt++;
663 jiffies_msec = jiffies_to_msecs(jiffies);
664 psmouse_dbg(psmouse,
665 "%08dms %s packets: %02x, %02x, %02x, %02x; "
666 "abs_x: %d, abs_y: %d\n",
667 jiffies_msec, packet_type,
668 packet[0], packet[1], packet[2], packet[3], abs_x, abs_y);
669
670 if (jiffies_msec - ps2_last_second > 1000) {
671 psmouse_dbg(psmouse, "PS/2 packets/sec = %d\n", ps2_packet_cnt);
672 ps2_packet_cnt = 0;
673 ps2_last_second = jiffies_msec;
674 }
675 }
676 #else
fsp_packet_debug(struct psmouse * psmouse,unsigned char packet[])677 static void fsp_packet_debug(struct psmouse *psmouse, unsigned char packet[])
678 {
679 }
680 #endif
681
fsp_set_slot(struct input_dev * dev,int slot,bool active,unsigned int x,unsigned int y)682 static void fsp_set_slot(struct input_dev *dev, int slot, bool active,
683 unsigned int x, unsigned int y)
684 {
685 input_mt_slot(dev, slot);
686 input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
687 if (active) {
688 input_report_abs(dev, ABS_MT_POSITION_X, x);
689 input_report_abs(dev, ABS_MT_POSITION_Y, y);
690 }
691 }
692
fsp_process_byte(struct psmouse * psmouse)693 static psmouse_ret_t fsp_process_byte(struct psmouse *psmouse)
694 {
695 struct input_dev *dev = psmouse->dev;
696 struct fsp_data *ad = psmouse->private;
697 unsigned char *packet = psmouse->packet;
698 unsigned char button_status = 0, lscroll = 0, rscroll = 0;
699 unsigned short abs_x, abs_y, fgrs = 0;
700
701 if (psmouse->pktcnt < 4)
702 return PSMOUSE_GOOD_DATA;
703
704 /*
705 * Full packet accumulated, process it
706 */
707
708 fsp_packet_debug(psmouse, packet);
709
710 switch (psmouse->packet[0] >> FSP_PKT_TYPE_SHIFT) {
711 case FSP_PKT_TYPE_ABS:
712
713 if ((packet[0] == 0x48 || packet[0] == 0x49) &&
714 packet[1] == 0 && packet[2] == 0) {
715 /*
716 * Ignore coordinate noise when finger leaving the
717 * surface, otherwise cursor may jump to upper-left
718 * corner.
719 */
720 packet[3] &= 0xf0;
721 }
722
723 abs_x = GET_ABS_X(packet);
724 abs_y = GET_ABS_Y(packet);
725
726 if (packet[0] & FSP_PB0_MFMC) {
727 /*
728 * MFMC packet: assume that there are two fingers on
729 * pad
730 */
731 fgrs = 2;
732
733 /* MFMC packet */
734 if (packet[0] & FSP_PB0_MFMC_FGR2) {
735 /* 2nd finger */
736 if (ad->last_mt_fgr == 2) {
737 /*
738 * workaround for buggy firmware
739 * which doesn't clear MFMC bit if
740 * the 1st finger is up
741 */
742 fgrs = 1;
743 fsp_set_slot(dev, 0, false, 0, 0);
744 }
745 ad->last_mt_fgr = 2;
746
747 fsp_set_slot(dev, 1, fgrs == 2, abs_x, abs_y);
748 } else {
749 /* 1st finger */
750 if (ad->last_mt_fgr == 1) {
751 /*
752 * workaround for buggy firmware
753 * which doesn't clear MFMC bit if
754 * the 2nd finger is up
755 */
756 fgrs = 1;
757 fsp_set_slot(dev, 1, false, 0, 0);
758 }
759 ad->last_mt_fgr = 1;
760 fsp_set_slot(dev, 0, fgrs != 0, abs_x, abs_y);
761 }
762 } else {
763 /* SFAC packet */
764 if ((packet[0] & (FSP_PB0_LBTN|FSP_PB0_PHY_BTN)) ==
765 FSP_PB0_LBTN) {
766 /* On-pad click in SFAC mode should be handled
767 * by userspace. On-pad clicks in MFMC mode
768 * are real clickpad clicks, and not ignored.
769 */
770 packet[0] &= ~FSP_PB0_LBTN;
771 }
772
773 /* no multi-finger information */
774 ad->last_mt_fgr = 0;
775
776 if (abs_x != 0 && abs_y != 0)
777 fgrs = 1;
778
779 fsp_set_slot(dev, 0, fgrs > 0, abs_x, abs_y);
780 fsp_set_slot(dev, 1, false, 0, 0);
781 }
782 if (fgrs == 1 || (fgrs == 2 && !(packet[0] & FSP_PB0_MFMC_FGR2))) {
783 input_report_abs(dev, ABS_X, abs_x);
784 input_report_abs(dev, ABS_Y, abs_y);
785 }
786 input_report_key(dev, BTN_LEFT, packet[0] & 0x01);
787 input_report_key(dev, BTN_RIGHT, packet[0] & 0x02);
788 input_report_key(dev, BTN_TOUCH, fgrs);
789 input_report_key(dev, BTN_TOOL_FINGER, fgrs == 1);
790 input_report_key(dev, BTN_TOOL_DOUBLETAP, fgrs == 2);
791 break;
792
793 case FSP_PKT_TYPE_NORMAL_OPC:
794 /* on-pad click, filter it if necessary */
795 if ((ad->flags & FSPDRV_FLAG_EN_OPC) != FSPDRV_FLAG_EN_OPC)
796 packet[0] &= ~FSP_PB0_LBTN;
797 fallthrough;
798
799 case FSP_PKT_TYPE_NORMAL:
800 /* normal packet */
801 /* special packet data translation from on-pad packets */
802 if (packet[3] != 0) {
803 if (packet[3] & BIT(0))
804 button_status |= 0x01; /* wheel down */
805 if (packet[3] & BIT(1))
806 button_status |= 0x0f; /* wheel up */
807 if (packet[3] & BIT(2))
808 button_status |= BIT(4);/* horizontal left */
809 if (packet[3] & BIT(3))
810 button_status |= BIT(5);/* horizontal right */
811 /* push back to packet queue */
812 if (button_status != 0)
813 packet[3] = button_status;
814 rscroll = (packet[3] >> 4) & 1;
815 lscroll = (packet[3] >> 5) & 1;
816 }
817 /*
818 * Processing wheel up/down and extra button events
819 */
820 input_report_rel(dev, REL_WHEEL,
821 (int)(packet[3] & 8) - (int)(packet[3] & 7));
822 input_report_rel(dev, REL_HWHEEL, lscroll - rscroll);
823 input_report_key(dev, BTN_BACK, lscroll);
824 input_report_key(dev, BTN_FORWARD, rscroll);
825
826 /*
827 * Standard PS/2 Mouse
828 */
829 psmouse_report_standard_packet(dev, packet);
830 break;
831 }
832
833 input_sync(dev);
834
835 return PSMOUSE_FULL_PACKET;
836 }
837
fsp_activate_protocol(struct psmouse * psmouse)838 static int fsp_activate_protocol(struct psmouse *psmouse)
839 {
840 struct fsp_data *pad = psmouse->private;
841 struct ps2dev *ps2dev = &psmouse->ps2dev;
842 unsigned char param[2];
843 int val;
844
845 /*
846 * Standard procedure to enter FSP Intellimouse mode
847 * (scrolling wheel, 4th and 5th buttons)
848 */
849 param[0] = 200;
850 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE);
851 param[0] = 200;
852 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE);
853 param[0] = 80;
854 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE);
855
856 ps2_command(ps2dev, param, PSMOUSE_CMD_GETID);
857 if (param[0] != 0x04) {
858 psmouse_err(psmouse,
859 "Unable to enable 4 bytes packet format.\n");
860 return -EIO;
861 }
862
863 if (pad->ver < FSP_VER_STL3888_C0) {
864 /* Preparing relative coordinates output for older hardware */
865 if (fsp_reg_read(psmouse, FSP_REG_SYSCTL5, &val)) {
866 psmouse_err(psmouse,
867 "Unable to read SYSCTL5 register.\n");
868 return -EIO;
869 }
870
871 if (fsp_get_buttons(psmouse, &pad->buttons)) {
872 psmouse_err(psmouse,
873 "Unable to retrieve number of buttons.\n");
874 return -EIO;
875 }
876
877 val &= ~(FSP_BIT_EN_MSID7 | FSP_BIT_EN_MSID8 | FSP_BIT_EN_AUTO_MSID8);
878 /* Ensure we are not in absolute mode */
879 val &= ~FSP_BIT_EN_PKT_G0;
880 if (pad->buttons == 0x06) {
881 /* Left/Middle/Right & Scroll Up/Down/Right/Left */
882 val |= FSP_BIT_EN_MSID6;
883 }
884
885 if (fsp_reg_write(psmouse, FSP_REG_SYSCTL5, val)) {
886 psmouse_err(psmouse,
887 "Unable to set up required mode bits.\n");
888 return -EIO;
889 }
890
891 /*
892 * Enable OPC tags such that driver can tell the difference
893 * between on-pad and real button click
894 */
895 if (fsp_opc_tag_enable(psmouse, true))
896 psmouse_warn(psmouse,
897 "Failed to enable OPC tag mode.\n");
898 /* enable on-pad click by default */
899 pad->flags |= FSPDRV_FLAG_EN_OPC;
900
901 /* Enable on-pad vertical and horizontal scrolling */
902 fsp_onpad_vscr(psmouse, true);
903 fsp_onpad_hscr(psmouse, true);
904 } else {
905 /* Enable absolute coordinates output for Cx/Dx hardware */
906 if (fsp_reg_write(psmouse, FSP_REG_SWC1,
907 FSP_BIT_SWC1_EN_ABS_1F |
908 FSP_BIT_SWC1_EN_ABS_2F |
909 FSP_BIT_SWC1_EN_FUP_OUT |
910 FSP_BIT_SWC1_EN_ABS_CON)) {
911 psmouse_err(psmouse,
912 "Unable to enable absolute coordinates output.\n");
913 return -EIO;
914 }
915 }
916
917 return 0;
918 }
919
fsp_set_input_params(struct psmouse * psmouse)920 static int fsp_set_input_params(struct psmouse *psmouse)
921 {
922 struct input_dev *dev = psmouse->dev;
923 struct fsp_data *pad = psmouse->private;
924
925 if (pad->ver < FSP_VER_STL3888_C0) {
926 __set_bit(BTN_MIDDLE, dev->keybit);
927 __set_bit(BTN_BACK, dev->keybit);
928 __set_bit(BTN_FORWARD, dev->keybit);
929 __set_bit(REL_WHEEL, dev->relbit);
930 __set_bit(REL_HWHEEL, dev->relbit);
931 } else {
932 /*
933 * Hardware prior to Cx performs much better in relative mode;
934 * hence, only enable absolute coordinates output as well as
935 * multi-touch output for the newer hardware.
936 *
937 * Maximum coordinates can be computed as:
938 *
939 * number of scanlines * 64 - 57
940 *
941 * where number of X/Y scanline lines are 16/12.
942 */
943 int abs_x = 967, abs_y = 711;
944
945 __set_bit(EV_ABS, dev->evbit);
946 __clear_bit(EV_REL, dev->evbit);
947 __set_bit(BTN_TOUCH, dev->keybit);
948 __set_bit(BTN_TOOL_FINGER, dev->keybit);
949 __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
950 __set_bit(INPUT_PROP_SEMI_MT, dev->propbit);
951
952 input_set_abs_params(dev, ABS_X, 0, abs_x, 0, 0);
953 input_set_abs_params(dev, ABS_Y, 0, abs_y, 0, 0);
954 input_mt_init_slots(dev, 2, 0);
955 input_set_abs_params(dev, ABS_MT_POSITION_X, 0, abs_x, 0, 0);
956 input_set_abs_params(dev, ABS_MT_POSITION_Y, 0, abs_y, 0, 0);
957 }
958
959 return 0;
960 }
961
fsp_detect(struct psmouse * psmouse,bool set_properties)962 int fsp_detect(struct psmouse *psmouse, bool set_properties)
963 {
964 int id;
965
966 if (fsp_reg_read(psmouse, FSP_REG_DEVICE_ID, &id))
967 return -EIO;
968
969 if (id != 0x01)
970 return -ENODEV;
971
972 if (set_properties) {
973 psmouse->vendor = "Sentelic";
974 psmouse->name = "FingerSensingPad";
975 }
976
977 return 0;
978 }
979
fsp_reset(struct psmouse * psmouse)980 static void fsp_reset(struct psmouse *psmouse)
981 {
982 fsp_opc_tag_enable(psmouse, false);
983 fsp_onpad_vscr(psmouse, false);
984 fsp_onpad_hscr(psmouse, false);
985 }
986
fsp_disconnect(struct psmouse * psmouse)987 static void fsp_disconnect(struct psmouse *psmouse)
988 {
989 sysfs_remove_group(&psmouse->ps2dev.serio->dev.kobj,
990 &fsp_attribute_group);
991
992 fsp_reset(psmouse);
993 kfree(psmouse->private);
994 }
995
fsp_reconnect(struct psmouse * psmouse)996 static int fsp_reconnect(struct psmouse *psmouse)
997 {
998 int version;
999
1000 if (fsp_detect(psmouse, 0))
1001 return -ENODEV;
1002
1003 if (fsp_get_version(psmouse, &version))
1004 return -ENODEV;
1005
1006 if (fsp_activate_protocol(psmouse))
1007 return -EIO;
1008
1009 return 0;
1010 }
1011
fsp_init(struct psmouse * psmouse)1012 int fsp_init(struct psmouse *psmouse)
1013 {
1014 struct fsp_data *priv;
1015 int ver, rev, sn = 0;
1016 int error;
1017
1018 if (fsp_get_version(psmouse, &ver) ||
1019 fsp_get_revision(psmouse, &rev)) {
1020 return -ENODEV;
1021 }
1022 if (ver >= FSP_VER_STL3888_C0) {
1023 /* firmware information is only available since C0 */
1024 fsp_get_sn(psmouse, &sn);
1025 }
1026
1027 psmouse_info(psmouse,
1028 "Finger Sensing Pad, hw: %d.%d.%d, sn: %x, sw: %s\n",
1029 ver >> 4, ver & 0x0F, rev, sn, fsp_drv_ver);
1030
1031 psmouse->private = priv = kzalloc(sizeof(*priv), GFP_KERNEL);
1032 if (!priv)
1033 return -ENOMEM;
1034
1035 priv->ver = ver;
1036 priv->rev = rev;
1037
1038 psmouse->protocol_handler = fsp_process_byte;
1039 psmouse->disconnect = fsp_disconnect;
1040 psmouse->reconnect = fsp_reconnect;
1041 psmouse->cleanup = fsp_reset;
1042 psmouse->pktsize = 4;
1043
1044 error = fsp_activate_protocol(psmouse);
1045 if (error)
1046 goto err_out;
1047
1048 /* Set up various supported input event bits */
1049 error = fsp_set_input_params(psmouse);
1050 if (error)
1051 goto err_out;
1052
1053 error = sysfs_create_group(&psmouse->ps2dev.serio->dev.kobj,
1054 &fsp_attribute_group);
1055 if (error) {
1056 psmouse_err(psmouse,
1057 "Failed to create sysfs attributes (%d)", error);
1058 goto err_out;
1059 }
1060
1061 return 0;
1062
1063 err_out:
1064 kfree(psmouse->private);
1065 psmouse->private = NULL;
1066 return error;
1067 }
1068