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