Home | History | Annotate | Line # | Download | only in pckbport
synaptics.c revision 1.30.2.1
      1  1.30.2.1       tls /*	$NetBSD: synaptics.c,v 1.30.2.1 2014/08/20 00:03:49 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.30.2.1       tls __KERNEL_RCSID(0, "$NetBSD: synaptics.c,v 1.30.2.1 2014/08/20 00:03:49 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.30.2.1       tls static void
    135  1.30.2.1       tls pms_synaptics_probe_extended(struct pms_softc *psc)
    136  1.30.2.1       tls {
    137  1.30.2.1       tls 	struct synaptics_softc *sc = &psc->u.synaptics;
    138  1.30.2.1       tls 	u_char cmd[1], resp[3];
    139  1.30.2.1       tls 	int res;
    140  1.30.2.1       tls 
    141  1.30.2.1       tls 	aprint_debug_dev(psc->sc_dev,
    142  1.30.2.1       tls 	    "synaptics_probe: Capabilities 0x%04x.\n", sc->caps);
    143  1.30.2.1       tls 	if (sc->caps & SYNAPTICS_CAP_PASSTHROUGH)
    144  1.30.2.1       tls 		sc->flags |= SYN_FLAG_HAS_PASSTHROUGH;
    145  1.30.2.1       tls 
    146  1.30.2.1       tls 	if (sc->caps & SYNAPTICS_CAP_PALMDETECT)
    147  1.30.2.1       tls 		sc->flags |= SYN_FLAG_HAS_PALM_DETECT;
    148  1.30.2.1       tls 
    149  1.30.2.1       tls 	if (sc->caps & SYNAPTICS_CAP_MULTIDETECT)
    150  1.30.2.1       tls 		sc->flags |= SYN_FLAG_HAS_MULTI_FINGER;
    151  1.30.2.1       tls 
    152  1.30.2.1       tls 	if (sc->caps & SYNAPTICS_CAP_MULTIFINGERREPORT)
    153  1.30.2.1       tls 		sc->flags |= SYN_FLAG_HAS_MULTI_FINGER_REPORT;
    154  1.30.2.1       tls 
    155  1.30.2.1       tls 	/* Ask about extra buttons to detect up/down. */
    156  1.30.2.1       tls 	if (((sc->caps & SYNAPTICS_CAP_EXTNUM) + 0x08)
    157  1.30.2.1       tls 	    >= SYNAPTICS_EXTENDED_QUERY)
    158  1.30.2.1       tls 	{
    159  1.30.2.1       tls 		res = pms_sliced_command(psc->sc_kbctag,
    160  1.30.2.1       tls 		    psc->sc_kbcslot, SYNAPTICS_EXTENDED_QUERY);
    161  1.30.2.1       tls 		cmd[0] = PMS_SEND_DEV_STATUS;
    162  1.30.2.1       tls 		res |= pckbport_poll_cmd(psc->sc_kbctag,
    163  1.30.2.1       tls 		    psc->sc_kbcslot, cmd, 1, 3, resp, 0);
    164  1.30.2.1       tls 		if (res == 0) {
    165  1.30.2.1       tls 			int buttons = (resp[1] >> 4);
    166  1.30.2.1       tls 			aprint_debug_dev(psc->sc_dev,
    167  1.30.2.1       tls 			    "%s: Extended Buttons: %d.\n", __func__, buttons);
    168  1.30.2.1       tls 
    169  1.30.2.1       tls 			aprint_debug_dev(psc->sc_dev, "%s: Extended "
    170  1.30.2.1       tls 			    "Capabilities: 0x%02x 0x%02x 0x%02x.\n", __func__,
    171  1.30.2.1       tls 			    resp[0], resp[1], resp[2]);
    172  1.30.2.1       tls 			if (buttons >= 2) {
    173  1.30.2.1       tls 				/* Yes. */
    174  1.30.2.1       tls 				sc->flags |= SYN_FLAG_HAS_UP_DOWN_BUTTONS;
    175  1.30.2.1       tls 			}
    176  1.30.2.1       tls 			if (resp[0] & 0x1) {
    177  1.30.2.1       tls 				/* Vertical scroll area */
    178  1.30.2.1       tls 				sc->flags |= SYN_FLAG_HAS_VERTICAL_SCROLL;
    179  1.30.2.1       tls 			}
    180  1.30.2.1       tls 			if (resp[0] & 0x2) {
    181  1.30.2.1       tls 				/* Horizontal scroll area */
    182  1.30.2.1       tls 				sc->flags |= SYN_FLAG_HAS_HORIZONTAL_SCROLL;
    183  1.30.2.1       tls 			}
    184  1.30.2.1       tls 			if (resp[0] & 0x4) {
    185  1.30.2.1       tls 				/* Extended W-Mode */
    186  1.30.2.1       tls 				sc->flags |= SYN_FLAG_HAS_EXTENDED_WMODE;
    187  1.30.2.1       tls 			}
    188  1.30.2.1       tls 		}
    189  1.30.2.1       tls 	}
    190  1.30.2.1       tls 
    191  1.30.2.1       tls 	/* Ask about click pad */
    192  1.30.2.1       tls 	if (((sc->caps & SYNAPTICS_CAP_EXTNUM) + 0x08) >=
    193  1.30.2.1       tls 	    SYNAPTICS_CONTINUED_CAPABILITIES)
    194  1.30.2.1       tls 	{
    195  1.30.2.1       tls 		res = pms_sliced_command(psc->sc_kbctag,
    196  1.30.2.1       tls 		    psc->sc_kbcslot, SYNAPTICS_CONTINUED_CAPABILITIES);
    197  1.30.2.1       tls 		cmd[0] = PMS_SEND_DEV_STATUS;
    198  1.30.2.1       tls 		res |= pckbport_poll_cmd(psc->sc_kbctag,
    199  1.30.2.1       tls 		    psc->sc_kbcslot, cmd, 1, 3, resp, 0);
    200  1.30.2.1       tls 		if (res == 0) {
    201  1.30.2.1       tls 			u_char clickpad_type = (resp[1] & 0x1);
    202  1.30.2.1       tls 			clickpad_type |= ((resp[0] >> 4) & 0x1);
    203  1.30.2.1       tls 
    204  1.30.2.1       tls 			aprint_debug_dev(psc->sc_dev, "%s: Continued "
    205  1.30.2.1       tls 			    "Capabilities 0x%02x 0x%02x 0x%02x.\n", __func__,
    206  1.30.2.1       tls 			    resp[0], resp[1], resp[2]);
    207  1.30.2.1       tls 			switch (clickpad_type) {
    208  1.30.2.1       tls 			case 1:
    209  1.30.2.1       tls 				sc->flags |= SYN_FLAG_HAS_ONE_BUTTON_CLICKPAD;
    210  1.30.2.1       tls 				break;
    211  1.30.2.1       tls 			case 2:
    212  1.30.2.1       tls 				sc->flags |= SYN_FLAG_HAS_TWO_BUTTON_CLICKPAD;
    213  1.30.2.1       tls 				break;
    214  1.30.2.1       tls 			default:
    215  1.30.2.1       tls 				break;
    216  1.30.2.1       tls 			}
    217  1.30.2.1       tls 		}
    218  1.30.2.1       tls 	}
    219  1.30.2.1       tls }
    220  1.30.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.30.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.30.2.1       tls 		if (sc->flags & SYN_FLAG_HAS_EXTENDED_WMODE) {
    298  1.30.2.1       tls 			aprint_normal("%sExtended W mode", sep);
    299  1.30.2.1       tls 			sep = comma;
    300  1.30.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.30.2.1       tls 		if (sc->flags & SYN_FLAG_HAS_ONE_BUTTON_CLICKPAD) {
    322  1.30.2.1       tls 			aprint_normal("%sOne button click pad", sep);
    323  1.30.2.1       tls 			sep = comma;
    324  1.30.2.1       tls 		}
    325  1.30.2.1       tls 		if (sc->flags & SYN_FLAG_HAS_TWO_BUTTON_CLICKPAD) {
    326  1.30.2.1       tls 			aprint_normal("%sTwo button click pad", sep);
    327  1.30.2.1       tls 			sep = comma;
    328  1.30.2.1       tls 		}
    329  1.30.2.1       tls 		if (sc->flags & SYN_FLAG_HAS_VERTICAL_SCROLL) {
    330  1.30.2.1       tls 			aprint_normal("%sVertical scroll", sep);
    331  1.30.2.1       tls 			sep = comma;
    332  1.30.2.1       tls 		}
    333  1.30.2.1       tls 		if (sc->flags & SYN_FLAG_HAS_HORIZONTAL_SCROLL) {
    334  1.30.2.1       tls 			aprint_normal("%sHorizontal scroll", sep);
    335  1.30.2.1       tls 			sep = comma;
    336  1.30.2.1       tls 		}
    337  1.30.2.1       tls 		if (sc->flags & SYN_FLAG_HAS_MULTI_FINGER_REPORT) {
    338  1.30.2.1       tls 			aprint_normal("%sMulti-finger Report", sep);
    339  1.30.2.1       tls 			sep = comma;
    340  1.30.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.30.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.30.2.1       tls 	memset(&sp, 0, sizeof(sp));
    710  1.30.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.30.2.1       tls 	if(sc->flags & SYN_FLAG_HAS_ONE_BUTTON_CLICKPAD) {
    749  1.30.2.1       tls 		/* This is not correctly specified. Read this button press
    750  1.30.2.1       tls 		 * from L/U bit.
    751  1.30.2.1       tls 		 */
    752  1.30.2.1       tls 		sp.sp_left = ((psc->packet[0] ^ psc->packet[3]) & 0x01) ? 1 : 0;
    753  1.30.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.30.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.30.2.1       tls 	if (fingers > 0 && (fingers == sc->prev_fingers)) {
    964  1.30.2.1       tls 		/* Finger is still present */
    965  1.30.2.1       tls 		sc->gesture_move_x = abs(sc->gesture_start_x - sp->sp_x);
    966  1.30.2.1       tls 		sc->gesture_move_y = abs(sc->gesture_start_y - sp->sp_y);
    967  1.30.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.30.2.1       tls 		sc->gesture_start_x = abs(sp->sp_x);
    982  1.30.2.1       tls 		sc->gesture_start_y = abs(sp->sp_y);
    983  1.30.2.1       tls 		sc->gesture_move_x = 0;
    984  1.30.2.1       tls 		sc->gesture_move_y = 0;
    985       1.3       scw 		sc->gesture_start_packet = sc->total_packets;
    986  1.30.2.1       tls 
    987  1.30.2.1       tls #ifdef DIAGNOSTIC
    988  1.30.2.1       tls 		aprint_debug("Finger applied: gesture_start_x: %d gesture_start_y: %d\n",
    989  1.30.2.1       tls 			sc->gesture_start_x, sc->gesture_start_y);
    990  1.30.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.30.2.1       tls 
   1002  1.30.2.1       tls #ifdef DIAGNOSTIC
   1003  1.30.2.1       tls 		aprint_debug("Finger removed: gesture_len: %d (%d)\n",
   1004  1.30.2.1       tls 			gesture_len, synaptics_gesture_length);
   1005  1.30.2.1       tls 		aprint_debug("gesture_move_x: %d (%d) sp_x: %d\n",
   1006  1.30.2.1       tls 			sc->gesture_move_x, synaptics_gesture_move, abs(sp->sp_x));
   1007  1.30.2.1       tls 		aprint_debug("gesture_move_y: %d (%d) sp_y: %d\n",
   1008  1.30.2.1       tls 			sc->gesture_move_y, synaptics_gesture_move, abs(sp->sp_y));
   1009  1.30.2.1       tls #endif
   1010       1.3       scw 
   1011       1.3       scw 		if (gesture_len < synaptics_gesture_length &&
   1012  1.30.2.1       tls 		    ((sc->gesture_move_x < synaptics_gesture_move &&
   1013  1.30.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