netwalker_btn.c revision 1.4 1 1.4 thorpej /* $NetBSD: netwalker_btn.c,v 1.4 2021/08/07 16:18:50 thorpej Exp $ */
2 1.1 hkenken
3 1.1 hkenken /*
4 1.1 hkenken * Copyright (c) 2014 Genetec Corporation. All rights reserved.
5 1.1 hkenken * Written by Hashimoto Kenichi for Genetec Corporation.
6 1.1 hkenken *
7 1.1 hkenken * Redistribution and use in source and binary forms, with or without
8 1.1 hkenken * modification, are permitted provided that the following conditions
9 1.1 hkenken * are met:
10 1.1 hkenken * 1. Redistributions of source code must retain the above copyright
11 1.1 hkenken * notice, this list of conditions and the following disclaimer.
12 1.1 hkenken * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 hkenken * notice, this list of conditions and the following disclaimer in the
14 1.1 hkenken * documentation and/or other materials provided with the distribution.
15 1.1 hkenken *
16 1.1 hkenken * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND
17 1.1 hkenken * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 hkenken * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 hkenken * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL GENETEC CORPORATION
20 1.1 hkenken * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 hkenken * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 hkenken * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 hkenken * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 hkenken * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 hkenken * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 hkenken * POSSIBILITY OF SUCH DAMAGE.
27 1.1 hkenken */
28 1.1 hkenken
29 1.1 hkenken #include <sys/cdefs.h>
30 1.4 thorpej __KERNEL_RCSID(0, "$NetBSD: netwalker_btn.c,v 1.4 2021/08/07 16:18:50 thorpej Exp $");
31 1.1 hkenken
32 1.1 hkenken #include "opt_imxspi.h"
33 1.1 hkenken #include "opt_mousebtn.h"
34 1.1 hkenken
35 1.1 hkenken #include <sys/param.h>
36 1.1 hkenken #include <sys/systm.h>
37 1.1 hkenken #include <sys/kernel.h>
38 1.1 hkenken #include <sys/device.h>
39 1.1 hkenken #include <sys/lock.h>
40 1.1 hkenken #include <sys/callout.h>
41 1.1 hkenken #include <sys/gpio.h>
42 1.1 hkenken #include <sys/bus.h>
43 1.1 hkenken #include <sys/mutex.h>
44 1.1 hkenken
45 1.1 hkenken #include <dev/wscons/wsconsio.h>
46 1.1 hkenken #include <dev/wscons/wsmousevar.h>
47 1.1 hkenken
48 1.1 hkenken #include <dev/gpio/gpiovar.h>
49 1.1 hkenken
50 1.1 hkenken #define GPIO1_BASE 160
51 1.1 hkenken
52 1.1 hkenken #define MOUSEBTN_PIN_LEFT 0
53 1.1 hkenken #define MOUSEBTN_PIN_RIGHT 1
54 1.1 hkenken #define MOUSEBTN_NPINS 2
55 1.1 hkenken
56 1.1 hkenken #define POLLRATE (hz/10)
57 1.1 hkenken
58 1.1 hkenken struct mousebtn_softc
59 1.1 hkenken {
60 1.1 hkenken device_t sc_dev;
61 1.1 hkenken void *sc_gpio;
62 1.1 hkenken void *sc_intr[MOUSEBTN_NPINS];
63 1.1 hkenken
64 1.1 hkenken struct gpio_pinmap sc_map;
65 1.1 hkenken int sc_map_pins[MOUSEBTN_NPINS];
66 1.1 hkenken
67 1.1 hkenken int sc_buttons;
68 1.1 hkenken
69 1.1 hkenken struct callout sc_c;
70 1.1 hkenken kmutex_t sc_lock;
71 1.1 hkenken
72 1.1 hkenken int sc_enabled;
73 1.1 hkenken struct device *sc_wsmousedev;
74 1.1 hkenken };
75 1.1 hkenken
76 1.1 hkenken static int mousebtn_match(device_t, cfdata_t, void *);
77 1.1 hkenken static void mousebtn_attach(device_t, device_t, void *);
78 1.1 hkenken static int mousebtn_detach(device_t, int);
79 1.1 hkenken
80 1.2 hkenken CFATTACH_DECL_NEW(netwalker_btn, sizeof(struct mousebtn_softc),
81 1.2 hkenken mousebtn_match, mousebtn_attach, mousebtn_detach, NULL);
82 1.1 hkenken
83 1.1 hkenken static void mousebtn_poll(void *);
84 1.1 hkenken static int mousebtn_intr(void *);
85 1.1 hkenken
86 1.1 hkenken static int mousebtn_enable(void *v);
87 1.1 hkenken static void mousebtn_disable(void *v);
88 1.1 hkenken static int mousebtn_ioctl(void *, u_long, void *, int, struct lwp *);
89 1.1 hkenken
90 1.1 hkenken static bool mousebtn_resume(device_t, const pmf_qual_t *);
91 1.1 hkenken static bool mousebtn_suspend(device_t, const pmf_qual_t *);
92 1.1 hkenken
93 1.1 hkenken static const struct wsmouse_accessops mousebtn_accessops = {
94 1.1 hkenken .enable = mousebtn_enable,
95 1.1 hkenken .ioctl = mousebtn_ioctl,
96 1.1 hkenken .disable = mousebtn_disable
97 1.1 hkenken };
98 1.1 hkenken
99 1.1 hkenken static int
100 1.1 hkenken mousebtn_match(device_t parent, cfdata_t cf, void * aux)
101 1.1 hkenken {
102 1.1 hkenken struct gpio_attach_args *ga = aux;
103 1.1 hkenken
104 1.1 hkenken if (strcmp(ga->ga_dvname, cf->cf_name))
105 1.1 hkenken return 0;
106 1.1 hkenken if (ga->ga_offset == -1)
107 1.1 hkenken return 0;
108 1.1 hkenken
109 1.1 hkenken /* check that we have enough pins */
110 1.1 hkenken if (gpio_npins(ga->ga_mask) != MOUSEBTN_NPINS) {
111 1.1 hkenken aprint_debug("%s: invalid pin mask 0x%02x\n", cf->cf_name,
112 1.1 hkenken ga->ga_mask);
113 1.1 hkenken return 0;
114 1.1 hkenken }
115 1.1 hkenken
116 1.1 hkenken return 1;
117 1.1 hkenken }
118 1.1 hkenken
119 1.1 hkenken static void
120 1.1 hkenken mousebtn_attach(device_t parent, device_t self, void *aux)
121 1.1 hkenken {
122 1.1 hkenken struct mousebtn_softc *sc = device_private(self);
123 1.1 hkenken struct gpio_attach_args *ga = aux;
124 1.1 hkenken int caps;
125 1.1 hkenken struct wsmousedev_attach_args a;
126 1.1 hkenken
127 1.1 hkenken sc->sc_dev = self;
128 1.1 hkenken sc->sc_gpio = ga->ga_gpio;
129 1.1 hkenken
130 1.1 hkenken /* map pins */
131 1.1 hkenken sc->sc_map.pm_map = sc->sc_map_pins;
132 1.1 hkenken if (gpio_pin_map(sc->sc_gpio, ga->ga_offset, ga->ga_mask,
133 1.1 hkenken &sc->sc_map)) {
134 1.1 hkenken aprint_error(": couldn't map the pins\n");
135 1.1 hkenken return;
136 1.1 hkenken }
137 1.1 hkenken
138 1.1 hkenken /* configure left pin */
139 1.1 hkenken caps = gpio_pin_caps(sc->sc_gpio, &sc->sc_map, MOUSEBTN_PIN_LEFT);
140 1.1 hkenken if (!(caps & GPIO_PIN_INPUT)) {
141 1.1 hkenken aprint_error(": pin is unable to read input\n");
142 1.1 hkenken gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
143 1.1 hkenken return;
144 1.1 hkenken }
145 1.1 hkenken gpio_pin_ctl(sc->sc_gpio, &sc->sc_map, MOUSEBTN_PIN_LEFT,
146 1.1 hkenken GPIO_PIN_INPUT);
147 1.1 hkenken
148 1.1 hkenken /* configure right pin */
149 1.1 hkenken caps = gpio_pin_caps(sc->sc_gpio, &sc->sc_map, MOUSEBTN_PIN_RIGHT);
150 1.1 hkenken if (!(caps & GPIO_PIN_INPUT)) {
151 1.1 hkenken aprint_error(": pin is unable to read input\n");
152 1.1 hkenken gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
153 1.1 hkenken return;
154 1.1 hkenken }
155 1.1 hkenken gpio_pin_ctl(sc->sc_gpio, &sc->sc_map, MOUSEBTN_PIN_RIGHT,
156 1.1 hkenken GPIO_PIN_INPUT);
157 1.1 hkenken
158 1.1 hkenken /* interrupt settings */
159 1.1 hkenken sc->sc_intr[0] = intr_establish(GPIO1_BASE + ga->ga_offset,
160 1.1 hkenken IPL_VM, IST_EDGE_BOTH, mousebtn_intr, sc);
161 1.1 hkenken if (sc->sc_intr[0] == NULL) {
162 1.1 hkenken aprint_error(": couldn't establish interrupt\n");
163 1.1 hkenken return;
164 1.1 hkenken }
165 1.1 hkenken sc->sc_intr[1] = intr_establish(GPIO1_BASE + ga->ga_offset + 1,
166 1.1 hkenken IPL_VM, IST_EDGE_BOTH, mousebtn_intr, sc);
167 1.1 hkenken if (sc->sc_intr[1] == NULL) {
168 1.1 hkenken aprint_error(": couldn't establish interrupt\n");
169 1.1 hkenken intr_disestablish(sc->sc_intr[0]);
170 1.1 hkenken return;
171 1.1 hkenken }
172 1.1 hkenken
173 1.1 hkenken aprint_normal(": NetWalker mouse button\n");
174 1.1 hkenken aprint_naive(": NetWalker mouse button\n");
175 1.1 hkenken
176 1.1 hkenken mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
177 1.1 hkenken callout_init(&sc->sc_c, 0);
178 1.1 hkenken
179 1.1 hkenken a.accessops = &mousebtn_accessops;
180 1.1 hkenken a.accesscookie = sc;
181 1.1 hkenken
182 1.1 hkenken sc->sc_buttons = 0;
183 1.4 thorpej sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint, CFARGS_NONE);
184 1.1 hkenken }
185 1.1 hkenken
186 1.1 hkenken static int
187 1.1 hkenken mousebtn_detach(device_t self, int flags)
188 1.1 hkenken {
189 1.1 hkenken struct mousebtn_softc *sc = device_private(self);
190 1.1 hkenken
191 1.1 hkenken if (sc->sc_intr[0] != NULL)
192 1.1 hkenken intr_disestablish(sc->sc_intr[0]);
193 1.1 hkenken if (sc->sc_intr[1] != NULL)
194 1.1 hkenken intr_disestablish(sc->sc_intr[1]);
195 1.1 hkenken
196 1.1 hkenken gpio_pin_unmap(sc->sc_gpio, &sc->sc_map);
197 1.1 hkenken
198 1.1 hkenken return 0;
199 1.1 hkenken }
200 1.1 hkenken
201 1.1 hkenken static void
202 1.1 hkenken mousebtn_poll(void *arg)
203 1.1 hkenken {
204 1.1 hkenken struct mousebtn_softc *sc = (struct mousebtn_softc *)arg;
205 1.1 hkenken uint32_t buttons = 0;
206 1.1 hkenken int s;
207 1.1 hkenken int left;
208 1.1 hkenken int right;
209 1.1 hkenken
210 1.1 hkenken mutex_enter(&sc->sc_lock);
211 1.1 hkenken
212 1.1 hkenken left = !gpio_pin_read(sc->sc_gpio, &sc->sc_map, MOUSEBTN_PIN_LEFT);
213 1.1 hkenken right = !gpio_pin_read(sc->sc_gpio, &sc->sc_map, MOUSEBTN_PIN_RIGHT);
214 1.1 hkenken buttons = (right << 2) | left;
215 1.1 hkenken
216 1.1 hkenken if (sc->sc_buttons != buttons) {
217 1.1 hkenken s = spltty();
218 1.1 hkenken wsmouse_input(sc->sc_wsmousedev, buttons, 0, 0, 0, 0,
219 1.1 hkenken WSMOUSE_INPUT_DELTA);
220 1.1 hkenken sc->sc_buttons = buttons;
221 1.1 hkenken splx(s);
222 1.1 hkenken }
223 1.1 hkenken
224 1.1 hkenken mutex_exit(&sc->sc_lock);
225 1.1 hkenken
226 1.1 hkenken #if defined(MOUSEBTN_POLLING)
227 1.1 hkenken if (sc->sc_enabled)
228 1.1 hkenken callout_reset(&sc->sc_c, POLLRATE, mousebtn_poll, sc);
229 1.1 hkenken #endif
230 1.1 hkenken return;
231 1.1 hkenken }
232 1.1 hkenken
233 1.1 hkenken static int
234 1.1 hkenken mousebtn_intr(void *v)
235 1.1 hkenken {
236 1.1 hkenken struct mousebtn_softc *sc = v;
237 1.1 hkenken
238 1.1 hkenken if (sc->sc_enabled)
239 1.1 hkenken callout_reset(&sc->sc_c, POLLRATE, mousebtn_poll, sc);
240 1.1 hkenken
241 1.1 hkenken return 1;
242 1.1 hkenken }
243 1.1 hkenken
244 1.1 hkenken
245 1.1 hkenken int
246 1.1 hkenken mousebtn_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l)
247 1.1 hkenken {
248 1.1 hkenken struct wsmouse_id *id;
249 1.1 hkenken
250 1.1 hkenken switch (cmd) {
251 1.1 hkenken case WSMOUSEIO_GTYPE:
252 1.1 hkenken *(u_int *)data = WSMOUSE_TYPE_PS2;
253 1.1 hkenken return 0;
254 1.1 hkenken case WSMOUSEIO_GETID:
255 1.1 hkenken id = (struct wsmouse_id *)data;
256 1.1 hkenken if (id->type != WSMOUSE_ID_TYPE_UIDSTR)
257 1.1 hkenken return EINVAL;
258 1.1 hkenken strlcpy(id->data, "NetWalker Mouse Button", WSMOUSE_ID_MAXLEN);
259 1.1 hkenken id->length = strlen(id->data);
260 1.1 hkenken return 0;
261 1.1 hkenken }
262 1.1 hkenken
263 1.1 hkenken return EPASSTHROUGH;
264 1.1 hkenken }
265 1.1 hkenken
266 1.1 hkenken int
267 1.1 hkenken mousebtn_enable(void *v)
268 1.1 hkenken {
269 1.1 hkenken struct mousebtn_softc *sc = (struct mousebtn_softc *)v;
270 1.1 hkenken
271 1.1 hkenken if (sc->sc_enabled)
272 1.1 hkenken return EBUSY;
273 1.1 hkenken
274 1.1 hkenken if (!pmf_device_register(sc->sc_dev, mousebtn_suspend, mousebtn_resume))
275 1.1 hkenken aprint_error_dev(sc->sc_dev,
276 1.1 hkenken "couldn't establish power handler\n");
277 1.1 hkenken
278 1.1 hkenken sc->sc_enabled = 1;
279 1.1 hkenken #if defined(MOUSEBTN_POLLING)
280 1.1 hkenken callout_reset(&sc->sc_c, POLLRATE, mousebtn_poll, sc);
281 1.1 hkenken #endif
282 1.1 hkenken
283 1.1 hkenken return 0;
284 1.1 hkenken }
285 1.1 hkenken
286 1.1 hkenken void
287 1.1 hkenken mousebtn_disable(void *v)
288 1.1 hkenken {
289 1.1 hkenken struct mousebtn_softc *sc = (struct mousebtn_softc *)v;
290 1.1 hkenken
291 1.1 hkenken if (!sc->sc_enabled)
292 1.1 hkenken return;
293 1.1 hkenken
294 1.1 hkenken pmf_device_deregister(sc->sc_dev);
295 1.1 hkenken
296 1.1 hkenken sc->sc_enabled = 0;
297 1.1 hkenken
298 1.1 hkenken return;
299 1.1 hkenken }
300 1.1 hkenken
301 1.1 hkenken static bool
302 1.1 hkenken mousebtn_suspend(device_t dv, const pmf_qual_t *qual)
303 1.1 hkenken {
304 1.1 hkenken struct mousebtn_softc *sc = device_private(dv);
305 1.1 hkenken
306 1.1 hkenken #if defined(MOUSEBTN_POLLING)
307 1.1 hkenken callout_stop(&sc->sc_c);
308 1.1 hkenken #endif
309 1.1 hkenken sc->sc_enabled = 0;
310 1.1 hkenken
311 1.1 hkenken return true;
312 1.1 hkenken }
313 1.1 hkenken
314 1.1 hkenken static bool
315 1.1 hkenken mousebtn_resume(device_t dv, const pmf_qual_t *qual)
316 1.1 hkenken {
317 1.1 hkenken struct mousebtn_softc *sc = device_private(dv);
318 1.1 hkenken
319 1.1 hkenken sc->sc_enabled = 1;
320 1.1 hkenken #if defined(MOUSEBTN_POLLING)
321 1.1 hkenken callout_reset(&sc->sc_c, POLLRATE, mousebtn_poll, sc);
322 1.1 hkenken #endif
323 1.1 hkenken return true;
324 1.1 hkenken }
325 1.1 hkenken
326