1 /* $NetBSD: netwalker_pwr.c,v 1.1 2014/05/06 11:08:51 hkenken Exp $ */ 2 3 /* 4 * Copyright (c) 2014 Genetec Corporation. All rights reserved. 5 * Written by Hashimoto Kenichi for Genetec Corporation. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND 17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL GENETEC CORPORATION 20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 * POSSIBILITY OF SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: netwalker_pwr.c,v 1.1 2014/05/06 11:08:51 hkenken Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/device.h> 35 #include <sys/gpio.h> 36 37 #include <dev/gpio/gpiovar.h> 38 #include <dev/sysmon/sysmonvar.h> 39 #include <dev/sysmon/sysmon_taskq.h> 40 41 #include <dev/gpio/gpiovar.h> 42 43 #include <evbarm/netwalker/netwalker.h> 44 45 #define PWR_PIN_INPUT 0 46 #define PWR_NPINS 1 47 48 49 struct netwalker_pwr_softc { 50 device_t sc_dev; 51 void *sc_gpio; 52 void *sc_intr; 53 54 struct gpio_pinmap sc_map; 55 int sc_map_pins[PWR_NPINS]; 56 57 struct sysmon_pswitch sc_smpsw; 58 int sc_state; 59 }; 60 61 static int netwalker_pwr_match(device_t, cfdata_t, void *); 62 static void netwalker_pwr_attach(device_t, device_t, void *); 63 static int netwalker_pwr_detach(device_t, int); 64 65 CFATTACH_DECL_NEW(netwalker_pwr, sizeof(struct netwalker_pwr_softc), 66 netwalker_pwr_match, netwalker_pwr_attach, netwalker_pwr_detach, NULL); 67 68 static void netwalker_pwr_refresh(void *); 69 static int netwalker_pwr_intr(void *); 70 71 72 static int 73 netwalker_pwr_match(device_t parent, cfdata_t cf, void * aux) 74 { 75 struct gpio_attach_args *ga = aux; 76 77 if (strcmp(ga->ga_dvname, cf->cf_name)) 78 return 0; 79 if (ga->ga_offset == -1) 80 return 0; 81 /* check that we have enough pins */ 82 if (gpio_npins(ga->ga_mask) != PWR_NPINS) { 83 aprint_debug("%s: invalid pin mask 0x%02x\n", cf->cf_name, 84 ga->ga_mask); 85 return 0; 86 } 87 88 return 1; 89 } 90 91 static void 92 netwalker_pwr_attach(device_t parent, device_t self, void *aux) 93 { 94 struct netwalker_pwr_softc *sc = device_private(self); 95 struct gpio_attach_args *ga = aux; 96 int caps; 97 98 sc->sc_dev = self; 99 sc->sc_gpio = ga->ga_gpio; 100 101 /* map pins */ 102 sc->sc_map.pm_map = sc->sc_map_pins; 103 if (gpio_pin_map(sc->sc_gpio, ga->ga_offset, ga->ga_mask, &sc->sc_map)) { 104 aprint_error(": couldn't map the pins\n"); 105 return; 106 } 107 108 /* configure the input pin */ 109 caps = gpio_pin_caps(sc->sc_gpio, &sc->sc_map, PWR_PIN_INPUT); 110 if (!(caps & GPIO_PIN_INPUT)) { 111 aprint_error(": pin is unable to read input\n"); 112 gpio_pin_unmap(sc->sc_gpio, &sc->sc_map); 113 return; 114 } 115 gpio_pin_ctl(sc->sc_gpio, &sc->sc_map, PWR_PIN_INPUT, 116 GPIO_PIN_INPUT); 117 118 sc->sc_intr = intr_establish(GPIO1_IRQBASE + ga->ga_offset, 119 IPL_VM, IST_EDGE_BOTH, netwalker_pwr_intr, sc); 120 if (sc->sc_intr == NULL) { 121 aprint_error(": couldn't establish interrupt\n"); 122 gpio_pin_unmap(sc->sc_gpio, &sc->sc_map); 123 return; 124 } 125 126 aprint_normal(": NETWALKER power button\n"); 127 aprint_naive(": NETWALKER power button\n"); 128 129 if (!pmf_device_register(sc->sc_dev, NULL, NULL)) { 130 aprint_error_dev(sc->sc_dev, 131 "couldn't establish power handler\n"); 132 } 133 134 sysmon_task_queue_init(); 135 sc->sc_smpsw.smpsw_name = device_xname(self); 136 sc->sc_smpsw.smpsw_type = PSWITCH_TYPE_POWER; 137 sc->sc_state = PSWITCH_EVENT_RELEASED; 138 sysmon_pswitch_register(&sc->sc_smpsw); 139 } 140 141 static int 142 netwalker_pwr_detach(device_t self, int flags) 143 { 144 struct netwalker_pwr_softc *sc = device_private(self); 145 146 if (sc->sc_intr != NULL) 147 intr_disestablish(sc->sc_intr); 148 149 gpio_pin_unmap(sc->sc_gpio, &sc->sc_map); 150 pmf_device_deregister(self); 151 sysmon_task_queue_fini(); 152 153 return 0; 154 } 155 156 static int 157 netwalker_pwr_intr(void *v) 158 { 159 struct netwalker_pwr_softc *sc = v; 160 161 sysmon_task_queue_sched(0, netwalker_pwr_refresh, sc); 162 return 1; 163 } 164 165 static void 166 netwalker_pwr_refresh(void *v) 167 { 168 struct netwalker_pwr_softc *sc = v; 169 int pwr; 170 int event; 171 172 pwr = gpio_pin_read(sc->sc_gpio, &sc->sc_map, PWR_PIN_INPUT); 173 event = (pwr == GPIO_PIN_HIGH) ? 174 PSWITCH_EVENT_RELEASED : PSWITCH_EVENT_PRESSED; 175 176 /* crude way to avoid duplicate events */ 177 if(event == sc->sc_state) 178 return; 179 180 sc->sc_state = event; 181 /* report the event */ 182 sysmon_pswitch_event(&sc->sc_smpsw, event); 183 } 184
Indexes created Tue Sep 30 17:09:57 GMT 2025