synaptics.c revision 1.24 1 /* $NetBSD: synaptics.c,v 1.24 2010/03/21 20:04:43 plunky Exp $ */
2
3 /*
4 * Copyright (c) 2005, Steve C. Woodford
5 * Copyright (c) 2004, Ales Krenek
6 * Copyright (c) 2004, Kentaro A. Kurahone
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 *
13 * * Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * * Redistributions in binary form must reproduce the above
16 * copyright notice, this list of conditions and the following
17 * disclaimer in the documentation and/or other materials provided
18 * with the distribution.
19 * * Neither the name of the authors nor the names of its
20 * contributors may be used to endorse or promote products derived
21 * from this software without specific prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
24 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
25 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
26 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
27 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
28 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
29 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
30 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
33 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34 * POSSIBILITY OF SUCH DAMAGE.
35 *
36 */
37
38 /*
39 * TODO:
40 * - Make the sysctl values per-instance instead of global.
41 * - Consider setting initial scaling factors at runtime according
42 * to the values returned by the 'Read Resolutions' command.
43 * - Support the serial protocol (we only support PS/2 for now)
44 * - Support auto-repeat for up/down button Z-axis emulation.
45 * - Maybe add some more gestures (can we use Palm support somehow?)
46 */
47
48 #include "opt_pms.h"
49
50 #include <sys/cdefs.h>
51 __KERNEL_RCSID(0, "$NetBSD: synaptics.c,v 1.24 2010/03/21 20:04:43 plunky Exp $");
52
53 #include <sys/param.h>
54 #include <sys/systm.h>
55 #include <sys/device.h>
56 #include <sys/ioctl.h>
57 #include <sys/sysctl.h>
58 #include <sys/kernel.h>
59
60 #include <sys/bus.h>
61
62 #include <dev/pckbport/pckbportvar.h>
63
64 #include <dev/pckbport/synapticsreg.h>
65 #include <dev/pckbport/synapticsvar.h>
66
67 #include <dev/pckbport/pmsreg.h>
68 #include <dev/pckbport/pmsvar.h>
69
70 #include <dev/wscons/wsconsio.h>
71 #include <dev/wscons/wsmousevar.h>
72
73 /*
74 * Absolute-mode packets are decoded and passed around using
75 * the following structure.
76 */
77 struct synaptics_packet {
78 signed short sp_x; /* Unscaled absolute X/Y coordinates */
79 signed short sp_y;
80 u_char sp_z; /* Z (pressure) */
81 u_char sp_w; /* W (contact patch width) */
82 char sp_left; /* Left mouse button status */
83 char sp_right; /* Right mouse button status */
84 char sp_middle; /* Middle button status (possibly emulated) */
85 char sp_up; /* Up button status */
86 char sp_down; /* Down button status */
87 };
88
89 static int pms_synaptics_send_command(pckbport_tag_t, pckbport_slot_t, u_char);
90 static void pms_synaptics_input(void *, int);
91 static void pms_synaptics_process_packet(struct pms_softc *,
92 struct synaptics_packet *);
93 static void pms_sysctl_synaptics(struct sysctllog **);
94 static int pms_sysctl_synaptics_verify(SYSCTLFN_ARGS);
95
96 /* Controled by sysctl. */
97 static int synaptics_up_down_emul = 2;
98 static int synaptics_up_down_motion_delta = 1;
99 static int synaptics_gesture_move = 200;
100 static int synaptics_gesture_length = 20;
101 static int synaptics_edge_left = SYNAPTICS_EDGE_LEFT;
102 static int synaptics_edge_right = SYNAPTICS_EDGE_RIGHT;
103 static int synaptics_edge_top = SYNAPTICS_EDGE_TOP;
104 static int synaptics_edge_bottom = SYNAPTICS_EDGE_BOTTOM;
105 static int synaptics_edge_motion_delta = 32;
106 static u_int synaptics_finger_high = SYNAPTICS_FINGER_LIGHT + 5;
107 static u_int synaptics_finger_low = SYNAPTICS_FINGER_LIGHT - 10;
108 static int synaptics_two_fingers_emul = 0;
109 static int synaptics_scale_x = 16;
110 static int synaptics_scale_y = 16;
111 static int synaptics_max_speed_x = 32;
112 static int synaptics_max_speed_y = 32;
113 static int synaptics_movement_threshold = 4;
114
115 /* Sysctl nodes. */
116 static int synaptics_up_down_emul_nodenum;
117 static int synaptics_up_down_motion_delta_nodenum;
118 static int synaptics_gesture_move_nodenum;
119 static int synaptics_gesture_length_nodenum;
120 static int synaptics_edge_left_nodenum;
121 static int synaptics_edge_right_nodenum;
122 static int synaptics_edge_top_nodenum;
123 static int synaptics_edge_bottom_nodenum;
124 static int synaptics_edge_motion_delta_nodenum;
125 static int synaptics_finger_high_nodenum;
126 static int synaptics_finger_low_nodenum;
127 static int synaptics_two_fingers_emul_nodenum;
128 static int synaptics_scale_x_nodenum;
129 static int synaptics_scale_y_nodenum;
130 static int synaptics_max_speed_x_nodenum;
131 static int synaptics_max_speed_y_nodenum;
132 static int synaptics_movement_threshold_nodenum;
133
134 int
135 pms_synaptics_probe_init(void *vsc)
136 {
137 struct pms_softc *psc = vsc;
138 struct synaptics_softc *sc = &psc->u.synaptics;
139 u_char cmd[2], resp[3];
140 int res, ver_minor, ver_major;
141 struct sysctllog *clog = NULL;
142
143 res = pms_synaptics_send_command(psc->sc_kbctag, psc->sc_kbcslot,
144 SYNAPTICS_IDENTIFY_TOUCHPAD);
145 cmd[0] = PMS_SEND_DEV_STATUS;
146 res |= pckbport_poll_cmd(psc->sc_kbctag, psc->sc_kbcslot, cmd, 1, 3,
147 resp, 0);
148 if (res) {
149 #ifdef SYNAPTICSDEBUG
150 aprint_normal_dev(psc->sc_dev,
151 "synaptics_probe: Identify Touchpad error.\n");
152 #endif
153 /*
154 * Reset device in case the probe confused it.
155 */
156 doreset:
157 cmd[0] = PMS_RESET;
158 (void) pckbport_poll_cmd(psc->sc_kbctag, psc->sc_kbcslot, cmd,
159 1, 2, resp, 1);
160 return (res);
161 }
162
163 if (resp[1] != SYNAPTICS_MAGIC_BYTE) {
164 #ifdef SYNAPTICSDEBUG
165 aprint_normal_dev(psc->sc_dev,
166 "synaptics_probe: Not synaptics.\n");
167 #endif
168 res = 1;
169 goto doreset;
170 }
171
172 sc->flags = 0;
173
174 /* Check for minimum version and print a nice message. */
175 ver_major = resp[2] & 0x0f;
176 ver_minor = resp[0];
177 aprint_normal_dev(psc->sc_dev, "Synaptics touchpad version %d.%d\n",
178 ver_major, ver_minor);
179 if (ver_major * 10 + ver_minor < SYNAPTICS_MIN_VERSION) {
180 /* No capability query support. */
181 sc->caps = 0;
182 goto done;
183 }
184
185 /* Query the hardware capabilities. */
186 res = pms_synaptics_send_command(psc->sc_kbctag, psc->sc_kbcslot,
187 SYNAPTICS_READ_CAPABILITIES);
188 cmd[0] = PMS_SEND_DEV_STATUS;
189 res |= pckbport_poll_cmd(psc->sc_kbctag, psc->sc_kbcslot, cmd, 1, 3,
190 resp, 0);
191 if (res) {
192 /* Hmm, failed to get capabilites. */
193 aprint_error_dev(psc->sc_dev,
194 "synaptics_probe: Failed to query capabilities.\n");
195 goto doreset;
196 }
197
198 sc->caps = (resp[0] << 8) | resp[2];
199
200 if (sc->caps & SYNAPTICS_CAP_MBUTTON)
201 sc->flags |= SYN_FLAG_HAS_MIDDLE_BUTTON;
202
203 if (sc->caps & SYNAPTICS_CAP_4BUTTON)
204 sc->flags |= SYN_FLAG_HAS_BUTTONS_4_5;
205
206 if (sc->caps & SYNAPTICS_CAP_EXTENDED) {
207 #ifdef SYNAPTICSDEBUG
208 aprint_normal_dev(psc->sc_dev,
209 "synaptics_probe: Capabilities 0x%04x.\n", sc->caps);
210 #endif
211 if (sc->caps & SYNAPTICS_CAP_PASSTHROUGH)
212 sc->flags |= SYN_FLAG_HAS_PASSTHROUGH;
213
214 if (sc->caps & SYNAPTICS_CAP_PALMDETECT)
215 sc->flags |= SYN_FLAG_HAS_PALM_DETECT;
216
217 if (sc->caps & SYNAPTICS_CAP_MULTIDETECT)
218 sc->flags |= SYN_FLAG_HAS_MULTI_FINGER;
219
220 /* Ask about extra buttons to detect up/down. */
221 if (sc->caps & SYNAPTICS_CAP_EXTNUM) {
222 res = pms_synaptics_send_command(psc->sc_kbctag,
223 psc->sc_kbcslot, SYNAPTICS_EXTENDED_QUERY);
224 cmd[0] = PMS_SEND_DEV_STATUS;
225 res |= pckbport_poll_cmd(psc->sc_kbctag,
226 psc->sc_kbcslot, cmd, 1, 3, resp, 0);
227 #ifdef SYNAPTICSDEBUG
228 if (res == 0)
229 aprint_normal_dev(psc->sc_dev,
230 "synaptics_probe: Extended "
231 "Capabilities 0x%02x.\n", resp[1]);
232 #endif
233 if (!res && (resp[1] >> 4) >= 2) {
234 /* Yes. */
235 sc->flags |= SYN_FLAG_HAS_UP_DOWN_BUTTONS;
236 }
237 }
238 }
239
240 if (sc->flags) {
241 const char comma[] = ", ";
242 const char *sep = "";
243 aprint_normal_dev(psc->sc_dev, "");
244 if (sc->flags & SYN_FLAG_HAS_PASSTHROUGH) {
245 aprint_normal("%sPassthrough", sep);
246 sep = comma;
247 }
248 if (sc->flags & SYN_FLAG_HAS_MIDDLE_BUTTON) {
249 aprint_normal("%sMiddle button", sep);
250 sep = comma;
251 }
252 if (sc->flags & SYN_FLAG_HAS_BUTTONS_4_5) {
253 aprint_normal("%sButtons 4/5", sep);
254 sep = comma;
255 }
256 if (sc->flags & SYN_FLAG_HAS_UP_DOWN_BUTTONS) {
257 aprint_normal("%sUp/down buttons", sep);
258 sep = comma;
259 }
260 if (sc->flags & SYN_FLAG_HAS_PALM_DETECT) {
261 aprint_normal("%sPalm detect", sep);
262 sep = comma;
263 }
264 if (sc->flags & SYN_FLAG_HAS_MULTI_FINGER)
265 aprint_normal("%sMulti-finger", sep);
266
267 aprint_normal("\n");
268 }
269
270 done:
271 pms_sysctl_synaptics(&clog);
272 pckbport_set_inputhandler(psc->sc_kbctag, psc->sc_kbcslot,
273 pms_synaptics_input, psc, device_xname(psc->sc_dev));
274
275 return (0);
276 }
277
278 void
279 pms_synaptics_enable(void *vsc)
280 {
281 struct pms_softc *psc = vsc;
282 struct synaptics_softc *sc = &psc->u.synaptics;
283 u_char cmd[2], resp[2];
284 int res;
285
286 if (sc->flags & SYN_FLAG_HAS_PASSTHROUGH) {
287 /*
288 * Extended capability probes can confuse the passthrough device;
289 * reset the touchpad now to cure that.
290 */
291 cmd[0] = PMS_RESET;
292 res = pckbport_poll_cmd(psc->sc_kbctag, psc->sc_kbcslot, cmd,
293 1, 2, resp, 1);
294 }
295
296 /*
297 * Enable Absolute mode with W (width) reporting, and set
298 * the packet rate to maximum (80 packets per second).
299 */
300 res = pms_synaptics_send_command(psc->sc_kbctag, psc->sc_kbcslot,
301 SYNAPTICS_MODE_ABSOLUTE | SYNAPTICS_MODE_W | SYNAPTICS_MODE_RATE);
302 cmd[0] = PMS_SET_SAMPLE;
303 cmd[1] = SYNAPTICS_CMD_SET_MODE2;
304 res |= pckbport_enqueue_cmd(psc->sc_kbctag, psc->sc_kbcslot, cmd, 2, 0,
305 1, NULL);
306 sc->up_down = 0;
307 sc->prev_fingers = 0;
308 sc->gesture_start_x = sc->gesture_start_y = 0;
309 sc->gesture_start_packet = 0;
310 sc->gesture_tap_packet = 0;
311 sc->gesture_type = 0;
312 sc->gesture_buttons = 0;
313 sc->rem_x = sc->rem_y = 0;
314 sc->movement_history = 0;
315 if (res) {
316 aprint_error_dev(psc->sc_dev,
317 "synaptics_enable: Error enabling device.\n");
318 }
319 }
320
321 void
322 pms_synaptics_resume(void *vsc)
323 {
324 struct pms_softc *psc = vsc;
325 unsigned char cmd[1],resp[2] = { 0,0 };
326 int res;
327
328 cmd[0] = PMS_RESET;
329 res = pckbport_poll_cmd(psc->sc_kbctag, psc->sc_kbcslot, cmd, 1, 2,
330 resp, 1);
331 aprint_debug_dev(psc->sc_dev,
332 "pms_synaptics_resume: reset on resume %d 0x%02x 0x%02x\n",
333 res, resp[0], resp[1]);
334 }
335
336 static void
337 pms_sysctl_synaptics(struct sysctllog **clog)
338 {
339 int rc, root_num;
340 const struct sysctlnode *node;
341
342 if ((rc = sysctl_createv(clog, 0, NULL, NULL,
343 CTLFLAG_PERMANENT, CTLTYPE_NODE, "hw", NULL,
344 NULL, 0, NULL, 0, CTL_HW, CTL_EOL)) != 0)
345 goto err;
346
347 if ((rc = sysctl_createv(clog, 0, NULL, &node,
348 CTLFLAG_PERMANENT, CTLTYPE_NODE, "synaptics",
349 SYSCTL_DESCR("Synaptics touchpad controls"),
350 NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL)) != 0)
351 goto err;
352
353 root_num = node->sysctl_num;
354
355 if ((rc = sysctl_createv(clog, 0, NULL, &node,
356 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
357 CTLTYPE_INT, "up_down_emulation",
358 SYSCTL_DESCR("Middle button/Z-axis emulation with up/down buttons"),
359 pms_sysctl_synaptics_verify, 0,
360 &synaptics_up_down_emul,
361 0, CTL_HW, root_num, CTL_CREATE,
362 CTL_EOL)) != 0)
363 goto err;
364
365 synaptics_up_down_emul_nodenum = node->sysctl_num;
366
367 if ((rc = sysctl_createv(clog, 0, NULL, &node,
368 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
369 CTLTYPE_INT, "up_down_motion_delta",
370 SYSCTL_DESCR("Up/down button Z-axis emulation rate"),
371 pms_sysctl_synaptics_verify, 0,
372 &synaptics_up_down_motion_delta,
373 0, CTL_HW, root_num, CTL_CREATE,
374 CTL_EOL)) != 0)
375 goto err;
376
377 synaptics_up_down_motion_delta_nodenum = node->sysctl_num;
378
379 if ((rc = sysctl_createv(clog, 0, NULL, &node,
380 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
381 CTLTYPE_INT, "gesture_move",
382 SYSCTL_DESCR("Movement greater than this between taps cancels gesture"),
383 pms_sysctl_synaptics_verify, 0,
384 &synaptics_gesture_move,
385 0, CTL_HW, root_num, CTL_CREATE,
386 CTL_EOL)) != 0)
387 goto err;
388
389 synaptics_gesture_move_nodenum = node->sysctl_num;
390
391 if ((rc = sysctl_createv(clog, 0, NULL, &node,
392 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
393 CTLTYPE_INT, "gesture_length",
394 SYSCTL_DESCR("Time period in which tap is recognised as a gesture"),
395 pms_sysctl_synaptics_verify, 0,
396 &synaptics_gesture_length,
397 0, CTL_HW, root_num, CTL_CREATE,
398 CTL_EOL)) != 0)
399 goto err;
400
401 synaptics_gesture_length_nodenum = node->sysctl_num;
402
403 if ((rc = sysctl_createv(clog, 0, NULL, &node,
404 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
405 CTLTYPE_INT, "edge_left",
406 SYSCTL_DESCR("Define left edge of touchpad"),
407 pms_sysctl_synaptics_verify, 0,
408 &synaptics_edge_left,
409 0, CTL_HW, root_num, CTL_CREATE,
410 CTL_EOL)) != 0)
411 goto err;
412
413 synaptics_edge_left_nodenum = node->sysctl_num;
414
415 if ((rc = sysctl_createv(clog, 0, NULL, &node,
416 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
417 CTLTYPE_INT, "edge_right",
418 SYSCTL_DESCR("Define right edge of touchpad"),
419 pms_sysctl_synaptics_verify, 0,
420 &synaptics_edge_right,
421 0, CTL_HW, root_num, CTL_CREATE,
422 CTL_EOL)) != 0)
423 goto err;
424
425 synaptics_edge_right_nodenum = node->sysctl_num;
426
427 if ((rc = sysctl_createv(clog, 0, NULL, &node,
428 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
429 CTLTYPE_INT, "edge_top",
430 SYSCTL_DESCR("Define top edge of touchpad"),
431 pms_sysctl_synaptics_verify, 0,
432 &synaptics_edge_top,
433 0, CTL_HW, root_num, CTL_CREATE,
434 CTL_EOL)) != 0)
435 goto err;
436
437 synaptics_edge_top_nodenum = node->sysctl_num;
438
439 if ((rc = sysctl_createv(clog, 0, NULL, &node,
440 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
441 CTLTYPE_INT, "edge_bottom",
442 SYSCTL_DESCR("Define bottom edge of touchpad"),
443 pms_sysctl_synaptics_verify, 0,
444 &synaptics_edge_bottom,
445 0, CTL_HW, root_num, CTL_CREATE,
446 CTL_EOL)) != 0)
447 goto err;
448
449 synaptics_edge_bottom_nodenum = node->sysctl_num;
450
451 if ((rc = sysctl_createv(clog, 0, NULL, &node,
452 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
453 CTLTYPE_INT, "edge_motion_delta",
454 SYSCTL_DESCR("Define edge motion rate"),
455 pms_sysctl_synaptics_verify, 0,
456 &synaptics_edge_motion_delta,
457 0, CTL_HW, root_num, CTL_CREATE,
458 CTL_EOL)) != 0)
459 goto err;
460
461 synaptics_edge_motion_delta_nodenum = node->sysctl_num;
462
463 if ((rc = sysctl_createv(clog, 0, NULL, &node,
464 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
465 CTLTYPE_INT, "finger_high",
466 SYSCTL_DESCR("Define finger applied pressure threshold"),
467 pms_sysctl_synaptics_verify, 0,
468 &synaptics_finger_high,
469 0, CTL_HW, root_num, CTL_CREATE,
470 CTL_EOL)) != 0)
471 goto err;
472
473 synaptics_finger_high_nodenum = node->sysctl_num;
474
475 if ((rc = sysctl_createv(clog, 0, NULL, &node,
476 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
477 CTLTYPE_INT, "finger_low",
478 SYSCTL_DESCR("Define finger removed pressure threshold"),
479 pms_sysctl_synaptics_verify, 0,
480 &synaptics_finger_low,
481 0, CTL_HW, root_num, CTL_CREATE,
482 CTL_EOL)) != 0)
483 goto err;
484
485 synaptics_finger_low_nodenum = node->sysctl_num;
486
487 if ((rc = sysctl_createv(clog, 0, NULL, &node,
488 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
489 CTLTYPE_INT, "two_fingers_emulation",
490 SYSCTL_DESCR("Map two fingers to middle button"),
491 pms_sysctl_synaptics_verify, 0,
492 &synaptics_two_fingers_emul,
493 0, CTL_HW, root_num, CTL_CREATE,
494 CTL_EOL)) != 0)
495 goto err;
496
497 synaptics_two_fingers_emul_nodenum = node->sysctl_num;
498
499 if ((rc = sysctl_createv(clog, 0, NULL, &node,
500 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
501 CTLTYPE_INT, "scale_x",
502 SYSCTL_DESCR("Horizontal movement scale factor"),
503 pms_sysctl_synaptics_verify, 0,
504 &synaptics_scale_x,
505 0, CTL_HW, root_num, CTL_CREATE,
506 CTL_EOL)) != 0)
507 goto err;
508
509 synaptics_scale_x_nodenum = node->sysctl_num;
510
511 if ((rc = sysctl_createv(clog, 0, NULL, &node,
512 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
513 CTLTYPE_INT, "scale_y",
514 SYSCTL_DESCR("Vertical movement scale factor"),
515 pms_sysctl_synaptics_verify, 0,
516 &synaptics_scale_y,
517 0, CTL_HW, root_num, CTL_CREATE,
518 CTL_EOL)) != 0)
519 goto err;
520
521 synaptics_scale_y_nodenum = node->sysctl_num;
522
523 if ((rc = sysctl_createv(clog, 0, NULL, &node,
524 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
525 CTLTYPE_INT, "max_speed_x",
526 SYSCTL_DESCR("Horizontal movement maximum speed"),
527 pms_sysctl_synaptics_verify, 0,
528 &synaptics_max_speed_x,
529 0, CTL_HW, root_num, CTL_CREATE,
530 CTL_EOL)) != 0)
531 goto err;
532
533 synaptics_max_speed_x_nodenum = node->sysctl_num;
534
535 if ((rc = sysctl_createv(clog, 0, NULL, &node,
536 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
537 CTLTYPE_INT, "max_speed_y",
538 SYSCTL_DESCR("Vertical movement maximum speed"),
539 pms_sysctl_synaptics_verify, 0,
540 &synaptics_max_speed_y,
541 0, CTL_HW, root_num, CTL_CREATE,
542 CTL_EOL)) != 0)
543 goto err;
544
545 synaptics_max_speed_y_nodenum = node->sysctl_num;
546
547 if ((rc = sysctl_createv(clog, 0, NULL, &node,
548 CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
549 CTLTYPE_INT, "movement_threshold",
550 SYSCTL_DESCR("Minimum reported movement threshold"),
551 pms_sysctl_synaptics_verify, 0,
552 &synaptics_movement_threshold,
553 0, CTL_HW, root_num, CTL_CREATE,
554 CTL_EOL)) != 0)
555 goto err;
556
557 synaptics_movement_threshold_nodenum = node->sysctl_num;
558 return;
559
560 err:
561 aprint_error("%s: sysctl_createv failed (rc = %d)\n", __func__, rc);
562 }
563
564 static int
565 pms_sysctl_synaptics_verify(SYSCTLFN_ARGS)
566 {
567 int error, t;
568 struct sysctlnode node;
569
570 node = *rnode;
571 t = *(int *)rnode->sysctl_data;
572 node.sysctl_data = &t;
573 error = sysctl_lookup(SYSCTLFN_CALL(&node));
574 if (error || newp == NULL)
575 return error;
576
577 /* Sanity check the params. */
578 if (node.sysctl_num == synaptics_up_down_emul_nodenum ||
579 node.sysctl_num == synaptics_two_fingers_emul_nodenum) {
580 if (t < 0 || t > 2)
581 return (EINVAL);
582 } else
583 if (node.sysctl_num == synaptics_gesture_length_nodenum ||
584 node.sysctl_num == synaptics_edge_motion_delta_nodenum ||
585 node.sysctl_num == synaptics_up_down_motion_delta_nodenum) {
586 if (t < 0)
587 return (EINVAL);
588 } else
589 if (node.sysctl_num == synaptics_edge_left_nodenum ||
590 node.sysctl_num == synaptics_edge_bottom_nodenum) {
591 if (t < 0 || t > (SYNAPTICS_EDGE_MAX / 2))
592 return (EINVAL);
593 } else
594 if (node.sysctl_num == synaptics_edge_right_nodenum ||
595 node.sysctl_num == synaptics_edge_top_nodenum) {
596 if (t < (SYNAPTICS_EDGE_MAX / 2))
597 return (EINVAL);
598 } else
599 if (node.sysctl_num == synaptics_scale_x_nodenum ||
600 node.sysctl_num == synaptics_scale_y_nodenum) {
601 if (t < 1 || t > (SYNAPTICS_EDGE_MAX / 4))
602 return (EINVAL);
603 } else
604 if (node.sysctl_num == synaptics_finger_high_nodenum) {
605 if (t < 0 || t > SYNAPTICS_FINGER_PALM ||
606 t < synaptics_finger_low)
607 return (EINVAL);
608 } else
609 if (node.sysctl_num == synaptics_finger_low_nodenum) {
610 if (t < 0 || t > SYNAPTICS_FINGER_PALM ||
611 t > synaptics_finger_high)
612 return (EINVAL);
613 } else
614 if (node.sysctl_num == synaptics_gesture_move_nodenum ||
615 node.sysctl_num == synaptics_movement_threshold_nodenum) {
616 if (t < 0 || t > (SYNAPTICS_EDGE_MAX / 4))
617 return (EINVAL);
618 } else
619 return (EINVAL);
620
621 *(int *)rnode->sysctl_data = t;
622
623 return (0);
624 }
625
626 static int
627 pms_synaptics_send_command(pckbport_tag_t tag, pckbport_slot_t slot,
628 u_char syn_cmd)
629 {
630 u_char cmd[2];
631 int res;
632
633 cmd[0] = PMS_SET_SCALE11;
634 res = pckbport_poll_cmd(tag, slot, cmd, 1, 0, NULL, 0);
635
636 /*
637 * Need to send 4 Set Resolution commands, with the argument
638 * encoded in the bottom most 2 bits.
639 */
640 cmd[0] = PMS_SET_RES;
641 cmd[1] = syn_cmd >> 6;
642 res |= pckbport_poll_cmd(tag, slot, cmd, 2, 0, NULL, 0);
643
644 cmd[0] = PMS_SET_RES;
645 cmd[1] = (syn_cmd & 0x30) >> 4;
646 res |= pckbport_poll_cmd(tag, slot, cmd, 2, 0, NULL, 0);
647
648 cmd[0] = PMS_SET_RES;
649 cmd[1] = (syn_cmd & 0x0c) >> 2;
650 res |= pckbport_poll_cmd(tag, slot, cmd, 2, 0, NULL, 0);
651
652 cmd[0] = PMS_SET_RES;
653 cmd[1] = (syn_cmd & 0x03);
654 res |= pckbport_poll_cmd(tag, slot, cmd, 2, 0, NULL, 0);
655
656 return (res);
657 }
658
659 /* Masks for the first byte of a packet */
660 #define PMS_LBUTMASK 0x01
661 #define PMS_RBUTMASK 0x02
662 #define PMS_MBUTMASK 0x04
663
664 static void
665 pms_synaptics_parse(struct pms_softc *psc)
666 {
667 struct synaptics_softc *sc = &psc->u.synaptics;
668 struct synaptics_packet sp;
669
670 /* Absolute X/Y coordinates of finger */
671 sp.sp_x = psc->packet[4] + ((psc->packet[1] & 0x0f) << 8) +
672 ((psc->packet[3] & 0x10) << 8);
673 sp.sp_y = psc->packet[5] + ((psc->packet[1] & 0xf0) << 4) +
674 ((psc->packet[3] & 0x20) << 7);
675
676 /* Pressure */
677 sp.sp_z = psc->packet[2];
678
679 /* Width of finger */
680 sp.sp_w = ((psc->packet[0] & 0x30) >> 2) +
681 ((psc->packet[0] & 0x04) >> 1) +
682 ((psc->packet[3] & 0x04) >> 2);
683
684 /* Left/Right button handling. */
685 sp.sp_left = psc->packet[0] & PMS_LBUTMASK;
686 sp.sp_right = psc->packet[0] & PMS_RBUTMASK;
687
688 /* Up/Down buttons. */
689 if (sc->flags & SYN_FLAG_HAS_BUTTONS_4_5) {
690 /* Old up/down buttons. */
691 sp.sp_up = sp.sp_left ^
692 (psc->packet[3] & PMS_LBUTMASK);
693 sp.sp_down = sp.sp_right ^
694 (psc->packet[3] & PMS_RBUTMASK);
695 } else
696 if (sc->flags & SYN_FLAG_HAS_UP_DOWN_BUTTONS &&
697 ((psc->packet[0] & PMS_RBUTMASK) ^
698 (psc->packet[3] & PMS_RBUTMASK))) {
699 /* New up/down button. */
700 sp.sp_up = psc->packet[4] & SYN_1BUTMASK;
701 sp.sp_down = psc->packet[5] & SYN_2BUTMASK;
702 } else {
703 sp.sp_up = 0;
704 sp.sp_down = 0;
705 }
706
707 /* Middle button. */
708 if (sc->flags & SYN_FLAG_HAS_MIDDLE_BUTTON) {
709 /* Old style Middle Button. */
710 sp.sp_middle = (psc->packet[0] & PMS_LBUTMASK) ^
711 (psc->packet[3] & PMS_LBUTMASK);
712 } else
713 if (synaptics_up_down_emul == 1) {
714 /* Do middle button emulation using up/down buttons */
715 sp.sp_middle = sp.sp_up | sp.sp_down;
716 sp.sp_up = sp.sp_down = 0;
717 } else
718 sp.sp_middle = 0;
719
720 pms_synaptics_process_packet(psc, &sp);
721 }
722
723 static void
724 pms_synaptics_passthrough(struct pms_softc *psc)
725 {
726 int dx, dy, dz;
727 int buttons, changed;
728 int s;
729
730 buttons = ((psc->packet[1] & PMS_LBUTMASK) ? 0x20 : 0) |
731 ((psc->packet[1] & PMS_MBUTMASK) ? 0x40 : 0) |
732 ((psc->packet[1] & PMS_RBUTMASK) ? 0x80 : 0);
733
734 dx = psc->packet[4];
735 if (dx >= 128)
736 dx -= 256;
737 if (dx == -128)
738 dx = -127;
739
740 dy = psc->packet[5];
741 if (dy >= 128)
742 dy -= 256;
743 if (dy == -128)
744 dy = -127;
745
746 dz = 0;
747
748 changed = buttons ^ (psc->buttons & 0xe0);
749 psc->buttons ^= changed;
750
751 if (dx || dy || dz || changed) {
752 buttons = (psc->buttons & 0x1f) | ((psc->buttons >> 5) & 0x7);
753 s = spltty();
754 wsmouse_input(psc->sc_wsmousedev,
755 buttons, dx, dy, dz, 0,
756 WSMOUSE_INPUT_DELTA);
757 splx(s);
758 }
759 }
760
761 static void
762 pms_synaptics_input(void *vsc, int data)
763 {
764 struct pms_softc *psc = vsc;
765 struct timeval diff;
766
767 if (!psc->sc_enabled) {
768 /* Interrupts are not expected. Discard the byte. */
769 return;
770 }
771
772 getmicrouptime(&psc->current);
773
774 if (psc->inputstate > 0) {
775 timersub(&psc->current, &psc->last, &diff);
776 if (diff.tv_sec > 0 || diff.tv_usec >= 40000) {
777 aprint_debug_dev(psc->sc_dev,
778 "pms_input: unusual delay (%ld.%06ld s), "
779 "scheduling reset\n",
780 (long)diff.tv_sec, (long)diff.tv_usec);
781 psc->inputstate = 0;
782 psc->sc_enabled = 0;
783 wakeup(&psc->sc_enabled);
784 return;
785 }
786 }
787 psc->last = psc->current;
788
789 switch (psc->inputstate) {
790 case 0:
791 if ((data & 0xc8) != 0x80) {
792 #ifdef SYNAPTICSDEBUG
793 aprint_normal_dev(psc->sc_dev,
794 "pms_input: 0x%02x out of sync\n", data);
795 #endif
796 return; /* not in sync yet, discard input */
797 }
798 /*FALLTHROUGH*/
799
800 case 3:
801 if ((data & 8) == 8) {
802 #ifdef SYNAPTICSDEBUG
803 aprint_normal_dev(psc->sc_dev,
804 "pms_input: dropped in relative mode, reset\n");
805 #endif
806 psc->inputstate = 0;
807 psc->sc_enabled = 0;
808 wakeup(&psc->sc_enabled);
809 return;
810 }
811 }
812
813 psc->packet[psc->inputstate++] = data & 0xff;
814 if (psc->inputstate == 6) {
815 /*
816 * We have a complete packet.
817 * Extract the pertinent details.
818 */
819 psc->inputstate = 0;
820
821 if ((psc->packet[0] & 0xfc) == 0x84 &&
822 (psc->packet[3] & 0xcc) == 0xc4) {
823 /* PS/2 passthrough */
824 pms_synaptics_passthrough(psc);
825 } else {
826 pms_synaptics_parse(psc);
827 }
828 }
829 }
830
831 static inline int
832 synaptics_finger_detect(struct synaptics_softc *sc, struct synaptics_packet *sp,
833 int *palmp)
834 {
835 int fingers;
836
837 /* Assume no palm */
838 *palmp = 0;
839
840 /*
841 * Apply some hysteresis when checking for a finger.
842 * When the finger is first applied, we ignore it until the
843 * pressure exceeds the 'high' threshold. The finger is considered
844 * removed only when pressure falls beneath the 'low' threshold.
845 */
846 if ((sc->prev_fingers == 0 && sp->sp_z > synaptics_finger_high) ||
847 (sc->prev_fingers != 0 && sp->sp_z > synaptics_finger_low))
848 fingers = 1;
849 else
850 fingers = 0;
851
852 /*
853 * If the pad can't do palm detection, skip the rest.
854 */
855 if (fingers == 0 || (sc->flags & SYN_FLAG_HAS_PALM_DETECT) == 0)
856 return (fingers);
857
858 /*
859 * Palm detection
860 */
861 if (sp->sp_z > SYNAPTICS_FINGER_FLAT &&
862 sp->sp_w >= SYNAPTICS_WIDTH_PALM_MIN)
863 *palmp = 1;
864
865 if (sc->prev_fingers == 0 &&
866 (sp->sp_z > SYNAPTICS_FINGER_FLAT ||
867 sp->sp_w >= SYNAPTICS_WIDTH_PALM_MIN)) {
868 /*
869 * Contact area or pressure is too great to be a finger.
870 * Just ignore it for now.
871 */
872 return (0);
873 }
874
875 /*
876 * Detect 2 and 3 fingers if supported, but only if multiple
877 * fingers appear within the tap gesture time period.
878 */
879 if (sc->flags & SYN_FLAG_HAS_MULTI_FINGER &&
880 SYN_TIME(sc, sc->gesture_start_packet) < synaptics_gesture_length) {
881 switch (sp->sp_w) {
882 case SYNAPTICS_WIDTH_TWO_FINGERS:
883 fingers = 2;
884 break;
885
886 case SYNAPTICS_WIDTH_THREE_OR_MORE:
887 fingers = 3;
888 break;
889
890 case SYNAPTICS_WIDTH_PEN:
891 fingers = 1;
892 break;
893
894 default:
895 /*
896 * The width value can report spurious single-finger
897 * events after a multi-finger event.
898 */
899 if (sc->prev_fingers > 1)
900 fingers = sc->prev_fingers;
901 else
902 fingers = 1;
903 break;
904 }
905 }
906
907 return (fingers);
908 }
909
910 static inline void
911 synaptics_gesture_detect(struct synaptics_softc *sc,
912 struct synaptics_packet *sp, int fingers)
913 {
914 int gesture_len, gesture_move_x, gesture_move_y, gesture_buttons;
915 int set_buttons;
916
917 gesture_len = SYN_TIME(sc, sc->gesture_start_packet);
918 gesture_buttons = sc->gesture_buttons;
919
920 if (fingers && sc->prev_fingers == 0) {
921 /*
922 * Finger was just applied.
923 * If the previous gesture was a single-click, set things
924 * up to deal with a possible drag or double-click gesture.
925 * Basically, if the finger is removed again within
926 * 'synaptics_gesture_length' packets, this is treated
927 * as a double-click. Otherwise we will emulate holding
928 * the left button down whilst dragging the mouse.
929 */
930 if (SYN_IS_SINGLE_TAP(sc->gesture_type))
931 sc->gesture_type |= SYN_GESTURE_DRAG;
932
933 sc->gesture_start_x = sp->sp_x;
934 sc->gesture_start_y = sp->sp_y;
935 sc->gesture_start_packet = sc->total_packets;
936 } else
937 if (fingers == 0 && sc->prev_fingers != 0) {
938 /*
939 * Finger was just removed.
940 * Check if the contact time and finger movement were
941 * small enough to qualify as a gesture.
942 * Ignore finger movement if multiple fingers were
943 * detected (the pad may report coordinates for any
944 * of the fingers).
945 */
946 gesture_move_x = abs(sc->gesture_start_x - sp->sp_x);
947 gesture_move_y = abs(sc->gesture_start_y - sp->sp_y);
948
949 if (gesture_len < synaptics_gesture_length &&
950 (sc->prev_fingers > 1 ||
951 (gesture_move_x < synaptics_gesture_move &&
952 gesture_move_y < synaptics_gesture_move))) {
953 /*
954 * Looking good so far.
955 */
956 if (SYN_IS_DRAG(sc->gesture_type)) {
957 /*
958 * Promote this gesture to double-click.
959 */
960 sc->gesture_type |= SYN_GESTURE_DOUBLE;
961 sc->gesture_type &= ~SYN_GESTURE_SINGLE;
962 } else {
963 /*
964 * Single tap gesture. Set the tap length timer
965 * and flag a single-click.
966 */
967 sc->gesture_tap_packet = sc->total_packets;
968 sc->gesture_type |= SYN_GESTURE_SINGLE;
969
970 /*
971 * The gesture can be modified depending on
972 * the number of fingers detected.
973 *
974 * 1: Normal left button emulation.
975 * 2: Either middle button or right button
976 * depending on the value of the two_fingers
977 * sysctl variable.
978 * 3: Right button.
979 */
980 switch (sc->prev_fingers) {
981 case 2:
982 if (synaptics_two_fingers_emul == 1)
983 gesture_buttons |= PMS_RBUTMASK;
984 else
985 if (synaptics_two_fingers_emul == 2)
986 gesture_buttons |= PMS_MBUTMASK;
987 break;
988 case 3:
989 gesture_buttons |= PMS_RBUTMASK;
990 break;
991 default:
992 gesture_buttons |= PMS_LBUTMASK;
993 break;
994 }
995 }
996 }
997
998 /*
999 * Always clear drag state when the finger is removed.
1000 */
1001 sc->gesture_type &= ~SYN_GESTURE_DRAG;
1002 }
1003
1004 if (sc->gesture_type == 0) {
1005 /*
1006 * There is no gesture in progress.
1007 * Clear emulated button state.
1008 */
1009 sc->gesture_buttons = 0;
1010 return;
1011 }
1012
1013 /*
1014 * A gesture is in progress.
1015 */
1016 set_buttons = 0;
1017
1018 if (SYN_IS_SINGLE_TAP(sc->gesture_type)) {
1019 /*
1020 * Single-click.
1021 * Activate the relevant button(s) until the
1022 * gesture tap timer has expired.
1023 */
1024 if (SYN_TIME(sc, sc->gesture_tap_packet) <
1025 synaptics_gesture_length)
1026 set_buttons = 1;
1027 else
1028 sc->gesture_type &= ~SYN_GESTURE_SINGLE;
1029 } else
1030 if (SYN_IS_DOUBLE_TAP(sc->gesture_type) && sc->prev_fingers == 0) {
1031 /*
1032 * Double-click.
1033 * Activate the relevant button(s) once.
1034 */
1035 set_buttons = 1;
1036 sc->gesture_type &= ~SYN_GESTURE_DOUBLE;
1037 }
1038
1039 if (set_buttons || SYN_IS_DRAG(sc->gesture_type)) {
1040 /*
1041 * Single-click and drag.
1042 * Maintain button state until the finger is removed.
1043 */
1044 sp->sp_left |= gesture_buttons & PMS_LBUTMASK;
1045 sp->sp_right |= gesture_buttons & PMS_RBUTMASK;
1046 sp->sp_middle |= gesture_buttons & PMS_MBUTMASK;
1047 }
1048
1049 sc->gesture_buttons = gesture_buttons;
1050 }
1051
1052 static inline int
1053 synaptics_filter_policy(struct synaptics_softc *sc, int *history, int value)
1054 {
1055 int a, b, rv, count;
1056
1057 count = sc->total_packets;
1058
1059 /*
1060 * Once we've accumulated at least SYN_HIST_SIZE values, combine
1061 * each new value with the previous two and return the average.
1062 *
1063 * This is necessary when the touchpad is operating in 80 packets
1064 * per second mode, as it performs little internal filtering on
1065 * reported values.
1066 *
1067 * Using a rolling average helps to filter out jitter caused by
1068 * tiny finger movements.
1069 */
1070 if (sc->movement_history >= SYN_HIST_SIZE) {
1071 a = (history[(count + 0) % SYN_HIST_SIZE] +
1072 history[(count + 1) % SYN_HIST_SIZE]) / 2;
1073
1074 b = (value + history[(count + 0) % SYN_HIST_SIZE]) / 2;
1075
1076 rv = b - a;
1077
1078 /*
1079 * Don't report the movement if it's below a certain
1080 * threshold.
1081 */
1082 if (abs(rv) < synaptics_movement_threshold)
1083 rv = 0;
1084 } else
1085 rv = 0;
1086
1087 /*
1088 * Add the new value to the history buffer.
1089 */
1090 history[(count + 1) % SYN_HIST_SIZE] = value;
1091
1092 return (rv);
1093 }
1094
1095 /* Edge detection */
1096 #define SYN_EDGE_TOP 1
1097 #define SYN_EDGE_BOTTOM 2
1098 #define SYN_EDGE_LEFT 4
1099 #define SYN_EDGE_RIGHT 8
1100
1101 static inline int
1102 synaptics_check_edge(int x, int y)
1103 {
1104 int rv = 0;
1105
1106 if (x < synaptics_edge_left)
1107 rv |= SYN_EDGE_LEFT;
1108 else
1109 if (x > synaptics_edge_right)
1110 rv |= SYN_EDGE_RIGHT;
1111
1112 if (y < synaptics_edge_bottom)
1113 rv |= SYN_EDGE_BOTTOM;
1114 else
1115 if (y > synaptics_edge_top)
1116 rv |= SYN_EDGE_TOP;
1117
1118 return (rv);
1119 }
1120
1121 static inline int
1122 synaptics_edge_motion(struct synaptics_softc *sc, int delta, int dir)
1123 {
1124
1125 /*
1126 * When edge motion is enabled, synaptics_edge_motion_delta is
1127 * combined with the current delta, together with the direction
1128 * in which to simulate the motion. The result is added to
1129 * the delta derived from finger movement. This provides a smooth
1130 * transition from finger movement to edge motion.
1131 */
1132 delta = synaptics_edge_motion_delta + (dir * delta);
1133 if (delta < 0)
1134 return (0);
1135 if (delta > synaptics_edge_motion_delta)
1136 return (synaptics_edge_motion_delta);
1137 return (delta);
1138 }
1139
1140 static inline int
1141 synaptics_scale(int delta, int scale, int *remp)
1142 {
1143 int rv;
1144
1145 /*
1146 * Scale the raw delta in Synaptics coordinates (0-6143) into
1147 * something more reasonable by dividing the raw delta by a
1148 * scale factor. Any remainder from the previous scale result
1149 * is added to the current delta before scaling.
1150 * This prevents loss of resolution for very small/slow
1151 * movements of the finger.
1152 */
1153 delta += *remp;
1154 rv = delta / scale;
1155 *remp = delta % scale;
1156
1157 return (rv);
1158 }
1159
1160 static inline void
1161 synaptics_movement(struct synaptics_softc *sc, struct synaptics_packet *sp,
1162 int *dxp, int *dyp)
1163 {
1164 int dx, dy, edge;
1165
1166 /*
1167 * Compute the next values of dx and dy
1168 */
1169 dx = synaptics_filter_policy(sc, sc->history_x, sp->sp_x);
1170 dy = synaptics_filter_policy(sc, sc->history_y, sp->sp_y);
1171
1172 /*
1173 * If we're dealing with a drag gesture, and the finger moves to
1174 * the edge of the touchpad, apply edge motion emulation if it
1175 * is enabled.
1176 */
1177 if (synaptics_edge_motion_delta && SYN_IS_DRAG(sc->gesture_type)) {
1178 edge = synaptics_check_edge(sp->sp_x, sp->sp_y);
1179
1180 if (edge & SYN_EDGE_LEFT)
1181 dx -= synaptics_edge_motion(sc, dx, 1);
1182 if (edge & SYN_EDGE_RIGHT)
1183 dx += synaptics_edge_motion(sc, dx, -1);
1184 if (edge & SYN_EDGE_BOTTOM)
1185 dy -= synaptics_edge_motion(sc, dy, 1);
1186 if (edge & SYN_EDGE_TOP)
1187 dy += synaptics_edge_motion(sc, dy, -1);
1188 }
1189
1190 /*
1191 * Apply scaling to both deltas
1192 */
1193 dx = synaptics_scale(dx, synaptics_scale_x, &sc->rem_x);
1194 dy = synaptics_scale(dy, synaptics_scale_y, &sc->rem_y);
1195
1196 /*
1197 * Clamp deltas to specified maximums.
1198 */
1199 if (dx > synaptics_max_speed_x)
1200 dx = synaptics_max_speed_x;
1201 if (dy > synaptics_max_speed_y)
1202 dy = synaptics_max_speed_y;
1203
1204 *dxp = dx;
1205 *dyp = dy;
1206
1207 sc->movement_history++;
1208 }
1209
1210 static void
1211 pms_synaptics_process_packet(struct pms_softc *psc, struct synaptics_packet *sp)
1212 {
1213 struct synaptics_softc *sc = &psc->u.synaptics;
1214 int dx, dy, dz;
1215 int fingers, palm, buttons, changed;
1216 int s;
1217
1218 /*
1219 * Do Z-axis emulation using up/down buttons if required.
1220 * Note that the pad will send a one second burst of packets
1221 * when an up/down button is pressed and held. At the moment
1222 * we don't deal with auto-repeat, so convert the burst into
1223 * a one-shot.
1224 */
1225 dz = 0;
1226 if (synaptics_up_down_emul == 2) {
1227 if (sc->up_down == 0) {
1228 if (sp->sp_up && sp->sp_down) {
1229 /*
1230 * Most up/down buttons will be actuated using
1231 * a rocker switch, so we should never see
1232 * them both simultaneously. But just in case,
1233 * treat this situation as a middle button
1234 * event.
1235 */
1236 sp->sp_middle = 1;
1237 } else
1238 if (sp->sp_up)
1239 dz = -synaptics_up_down_motion_delta;
1240 else
1241 if (sp->sp_down)
1242 dz = synaptics_up_down_motion_delta;
1243 }
1244
1245 sc->up_down = sp->sp_up | sp->sp_down;
1246 sp->sp_up = sp->sp_down = 0;
1247 }
1248
1249 /*
1250 * Determine whether or not a finger is on the pad.
1251 * On some pads, this will return the number of fingers
1252 * detected.
1253 */
1254 fingers = synaptics_finger_detect(sc, sp, &palm);
1255
1256 /*
1257 * Do gesture processing only if we didn't detect a palm.
1258 */
1259 if (palm == 0)
1260 synaptics_gesture_detect(sc, sp, fingers);
1261 else
1262 sc->gesture_type = sc->gesture_buttons = 0;
1263
1264 /*
1265 * Determine what buttons to report
1266 */
1267 buttons = (sp->sp_left ? 0x1 : 0) |
1268 (sp->sp_middle ? 0x2 : 0) |
1269 (sp->sp_right ? 0x4 : 0) |
1270 (sp->sp_up ? 0x8 : 0) |
1271 (sp->sp_down ? 0x10 : 0);
1272 changed = buttons ^ (psc->buttons & 0x1f);
1273 psc->buttons ^= changed;
1274
1275 sc->prev_fingers = fingers;
1276 sc->total_packets++;
1277
1278 /*
1279 * Do movement processing IFF we have a single finger and no palm.
1280 */
1281 if (fingers == 1 && palm == 0)
1282 synaptics_movement(sc, sp, &dx, &dy);
1283 else {
1284 /*
1285 * No valid finger. Therefore no movement.
1286 */
1287 sc->movement_history = 0;
1288 sc->rem_x = sc->rem_y = 0;
1289 dx = dy = 0;
1290 }
1291
1292 /*
1293 * Pass the final results up to wsmouse_input() if necessary.
1294 */
1295 if (dx || dy || dz || changed) {
1296 buttons = (psc->buttons & 0x1f) | ((psc->buttons >> 5) & 0x7);
1297 s = spltty();
1298 wsmouse_input(psc->sc_wsmousedev,
1299 buttons,
1300 dx, dy, dz, 0,
1301 WSMOUSE_INPUT_DELTA);
1302 splx(s);
1303 }
1304 }
1305