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