xref: /freebsd/sys/dev/adb/adb_mouse.c (revision 582434bd08e752cee5742bd54d0da37acfc49861)
1b4dbc599SNathan Whitehorn /*-
2b4dbc599SNathan Whitehorn  * Copyright (C) 2008 Nathan Whitehorn
3b4dbc599SNathan Whitehorn  * All rights reserved.
4b4dbc599SNathan Whitehorn  *
5b4dbc599SNathan Whitehorn  * Redistribution and use in source and binary forms, with or without
6b4dbc599SNathan Whitehorn  * modification, are permitted provided that the following conditions
7b4dbc599SNathan Whitehorn  * are met:
8b4dbc599SNathan Whitehorn  * 1. Redistributions of source code must retain the above copyright
9b4dbc599SNathan Whitehorn  *    notice, this list of conditions and the following disclaimer.
10b4dbc599SNathan Whitehorn  * 2. Redistributions in binary form must reproduce the above copyright
11b4dbc599SNathan Whitehorn  *    notice, this list of conditions and the following disclaimer in the
12b4dbc599SNathan Whitehorn  *    documentation and/or other materials provided with the distribution.
13b4dbc599SNathan Whitehorn  *
14b4dbc599SNathan Whitehorn  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15b4dbc599SNathan Whitehorn  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16b4dbc599SNathan Whitehorn  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17b4dbc599SNathan Whitehorn  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
18b4dbc599SNathan Whitehorn  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
19b4dbc599SNathan Whitehorn  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
20b4dbc599SNathan Whitehorn  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
21b4dbc599SNathan Whitehorn  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
22b4dbc599SNathan Whitehorn  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
23b4dbc599SNathan Whitehorn  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24b4dbc599SNathan Whitehorn  *
25b4dbc599SNathan Whitehorn  * $FreeBSD$
26b4dbc599SNathan Whitehorn  */
27b4dbc599SNathan Whitehorn 
28b4dbc599SNathan Whitehorn #include <sys/cdefs.h>
29b4dbc599SNathan Whitehorn #include <sys/param.h>
30b4dbc599SNathan Whitehorn #include <sys/systm.h>
31b4dbc599SNathan Whitehorn #include <sys/module.h>
32b4dbc599SNathan Whitehorn #include <sys/bus.h>
33b4dbc599SNathan Whitehorn #include <sys/conf.h>
34b4dbc599SNathan Whitehorn #include <sys/mouse.h>
35b4dbc599SNathan Whitehorn #include <sys/poll.h>
36b4dbc599SNathan Whitehorn #include <sys/condvar.h>
37b4dbc599SNathan Whitehorn #include <sys/selinfo.h>
38b4dbc599SNathan Whitehorn #include <sys/uio.h>
39b4dbc599SNathan Whitehorn #include <sys/fcntl.h>
40b4dbc599SNathan Whitehorn #include <sys/kernel.h>
41b4dbc599SNathan Whitehorn 
42b4dbc599SNathan Whitehorn #include <machine/bus.h>
43b4dbc599SNathan Whitehorn 
44b4dbc599SNathan Whitehorn #include <vm/vm.h>
45b4dbc599SNathan Whitehorn #include <vm/pmap.h>
46b4dbc599SNathan Whitehorn 
47b4dbc599SNathan Whitehorn #include "adb.h"
48b4dbc599SNathan Whitehorn 
49b4dbc599SNathan Whitehorn #define CDEV_GET_SOFTC(x) devclass_get_softc(adb_mouse_devclass, minor(x) & 0x1f)
50b4dbc599SNathan Whitehorn 
51b4dbc599SNathan Whitehorn static int adb_mouse_probe(device_t dev);
52b4dbc599SNathan Whitehorn static int adb_mouse_attach(device_t dev);
53b4dbc599SNathan Whitehorn static int adb_mouse_detach(device_t dev);
54b4dbc599SNathan Whitehorn 
55b4dbc599SNathan Whitehorn static d_open_t  ams_open;
56b4dbc599SNathan Whitehorn static d_close_t ams_close;
57b4dbc599SNathan Whitehorn static d_read_t  ams_read;
58b4dbc599SNathan Whitehorn static d_ioctl_t ams_ioctl;
59b4dbc599SNathan Whitehorn static d_poll_t  ams_poll;
60b4dbc599SNathan Whitehorn 
61b4dbc599SNathan Whitehorn static u_int adb_mouse_receive_packet(device_t dev, u_char status,
62b4dbc599SNathan Whitehorn     u_char command, u_char reg, int len, u_char *data);
63b4dbc599SNathan Whitehorn 
64b4dbc599SNathan Whitehorn struct adb_mouse_softc {
65b4dbc599SNathan Whitehorn 	device_t sc_dev;
66b4dbc599SNathan Whitehorn 
67b4dbc599SNathan Whitehorn 	struct mtx sc_mtx;
68b4dbc599SNathan Whitehorn 	struct cv  sc_cv;
69b4dbc599SNathan Whitehorn 
703c5f535bSEd Schouten 	int flags;
713c5f535bSEd Schouten #define	AMS_EXTENDED	0x1
723c5f535bSEd Schouten #define	AMS_TOUCHPAD	0x2
73b4dbc599SNathan Whitehorn 	uint16_t dpi;
74b4dbc599SNathan Whitehorn 
75b4dbc599SNathan Whitehorn 	mousehw_t hw;
76b4dbc599SNathan Whitehorn 	mousemode_t mode;
77b4dbc599SNathan Whitehorn 	u_char id[4];
78b4dbc599SNathan Whitehorn 
79b4dbc599SNathan Whitehorn 	int buttons;
80b4dbc599SNathan Whitehorn 	int last_buttons;
81b4dbc599SNathan Whitehorn 	int xdelta, ydelta;
82b4dbc599SNathan Whitehorn 
83b4dbc599SNathan Whitehorn 	int8_t packet[8];
84b4dbc599SNathan Whitehorn 	size_t packet_read_len;
85b4dbc599SNathan Whitehorn 
86b4dbc599SNathan Whitehorn 	struct cdev *cdev;
87b4dbc599SNathan Whitehorn 	struct selinfo rsel;
88b4dbc599SNathan Whitehorn };
89b4dbc599SNathan Whitehorn 
90b4dbc599SNathan Whitehorn static device_method_t adb_mouse_methods[] = {
91b4dbc599SNathan Whitehorn 	/* Device interface */
92b4dbc599SNathan Whitehorn 	DEVMETHOD(device_probe,         adb_mouse_probe),
93b4dbc599SNathan Whitehorn         DEVMETHOD(device_attach,        adb_mouse_attach),
94b4dbc599SNathan Whitehorn         DEVMETHOD(device_detach,        adb_mouse_detach),
95b4dbc599SNathan Whitehorn         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
96b4dbc599SNathan Whitehorn         DEVMETHOD(device_suspend,       bus_generic_suspend),
97b4dbc599SNathan Whitehorn         DEVMETHOD(device_resume,        bus_generic_resume),
98b4dbc599SNathan Whitehorn 
99b4dbc599SNathan Whitehorn 	/* ADB interface */
100b4dbc599SNathan Whitehorn 	DEVMETHOD(adb_receive_packet,	adb_mouse_receive_packet),
101b4dbc599SNathan Whitehorn 
102b4dbc599SNathan Whitehorn 	{ 0, 0 }
103b4dbc599SNathan Whitehorn };
104b4dbc599SNathan Whitehorn 
105b4dbc599SNathan Whitehorn static driver_t adb_mouse_driver = {
106b4dbc599SNathan Whitehorn 	"ams",
107b4dbc599SNathan Whitehorn 	adb_mouse_methods,
108b4dbc599SNathan Whitehorn 	sizeof(struct adb_mouse_softc),
109b4dbc599SNathan Whitehorn };
110b4dbc599SNathan Whitehorn 
111b4dbc599SNathan Whitehorn static devclass_t adb_mouse_devclass;
112b4dbc599SNathan Whitehorn 
113b4dbc599SNathan Whitehorn DRIVER_MODULE(ams, adb, adb_mouse_driver, adb_mouse_devclass, 0, 0);
114b4dbc599SNathan Whitehorn 
115b4dbc599SNathan Whitehorn static struct cdevsw ams_cdevsw = {
116b4dbc599SNathan Whitehorn 	.d_version = 	D_VERSION,
117b4dbc599SNathan Whitehorn 	.d_flags   = 	0,
118b4dbc599SNathan Whitehorn 	.d_open    =	ams_open,
119b4dbc599SNathan Whitehorn 	.d_close   =	ams_close,
120b4dbc599SNathan Whitehorn 	.d_read    =	ams_read,
121b4dbc599SNathan Whitehorn 	.d_ioctl   =	ams_ioctl,
122b4dbc599SNathan Whitehorn 	.d_poll    =	ams_poll,
123b4dbc599SNathan Whitehorn 	.d_name    =	"ams",
124b4dbc599SNathan Whitehorn };
125b4dbc599SNathan Whitehorn 
126b4dbc599SNathan Whitehorn static int
127b4dbc599SNathan Whitehorn adb_mouse_probe(device_t dev)
128b4dbc599SNathan Whitehorn {
129b4dbc599SNathan Whitehorn 	uint8_t type;
130b4dbc599SNathan Whitehorn 
131b4dbc599SNathan Whitehorn 	type = adb_get_device_type(dev);
132b4dbc599SNathan Whitehorn 
133b4dbc599SNathan Whitehorn 	if (type != ADB_DEVICE_MOUSE)
134b4dbc599SNathan Whitehorn 		return (ENXIO);
135b4dbc599SNathan Whitehorn 
136b4dbc599SNathan Whitehorn 	device_set_desc(dev,"ADB Mouse");
137b4dbc599SNathan Whitehorn 	return (0);
138b4dbc599SNathan Whitehorn }
139b4dbc599SNathan Whitehorn 
140b4dbc599SNathan Whitehorn static int
141b4dbc599SNathan Whitehorn adb_mouse_attach(device_t dev)
142b4dbc599SNathan Whitehorn {
143b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
144b4dbc599SNathan Whitehorn 	char *description = "Unknown Pointing Device";
145b4dbc599SNathan Whitehorn 
146b4dbc599SNathan Whitehorn 	size_t r1_len;
147b4dbc599SNathan Whitehorn 	u_char r1[8];
148b4dbc599SNathan Whitehorn 
149b4dbc599SNathan Whitehorn 	sc = device_get_softc(dev);
150b4dbc599SNathan Whitehorn 	sc->sc_dev = dev;
151b4dbc599SNathan Whitehorn 
152b4dbc599SNathan Whitehorn 	mtx_init(&sc->sc_mtx,"ams",MTX_DEF,0);
153b4dbc599SNathan Whitehorn 	cv_init(&sc->sc_cv,"ams");
154b4dbc599SNathan Whitehorn 
1553c5f535bSEd Schouten 	sc->flags = 0;
156b4dbc599SNathan Whitehorn 
157b4dbc599SNathan Whitehorn 	sc->hw.buttons = 2;
158b4dbc599SNathan Whitehorn 	sc->hw.iftype = MOUSE_IF_UNKNOWN;
159b4dbc599SNathan Whitehorn 	sc->hw.type = MOUSE_UNKNOWN;
160b4dbc599SNathan Whitehorn 	sc->hw.model = sc->hw.hwid = 0;
161b4dbc599SNathan Whitehorn 
162b4dbc599SNathan Whitehorn 	sc->mode.protocol = MOUSE_PROTO_SYSMOUSE;
163b4dbc599SNathan Whitehorn 	sc->mode.rate = -1;
164b4dbc599SNathan Whitehorn 	sc->mode.resolution = 100;
165b4dbc599SNathan Whitehorn 	sc->mode.accelfactor = 0;
166b4dbc599SNathan Whitehorn 	sc->mode.level = 0;
167b4dbc599SNathan Whitehorn 	sc->mode.packetsize = 5;
168b4dbc599SNathan Whitehorn 
169b4dbc599SNathan Whitehorn 	sc->buttons = 0;
170b4dbc599SNathan Whitehorn 	sc->last_buttons = 0;
171b4dbc599SNathan Whitehorn 	sc->packet_read_len = 0;
172b4dbc599SNathan Whitehorn 
173b4dbc599SNathan Whitehorn 	/* Try to switch to extended protocol */
174b4dbc599SNathan Whitehorn 	adb_set_device_handler(dev,4);
175b4dbc599SNathan Whitehorn 
176b4dbc599SNathan Whitehorn 	switch(adb_get_device_handler(dev)) {
177b4dbc599SNathan Whitehorn 	case 1:
178b4dbc599SNathan Whitehorn 		sc->mode.resolution = 100;
179b4dbc599SNathan Whitehorn 		break;
180b4dbc599SNathan Whitehorn 	case 2:
181b4dbc599SNathan Whitehorn 		sc->mode.resolution = 200;
182b4dbc599SNathan Whitehorn 		break;
183b4dbc599SNathan Whitehorn 	case 4:
184582434bdSNathan Whitehorn 		r1_len = adb_read_register(dev,1,r1);
185b4dbc599SNathan Whitehorn 		if (r1_len < 8)
186b4dbc599SNathan Whitehorn 			break;
187b4dbc599SNathan Whitehorn 
1883c5f535bSEd Schouten 		sc->flags |= AMS_EXTENDED;
189b4dbc599SNathan Whitehorn 		memcpy(&sc->hw.hwid,r1,4);
190b4dbc599SNathan Whitehorn 		sc->mode.resolution = (r1[4] << 8) | r1[5];
191b4dbc599SNathan Whitehorn 
192b4dbc599SNathan Whitehorn 		switch (r1[6]) {
193b4dbc599SNathan Whitehorn 		case 0:
194b4dbc599SNathan Whitehorn 			sc->hw.type = MOUSE_PAD;
195b4dbc599SNathan Whitehorn 			description = "Tablet";
196b4dbc599SNathan Whitehorn 			break;
197b4dbc599SNathan Whitehorn 		case 1:
198b4dbc599SNathan Whitehorn 			sc->hw.type = MOUSE_MOUSE;
199b4dbc599SNathan Whitehorn 			description = "Mouse";
200b4dbc599SNathan Whitehorn 			break;
201b4dbc599SNathan Whitehorn 		case 2:
202b4dbc599SNathan Whitehorn 			sc->hw.type = MOUSE_TRACKBALL;
203b4dbc599SNathan Whitehorn 			description = "Trackball";
204b4dbc599SNathan Whitehorn 			break;
2053c5f535bSEd Schouten 		case 3:
2063c5f535bSEd Schouten 			sc->flags |= AMS_TOUCHPAD;
2073c5f535bSEd Schouten 			sc->hw.type = MOUSE_PAD;
2083c5f535bSEd Schouten 			description = "Touchpad";
2093c5f535bSEd Schouten 			break;
210b4dbc599SNathan Whitehorn 		}
211b4dbc599SNathan Whitehorn 
212b4dbc599SNathan Whitehorn 		sc->hw.buttons = r1[7];
213b4dbc599SNathan Whitehorn 
214b4dbc599SNathan Whitehorn 		device_printf(dev,"%d-button %d-dpi %s\n",
215b4dbc599SNathan Whitehorn 		    sc->hw.buttons, sc->mode.resolution,description);
216b4dbc599SNathan Whitehorn 
217b4dbc599SNathan Whitehorn 		/*
218b4dbc599SNathan Whitehorn 		 * Check for one of MacAlly's non-compliant 2-button mice.
219b4dbc599SNathan Whitehorn 		 * These claim to speak the extended mouse protocol, but
220b4dbc599SNathan Whitehorn 		 * instead speak the standard protocol and only when their
221b4dbc599SNathan Whitehorn 		 * handler is set to 0x42.
222b4dbc599SNathan Whitehorn 		 */
223b4dbc599SNathan Whitehorn 
224b4dbc599SNathan Whitehorn 		if (sc->hw.hwid == 0x4b4f4954) {
225b4dbc599SNathan Whitehorn 			adb_set_device_handler(dev,0x42);
226b4dbc599SNathan Whitehorn 
227b4dbc599SNathan Whitehorn 			if (adb_get_device_handler(dev) == 0x42) {
228b4dbc599SNathan Whitehorn 				device_printf(dev, "MacAlly 2-Button Mouse\n");
2293c5f535bSEd Schouten 				sc->flags &= ~AMS_EXTENDED;
230b4dbc599SNathan Whitehorn 			}
231b4dbc599SNathan Whitehorn 		}
232b4dbc599SNathan Whitehorn 
233b4dbc599SNathan Whitehorn 		break;
234b4dbc599SNathan Whitehorn 	}
235b4dbc599SNathan Whitehorn 
236b4dbc599SNathan Whitehorn 	sc->cdev = make_dev(&ams_cdevsw, device_get_unit(dev),
237b4dbc599SNathan Whitehorn 		       UID_ROOT, GID_OPERATOR, 0644, "ams%d",
238b4dbc599SNathan Whitehorn 		       device_get_unit(dev));
239b4dbc599SNathan Whitehorn 
240b4dbc599SNathan Whitehorn 	adb_set_autopoll(dev,1);
241b4dbc599SNathan Whitehorn 
242b4dbc599SNathan Whitehorn 	return (0);
243b4dbc599SNathan Whitehorn }
244b4dbc599SNathan Whitehorn 
245b4dbc599SNathan Whitehorn static int
246b4dbc599SNathan Whitehorn adb_mouse_detach(device_t dev)
247b4dbc599SNathan Whitehorn {
248b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
249b4dbc599SNathan Whitehorn 
250b4dbc599SNathan Whitehorn 	adb_set_autopoll(dev,0);
251b4dbc599SNathan Whitehorn 
252b4dbc599SNathan Whitehorn 	sc = device_get_softc(dev);
253b4dbc599SNathan Whitehorn 	destroy_dev(sc->cdev);
254b4dbc599SNathan Whitehorn 
255b4dbc599SNathan Whitehorn 	mtx_destroy(&sc->sc_mtx);
256b4dbc599SNathan Whitehorn 	cv_destroy(&sc->sc_cv);
257b4dbc599SNathan Whitehorn 
258b4dbc599SNathan Whitehorn 	return (0);
259b4dbc599SNathan Whitehorn }
260b4dbc599SNathan Whitehorn 
261b4dbc599SNathan Whitehorn static u_int
262b4dbc599SNathan Whitehorn adb_mouse_receive_packet(device_t dev, u_char status, u_char command,
263b4dbc599SNathan Whitehorn     u_char reg, int len, u_char *data)
264b4dbc599SNathan Whitehorn {
265b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
266b4dbc599SNathan Whitehorn 	int i = 0;
267b4dbc599SNathan Whitehorn 	int xdelta, ydelta;
268b4dbc599SNathan Whitehorn 	int buttons;
269b4dbc599SNathan Whitehorn 
270b4dbc599SNathan Whitehorn 	sc = device_get_softc(dev);
271b4dbc599SNathan Whitehorn 
272b4dbc599SNathan Whitehorn 	if (command != ADB_COMMAND_TALK || reg != 0 || len < 2)
273b4dbc599SNathan Whitehorn 		return (0);
274b4dbc599SNathan Whitehorn 
275b4dbc599SNathan Whitehorn 	ydelta = data[0] & 0x7f;
276b4dbc599SNathan Whitehorn 	xdelta = data[1] & 0x7f;
277b4dbc599SNathan Whitehorn 
278b4dbc599SNathan Whitehorn 	buttons = 0;
279b4dbc599SNathan Whitehorn 	buttons |= !(data[0] & 0x80);
280b4dbc599SNathan Whitehorn 	buttons |= !(data[1] & 0x80) << 1;
281b4dbc599SNathan Whitehorn 
2823c5f535bSEd Schouten 	if (sc->flags & AMS_EXTENDED) {
283b4dbc599SNathan Whitehorn 		for (i = 2; i < len && i < 5; i++) {
284b4dbc599SNathan Whitehorn 			xdelta |= (data[i] & 0x07) << (3*i + 1);
285b4dbc599SNathan Whitehorn 			ydelta |= (data[i] & 0x70) << (3*i - 3);
286b4dbc599SNathan Whitehorn 
287b4dbc599SNathan Whitehorn 			buttons |= !(data[i] & 0x08) << (2*i - 2);
288b4dbc599SNathan Whitehorn 			buttons |= !(data[i] & 0x80) << (2*i - 1);
289b4dbc599SNathan Whitehorn 		}
290b4dbc599SNathan Whitehorn 	} else {
291b4dbc599SNathan Whitehorn 		len = 2; /* Ignore extra data */
292b4dbc599SNathan Whitehorn 	}
293b4dbc599SNathan Whitehorn 
294b4dbc599SNathan Whitehorn 	/* Do sign extension as necessary */
295b4dbc599SNathan Whitehorn 	if (xdelta & (0x40 << 3*(len-2)))
296b4dbc599SNathan Whitehorn 		xdelta |= 0xffffffc0 << 3*(len - 2);
297b4dbc599SNathan Whitehorn 	if (ydelta & (0x40 << 3*(len-2)))
298b4dbc599SNathan Whitehorn 		ydelta |= 0xffffffc0 << 3*(len - 2);
299b4dbc599SNathan Whitehorn 
300b4dbc599SNathan Whitehorn 	/*
301b4dbc599SNathan Whitehorn 	 * Some mice report high-numbered buttons on the wrong button number,
302b4dbc599SNathan Whitehorn 	 * so set the highest-numbered real button as pressed if there are
303b4dbc599SNathan Whitehorn 	 * mysterious high-numbered ones set.
3043c5f535bSEd Schouten 	 *
3053c5f535bSEd Schouten 	 * Don't do this for touchpads, because touchpads also trigger
3063c5f535bSEd Schouten 	 * high button events when they are touched.
307b4dbc599SNathan Whitehorn 	 */
308b4dbc599SNathan Whitehorn 
3093c5f535bSEd Schouten 	if (buttons & ~((1 << sc->hw.buttons) - 1)
3103c5f535bSEd Schouten 	    && !(sc->flags & AMS_TOUCHPAD)) {
311b4dbc599SNathan Whitehorn 		buttons |= 1 << (sc->hw.buttons - 1);
312b4dbc599SNathan Whitehorn 	}
3133c5f535bSEd Schouten 	buttons &= (1 << sc->hw.buttons) - 1;
314b4dbc599SNathan Whitehorn 
315b4dbc599SNathan Whitehorn 	mtx_lock(&sc->sc_mtx);
316b4dbc599SNathan Whitehorn 
317b4dbc599SNathan Whitehorn 	/* Add in our new deltas, and take into account
318b4dbc599SNathan Whitehorn 	   Apple's opposite meaning for Y axis motion */
319b4dbc599SNathan Whitehorn 
320b4dbc599SNathan Whitehorn 	sc->xdelta += xdelta;
321b4dbc599SNathan Whitehorn 	sc->ydelta -= ydelta;
322b4dbc599SNathan Whitehorn 
323b4dbc599SNathan Whitehorn 	sc->buttons = buttons;
324b4dbc599SNathan Whitehorn 
325b4dbc599SNathan Whitehorn 	mtx_unlock(&sc->sc_mtx);
326b4dbc599SNathan Whitehorn 
327b4dbc599SNathan Whitehorn 	cv_broadcast(&sc->sc_cv);
328b4dbc599SNathan Whitehorn 	selwakeuppri(&sc->rsel, PZERO);
329b4dbc599SNathan Whitehorn 
330b4dbc599SNathan Whitehorn 	return (0);
331b4dbc599SNathan Whitehorn }
332b4dbc599SNathan Whitehorn 
333b4dbc599SNathan Whitehorn static int
334b4dbc599SNathan Whitehorn ams_open(struct cdev *dev, int flag, int fmt, struct thread *p)
335b4dbc599SNathan Whitehorn {
336b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
337b4dbc599SNathan Whitehorn 
338b4dbc599SNathan Whitehorn 	sc = CDEV_GET_SOFTC(dev);
339b4dbc599SNathan Whitehorn 	if (sc == NULL)
340b4dbc599SNathan Whitehorn 		return (ENXIO);
341b4dbc599SNathan Whitehorn 
342b4dbc599SNathan Whitehorn 	mtx_lock(&sc->sc_mtx);
343b4dbc599SNathan Whitehorn 	sc->packet_read_len = 0;
344b4dbc599SNathan Whitehorn 	sc->xdelta = 0;
345b4dbc599SNathan Whitehorn 	sc->ydelta = 0;
346b4dbc599SNathan Whitehorn 	sc->buttons = 0;
347b4dbc599SNathan Whitehorn 	mtx_unlock(&sc->sc_mtx);
348b4dbc599SNathan Whitehorn 
349b4dbc599SNathan Whitehorn 	return (0);
350b4dbc599SNathan Whitehorn }
351b4dbc599SNathan Whitehorn 
352b4dbc599SNathan Whitehorn static int
353b4dbc599SNathan Whitehorn ams_close(struct cdev *dev, int flag, int fmt, struct thread *p)
354b4dbc599SNathan Whitehorn {
355b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
356b4dbc599SNathan Whitehorn 
357b4dbc599SNathan Whitehorn 	sc = CDEV_GET_SOFTC(dev);
358b4dbc599SNathan Whitehorn 
359b4dbc599SNathan Whitehorn 	cv_broadcast(&sc->sc_cv);
360b4dbc599SNathan Whitehorn 	selwakeuppri(&sc->rsel, PZERO);
361b4dbc599SNathan Whitehorn 	return (0);
362b4dbc599SNathan Whitehorn }
363b4dbc599SNathan Whitehorn 
364b4dbc599SNathan Whitehorn static int
365b4dbc599SNathan Whitehorn ams_poll(struct cdev *dev, int events, struct thread *p)
366b4dbc599SNathan Whitehorn {
367b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
368b4dbc599SNathan Whitehorn 
369b4dbc599SNathan Whitehorn 	sc = CDEV_GET_SOFTC(dev);
370b4dbc599SNathan Whitehorn 	if (sc == NULL)
371b4dbc599SNathan Whitehorn 		return (EIO);
372b4dbc599SNathan Whitehorn 
373b4dbc599SNathan Whitehorn 	if (events & (POLLIN | POLLRDNORM)) {
374b4dbc599SNathan Whitehorn 		mtx_lock(&sc->sc_mtx);
375b4dbc599SNathan Whitehorn 
376b4dbc599SNathan Whitehorn 		if (sc->xdelta == 0 && sc->ydelta == 0 &&
377b4dbc599SNathan Whitehorn 		   sc->buttons == sc->last_buttons) {
378b4dbc599SNathan Whitehorn 			selrecord(p, &sc->rsel);
379b4dbc599SNathan Whitehorn 			events = 0;
380b4dbc599SNathan Whitehorn 		} else {
381b4dbc599SNathan Whitehorn 			events &= (POLLIN | POLLRDNORM);
382b4dbc599SNathan Whitehorn 		}
383b4dbc599SNathan Whitehorn 
384b4dbc599SNathan Whitehorn 		mtx_unlock(&sc->sc_mtx);
385b4dbc599SNathan Whitehorn 	}
386b4dbc599SNathan Whitehorn 
387b4dbc599SNathan Whitehorn 	return events;
388b4dbc599SNathan Whitehorn }
389b4dbc599SNathan Whitehorn 
390b4dbc599SNathan Whitehorn static int
391b4dbc599SNathan Whitehorn ams_read(struct cdev *dev, struct uio *uio, int flag)
392b4dbc599SNathan Whitehorn {
393b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
394b4dbc599SNathan Whitehorn 	size_t len;
395b4dbc599SNathan Whitehorn 	int8_t outpacket[8];
396b75d1970SEd Schouten 	int error;
397b4dbc599SNathan Whitehorn 
398b4dbc599SNathan Whitehorn 	sc = CDEV_GET_SOFTC(dev);
399b4dbc599SNathan Whitehorn 	if (sc == NULL)
400b4dbc599SNathan Whitehorn 		return (EIO);
401b4dbc599SNathan Whitehorn 
402b4dbc599SNathan Whitehorn 	if (uio->uio_resid <= 0)
403b4dbc599SNathan Whitehorn 		return (0);
404b4dbc599SNathan Whitehorn 
405b4dbc599SNathan Whitehorn 	mtx_lock(&sc->sc_mtx);
406b4dbc599SNathan Whitehorn 
407b4dbc599SNathan Whitehorn 	if (!sc->packet_read_len) {
408b4dbc599SNathan Whitehorn 		if (sc->xdelta == 0 && sc->ydelta == 0 &&
409b4dbc599SNathan Whitehorn 		   sc->buttons == sc->last_buttons) {
410b4dbc599SNathan Whitehorn 
411b4dbc599SNathan Whitehorn 			if (flag & O_NONBLOCK) {
412b4dbc599SNathan Whitehorn 				mtx_unlock(&sc->sc_mtx);
413b4dbc599SNathan Whitehorn 				return EWOULDBLOCK;
414b4dbc599SNathan Whitehorn 			}
415b4dbc599SNathan Whitehorn 
416b4dbc599SNathan Whitehorn 
417b4dbc599SNathan Whitehorn 			/* Otherwise, block on new data */
418b75d1970SEd Schouten 			error = cv_wait_sig(&sc->sc_cv, &sc->sc_mtx);
419b75d1970SEd Schouten 			if (error) {
420b75d1970SEd Schouten 				mtx_unlock(&sc->sc_mtx);
421b75d1970SEd Schouten 				return (error);
422b75d1970SEd Schouten 			}
423b4dbc599SNathan Whitehorn 		}
424b4dbc599SNathan Whitehorn 
425b4dbc599SNathan Whitehorn 		sc->packet[0] = 1 << 7;
426b4dbc599SNathan Whitehorn 		sc->packet[0] |= (!(sc->buttons & 1)) << 2;
427b4dbc599SNathan Whitehorn 		sc->packet[0] |= (!(sc->buttons & 4)) << 1;
428b4dbc599SNathan Whitehorn 		sc->packet[0] |= (!(sc->buttons & 2));
429b4dbc599SNathan Whitehorn 
430b4dbc599SNathan Whitehorn 		if (sc->xdelta > 127) {
431b4dbc599SNathan Whitehorn 			sc->packet[1] = 127;
432b4dbc599SNathan Whitehorn 			sc->packet[3] = sc->xdelta - 127;
433b4dbc599SNathan Whitehorn 		} else if (sc->xdelta < -127) {
434b4dbc599SNathan Whitehorn 			sc->packet[1] = -127;
435b4dbc599SNathan Whitehorn 			sc->packet[3] = sc->xdelta + 127;
436b4dbc599SNathan Whitehorn 		} else {
437b4dbc599SNathan Whitehorn 			sc->packet[1] = sc->xdelta;
438b4dbc599SNathan Whitehorn 			sc->packet[3] = 0;
439b4dbc599SNathan Whitehorn 		}
440b4dbc599SNathan Whitehorn 
441b4dbc599SNathan Whitehorn 		if (sc->ydelta > 127) {
442b4dbc599SNathan Whitehorn 			sc->packet[2] = 127;
443b4dbc599SNathan Whitehorn 			sc->packet[4] = sc->ydelta - 127;
444b4dbc599SNathan Whitehorn 		} else if (sc->ydelta < -127) {
445b4dbc599SNathan Whitehorn 			sc->packet[2] = -127;
446b4dbc599SNathan Whitehorn 			sc->packet[4] = sc->ydelta + 127;
447b4dbc599SNathan Whitehorn 		} else {
448b4dbc599SNathan Whitehorn 			sc->packet[2] = sc->ydelta;
449b4dbc599SNathan Whitehorn 			sc->packet[4] = 0;
450b4dbc599SNathan Whitehorn 		}
451b4dbc599SNathan Whitehorn 
452b4dbc599SNathan Whitehorn 		/* No Z movement */
453b4dbc599SNathan Whitehorn 		sc->packet[5] = 0;
454b4dbc599SNathan Whitehorn 		sc->packet[6] = 0;
455b4dbc599SNathan Whitehorn 
456b4dbc599SNathan Whitehorn 		sc->packet[7] = ~((uint8_t)(sc->buttons >> 3)) & 0x7f;
457b4dbc599SNathan Whitehorn 
458b4dbc599SNathan Whitehorn 
459b4dbc599SNathan Whitehorn 		sc->last_buttons = sc->buttons;
460b4dbc599SNathan Whitehorn 		sc->xdelta = 0;
461b4dbc599SNathan Whitehorn 		sc->ydelta = 0;
462b4dbc599SNathan Whitehorn 
463b4dbc599SNathan Whitehorn 		sc->packet_read_len = sc->mode.packetsize;
464b4dbc599SNathan Whitehorn 	}
465b4dbc599SNathan Whitehorn 
466b4dbc599SNathan Whitehorn 	len = (sc->packet_read_len > uio->uio_resid) ?
467b4dbc599SNathan Whitehorn 		uio->uio_resid : sc->packet_read_len;
468b4dbc599SNathan Whitehorn 
469b4dbc599SNathan Whitehorn 	memcpy(outpacket,sc->packet +
470b4dbc599SNathan Whitehorn 		(sc->mode.packetsize - sc->packet_read_len),len);
471b4dbc599SNathan Whitehorn 	sc->packet_read_len -= len;
472b4dbc599SNathan Whitehorn 
473b4dbc599SNathan Whitehorn 	mtx_unlock(&sc->sc_mtx);
474b4dbc599SNathan Whitehorn 
475b4dbc599SNathan Whitehorn 	uiomove(outpacket,len,uio);
476b4dbc599SNathan Whitehorn 
477b4dbc599SNathan Whitehorn 	return (0);
478b4dbc599SNathan Whitehorn }
479b4dbc599SNathan Whitehorn 
480b4dbc599SNathan Whitehorn 
481b4dbc599SNathan Whitehorn static int
482b4dbc599SNathan Whitehorn ams_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag,
483b4dbc599SNathan Whitehorn     struct thread *p)
484b4dbc599SNathan Whitehorn {
485b4dbc599SNathan Whitehorn 	struct adb_mouse_softc *sc;
486b4dbc599SNathan Whitehorn 	mousemode_t mode;
487b4dbc599SNathan Whitehorn 
488b4dbc599SNathan Whitehorn 	sc = CDEV_GET_SOFTC(dev);
489b4dbc599SNathan Whitehorn 	if (sc == NULL)
490b4dbc599SNathan Whitehorn 		return (EIO);
491b4dbc599SNathan Whitehorn 
492b4dbc599SNathan Whitehorn 	switch (cmd) {
493b4dbc599SNathan Whitehorn 	case MOUSE_GETHWINFO:
494b4dbc599SNathan Whitehorn 		*(mousehw_t *)addr = sc->hw;
495b4dbc599SNathan Whitehorn 		break;
496b4dbc599SNathan Whitehorn 	case MOUSE_GETMODE:
497b4dbc599SNathan Whitehorn 		*(mousemode_t *)addr = sc->mode;
498b4dbc599SNathan Whitehorn 		break;
499b4dbc599SNathan Whitehorn 	case MOUSE_SETMODE:
500b4dbc599SNathan Whitehorn 		mode = *(mousemode_t *)addr;
501b4dbc599SNathan Whitehorn 		addr = (caddr_t)&mode.level;
502b4dbc599SNathan Whitehorn 
503b4dbc599SNathan Whitehorn 		/* Fallthrough */
504b4dbc599SNathan Whitehorn 
505b4dbc599SNathan Whitehorn 	case MOUSE_SETLEVEL:
506b4dbc599SNathan Whitehorn 		if (*(int *)addr == -1)
507b4dbc599SNathan Whitehorn 			break;
508b4dbc599SNathan Whitehorn 		else if (*(int *)addr == 1) {
509b4dbc599SNathan Whitehorn 			sc->mode.level = 1;
510b4dbc599SNathan Whitehorn 			sc->mode.packetsize = 8;
511b4dbc599SNathan Whitehorn 			break;
512b4dbc599SNathan Whitehorn 		} else if (*(int *)addr == 0) {
513b4dbc599SNathan Whitehorn 			sc->mode.level = 0;
514b4dbc599SNathan Whitehorn 			sc->mode.packetsize = 5;
515b4dbc599SNathan Whitehorn 			break;
516b4dbc599SNathan Whitehorn 		}
517b4dbc599SNathan Whitehorn 
518b4dbc599SNathan Whitehorn 		return EINVAL;
519b4dbc599SNathan Whitehorn 	case MOUSE_GETLEVEL:
520b4dbc599SNathan Whitehorn 		*(int *)addr = sc->mode.level;
521b4dbc599SNathan Whitehorn 		break;
522b4dbc599SNathan Whitehorn 
523b4dbc599SNathan Whitehorn 	case MOUSE_GETSTATUS: {
524b4dbc599SNathan Whitehorn 		mousestatus_t *status = (mousestatus_t *) addr;
525b4dbc599SNathan Whitehorn 
526b4dbc599SNathan Whitehorn 		mtx_lock(&sc->sc_mtx);
527b4dbc599SNathan Whitehorn 
528b4dbc599SNathan Whitehorn 		status->button = sc->buttons;
529b4dbc599SNathan Whitehorn 		status->obutton = sc->last_buttons;
530b4dbc599SNathan Whitehorn 
531b4dbc599SNathan Whitehorn 		status->flags = status->button ^ status->obutton;
532b4dbc599SNathan Whitehorn 
533b4dbc599SNathan Whitehorn 		if (sc->xdelta != 0 || sc->ydelta)
534b4dbc599SNathan Whitehorn 			status->flags |= MOUSE_POSCHANGED;
535b4dbc599SNathan Whitehorn 		if (status->button != status->obutton)
536b4dbc599SNathan Whitehorn 			status->flags |= MOUSE_BUTTONSCHANGED;
537b4dbc599SNathan Whitehorn 
538b4dbc599SNathan Whitehorn 		status->dx = sc->xdelta;
539b4dbc599SNathan Whitehorn 		status->dy = sc->ydelta;
540b4dbc599SNathan Whitehorn 		status->dz = 0;
541b4dbc599SNathan Whitehorn 
542b4dbc599SNathan Whitehorn 		sc->xdelta = 0;
543b4dbc599SNathan Whitehorn 		sc->ydelta = 0;
544b4dbc599SNathan Whitehorn 		sc->last_buttons = sc->buttons;
545b4dbc599SNathan Whitehorn 
546b4dbc599SNathan Whitehorn 		mtx_unlock(&sc->sc_mtx);
547b4dbc599SNathan Whitehorn 
548b4dbc599SNathan Whitehorn 		break; }
549b4dbc599SNathan Whitehorn 	default:
550b4dbc599SNathan Whitehorn 		return ENOTTY;
551b4dbc599SNathan Whitehorn 	}
552b4dbc599SNathan Whitehorn 
553b4dbc599SNathan Whitehorn 	return (0);
554b4dbc599SNathan Whitehorn }
555b4dbc599SNathan Whitehorn 
556