xref: /netbsd-src/sys/dev/bluetooth/btms.c (revision 8b0f9554ff8762542c4defc4f70e1eb76fb508fa)
1 /*	$NetBSD: btms.c,v 1.7 2007/11/03 17:41:03 plunky Exp $	*/
2 
3 /*-
4  * Copyright (c) 2006 Itronix Inc.
5  * All rights reserved.
6  *
7  * Written by Iain Hibbert for Itronix Inc.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  * 3. The name of Itronix Inc. may not be used to endorse
18  *    or promote products derived from this software without specific
19  *    prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
25  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28  * ON ANY THEORY OF LIABILITY, WHETHER IN
29  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31  * POSSIBILITY OF SUCH DAMAGE.
32  */
33 
34 /*
35  * based on dev/usb/ums.c
36  */
37 
38 #include <sys/cdefs.h>
39 __KERNEL_RCSID(0, "$NetBSD: btms.c,v 1.7 2007/11/03 17:41:03 plunky Exp $");
40 
41 #include <sys/param.h>
42 #include <sys/conf.h>
43 #include <sys/device.h>
44 #include <sys/proc.h>
45 #include <sys/systm.h>
46 
47 #include <netbt/bluetooth.h>
48 
49 #include <dev/bluetooth/bthid.h>
50 #include <dev/bluetooth/bthidev.h>
51 
52 #include <dev/usb/hid.h>
53 #include <dev/usb/usb.h>
54 #include <dev/usb/usbhid.h>
55 
56 #include <dev/wscons/wsconsio.h>
57 #include <dev/wscons/wsmousevar.h>
58 
59 #define MAX_BUTTONS	31
60 #define BUTTON(n)	(1 << (((n) == 1 || (n) == 2) ? 3 - (n) : (n)))
61 #define NOTMOUSE(f)	(((f) & (HIO_CONST | HIO_RELATIVE)) != HIO_RELATIVE)
62 
63 struct btms_softc {
64 	struct bthidev		 sc_hidev;	/* device+ */
65 
66 	device_t		 sc_wsmouse;	/* child */
67 	int			 sc_enabled;
68 	uint16_t		 sc_flags;
69 
70 	/* locators */
71 	struct hid_location	 sc_loc_x;
72 	struct hid_location	 sc_loc_y;
73 	struct hid_location	 sc_loc_z;
74 	struct hid_location	 sc_loc_w;
75 	struct hid_location	 sc_loc_button[MAX_BUTTONS];
76 
77 	int			 sc_num_buttons;
78 	uint32_t		 sc_buttons;
79 };
80 
81 /* sc_flags */
82 #define BTMS_REVZ		(1 << 0)	/* reverse Z direction */
83 #define BTMS_HASZ		(1 << 1)	/* has Z direction */
84 #define BTMS_HASW		(1 << 2)	/* has W direction */
85 
86 /* autoconf(9) methods */
87 static int	btms_match(device_t, struct cfdata *, void *);
88 static void	btms_attach(device_t, device_t, void *);
89 static int	btms_detach(device_t, int);
90 
91 CFATTACH_DECL_NEW(btms, sizeof(struct btms_softc),
92     btms_match, btms_attach, btms_detach, NULL);
93 
94 /* wsmouse(4) accessops */
95 static int	btms_wsmouse_enable(void *);
96 static int	btms_wsmouse_ioctl(void *, unsigned long, void *, int, struct lwp *);
97 static void	btms_wsmouse_disable(void *);
98 
99 static const struct wsmouse_accessops btms_wsmouse_accessops = {
100 	btms_wsmouse_enable,
101 	btms_wsmouse_ioctl,
102 	btms_wsmouse_disable,
103 };
104 
105 /* bthid methods */
106 static void btms_input(struct bthidev *, uint8_t *, int);
107 
108 /*****************************************************************************
109  *
110  *	btms autoconf(9) routines
111  */
112 
113 static int
114 btms_match(device_t parent, struct cfdata *match, void *aux)
115 {
116 	struct bthidev_attach_args *ba = aux;
117 
118 	if (hid_is_collection(ba->ba_desc, ba->ba_dlen, ba->ba_id,
119 			    HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_MOUSE)))
120 		return 1;
121 
122 	return 0;
123 }
124 
125 static void
126 btms_attach(device_t parent, device_t self, void *aux)
127 {
128 	struct btms_softc *sc = device_private(self);
129 	struct bthidev_attach_args *ba = aux;
130 	struct wsmousedev_attach_args wsma;
131 	struct hid_location *zloc;
132 	uint32_t flags;
133 	int i, hl;
134 
135 	ba->ba_input = btms_input;
136 
137 	/* control the horizontal */
138 	hl = hid_locate(ba->ba_desc,
139 			ba->ba_dlen,
140 			HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_X),
141 			ba->ba_id,
142 			hid_input,
143 			&sc->sc_loc_x,
144 			&flags);
145 
146 	if (hl == 0 || NOTMOUSE(flags)) {
147 		aprint_error("X report 0x%04x not supported\n", flags);
148 		return;
149 	}
150 
151 	/* control the vertical */
152 	hl = hid_locate(ba->ba_desc,
153 			ba->ba_dlen,
154 			HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Y),
155 			ba->ba_id,
156 			hid_input,
157 			&sc->sc_loc_y,
158 			&flags);
159 
160 	if (hl == 0 || NOTMOUSE(flags)) {
161 		aprint_error("Y report 0x%04x not supported\n", flags);
162 		return;
163 	}
164 
165 	/* Try the wheel first as the Z activator since it's tradition. */
166 	hl = hid_locate(ba->ba_desc,
167 			ba->ba_dlen,
168 			HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_WHEEL),
169 			ba->ba_id,
170 			hid_input,
171 			&sc->sc_loc_z,
172 			&flags);
173 
174 	zloc = &sc->sc_loc_z;
175 	if (hl) {
176 		if (NOTMOUSE(flags)) {
177 			aprint_error("Wheel report 0x%04x ignored\n", flags);
178 
179 			/* ignore Bad Z coord */
180 			sc->sc_loc_z.size = 0;
181 		} else {
182 			sc->sc_flags |= BTMS_HASZ;
183 			/* Wheels need the Z axis reversed. */
184 			sc->sc_flags ^= BTMS_REVZ;
185 			/* Put Z on the W coordinate */
186 			zloc = &sc->sc_loc_w;
187 		}
188 	}
189 
190 	hl = hid_locate(ba->ba_desc,
191 			ba->ba_dlen,
192 			HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Z),
193 			ba->ba_id,
194 			hid_input,
195 			zloc,
196 			&flags);
197 
198 	/*
199 	 * The horizontal component of the scrollball can also be given by
200 	 * Application Control Pan in the Consumer page, so if we didnt see
201 	 * any Z then check that.
202 	 */
203 	if (!hl) {
204 		hl = hid_locate(ba->ba_desc,
205 				ba->ba_dlen,
206 				HID_USAGE2(HUP_CONSUMER, HUC_AC_PAN),
207 				ba->ba_id,
208 				hid_input,
209 				zloc,
210 				&flags);
211 	}
212 
213 	if (hl) {
214 		if (NOTMOUSE(flags))
215 			zloc->size = 0;	/* ignore Z */
216 		else {
217 			if (sc->sc_flags & BTMS_HASZ)
218 				sc->sc_flags |= BTMS_HASW;
219 			else
220 				sc->sc_flags |= BTMS_HASZ;
221 		}
222 	}
223 
224 	for (i = 1 ; i <= MAX_BUTTONS ; i++) {
225 		hl = hid_locate(ba->ba_desc,
226 				ba->ba_dlen,
227 				HID_USAGE2(HUP_BUTTON, i),
228 				ba->ba_id,
229 				hid_input,
230 				&sc->sc_loc_button[i - 1],
231 				NULL);
232 
233 		if (hl == 0)
234 			break;
235 	}
236 	sc->sc_num_buttons = i - 1;
237 
238 	aprint_normal(": %d button%s%s%s%s.\n",
239 			sc->sc_num_buttons,
240 			sc->sc_num_buttons == 1 ? "" : "s",
241 			sc->sc_flags & BTMS_HASW ? ", W" : "",
242 			sc->sc_flags & BTMS_HASZ ? " and Z dir" : "",
243 			sc->sc_flags & BTMS_HASW ? "s" : "");
244 
245 	wsma.accessops = &btms_wsmouse_accessops;
246 	wsma.accesscookie = sc;
247 
248 	sc->sc_wsmouse = config_found(self, &wsma, wsmousedevprint);
249 }
250 
251 static int
252 btms_detach(device_t self, int flags)
253 {
254 	struct btms_softc *sc = device_private(self);
255 	int err = 0;
256 
257 	if (sc->sc_wsmouse != NULL) {
258 		err = config_detach(sc->sc_wsmouse, flags);
259 		sc->sc_wsmouse = NULL;
260 	}
261 
262 	return err;
263 }
264 
265 /*****************************************************************************
266  *
267  *	wsmouse(4) accessops
268  */
269 
270 static int
271 btms_wsmouse_enable(void *self)
272 {
273 	struct btms_softc *sc = self;
274 
275 	if (sc->sc_enabled)
276 		return EBUSY;
277 
278 	sc->sc_enabled = 1;
279 	return 0;
280 }
281 
282 static int
283 btms_wsmouse_ioctl(void *self, unsigned long cmd, void *data,
284     int flag, struct lwp *l)
285 {
286 	/* struct btms_softc *sc = self; */
287 
288 	switch (cmd) {
289 	case WSMOUSEIO_GTYPE:
290 		*(uint *)data = WSMOUSE_TYPE_BLUETOOTH;
291 		break;
292 
293 	default:
294 		return EPASSTHROUGH;
295 	}
296 
297 	return 0;
298 }
299 
300 static void
301 btms_wsmouse_disable(void *self)
302 {
303 	struct btms_softc *sc = self;
304 
305 	sc->sc_enabled = 0;
306 }
307 
308 /*****************************************************************************
309  *
310  *	btms input routine, called from our parent
311  */
312 
313 static void
314 btms_input(struct bthidev *self, uint8_t *data, int len)
315 {
316 	struct btms_softc *sc = (struct btms_softc *)self;
317 	int dx, dy, dz, dw;
318 	uint32_t buttons;
319 	int i, s;
320 
321 	if (sc->sc_wsmouse == NULL || sc->sc_enabled == 0)
322 		return;
323 
324 	dx =  hid_get_data(data, &sc->sc_loc_x);
325 	dy = -hid_get_data(data, &sc->sc_loc_y);
326 	dz =  hid_get_data(data, &sc->sc_loc_z);
327 	dw =  hid_get_data(data, &sc->sc_loc_w);
328 
329 	if (sc->sc_flags & BTMS_REVZ)
330 		dz = -dz;
331 
332 	buttons = 0;
333 	for (i = 0 ; i < sc->sc_num_buttons ; i++)
334 		if (hid_get_data(data, &sc->sc_loc_button[i]))
335 			buttons |= BUTTON(i);
336 
337 	if (dx != 0 || dy != 0 || dz != 0 || dw != 0 || buttons != sc->sc_buttons) {
338 		sc->sc_buttons = buttons;
339 
340 		s = spltty();
341 		wsmouse_input(sc->sc_wsmouse,
342 				buttons,
343 				dx, dy, dz, dw,
344 				WSMOUSE_INPUT_DELTA);
345 		splx(s);
346 	}
347 }
348