Home | History | Annotate | Line # | Download | only in netwalker
netwalker_btn.c revision 1.3.8.1
      1  1.3.8.1  thorpej /*	$NetBSD: netwalker_btn.c,v 1.3.8.1 2021/08/04 16:59:14 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.3.8.1  thorpej __KERNEL_RCSID(0, "$NetBSD: netwalker_btn.c,v 1.3.8.1 2021/08/04 16:59:14 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.3.8.1  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