Home | History | Annotate | Line # | Download | only in adb
adb_ms.c revision 1.14.2.1
      1  1.14.2.1     rmind /*	$NetBSD: adb_ms.c,v 1.14.2.1 2014/05/18 17:45:35 rmind Exp $	*/
      2       1.1  macallan 
      3       1.1  macallan /*
      4       1.1  macallan  * Copyright (C) 1998	Colin Wood
      5       1.5  macallan  * Copyright (C) 2006, 2007 Michael Lorenz
      6       1.1  macallan  * All rights reserved.
      7       1.1  macallan  *
      8       1.1  macallan  * Redistribution and use in source and binary forms, with or without
      9       1.1  macallan  * modification, are permitted provided that the following conditions
     10       1.1  macallan  * are met:
     11       1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     12       1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     13       1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     14       1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     15       1.1  macallan  *    documentation and/or other materials provided with the distribution.
     16       1.1  macallan  * 3. All advertising materials mentioning features or use of this software
     17       1.1  macallan  *    must display the following acknowledgement:
     18       1.1  macallan  *	This product includes software developed by Colin Wood.
     19       1.1  macallan  * 4. The name of the author may not be used to endorse or promote products
     20       1.1  macallan  *    derived from this software without specific prior written permission.
     21       1.1  macallan  *
     22       1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23       1.1  macallan  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24       1.1  macallan  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25       1.1  macallan  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26       1.1  macallan  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27       1.1  macallan  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28       1.1  macallan  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29       1.1  macallan  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30       1.1  macallan  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     31       1.1  macallan  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32       1.1  macallan  */
     33       1.1  macallan 
     34       1.1  macallan #include <sys/cdefs.h>
     35  1.14.2.1     rmind __KERNEL_RCSID(0, "$NetBSD: adb_ms.c,v 1.14.2.1 2014/05/18 17:45:35 rmind Exp $");
     36       1.1  macallan 
     37       1.1  macallan #include <sys/param.h>
     38       1.1  macallan #include <sys/device.h>
     39       1.1  macallan #include <sys/fcntl.h>
     40       1.1  macallan #include <sys/poll.h>
     41       1.1  macallan #include <sys/select.h>
     42       1.1  macallan #include <sys/proc.h>
     43       1.1  macallan #include <sys/signalvar.h>
     44       1.1  macallan #include <sys/systm.h>
     45       1.1  macallan #include <sys/kernel.h>
     46       1.4   tsutsui #include <sys/sysctl.h>
     47       1.1  macallan 
     48       1.1  macallan #include <machine/autoconf.h>
     49       1.1  macallan 
     50       1.1  macallan #include <dev/wscons/wsconsio.h>
     51       1.1  macallan #include <dev/wscons/wsmousevar.h>
     52       1.1  macallan 
     53       1.1  macallan #include <machine/adbsys.h>
     54       1.1  macallan #include <dev/adb/adbvar.h>
     55       1.1  macallan 
     56       1.1  macallan #include "adbdebug.h"
     57       1.1  macallan 
     58       1.1  macallan #ifdef ADBMS_DEBUG
     59       1.1  macallan #define DPRINTF printf
     60       1.1  macallan #else
     61       1.1  macallan #define DPRINTF while (0) printf
     62       1.1  macallan #endif
     63       1.1  macallan 
     64       1.1  macallan /*
     65       1.1  macallan  * State info, per mouse instance.
     66       1.1  macallan  */
     67       1.1  macallan struct adbms_softc {
     68       1.8      matt 	device_t	sc_dev;
     69       1.1  macallan 	struct adb_device *sc_adbdev;
     70       1.1  macallan 	struct adb_bus_accessops *sc_ops;
     71       1.1  macallan 
     72       1.1  macallan 	/* Extended Mouse Protocol info, faked for non-EMP mice */
     73       1.1  macallan 	u_int8_t	sc_class;	/* mouse class (mouse, trackball) */
     74       1.1  macallan 	u_int8_t	sc_buttons;	/* number of buttons */
     75       1.1  macallan 	u_int32_t	sc_res;		/* mouse resolution (dpi) */
     76       1.1  macallan 	char		sc_devid[5];	/* device indentifier */
     77       1.1  macallan 	uint8_t		sc_us;		/* cmd to watch for */
     78       1.1  macallan 	int		sc_mb;		/* current button state */
     79      1.14       chs 	device_t	sc_wsmousedev;
     80       1.1  macallan 	/* helpers for trackpads */
     81       1.1  macallan 	int		sc_down;
     82       1.1  macallan 	/*
     83       1.1  macallan 	 * trackpad protocol variant. Known so far:
     84       1.1  macallan 	 * 2 buttons - PowerBook 3400, single events on button 3 and 4 indicate
     85       1.1  macallan 	 *             finger down and up
     86       1.1  macallan 	 * 4 buttons - iBook G4, button 6 indicates finger down, button 4 is
     87       1.1  macallan 	 *             always down
     88       1.1  macallan 	 */
     89       1.1  macallan 	int		sc_x, sc_y;
     90       1.4   tsutsui 	int		sc_tapping;
     91       1.1  macallan 	/* buffers */
     92       1.1  macallan 	int		sc_poll;
     93       1.1  macallan 	int		sc_msg_len;
     94       1.1  macallan 	int		sc_event;
     95       1.1  macallan 	uint8_t		sc_buffer[16];
     96       1.1  macallan };
     97       1.1  macallan 
     98       1.1  macallan /* EMP device classes */
     99       1.1  macallan #define MSCLASS_TABLET		0
    100       1.1  macallan #define MSCLASS_MOUSE		1
    101       1.1  macallan #define MSCLASS_TRACKBALL	2
    102       1.1  macallan #define MSCLASS_TRACKPAD	3
    103       1.1  macallan 
    104       1.1  macallan /*
    105       1.1  macallan  * Function declarations.
    106       1.1  macallan  */
    107       1.8      matt static int	adbms_match(device_t, cfdata_t, void *);
    108       1.8      matt static void	adbms_attach(device_t, device_t, void *);
    109       1.1  macallan static void	ems_init(struct adbms_softc *);
    110       1.1  macallan static void	init_trackpad(struct adbms_softc *);
    111       1.1  macallan static void	adbms_init_mouse(struct adbms_softc *);
    112       1.1  macallan static void	adbms_init_turbo(struct adbms_softc *);
    113       1.1  macallan static void	adbms_init_uspeed(struct adbms_softc *);
    114       1.1  macallan static void	adbms_process_event(struct adbms_softc *, int, uint8_t *);
    115       1.1  macallan static int	adbms_send_sync(struct adbms_softc *, uint8_t, int, uint8_t *);
    116       1.1  macallan 
    117       1.1  macallan /* Driver definition. */
    118       1.8      matt CFATTACH_DECL_NEW(adbms, sizeof(struct adbms_softc),
    119       1.1  macallan     adbms_match, adbms_attach, NULL, NULL);
    120       1.1  macallan 
    121       1.1  macallan static int adbms_enable(void *);
    122       1.6  christos static int adbms_ioctl(void *, u_long, void *, int, struct lwp *);
    123       1.1  macallan static void adbms_disable(void *);
    124       1.1  macallan 
    125       1.1  macallan /*
    126       1.1  macallan  * handle tapping the trackpad
    127       1.1  macallan  * different pads report different button counts and use slightly different
    128       1.1  macallan  * protocols
    129       1.1  macallan  */
    130       1.1  macallan static void adbms_mangle_2(struct adbms_softc *, int);
    131       1.1  macallan static void adbms_mangle_4(struct adbms_softc *, int);
    132       1.1  macallan static void adbms_handler(void *, int, uint8_t *);
    133       1.1  macallan static int  adbms_wait(struct adbms_softc *, int);
    134       1.4   tsutsui static int  sysctl_adbms_tap(SYSCTLFN_ARGS);
    135       1.1  macallan 
    136       1.1  macallan const struct wsmouse_accessops adbms_accessops = {
    137       1.1  macallan 	adbms_enable,
    138       1.1  macallan 	adbms_ioctl,
    139       1.1  macallan 	adbms_disable,
    140       1.1  macallan };
    141       1.1  macallan 
    142       1.1  macallan static int
    143       1.8      matt adbms_match(device_t parent, cfdata_t cf, void *aux)
    144       1.1  macallan {
    145       1.1  macallan 	struct adb_attach_args *aaa = aux;
    146       1.1  macallan 
    147       1.1  macallan 	if (aaa->dev->original_addr == ADBADDR_MS)
    148       1.1  macallan 		return 1;
    149       1.1  macallan 	else
    150       1.1  macallan 		return 0;
    151       1.1  macallan }
    152       1.1  macallan 
    153       1.1  macallan static void
    154       1.8      matt adbms_attach(device_t parent, device_t self, void *aux)
    155       1.1  macallan {
    156       1.8      matt 	struct adbms_softc *sc = device_private(self);
    157       1.1  macallan 	struct adb_attach_args *aaa = aux;
    158       1.1  macallan 	struct wsmousedev_attach_args a;
    159       1.1  macallan 
    160       1.8      matt 	sc->sc_dev = self;
    161       1.1  macallan 	sc->sc_ops = aaa->ops;
    162       1.1  macallan 	sc->sc_adbdev = aaa->dev;
    163       1.1  macallan 	sc->sc_adbdev->cookie = sc;
    164       1.1  macallan 	sc->sc_adbdev->handler = adbms_handler;
    165       1.1  macallan 	sc->sc_us = ADBTALK(sc->sc_adbdev->current_addr, 0);
    166       1.7  macallan 	printf(" addr %d: ", sc->sc_adbdev->current_addr);
    167       1.1  macallan 
    168       1.1  macallan 	sc->sc_class = MSCLASS_MOUSE;
    169       1.1  macallan 	sc->sc_buttons = 1;
    170       1.1  macallan 	sc->sc_res = 100;
    171       1.1  macallan 	sc->sc_devid[0] = 0;
    172       1.1  macallan 	sc->sc_devid[4] = 0;
    173       1.1  macallan 	sc->sc_poll = 0;
    174       1.1  macallan 	sc->sc_msg_len = 0;
    175       1.4   tsutsui 	sc->sc_tapping = 1;
    176       1.1  macallan 
    177       1.1  macallan 	ems_init(sc);
    178       1.1  macallan 
    179       1.1  macallan 	/* print out the type of mouse we have */
    180       1.1  macallan 	switch (sc->sc_adbdev->handler_id) {
    181       1.1  macallan 	case ADBMS_100DPI:
    182      1.12  christos 		printf("%d-button, %u dpi mouse\n", sc->sc_buttons,
    183      1.12  christos 		    sc->sc_res);
    184       1.1  macallan 		break;
    185       1.1  macallan 	case ADBMS_200DPI:
    186       1.1  macallan 		sc->sc_res = 200;
    187      1.12  christos 		printf("%d-button, %u dpi mouse\n", sc->sc_buttons,
    188      1.12  christos 		    sc->sc_res);
    189       1.1  macallan 		break;
    190       1.1  macallan 	case ADBMS_MSA3:
    191      1.12  christos 		printf("Mouse Systems A3 mouse, %d-button, %u dpi\n",
    192      1.12  christos 		    sc->sc_buttons, sc->sc_res);
    193       1.1  macallan 		break;
    194       1.1  macallan 	case ADBMS_USPEED:
    195       1.1  macallan 		printf("MicroSpeed mouse, default parameters\n");
    196       1.1  macallan 		break;
    197       1.1  macallan 	case ADBMS_UCONTOUR:
    198       1.1  macallan 		printf("Contour mouse, default parameters\n");
    199       1.1  macallan 		break;
    200       1.1  macallan 	case ADBMS_TURBO:
    201       1.1  macallan 		printf("Kensington Turbo Mouse\n");
    202       1.1  macallan 		break;
    203       1.1  macallan 	case ADBMS_EXTENDED:
    204       1.1  macallan 		if (sc->sc_devid[0] == '\0') {
    205       1.1  macallan 			printf("Logitech ");
    206       1.1  macallan 			switch (sc->sc_class) {
    207       1.1  macallan 			case MSCLASS_MOUSE:
    208       1.1  macallan 				printf("MouseMan (non-EMP) mouse");
    209       1.1  macallan 				break;
    210       1.1  macallan 			case MSCLASS_TRACKBALL:
    211       1.1  macallan 				printf("TrackMan (non-EMP) trackball");
    212       1.1  macallan 				break;
    213       1.1  macallan 			default:
    214       1.1  macallan 				printf("non-EMP relative positioning device");
    215       1.1  macallan 				break;
    216       1.1  macallan 			}
    217       1.1  macallan 			printf("\n");
    218       1.1  macallan 		} else {
    219       1.1  macallan 			printf("EMP ");
    220       1.1  macallan 			switch (sc->sc_class) {
    221       1.1  macallan 			case MSCLASS_TABLET:
    222       1.1  macallan 				printf("tablet");
    223       1.1  macallan 				break;
    224       1.1  macallan 			case MSCLASS_MOUSE:
    225       1.1  macallan 				printf("mouse");
    226       1.1  macallan 				break;
    227       1.1  macallan 			case MSCLASS_TRACKBALL:
    228       1.1  macallan 				printf("trackball");
    229       1.1  macallan 				break;
    230       1.1  macallan 			case MSCLASS_TRACKPAD:
    231       1.1  macallan 				printf("trackpad");
    232       1.1  macallan 				init_trackpad(sc);
    233       1.1  macallan 				break;
    234       1.1  macallan 			default:
    235       1.1  macallan 				printf("unknown device");
    236       1.1  macallan 				break;
    237       1.1  macallan 			}
    238      1.12  christos 			printf(" <%s> %d-button, %u dpi\n", sc->sc_devid,
    239      1.12  christos 			    sc->sc_buttons, sc->sc_res);
    240       1.1  macallan 		}
    241       1.1  macallan 		break;
    242       1.1  macallan 	default:
    243       1.1  macallan 		printf("relative positioning device (mouse?) (%d)\n",
    244       1.1  macallan 			sc->sc_adbdev->handler_id);
    245       1.1  macallan 		break;
    246       1.1  macallan 	}
    247       1.1  macallan 
    248       1.1  macallan 	a.accessops = &adbms_accessops;
    249       1.1  macallan 	a.accesscookie = sc;
    250       1.1  macallan 	sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
    251       1.1  macallan }
    252       1.1  macallan 
    253       1.1  macallan 
    254       1.1  macallan /*
    255       1.1  macallan  * Initialize extended mouse support -- probes devices as described
    256       1.1  macallan  * in Inside Macintosh: Devices, Chapter 5 "ADB Manager".
    257       1.1  macallan  *
    258       1.1  macallan  * Extended Mouse Protocol is documented in TechNote HW1:
    259       1.1  macallan  * 	"ADB - The Untold Story:  Space Aliens Ate My Mouse"
    260       1.1  macallan  *
    261       1.1  macallan  * Supports: Extended Mouse Protocol, MicroSpeed Mouse Deluxe,
    262       1.1  macallan  * 	     Mouse Systems A^3 Mouse, Logitech non-EMP MouseMan
    263       1.1  macallan  */
    264       1.1  macallan void
    265       1.1  macallan ems_init(struct adbms_softc *sc)
    266       1.1  macallan {
    267       1.1  macallan 
    268       1.1  macallan 	DPRINTF("ems_init %d\n", sc->sc_adbdev->handler_id);
    269       1.1  macallan 
    270       1.1  macallan 	switch (sc->sc_adbdev->handler_id) {
    271       1.1  macallan 		case ADBMS_USPEED:
    272       1.1  macallan 		case ADBMS_UCONTOUR:
    273       1.1  macallan 			adbms_init_uspeed(sc);
    274       1.1  macallan 			return;
    275       1.1  macallan 		case ADBMS_TURBO:
    276       1.1  macallan 			adbms_init_turbo(sc);
    277       1.1  macallan 			return;
    278       1.1  macallan 		case ADBMS_100DPI:
    279       1.1  macallan 		case ADBMS_200DPI:
    280       1.1  macallan 			adbms_init_mouse(sc);
    281       1.1  macallan 	}
    282       1.1  macallan }
    283       1.1  macallan 
    284       1.1  macallan static void
    285       1.1  macallan adbms_init_uspeed(struct adbms_softc *sc)
    286       1.1  macallan {
    287       1.1  macallan 	uint8_t cmd, addr, buffer[4];
    288       1.1  macallan 
    289       1.1  macallan 	addr = sc->sc_adbdev->current_addr;
    290       1.1  macallan 
    291       1.1  macallan 	/* Found MicroSpeed Mouse Deluxe Mac or Contour Mouse */
    292       1.1  macallan 	cmd = ADBLISTEN(addr, 1);
    293       1.1  macallan 
    294       1.1  macallan 	/*
    295       1.1  macallan 	 * To setup the MicroSpeed or the Contour, it appears
    296       1.1  macallan 	 * that we can send the following command to the mouse
    297       1.1  macallan 	 * and then expect data back in the form:
    298       1.1  macallan 	 *  buffer[0] = 4 (bytes)
    299       1.1  macallan 	 *  buffer[1], buffer[2] as std. mouse
    300       1.1  macallan 	 *  buffer[3] = buffer[4] = 0xff when no buttons
    301       1.1  macallan 	 *   are down.  When button N down, bit N is clear.
    302       1.1  macallan 	 * buffer[4]'s locking mask enables a
    303       1.1  macallan 	 * click to toggle the button down state--sort of
    304       1.1  macallan 	 * like the "Easy Access" shift/control/etc. keys.
    305       1.1  macallan 	 * buffer[3]'s alternative speed mask enables using
    306       1.1  macallan 	 * different speed when the corr. button is down
    307       1.1  macallan 	 */
    308       1.1  macallan 	buffer[0] = 0x00;	/* Alternative speed */
    309       1.1  macallan 	buffer[1] = 0x00;	/* speed = maximum */
    310       1.1  macallan 	buffer[2] = 0x10;	/* enable extended protocol,
    311       1.1  macallan 				 * lower bits = alt. speed mask
    312       1.1  macallan 				 *            = 0000b
    313       1.1  macallan 				 */
    314       1.1  macallan 	buffer[3] = 0x07;	/* Locking mask = 0000b,
    315       1.1  macallan 				 * enable buttons = 0111b
    316       1.1  macallan 				 */
    317       1.1  macallan 	adbms_send_sync(sc, cmd, 4, buffer);
    318       1.1  macallan 
    319       1.1  macallan 	sc->sc_buttons = 3;
    320       1.1  macallan 	sc->sc_res = 200;
    321       1.1  macallan }
    322       1.1  macallan 
    323       1.1  macallan static void
    324       1.1  macallan adbms_init_turbo(struct adbms_softc *sc)
    325       1.1  macallan {
    326       1.1  macallan 	uint8_t addr;
    327       1.1  macallan 
    328       1.1  macallan 	/* Found Kensington Turbo Mouse */
    329       1.1  macallan 	static u_char data1[] =
    330       1.1  macallan 		{ 0xe7, 0x8c, 0, 0, 0, 0xff, 0xff, 0x94 };
    331       1.1  macallan 	static u_char data2[] =
    332       1.1  macallan 		{ 0xa5, 0x14, 0, 0, 0x69, 0xff, 0xff, 0x27 };
    333       1.1  macallan 
    334       1.1  macallan 	addr = sc->sc_adbdev->current_addr;
    335       1.1  macallan 
    336       1.1  macallan 	adbms_send_sync(sc, ADBFLUSH(addr), 0, NULL);
    337       1.1  macallan 	adbms_send_sync(sc, ADBLISTEN(addr, 2), 8, data1);
    338       1.1  macallan 	adbms_send_sync(sc, ADBFLUSH(addr), 0, NULL);
    339       1.1  macallan 	adbms_send_sync(sc, ADBLISTEN(addr, 2), 8, data2);
    340       1.1  macallan }
    341       1.1  macallan 
    342       1.1  macallan static void
    343       1.1  macallan adbms_init_mouse(struct adbms_softc *sc)
    344       1.1  macallan {
    345       1.1  macallan 	int len;
    346       1.1  macallan 	uint8_t cmd, addr, buffer[16];
    347       1.1  macallan 
    348       1.1  macallan 	addr = sc->sc_adbdev->current_addr;
    349       1.1  macallan 	/* found a mouse */
    350       1.1  macallan 	cmd = ADBTALK(addr, 3);
    351       1.1  macallan 	if (!adbms_send_sync(sc, cmd, 0, NULL)) {
    352       1.1  macallan #ifdef ADBMS_DEBUG
    353       1.1  macallan 		printf("adb: ems_init timed out\n");
    354       1.1  macallan #endif
    355       1.1  macallan 		return;
    356       1.1  macallan 	}
    357       1.1  macallan 
    358       1.1  macallan 	/* Attempt to initialize Extended Mouse Protocol */
    359       1.1  macallan 	len = sc->sc_msg_len;
    360       1.1  macallan 	memcpy(buffer, sc->sc_buffer, len);
    361       1.1  macallan 	DPRINTF("buffer: %02x %02x\n", buffer[0], buffer[1]);
    362       1.1  macallan 	buffer[1] = 4; /* make handler ID 4 */
    363       1.1  macallan 	cmd = ADBLISTEN(addr, 3);
    364       1.1  macallan 	if (!adbms_send_sync(sc, cmd, len, buffer)) {
    365       1.1  macallan #ifdef ADBMS_DEBUG
    366       1.1  macallan 		printf("adb: ems_init timed out\n");
    367       1.1  macallan #endif
    368       1.1  macallan 		return;
    369       1.1  macallan 	}
    370       1.1  macallan 
    371       1.1  macallan 	/*
    372       1.1  macallan 	 * Check to see if successful, if not
    373       1.1  macallan 	 * try to initialize it as other types
    374       1.1  macallan 	 */
    375       1.1  macallan 	cmd = ADBTALK(addr, 3);
    376       1.1  macallan 	if (!adbms_send_sync(sc, cmd, 0, NULL)) {
    377       1.1  macallan 		DPRINTF("timeout checking for EMP switch\n");
    378       1.1  macallan 		return;
    379       1.1  macallan 	}
    380       1.1  macallan 	DPRINTF("new handler ID: %02x\n", sc->sc_buffer[1]);
    381       1.1  macallan 	if (sc->sc_buffer[1] == ADBMS_EXTENDED) {
    382       1.1  macallan 		sc->sc_adbdev->handler_id = ADBMS_EXTENDED;
    383       1.1  macallan 		cmd = ADBTALK(addr, 1);
    384       1.1  macallan 		if(!adbms_send_sync(sc, cmd, 0, NULL)) {
    385       1.1  macallan 			DPRINTF("adb: ems_init timed out\n");
    386       1.1  macallan 			return;
    387       1.1  macallan 		}
    388       1.1  macallan 
    389       1.1  macallan 		len = sc->sc_msg_len;
    390       1.1  macallan 		memcpy(buffer, sc->sc_buffer, len);
    391       1.1  macallan 
    392       1.1  macallan 		if (sc->sc_msg_len == 8) {
    393      1.12  christos 			uint16_t res;
    394       1.1  macallan 			/* we have a true EMP device */
    395       1.1  macallan #ifdef ADB_PRINT_EMP
    396       1.1  macallan 
    397       1.1  macallan 			printf("EMP: %02x %02x %02x %02x %02x %02x %02x %02x\n",
    398       1.1  macallan 			    buffer[0], buffer[1], buffer[2], buffer[3],
    399       1.1  macallan 			    buffer[4], buffer[5], buffer[6], buffer[7]);
    400       1.1  macallan #endif
    401      1.12  christos 			memcpy(sc->sc_devid, &buffer[0], 4);
    402      1.12  christos 			memcpy(&res, &buffer[4], sizeof(res));
    403      1.12  christos 			sc->sc_res = res;
    404       1.1  macallan 			sc->sc_class = buffer[6];
    405       1.1  macallan 			sc->sc_buttons = buffer[7];
    406       1.1  macallan 		} else if (buffer[0] == 0x9a &&
    407       1.1  macallan 		    ((buffer[1] == 0x20) || (buffer[1] == 0x21))) {
    408       1.1  macallan 			/*
    409       1.1  macallan 			 * Set up non-EMP Mouseman/Trackman to put
    410       1.1  macallan 			 * button bits in 3rd byte instead of sending
    411       1.1  macallan 			 * via pseudo keyboard device.
    412       1.1  macallan 			 */
    413       1.1  macallan 			if (buffer[1] == 0x21)
    414       1.1  macallan 				sc->sc_class = MSCLASS_TRACKBALL;
    415       1.1  macallan 			else
    416       1.1  macallan 				sc->sc_class = MSCLASS_MOUSE;
    417       1.1  macallan 
    418       1.1  macallan 			cmd = ADBLISTEN(addr, 1);
    419       1.1  macallan 			buffer[0]=0x00;
    420       1.1  macallan 			buffer[1]=0x81;
    421       1.1  macallan 			adbms_send_sync(sc, cmd, 2, buffer);
    422       1.1  macallan 
    423       1.1  macallan 			cmd = ADBLISTEN(addr, 1);
    424       1.1  macallan 			buffer[0]=0x01;
    425       1.1  macallan 			buffer[1]=0x81;
    426       1.1  macallan 			adbms_send_sync(sc, cmd, 2, buffer);
    427       1.1  macallan 
    428       1.1  macallan 			cmd = ADBLISTEN(addr, 1);
    429       1.1  macallan 			buffer[0]=0x02;
    430       1.1  macallan 			buffer[1]=0x81;
    431       1.1  macallan 			adbms_send_sync(sc, cmd, 2, buffer);
    432       1.1  macallan 
    433       1.1  macallan 			cmd = ADBLISTEN(addr, 1);
    434       1.1  macallan 			buffer[0]=0x03;
    435       1.1  macallan 			buffer[1]=0x38;
    436       1.1  macallan 			adbms_send_sync(sc, cmd, 2, buffer);
    437       1.1  macallan 
    438       1.1  macallan 			sc->sc_buttons = 3;
    439       1.1  macallan 			sc->sc_res = 400;
    440       1.1  macallan 		}
    441       1.1  macallan 	} else {
    442       1.1  macallan 		/* Attempt to initialize as an A3 mouse */
    443       1.1  macallan 		buffer[1] = 0x03; /* make handler ID 3 */
    444       1.1  macallan 		cmd = ADBLISTEN(addr, 3);
    445       1.1  macallan 		if (!adbms_send_sync(sc, cmd, len, buffer)) {
    446       1.1  macallan #ifdef ADBMS_DEBUG
    447       1.1  macallan 			printf("adb: ems_init timed out\n");
    448       1.1  macallan #endif
    449       1.1  macallan 			return;
    450       1.1  macallan 		}
    451       1.1  macallan 
    452       1.1  macallan 		/*
    453       1.1  macallan 		 * Check to see if successful, if not
    454       1.1  macallan 		 * try to initialize it as other types
    455       1.1  macallan 		 */
    456       1.1  macallan 		cmd = ADBTALK(addr, 3);
    457       1.1  macallan 		if(adbms_send_sync(sc, cmd, 0, NULL)) {
    458       1.1  macallan 			len = sc->sc_msg_len;
    459       1.1  macallan 			memcpy(buffer, sc->sc_buffer, len);
    460       1.1  macallan 			if (buffer[1] == ADBMS_MSA3) {
    461       1.1  macallan 				sc->sc_adbdev->handler_id = ADBMS_MSA3;
    462       1.1  macallan 				/* Initialize as above */
    463       1.1  macallan 				cmd = ADBLISTEN(addr, 2);
    464       1.1  macallan 				/* listen 2 */
    465       1.1  macallan 				buffer[0] = 0x00;
    466       1.1  macallan 				/* Irrelevant, buffer has 0x77 */
    467       1.1  macallan 				buffer[2] = 0x07;
    468       1.1  macallan 				/*
    469       1.1  macallan 				 * enable 3 button mode = 0111b,
    470       1.1  macallan 				 * speed = normal
    471       1.1  macallan 				 */
    472       1.1  macallan 				adbms_send_sync(sc, cmd, 3, buffer);
    473       1.1  macallan 				sc->sc_buttons = 3;
    474       1.1  macallan 				sc->sc_res = 300;
    475       1.1  macallan 			}
    476       1.1  macallan 		}
    477       1.1  macallan 	}
    478       1.1  macallan }
    479       1.1  macallan 
    480       1.1  macallan static void
    481       1.1  macallan adbms_handler(void *cookie, int len, uint8_t *data)
    482       1.1  macallan {
    483       1.1  macallan 	struct adbms_softc *sc = cookie;
    484       1.1  macallan 
    485       1.1  macallan #ifdef ADBMS_DEBUG
    486       1.1  macallan 	int i;
    487       1.8      matt 	printf("%s: %02x - ", device_xname(sc->sc_dev), sc->sc_us);
    488       1.1  macallan 	for (i = 0; i < len; i++) {
    489       1.1  macallan 		printf(" %02x", data[i]);
    490       1.1  macallan 	}
    491       1.1  macallan 	printf("\n");
    492       1.1  macallan #endif
    493       1.1  macallan 	if (len >= 2) {
    494       1.1  macallan 		memcpy(sc->sc_buffer, &data[2], len - 2);
    495       1.1  macallan 		sc->sc_msg_len = len - 2;
    496       1.1  macallan 		if (data[1] == sc->sc_us) {
    497       1.1  macallan 			/* make sense of the mouse message */
    498       1.1  macallan 			adbms_process_event(sc, sc->sc_msg_len, sc->sc_buffer);
    499       1.1  macallan 			return;
    500       1.1  macallan 		}
    501       1.1  macallan 		wakeup(&sc->sc_event);
    502       1.1  macallan 	} else {
    503       1.1  macallan 		DPRINTF("bogus message\n");
    504       1.1  macallan 	}
    505       1.1  macallan }
    506       1.1  macallan 
    507       1.1  macallan static void
    508       1.1  macallan adbms_process_event(struct adbms_softc *sc, int len, uint8_t *buffer)
    509       1.1  macallan {
    510       1.1  macallan 	int buttons = 0, mask, dx, dy, i;
    511       1.1  macallan 	int button_bit = 1;
    512       1.1  macallan 
    513       1.1  macallan 	if ((sc->sc_adbdev->handler_id == ADBMS_EXTENDED) && (sc->sc_devid[0] == 0)) {
    514       1.1  macallan 		/* massage the data to look like EMP data */
    515       1.1  macallan 		if ((buffer[2] & 0x04) == 0x04)
    516       1.1  macallan 			buffer[0] &= 0x7f;
    517       1.1  macallan 		else
    518       1.1  macallan 			buffer[0] |= 0x80;
    519       1.1  macallan 		if ((buffer[2] & 0x02) == 0x02)
    520       1.1  macallan 			buffer[1] &= 0x7f;
    521       1.1  macallan 		else
    522       1.1  macallan 			buffer[1] |= 0x80;
    523       1.1  macallan 		if ((buffer[2] & 0x01) == 0x01)
    524       1.1  macallan 			buffer[2] = 0x00;
    525       1.1  macallan 		else
    526       1.1  macallan 			buffer[2] = 0x80;
    527       1.1  macallan 	}
    528       1.1  macallan 
    529       1.1  macallan 	switch (sc->sc_adbdev->handler_id) {
    530       1.1  macallan 		case ADBMS_USPEED:
    531       1.1  macallan 		case ADBMS_UCONTOUR:
    532       1.1  macallan 			/* MicroSpeed mouse and Contour mouse */
    533       1.1  macallan 			if (len == 4)
    534       1.1  macallan 				buttons = (~buffer[3]) & 0xff;
    535       1.1  macallan 			else
    536       1.1  macallan 				buttons = (buffer[1] & 0x80) ? 0 : 1;
    537       1.1  macallan 			break;
    538       1.1  macallan 		case ADBMS_MSA3:
    539       1.1  macallan 			/* Mouse Systems A3 mouse */
    540       1.1  macallan 			if (len == 3)
    541       1.1  macallan 				buttons = (~buffer[2]) & 0x07;
    542       1.1  macallan 			else
    543       1.1  macallan 				buttons = (buffer[0] & 0x80) ? 0 : 1;
    544       1.1  macallan 			break;
    545       1.1  macallan 		default:
    546       1.1  macallan 			/* Classic Mouse Protocol (up to 2 buttons) */
    547       1.1  macallan 			for (i = 0; i < 2; i++, button_bit <<= 1)
    548       1.1  macallan 				/* 0 when button down */
    549       1.1  macallan 				if (!(buffer[i] & 0x80))
    550       1.1  macallan 					buttons |= button_bit;
    551       1.1  macallan 				else
    552       1.1  macallan 					buttons &= ~button_bit;
    553       1.1  macallan 			/* Extended Protocol (up to 6 more buttons) */
    554       1.1  macallan 			for (mask = 0x80; i < len;
    555       1.1  macallan 			     i += (mask == 0x80), button_bit <<= 1) {
    556       1.1  macallan 				/* 0 when button down */
    557       1.1  macallan 				if (!(buffer[i] & mask))
    558       1.1  macallan 					buttons |= button_bit;
    559       1.1  macallan 				else
    560       1.1  macallan 					buttons &= ~button_bit;
    561       1.1  macallan 				mask = ((mask >> 4) & 0xf)
    562       1.1  macallan 					| ((mask & 0xf) << 4);
    563       1.1  macallan 			}
    564       1.1  macallan 			break;
    565       1.1  macallan 	}
    566       1.1  macallan 
    567       1.1  macallan 	dx = ((int)(buffer[1] & 0x3f)) - ((buffer[1] & 0x40) ? 64 : 0);
    568       1.1  macallan 	dy = ((int)(buffer[0] & 0x3f)) - ((buffer[0] & 0x40) ? 64 : 0);
    569       1.1  macallan 
    570       1.1  macallan 	if (sc->sc_class == MSCLASS_TRACKPAD) {
    571       1.1  macallan 
    572       1.4   tsutsui 		if (sc->sc_tapping == 1) {
    573       1.4   tsutsui 			if (sc->sc_down) {
    574       1.4   tsutsui 				/* finger is down - collect motion data */
    575       1.4   tsutsui 				sc->sc_x += dx;
    576       1.4   tsutsui 				sc->sc_y += dy;
    577       1.4   tsutsui 			}
    578       1.4   tsutsui 			DPRINTF("buttons: %02x\n", buttons);
    579       1.4   tsutsui 			switch (sc->sc_buttons) {
    580       1.4   tsutsui 				case 2:
    581       1.4   tsutsui 					buttons |= ((buttons & 2) >> 1);
    582       1.4   tsutsui 					adbms_mangle_2(sc, buttons);
    583       1.4   tsutsui 					break;
    584       1.4   tsutsui 				case 4:
    585       1.4   tsutsui 					adbms_mangle_4(sc, buttons);
    586       1.4   tsutsui 					break;
    587       1.4   tsutsui 			}
    588       1.1  macallan 		}
    589       1.1  macallan 		/* filter the pseudo-buttons out */
    590       1.1  macallan 		buttons &= 1;
    591       1.1  macallan 	}
    592       1.1  macallan 
    593       1.1  macallan 	if (sc->sc_wsmousedev)
    594       1.1  macallan 		wsmouse_input(sc->sc_wsmousedev, sc->sc_mb | buttons,
    595       1.1  macallan 			      dx, -dy, 0, 0,
    596       1.1  macallan 			      WSMOUSE_INPUT_DELTA);
    597       1.1  macallan #if NAED > 0
    598       1.1  macallan 	aed_input(&new_event);
    599       1.1  macallan #endif
    600       1.1  macallan }
    601       1.1  macallan 
    602       1.1  macallan static void
    603       1.1  macallan adbms_mangle_2(struct adbms_softc *sc, int buttons)
    604       1.1  macallan {
    605       1.1  macallan 
    606       1.1  macallan 	if (buttons & 4) {
    607       1.1  macallan 		/* finger down on pad */
    608       1.1  macallan 		if (sc->sc_down == 0) {
    609       1.1  macallan 			sc->sc_down = 1;
    610       1.1  macallan 			sc->sc_x = 0;
    611       1.1  macallan 			sc->sc_y = 0;
    612       1.1  macallan 		}
    613       1.1  macallan 	}
    614       1.1  macallan 	if (buttons & 8) {
    615       1.1  macallan 		/* finger up */
    616       1.1  macallan 		if (sc->sc_down) {
    617       1.1  macallan 			if (((sc->sc_x * sc->sc_x +
    618       1.9  macallan 			    sc->sc_y * sc->sc_y) < 3) &&
    619       1.1  macallan 			    (sc->sc_wsmousedev)) {
    620       1.1  macallan 				/*
    621       1.1  macallan 				 * if there wasn't much movement between
    622       1.1  macallan 				 * finger down and up again we assume
    623       1.1  macallan 				 * someone tapped the pad and we just
    624       1.1  macallan 				 * send a mouse button event
    625       1.1  macallan 				 */
    626       1.1  macallan 				wsmouse_input(sc->sc_wsmousedev,
    627       1.1  macallan 				    1, 0, 0, 0, 0, WSMOUSE_INPUT_DELTA);
    628       1.1  macallan 			}
    629       1.1  macallan 			sc->sc_down = 0;
    630       1.1  macallan 		}
    631       1.1  macallan 	}
    632       1.1  macallan }
    633       1.1  macallan 
    634       1.1  macallan static void
    635       1.1  macallan adbms_mangle_4(struct adbms_softc *sc, int buttons)
    636       1.1  macallan {
    637       1.1  macallan 
    638       1.1  macallan 	if (buttons & 0x20) {
    639       1.1  macallan 		/* finger down on pad */
    640       1.1  macallan 		if (sc->sc_down == 0) {
    641       1.1  macallan 			sc->sc_down = 1;
    642       1.1  macallan 			sc->sc_x = 0;
    643       1.1  macallan 			sc->sc_y = 0;
    644       1.1  macallan 		}
    645       1.1  macallan 	}
    646       1.1  macallan 	if ((buttons & 0x20) == 0) {
    647       1.1  macallan 		/* finger up */
    648       1.1  macallan 		if (sc->sc_down) {
    649       1.1  macallan 			if (((sc->sc_x * sc->sc_x +
    650       1.9  macallan 			    sc->sc_y * sc->sc_y) < 3) &&
    651       1.1  macallan 			    (sc->sc_wsmousedev)) {
    652       1.1  macallan 				/*
    653       1.1  macallan 				 * if there wasn't much movement between
    654       1.1  macallan 				 * finger down and up again we assume
    655       1.1  macallan 				 * someone tapped the pad and we just
    656       1.1  macallan 				 * send a mouse button event
    657       1.1  macallan 				 */
    658       1.1  macallan 				wsmouse_input(sc->sc_wsmousedev,
    659       1.1  macallan 				    1, 0, 0, 0, 0, WSMOUSE_INPUT_DELTA);
    660       1.1  macallan 			}
    661       1.1  macallan 			sc->sc_down = 0;
    662       1.1  macallan 		}
    663       1.1  macallan 	}
    664       1.1  macallan }
    665       1.1  macallan 
    666       1.1  macallan static int
    667       1.1  macallan adbms_enable(void *v)
    668       1.1  macallan {
    669       1.1  macallan 	return 0;
    670       1.1  macallan }
    671       1.1  macallan 
    672       1.1  macallan static int
    673       1.6  christos adbms_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l)
    674       1.1  macallan {
    675       1.1  macallan 
    676       1.1  macallan 	switch (cmd) {
    677       1.1  macallan 	case WSMOUSEIO_GTYPE:
    678       1.1  macallan 		*(u_int *)data = WSMOUSE_TYPE_ADB;
    679       1.1  macallan 		break;
    680       1.1  macallan 
    681       1.1  macallan 	default:
    682       1.1  macallan 		return (EPASSTHROUGH);
    683       1.1  macallan 	}
    684       1.1  macallan 	return (0);
    685       1.1  macallan }
    686       1.1  macallan 
    687       1.1  macallan static void
    688       1.1  macallan adbms_disable(void *v)
    689       1.1  macallan {
    690       1.1  macallan }
    691       1.1  macallan 
    692       1.1  macallan static void
    693       1.1  macallan init_trackpad(struct adbms_softc *sc)
    694       1.1  macallan {
    695      1.10  macallan 	const struct sysctlnode *me = NULL, *node = NULL;
    696       1.4   tsutsui 	int cmd, addr, ret;
    697       1.1  macallan 	uint8_t buffer[16];
    698       1.1  macallan 	uint8_t b2[] = {0x99, 0x94, 0x19, 0xff, 0xb2, 0x8a, 0x1b, 0x50};
    699       1.1  macallan 
    700       1.1  macallan 	addr = sc->sc_adbdev->current_addr;
    701       1.1  macallan 	cmd = ADBTALK(addr, 1);
    702       1.1  macallan 	if (!adbms_send_sync(sc, cmd, 0, NULL))
    703       1.1  macallan 		return;
    704       1.1  macallan 
    705       1.1  macallan 	if (sc->sc_msg_len != 8)
    706       1.1  macallan 		return;
    707       1.1  macallan 
    708       1.1  macallan 	memcpy(buffer, sc->sc_buffer, 8);
    709       1.1  macallan 
    710       1.1  macallan 	/* now whack the pad */
    711       1.1  macallan 	cmd = ADBLISTEN(addr, 1);
    712       1.1  macallan 	buffer[6] = 0x0d;
    713       1.1  macallan 	adbms_send_sync(sc, cmd, 8, buffer);
    714       1.1  macallan 
    715       1.1  macallan 	delay(1000);
    716       1.1  macallan 	cmd = ADBLISTEN(addr, 2);
    717       1.1  macallan 	adbms_send_sync(sc, cmd, 8, b2);
    718       1.1  macallan 
    719       1.1  macallan 	delay(1000);
    720       1.1  macallan 	cmd = ADBLISTEN(addr, 1);
    721       1.1  macallan 	buffer[6] = 0x03;
    722       1.1  macallan 	adbms_send_sync(sc, cmd, 8, buffer);
    723       1.1  macallan 
    724       1.1  macallan 	cmd = ADBFLUSH(addr);
    725       1.1  macallan 	adbms_send_sync(sc, cmd, 0, NULL);
    726       1.1  macallan 	delay(1000);
    727       1.4   tsutsui 
    728       1.4   tsutsui 	/*
    729      1.11   mbalmer 	 * setup a sysctl node to control whether tapping the pad should
    730       1.4   tsutsui 	 * trigger mouse button events
    731       1.4   tsutsui 	 */
    732       1.4   tsutsui 
    733       1.4   tsutsui 	sc->sc_tapping = 1;
    734       1.4   tsutsui 
    735      1.10  macallan 	ret = sysctl_createv(NULL, 0, NULL, &me,
    736       1.4   tsutsui 	    CTLFLAG_READWRITE,
    737       1.8      matt 	    CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
    738       1.4   tsutsui 	    NULL, 0, NULL, 0,
    739       1.4   tsutsui 	    CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    740       1.4   tsutsui 
    741      1.10  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    742      1.10  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    743       1.4   tsutsui 	    CTLTYPE_INT, "tapping", "tapping the pad causes button events",
    744      1.13       dsl 	    sysctl_adbms_tap, 1, (void *)sc, 0,
    745       1.4   tsutsui 	    CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    746  1.14.2.1     rmind 
    747  1.14.2.1     rmind 	(void)ret;
    748       1.1  macallan }
    749       1.1  macallan 
    750       1.1  macallan static int
    751       1.1  macallan adbms_wait(struct adbms_softc *sc, int timeout)
    752       1.1  macallan {
    753       1.1  macallan 	int cnt = 0;
    754       1.1  macallan 
    755       1.1  macallan 	if (sc->sc_poll) {
    756       1.1  macallan 		while (sc->sc_msg_len == -1) {
    757       1.1  macallan 			sc->sc_ops->poll(sc->sc_ops->cookie);
    758       1.1  macallan 		}
    759       1.1  macallan 	} else {
    760       1.1  macallan 		while ((sc->sc_msg_len == -1) && (cnt < timeout)) {
    761       1.9  macallan 			tsleep(&sc->sc_event, 0, "adbmsio", hz);
    762       1.1  macallan 			cnt++;
    763       1.1  macallan 		}
    764       1.1  macallan 	}
    765       1.1  macallan 	return (sc->sc_msg_len > 0);
    766       1.1  macallan }
    767       1.1  macallan 
    768       1.1  macallan static int
    769       1.1  macallan adbms_send_sync(struct adbms_softc *sc, uint8_t cmd, int len, uint8_t *msg)
    770       1.1  macallan {
    771       1.1  macallan 	int i;
    772       1.1  macallan 
    773       1.1  macallan 	sc->sc_msg_len = -1;
    774       1.1  macallan 	DPRINTF("send: %02x", cmd);
    775       1.1  macallan 	for (i = 0; i < len; i++)
    776       1.1  macallan 		DPRINTF(" %02x", msg[i]);
    777       1.1  macallan 	DPRINTF("\n");
    778       1.1  macallan 	sc->sc_ops->send(sc->sc_ops->cookie, sc->sc_poll, cmd, len, msg);
    779       1.1  macallan 	adbms_wait(sc, 1000);
    780       1.1  macallan 	return (sc->sc_msg_len != -1);
    781       1.1  macallan }
    782       1.4   tsutsui 
    783       1.4   tsutsui static int
    784       1.4   tsutsui sysctl_adbms_tap(SYSCTLFN_ARGS)
    785       1.4   tsutsui {
    786       1.4   tsutsui 	struct sysctlnode node = *rnode;
    787       1.4   tsutsui 	struct adbms_softc *sc = node.sysctl_data;
    788       1.4   tsutsui 
    789       1.4   tsutsui 	node.sysctl_idata = sc->sc_tapping;
    790       1.4   tsutsui 
    791       1.4   tsutsui 	if (newp) {
    792       1.4   tsutsui 
    793       1.4   tsutsui 		/* we're asked to write */
    794       1.4   tsutsui 		node.sysctl_data = &sc->sc_tapping;
    795       1.4   tsutsui 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    796       1.4   tsutsui 
    797      1.10  macallan 			sc->sc_tapping = (*(int *)node.sysctl_data == 0) ? 0 : 1;
    798       1.4   tsutsui 			return 0;
    799       1.4   tsutsui 		}
    800       1.4   tsutsui 		return EINVAL;
    801       1.4   tsutsui 	} else {
    802       1.4   tsutsui 
    803      1.10  macallan 		node.sysctl_data = &sc->sc_tapping;
    804       1.4   tsutsui 		node.sysctl_size = 4;
    805       1.4   tsutsui 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    806       1.4   tsutsui 	}
    807       1.4   tsutsui 
    808       1.4   tsutsui 	return 0;
    809       1.4   tsutsui }
    810       1.4   tsutsui 
    811       1.4   tsutsui SYSCTL_SETUP(sysctl_ams_setup, "sysctl ams subtree setup")
    812       1.4   tsutsui {
    813       1.4   tsutsui 
    814       1.4   tsutsui 	sysctl_createv(NULL, 0, NULL, NULL,
    815       1.4   tsutsui 		       CTLFLAG_PERMANENT,
    816       1.4   tsutsui 		       CTLTYPE_NODE, "machdep", NULL,
    817       1.4   tsutsui 		       NULL, 0, NULL, 0,
    818       1.4   tsutsui 		       CTL_MACHDEP, CTL_EOL);
    819       1.4   tsutsui }
    820