/* $NetBSD: netwalker_pwr.c,v 1.1 2014/05/06 11:08:51 hkenken Exp $ */ /* * Copyright (c) 2014 Genetec Corporation. All rights reserved. * Written by Hashimoto Kenichi for Genetec Corporation. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL GENETEC CORPORATION * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include __KERNEL_RCSID(0, "$NetBSD: netwalker_pwr.c,v 1.1 2014/05/06 11:08:51 hkenken Exp $"); #include #include #include #include #include #include #include #include #include #define PWR_PIN_INPUT 0 #define PWR_NPINS 1 struct netwalker_pwr_softc { device_t sc_dev; void *sc_gpio; void *sc_intr; struct gpio_pinmap sc_map; int sc_map_pins[PWR_NPINS]; struct sysmon_pswitch sc_smpsw; int sc_state; }; static int netwalker_pwr_match(device_t, cfdata_t, void *); static void netwalker_pwr_attach(device_t, device_t, void *); static int netwalker_pwr_detach(device_t, int); CFATTACH_DECL_NEW(netwalker_pwr, sizeof(struct netwalker_pwr_softc), netwalker_pwr_match, netwalker_pwr_attach, netwalker_pwr_detach, NULL); static void netwalker_pwr_refresh(void *); static int netwalker_pwr_intr(void *); static int netwalker_pwr_match(device_t parent, cfdata_t cf, void * aux) { struct gpio_attach_args *ga = aux; if (strcmp(ga->ga_dvname, cf->cf_name)) return 0; if (ga->ga_offset == -1) return 0; /* check that we have enough pins */ if (gpio_npins(ga->ga_mask) != PWR_NPINS) { aprint_debug("%s: invalid pin mask 0x%02x\n", cf->cf_name, ga->ga_mask); return 0; } return 1; } static void netwalker_pwr_attach(device_t parent, device_t self, void *aux) { struct netwalker_pwr_softc *sc = device_private(self); struct gpio_attach_args *ga = aux; int caps; sc->sc_dev = self; sc->sc_gpio = ga->ga_gpio; /* map pins */ sc->sc_map.pm_map = sc->sc_map_pins; if (gpio_pin_map(sc->sc_gpio, ga->ga_offset, ga->ga_mask, &sc->sc_map)) { aprint_error(": couldn't map the pins\n"); return; } /* configure the input pin */ caps = gpio_pin_caps(sc->sc_gpio, &sc->sc_map, PWR_PIN_INPUT); if (!(caps & GPIO_PIN_INPUT)) { aprint_error(": pin is unable to read input\n"); gpio_pin_unmap(sc->sc_gpio, &sc->sc_map); return; } gpio_pin_ctl(sc->sc_gpio, &sc->sc_map, PWR_PIN_INPUT, GPIO_PIN_INPUT); sc->sc_intr = intr_establish(GPIO1_IRQBASE + ga->ga_offset, IPL_VM, IST_EDGE_BOTH, netwalker_pwr_intr, sc); if (sc->sc_intr == NULL) { aprint_error(": couldn't establish interrupt\n"); gpio_pin_unmap(sc->sc_gpio, &sc->sc_map); return; } aprint_normal(": NETWALKER power button\n"); aprint_naive(": NETWALKER power button\n"); if (!pmf_device_register(sc->sc_dev, NULL, NULL)) { aprint_error_dev(sc->sc_dev, "couldn't establish power handler\n"); } sysmon_task_queue_init(); sc->sc_smpsw.smpsw_name = device_xname(self); sc->sc_smpsw.smpsw_type = PSWITCH_TYPE_POWER; sc->sc_state = PSWITCH_EVENT_RELEASED; sysmon_pswitch_register(&sc->sc_smpsw); } static int netwalker_pwr_detach(device_t self, int flags) { struct netwalker_pwr_softc *sc = device_private(self); if (sc->sc_intr != NULL) intr_disestablish(sc->sc_intr); gpio_pin_unmap(sc->sc_gpio, &sc->sc_map); pmf_device_deregister(self); sysmon_task_queue_fini(); return 0; } static int netwalker_pwr_intr(void *v) { struct netwalker_pwr_softc *sc = v; sysmon_task_queue_sched(0, netwalker_pwr_refresh, sc); return 1; } static void netwalker_pwr_refresh(void *v) { struct netwalker_pwr_softc *sc = v; int pwr; int event; pwr = gpio_pin_read(sc->sc_gpio, &sc->sc_map, PWR_PIN_INPUT); event = (pwr == GPIO_PIN_HIGH) ? PSWITCH_EVENT_RELEASED : PSWITCH_EVENT_PRESSED; /* crude way to avoid duplicate events */ if(event == sc->sc_state) return; sc->sc_state = event; /* report the event */ sysmon_pswitch_event(&sc->sc_smpsw, event); }