wzero3_kbd.c revision 1.3.2.2
1 1.3.2.2 uebayasi /* $NetBSD: wzero3_kbd.c,v 1.3.2.2 2010/04/30 14:39:25 uebayasi Exp $ */ 2 1.3.2.2 uebayasi 3 1.3.2.2 uebayasi /* 4 1.3.2.2 uebayasi * Copyright (c) 2008, 2009 NONAKA Kimihiro <nonaka (at) netbsd.org> 5 1.3.2.2 uebayasi * All rights reserved. 6 1.3.2.2 uebayasi * 7 1.3.2.2 uebayasi * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 uebayasi * modification, are permitted provided that the following conditions 9 1.3.2.2 uebayasi * are met: 10 1.3.2.2 uebayasi * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 uebayasi * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 uebayasi * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 uebayasi * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 uebayasi * documentation and/or other materials provided with the distribution. 15 1.3.2.2 uebayasi * 16 1.3.2.2 uebayasi * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 17 1.3.2.2 uebayasi * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 1.3.2.2 uebayasi * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 1.3.2.2 uebayasi * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 20 1.3.2.2 uebayasi * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 1.3.2.2 uebayasi * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 1.3.2.2 uebayasi * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 1.3.2.2 uebayasi * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 1.3.2.2 uebayasi * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.3.2.2 uebayasi * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.3.2.2 uebayasi * SUCH DAMAGE. 27 1.3.2.2 uebayasi */ 28 1.3.2.2 uebayasi 29 1.3.2.2 uebayasi #include <sys/cdefs.h> 30 1.3.2.2 uebayasi __KERNEL_RCSID(0, "$NetBSD: wzero3_kbd.c,v 1.3.2.2 2010/04/30 14:39:25 uebayasi Exp $"); 31 1.3.2.2 uebayasi 32 1.3.2.2 uebayasi #include <sys/param.h> 33 1.3.2.2 uebayasi #include <sys/systm.h> 34 1.3.2.2 uebayasi #include <sys/device.h> 35 1.3.2.2 uebayasi #include <sys/kernel.h> 36 1.3.2.2 uebayasi #include <sys/malloc.h> 37 1.3.2.2 uebayasi #include <sys/callout.h> 38 1.3.2.2 uebayasi 39 1.3.2.2 uebayasi #include <dev/sysmon/sysmonvar.h> 40 1.3.2.2 uebayasi #include <dev/sysmon/sysmon_taskq.h> 41 1.3.2.2 uebayasi 42 1.3.2.2 uebayasi #include <arm/xscale/pxa2x0cpu.h> 43 1.3.2.2 uebayasi #include <arm/xscale/pxa2x0var.h> 44 1.3.2.2 uebayasi #include <arm/xscale/pxa2x0_gpio.h> 45 1.3.2.2 uebayasi 46 1.3.2.2 uebayasi #include <machine/bus.h> 47 1.3.2.2 uebayasi #include <machine/bootinfo.h> 48 1.3.2.2 uebayasi #include <machine/config_hook.h> 49 1.3.2.2 uebayasi #include <machine/platid.h> 50 1.3.2.2 uebayasi #include <machine/platid_mask.h> 51 1.3.2.2 uebayasi 52 1.3.2.2 uebayasi #include <dev/hpc/hpckbdvar.h> 53 1.3.2.2 uebayasi 54 1.3.2.2 uebayasi #include <arch/hpcarm/dev/wzero3_reg.h> 55 1.3.2.2 uebayasi 56 1.3.2.2 uebayasi #ifdef DEBUG 57 1.3.2.2 uebayasi #define DPRINTF(arg) printf arg 58 1.3.2.2 uebayasi #else 59 1.3.2.2 uebayasi #define DPRINTF(arg) /* nothing */ 60 1.3.2.2 uebayasi #endif 61 1.3.2.2 uebayasi 62 1.3.2.2 uebayasi #define CSR_READ1(r) bus_space_read_1(sc->sc_iot, sc->sc_ioh, (r)) 63 1.3.2.2 uebayasi #define CSR_WRITE1(r,v) bus_space_write_1(sc->sc_iot, sc->sc_ioh, (r), (v)) 64 1.3.2.2 uebayasi #define CSR_READ2(r) bus_space_read_2(sc->sc_iot, sc->sc_ioh, (r)) 65 1.3.2.2 uebayasi #define CSR_WRITE2(r,v) bus_space_write_2(sc->sc_iot, sc->sc_ioh, (r), (v)) 66 1.3.2.2 uebayasi #define CSR_READ4(r) bus_space_read_4(sc->sc_iot, sc->sc_ioh, (r)) 67 1.3.2.2 uebayasi #define CSR_WRITE4(r,v) bus_space_write_4(sc->sc_iot, sc->sc_ioh, (r), (v)) 68 1.3.2.2 uebayasi 69 1.3.2.2 uebayasi /* register */ 70 1.3.2.2 uebayasi #define KBDCOL_L (0x00) /* Write */ 71 1.3.2.2 uebayasi #define KBDCOL_U (0x04) /* Write */ 72 1.3.2.2 uebayasi #define KBDCHARGE (0x08) /* Write */ 73 1.3.2.2 uebayasi #define KBDDATA (0x08) /* Read */ 74 1.3.2.2 uebayasi #define REGMAPSIZE 0x0c 75 1.3.2.2 uebayasi 76 1.3.2.2 uebayasi #define KEYWAIT 20 /* us */ 77 1.3.2.2 uebayasi 78 1.3.2.2 uebayasi #define WS003SH_NCOLUMN 12 79 1.3.2.2 uebayasi #define WS003SH_NROW 7 80 1.3.2.2 uebayasi 81 1.3.2.2 uebayasi struct wzero3kbd_softc { 82 1.3.2.2 uebayasi device_t sc_dev; 83 1.3.2.2 uebayasi 84 1.3.2.2 uebayasi bus_space_tag_t sc_iot; 85 1.3.2.2 uebayasi bus_space_handle_t sc_ioh; 86 1.3.2.2 uebayasi 87 1.3.2.2 uebayasi int sc_ncolumn; 88 1.3.2.2 uebayasi int sc_nrow; 89 1.3.2.2 uebayasi uint8_t *sc_okeystat; 90 1.3.2.2 uebayasi uint8_t *sc_keystat; 91 1.3.2.2 uebayasi 92 1.3.2.2 uebayasi void *sc_key_ih; 93 1.3.2.2 uebayasi void *sc_power_ih; 94 1.3.2.2 uebayasi void *sc_reset_ih; 95 1.3.2.2 uebayasi 96 1.3.2.2 uebayasi int sc_key_pin; 97 1.3.2.2 uebayasi int sc_power_pin; 98 1.3.2.2 uebayasi int sc_reset_pin; 99 1.3.2.2 uebayasi 100 1.3.2.2 uebayasi struct hpckbd_ic_if sc_if; 101 1.3.2.2 uebayasi struct hpckbd_if *sc_hpckbd; 102 1.3.2.2 uebayasi 103 1.3.2.2 uebayasi struct sysmon_pswitch sc_smpsw; /* for reset key */ 104 1.3.2.2 uebayasi 105 1.3.2.2 uebayasi int sc_enabled; 106 1.3.2.2 uebayasi 107 1.3.2.2 uebayasi /* polling stuff */ 108 1.3.2.2 uebayasi struct callout sc_keyscan_ch; 109 1.3.2.2 uebayasi int sc_interval; 110 1.3.2.2 uebayasi #define KEY_INTERVAL 50 /* ms */ 111 1.3.2.2 uebayasi 112 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) || defined(KEYTEST5) 113 1.3.2.2 uebayasi void *sc_test_ih; 114 1.3.2.2 uebayasi int sc_test_pin; 115 1.3.2.2 uebayasi int sc_nouse_pin; 116 1.3.2.2 uebayasi int sc_nouse_pin2; 117 1.3.2.2 uebayasi int sc_nouse_pin3; 118 1.3.2.2 uebayasi int sc_bit; 119 1.3.2.2 uebayasi #endif 120 1.3.2.2 uebayasi }; 121 1.3.2.2 uebayasi 122 1.3.2.2 uebayasi static int wzero3kbd_match(device_t, cfdata_t, void *); 123 1.3.2.2 uebayasi static void wzero3kbd_attach(device_t, device_t, void *); 124 1.3.2.2 uebayasi 125 1.3.2.2 uebayasi CFATTACH_DECL_NEW(wzero3kbd, sizeof(struct wzero3kbd_softc), 126 1.3.2.2 uebayasi wzero3kbd_match, wzero3kbd_attach, NULL, NULL); 127 1.3.2.2 uebayasi 128 1.3.2.2 uebayasi static int wzero3kbd_intr(void *arg); 129 1.3.2.2 uebayasi #if defined(KEYTEST) 130 1.3.2.2 uebayasi static int wzero3kbd_intr2(void *arg); 131 1.3.2.2 uebayasi #endif 132 1.3.2.2 uebayasi #if defined(KEYTEST3) 133 1.3.2.2 uebayasi static int wzero3kbd_intr3(void *arg); 134 1.3.2.2 uebayasi #endif 135 1.3.2.2 uebayasi static void wzero3kbd_tick(void *arg); 136 1.3.2.2 uebayasi static int wzero3kbd_power_intr(void *arg); 137 1.3.2.2 uebayasi static int wzero3kbd_reset_intr(void *arg); 138 1.3.2.2 uebayasi static int wzero3kbd_input_establish(void *arg, struct hpckbd_if *kbdif); 139 1.3.2.2 uebayasi static void wzero3kbd_sysmon_reset_event(void *arg); 140 1.3.2.2 uebayasi static int wzero3kbd_poll(void *arg); 141 1.3.2.2 uebayasi static int wzero3kbd_poll1(void *arg); 142 1.3.2.2 uebayasi 143 1.3.2.2 uebayasi /* 144 1.3.2.2 uebayasi * WS003SH keyscan map 145 1.3.2.2 uebayasi col#0 col#1 col#2 col#3 col#4 col#5 col#6 col#7 col#8 col#9 col#10 col#11 146 1.3.2.2 uebayasi row#0: CTRL 1 3 5 6 7 9 0 BS (none) ROTATE CAMERA 147 1.3.2.2 uebayasi row#1: (none) 2 4 r y 8 i o p (none) VOL- VOL+ 148 1.3.2.2 uebayasi row#2: TAB q e t g u j k (none) (none) (none) (none) 149 1.3.2.2 uebayasi row#3: (none) w s f v h m l (none) (none) SHIFT (none) 150 1.3.2.2 uebayasi row#4: CALL a d c b n . (none) ENTER (none) WIN (none) 151 1.3.2.2 uebayasi row#5: MAIL z x - SPACE / (none) UP (none) (none) LSOFT FN 152 1.3.2.2 uebayasi row#6: IE MOJI (none) OK ACTION , LEFT DOWN RIGHT (none) RSOFT (none) 153 1.3.2.2 uebayasi */ 154 1.3.2.2 uebayasi 155 1.3.2.2 uebayasi /* 156 1.3.2.2 uebayasi * WS011SH keyscan map 157 1.3.2.2 uebayasi col#0 col#1 col#2 col#3 col#4 col#5 col#6 col#7 col#8 col#9 col#10 col#11 158 1.3.2.2 uebayasi row#0 Ctrl (none) (none) (none) (none) (none) (none) (none) Del (none) ROTATE (none) 159 1.3.2.2 uebayasi row#1 (none) (none) (none) R Y (none) I O (none) (none) (none) (none) 160 1.3.2.2 uebayasi row#2 Tab Q E T G U J K (none) (none) (none) (none) 161 1.3.2.2 uebayasi row#3 (none) W S F V H M L (none) (none) Shift (none) 162 1.3.2.2 uebayasi row#4 (none) A D C B N . (none) Enter (none) (none) (none) 163 1.3.2.2 uebayasi row#5 (none) Z X - Space / (none) UP (none) (none) (none) (none) 164 1.3.2.2 uebayasi row#6 (none) MOJI HAN/ZEN OK (none) , LEFT DOWN RIGHT (none) Fn (none) 165 1.3.2.2 uebayasi */ 166 1.3.2.2 uebayasi 167 1.3.2.2 uebayasi static const struct wzero3kbd_model { 168 1.3.2.2 uebayasi platid_mask_t *platid; 169 1.3.2.2 uebayasi int key_pin; 170 1.3.2.2 uebayasi int power_pin; 171 1.3.2.2 uebayasi int reset_pin; 172 1.3.2.2 uebayasi int ncolumn; 173 1.3.2.2 uebayasi int nrow; 174 1.3.2.2 uebayasi } wzero3kbd_table[] = { 175 1.3.2.2 uebayasi /* WS003SH */ 176 1.3.2.2 uebayasi { 177 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS003SH, 178 1.3.2.2 uebayasi -1, /* XXX */ 179 1.3.2.2 uebayasi GPIO_WS003SH_POWER_BUTTON, 180 1.3.2.2 uebayasi -1, /* None */ 181 1.3.2.2 uebayasi WS003SH_NCOLUMN, 182 1.3.2.2 uebayasi WS003SH_NROW, 183 1.3.2.2 uebayasi }, 184 1.3.2.2 uebayasi /* WS004SH */ 185 1.3.2.2 uebayasi { 186 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS004SH, 187 1.3.2.2 uebayasi -1, /* XXX */ 188 1.3.2.2 uebayasi GPIO_WS003SH_POWER_BUTTON, 189 1.3.2.2 uebayasi -1, /* None */ 190 1.3.2.2 uebayasi WS003SH_NCOLUMN, 191 1.3.2.2 uebayasi WS003SH_NROW, 192 1.3.2.2 uebayasi }, 193 1.3.2.2 uebayasi /* WS007SH */ 194 1.3.2.2 uebayasi { 195 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS007SH, 196 1.3.2.2 uebayasi -1, /* XXX */ 197 1.3.2.2 uebayasi GPIO_WS007SH_POWER_BUTTON, 198 1.3.2.2 uebayasi GPIO_WS007SH_RESET_BUTTON, 199 1.3.2.2 uebayasi WS003SH_NCOLUMN, 200 1.3.2.2 uebayasi WS003SH_NROW, 201 1.3.2.2 uebayasi }, 202 1.3.2.2 uebayasi /* WS011SH */ 203 1.3.2.2 uebayasi { 204 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS011SH, 205 1.3.2.2 uebayasi -1, /* XXX */ 206 1.3.2.2 uebayasi GPIO_WS011SH_POWER_BUTTON, 207 1.3.2.2 uebayasi GPIO_WS011SH_RESET_BUTTON, 208 1.3.2.2 uebayasi WS003SH_NCOLUMN, 209 1.3.2.2 uebayasi WS003SH_NROW, 210 1.3.2.2 uebayasi }, 211 1.3.2.2 uebayasi /* WS020SH */ 212 1.3.2.2 uebayasi { 213 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS020SH, 214 1.3.2.2 uebayasi -1, /* XXX */ 215 1.3.2.2 uebayasi -1, /* XXX */ 216 1.3.2.2 uebayasi -1, /* XXX */ 217 1.3.2.2 uebayasi WS003SH_NCOLUMN, 218 1.3.2.2 uebayasi WS003SH_NROW, 219 1.3.2.2 uebayasi }, 220 1.3.2.2 uebayasi 221 1.3.2.2 uebayasi { NULL, -1, -1, -1, 0, 0, } 222 1.3.2.2 uebayasi }; 223 1.3.2.2 uebayasi 224 1.3.2.2 uebayasi static const struct wzero3kbd_model * 225 1.3.2.2 uebayasi wzero3kbd_lookup(void) 226 1.3.2.2 uebayasi { 227 1.3.2.2 uebayasi const struct wzero3kbd_model *model; 228 1.3.2.2 uebayasi 229 1.3.2.2 uebayasi for (model = wzero3kbd_table; model->platid != NULL; model++) { 230 1.3.2.2 uebayasi if (platid_match(&platid, model->platid)) { 231 1.3.2.2 uebayasi return model; 232 1.3.2.2 uebayasi } 233 1.3.2.2 uebayasi } 234 1.3.2.2 uebayasi return NULL; 235 1.3.2.2 uebayasi } 236 1.3.2.2 uebayasi 237 1.3.2.2 uebayasi static int 238 1.3.2.2 uebayasi wzero3kbd_match(struct device *parent, struct cfdata *cf, void *aux) 239 1.3.2.2 uebayasi { 240 1.3.2.2 uebayasi 241 1.3.2.2 uebayasi if (strcmp(cf->cf_name, "wzero3kbd") != 0) 242 1.3.2.2 uebayasi return 0; 243 1.3.2.2 uebayasi if (wzero3kbd_lookup() == NULL) 244 1.3.2.2 uebayasi return 0; 245 1.3.2.2 uebayasi return 1; 246 1.3.2.2 uebayasi } 247 1.3.2.2 uebayasi 248 1.3.2.2 uebayasi static void 249 1.3.2.2 uebayasi wzero3kbd_attach(struct device *parent, struct device *self, void *aux) 250 1.3.2.2 uebayasi { 251 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = device_private(self); 252 1.3.2.2 uebayasi struct pxaip_attach_args *pxa = (struct pxaip_attach_args *)aux; 253 1.3.2.2 uebayasi struct hpckbd_attach_args haa; 254 1.3.2.2 uebayasi const struct wzero3kbd_model *model; 255 1.3.2.2 uebayasi 256 1.3.2.2 uebayasi sc->sc_dev = self; 257 1.3.2.2 uebayasi 258 1.3.2.2 uebayasi model = wzero3kbd_lookup(); 259 1.3.2.2 uebayasi if (model == NULL) { 260 1.3.2.2 uebayasi aprint_error(": unknown model\n"); 261 1.3.2.2 uebayasi return; 262 1.3.2.2 uebayasi } 263 1.3.2.2 uebayasi 264 1.3.2.2 uebayasi aprint_normal(": keyboard\n"); 265 1.3.2.2 uebayasi aprint_naive("\n"); 266 1.3.2.2 uebayasi 267 1.3.2.2 uebayasi sc->sc_key_pin = model->key_pin; 268 1.3.2.2 uebayasi sc->sc_power_pin = model->power_pin; 269 1.3.2.2 uebayasi sc->sc_reset_pin = model->reset_pin; 270 1.3.2.2 uebayasi sc->sc_ncolumn = model->ncolumn; 271 1.3.2.2 uebayasi sc->sc_nrow = model->nrow; 272 1.3.2.2 uebayasi 273 1.3.2.2 uebayasi sc->sc_iot = pxa->pxa_iot; 274 1.3.2.2 uebayasi if (bus_space_map(sc->sc_iot, PXA2X0_CS2_START, REGMAPSIZE, 0, 275 1.3.2.2 uebayasi &sc->sc_ioh)) { 276 1.3.2.2 uebayasi aprint_error_dev(self, "couldn't map registers.\n"); 277 1.3.2.2 uebayasi return; 278 1.3.2.2 uebayasi } 279 1.3.2.2 uebayasi 280 1.3.2.2 uebayasi sc->sc_okeystat = malloc(sc->sc_nrow * sc->sc_ncolumn, M_DEVBUF, 281 1.3.2.2 uebayasi M_NOWAIT | M_ZERO); 282 1.3.2.2 uebayasi sc->sc_keystat = malloc(sc->sc_nrow * sc->sc_ncolumn, M_DEVBUF, 283 1.3.2.2 uebayasi M_NOWAIT | M_ZERO); 284 1.3.2.2 uebayasi if (sc->sc_okeystat == NULL || sc->sc_keystat == NULL) { 285 1.3.2.2 uebayasi aprint_error_dev(self, "couldn't alloc memory.\n"); 286 1.3.2.2 uebayasi if (sc->sc_okeystat) 287 1.3.2.2 uebayasi free(sc->sc_okeystat, M_DEVBUF); 288 1.3.2.2 uebayasi if (sc->sc_keystat) 289 1.3.2.2 uebayasi free(sc->sc_keystat, M_DEVBUF); 290 1.3.2.2 uebayasi return; 291 1.3.2.2 uebayasi } 292 1.3.2.2 uebayasi 293 1.3.2.2 uebayasi sc->sc_if.hii_ctx = sc; 294 1.3.2.2 uebayasi sc->sc_if.hii_establish = wzero3kbd_input_establish; 295 1.3.2.2 uebayasi sc->sc_if.hii_poll = wzero3kbd_poll; 296 1.3.2.2 uebayasi 297 1.3.2.2 uebayasi /* Attach console if not using serial. */ 298 1.3.2.2 uebayasi if (!(bootinfo->bi_cnuse & BI_CNUSE_SERIAL)) 299 1.3.2.2 uebayasi hpckbd_cnattach(&sc->sc_if); 300 1.3.2.2 uebayasi 301 1.3.2.2 uebayasi /* Install interrupt handler. */ 302 1.3.2.2 uebayasi if (sc->sc_key_pin >= 0) { 303 1.3.2.2 uebayasi pxa2x0_gpio_set_function(sc->sc_key_pin, GPIO_IN); 304 1.3.2.2 uebayasi sc->sc_key_ih = pxa2x0_gpio_intr_establish(sc->sc_key_pin, 305 1.3.2.2 uebayasi IST_EDGE_BOTH, IPL_TTY, wzero3kbd_intr, sc); 306 1.3.2.2 uebayasi if (sc->sc_key_ih == NULL) { 307 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 308 1.3.2.2 uebayasi "couldn't establish key interrupt\n"); 309 1.3.2.2 uebayasi } 310 1.3.2.2 uebayasi } else { 311 1.3.2.2 uebayasi sc->sc_interval = KEY_INTERVAL / (1000 / hz); 312 1.3.2.2 uebayasi if (sc->sc_interval < 1) 313 1.3.2.2 uebayasi sc->sc_interval = 1; 314 1.3.2.2 uebayasi callout_init(&sc->sc_keyscan_ch, 0); 315 1.3.2.2 uebayasi callout_reset(&sc->sc_keyscan_ch, sc->sc_interval, 316 1.3.2.2 uebayasi wzero3kbd_tick, sc); 317 1.3.2.2 uebayasi } 318 1.3.2.2 uebayasi 319 1.3.2.2 uebayasi /* power key */ 320 1.3.2.2 uebayasi if (sc->sc_power_pin >= 0) { 321 1.3.2.2 uebayasi pxa2x0_gpio_set_function(sc->sc_power_pin, GPIO_IN); 322 1.3.2.2 uebayasi sc->sc_power_ih = pxa2x0_gpio_intr_establish( 323 1.3.2.2 uebayasi sc->sc_power_pin, IST_EDGE_BOTH, IPL_TTY, 324 1.3.2.2 uebayasi wzero3kbd_power_intr, sc); 325 1.3.2.2 uebayasi if (sc->sc_power_ih == NULL) { 326 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 327 1.3.2.2 uebayasi "couldn't establish power key interrupt\n"); 328 1.3.2.2 uebayasi } 329 1.3.2.2 uebayasi } 330 1.3.2.2 uebayasi 331 1.3.2.2 uebayasi /* reset button */ 332 1.3.2.2 uebayasi if (sc->sc_reset_pin >= 0) { 333 1.3.2.2 uebayasi pxa2x0_gpio_set_function(sc->sc_reset_pin, GPIO_IN); 334 1.3.2.2 uebayasi sc->sc_reset_ih = pxa2x0_gpio_intr_establish( 335 1.3.2.2 uebayasi sc->sc_reset_pin, IST_EDGE_BOTH, IPL_TTY, 336 1.3.2.2 uebayasi wzero3kbd_reset_intr, sc); 337 1.3.2.2 uebayasi if (sc->sc_reset_ih == NULL) { 338 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 339 1.3.2.2 uebayasi "couldn't establish reset key interrupt\n"); 340 1.3.2.2 uebayasi } 341 1.3.2.2 uebayasi 342 1.3.2.2 uebayasi sc->sc_smpsw.smpsw_name = device_xname(self); 343 1.3.2.2 uebayasi sc->sc_smpsw.smpsw_type = PSWITCH_TYPE_RESET; 344 1.3.2.2 uebayasi if (sysmon_pswitch_register(&sc->sc_smpsw) != 0) { 345 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 346 1.3.2.2 uebayasi "unable to register reset event handler\n"); 347 1.3.2.2 uebayasi } 348 1.3.2.2 uebayasi } 349 1.3.2.2 uebayasi 350 1.3.2.2 uebayasi /* Attach hpckbd. */ 351 1.3.2.2 uebayasi haa.haa_ic = &sc->sc_if; 352 1.3.2.2 uebayasi config_found(self, &haa, hpckbd_print); 353 1.3.2.2 uebayasi 354 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) || defined(KEYTEST5) 355 1.3.2.2 uebayasi sc->sc_test_ih = NULL; 356 1.3.2.2 uebayasi sc->sc_test_pin = -1; 357 1.3.2.2 uebayasi sc->sc_nouse_pin = -1; 358 1.3.2.2 uebayasi sc->sc_nouse_pin2 = -1; 359 1.3.2.2 uebayasi sc->sc_nouse_pin3 = -1; 360 1.3.2.2 uebayasi sc->sc_bit = 0x01; 361 1.3.2.2 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS003SH) 362 1.3.2.2 uebayasi || platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS004SH)) { 363 1.3.2.2 uebayasi sc->sc_nouse_pin = GPIO_WS003SH_SD_DETECT; /* SD_DETECT */ 364 1.3.2.2 uebayasi sc->sc_nouse_pin2 = 86; /* Vsync? */ 365 1.3.2.2 uebayasi sc->sc_nouse_pin3 = 89; /* RESET? */ 366 1.3.2.2 uebayasi } 367 1.3.2.2 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS007SH)) { 368 1.3.2.2 uebayasi sc->sc_nouse_pin = GPIO_WS007SH_SD_DETECT; /* SD_DETECT */ 369 1.3.2.2 uebayasi sc->sc_nouse_pin2 = 77; /* Vsync? */ 370 1.3.2.2 uebayasi } 371 1.3.2.2 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS011SH)) { 372 1.3.2.2 uebayasi sc->sc_nouse_pin = GPIO_WS011SH_SD_DETECT; /* SD_DETECT */ 373 1.3.2.2 uebayasi sc->sc_nouse_pin2 = 77; /* Vsync? */ 374 1.3.2.2 uebayasi } 375 1.3.2.2 uebayasi 376 1.3.2.2 uebayasi #ifdef KEYTEST 377 1.3.2.2 uebayasi for (sc->sc_test_pin = 2; sc->sc_test_pin < PXA270_GPIO_NPINS; sc->sc_test_pin++) { 378 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 379 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 380 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 381 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 382 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 383 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 384 1.3.2.2 uebayasi && GPIO_IS_GPIO_IN(pxa2x0_gpio_get_function(sc->sc_test_pin))) 385 1.3.2.2 uebayasi break; 386 1.3.2.2 uebayasi } 387 1.3.2.2 uebayasi if (sc->sc_test_pin < PXA270_GPIO_NPINS) { 388 1.3.2.2 uebayasi printf("GPIO_IN: GPIO pin #%d\n", sc->sc_test_pin); 389 1.3.2.2 uebayasi sc->sc_test_ih = pxa2x0_gpio_intr_establish(sc->sc_test_pin, 390 1.3.2.2 uebayasi IST_EDGE_BOTH, IPL_TTY, wzero3kbd_intr2, sc); 391 1.3.2.2 uebayasi } else { 392 1.3.2.2 uebayasi sc->sc_test_pin = -1; 393 1.3.2.2 uebayasi } 394 1.3.2.2 uebayasi #endif 395 1.3.2.2 uebayasi 396 1.3.2.2 uebayasi #ifdef KEYTEST3 397 1.3.2.2 uebayasi { 398 1.3.2.2 uebayasi int i; 399 1.3.2.2 uebayasi printf("pin: "); 400 1.3.2.2 uebayasi for (i = 0; i < PXA270_GPIO_NPINS; i++) { 401 1.3.2.2 uebayasi if (i == sc->sc_nouse_pin 402 1.3.2.2 uebayasi || i == sc->sc_nouse_pin2 403 1.3.2.2 uebayasi || i == sc->sc_nouse_pin3 404 1.3.2.2 uebayasi || i == sc->sc_key_pin 405 1.3.2.2 uebayasi || i == sc->sc_power_pin 406 1.3.2.2 uebayasi || i == sc->sc_reset_pin) 407 1.3.2.2 uebayasi continue; 408 1.3.2.2 uebayasi 409 1.3.2.2 uebayasi printf("%d, ", i); 410 1.3.2.2 uebayasi if (GPIO_IS_GPIO_IN(pxa2x0_gpio_get_function(i))) { 411 1.3.2.2 uebayasi pxa2x0_gpio_intr_establish(i, IST_EDGE_BOTH, 412 1.3.2.2 uebayasi IPL_TTY, wzero3kbd_intr3, (void *)(long)i); 413 1.3.2.2 uebayasi } 414 1.3.2.2 uebayasi } 415 1.3.2.2 uebayasi } 416 1.3.2.2 uebayasi #endif 417 1.3.2.2 uebayasi 418 1.3.2.2 uebayasi #ifdef KEYTEST4 419 1.3.2.2 uebayasi for (sc->sc_test_pin = 2; sc->sc_test_pin < PXA270_GPIO_NPINS; sc->sc_test_pin++) { 420 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 421 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 422 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 423 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 424 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 425 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 426 1.3.2.2 uebayasi && GPIO_IS_GPIO_OUT(pxa2x0_gpio_get_function(sc->sc_test_pin))) 427 1.3.2.2 uebayasi break; 428 1.3.2.2 uebayasi } 429 1.3.2.2 uebayasi if (sc->sc_test_pin < PXA270_GPIO_NPINS) { 430 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d\n", sc->sc_test_pin); 431 1.3.2.2 uebayasi } else { 432 1.3.2.2 uebayasi sc->sc_test_pin = -1; 433 1.3.2.2 uebayasi } 434 1.3.2.2 uebayasi #endif 435 1.3.2.2 uebayasi #ifdef KEYTEST5 436 1.3.2.2 uebayasi sc->sc_test_pin = 0x00; 437 1.3.2.2 uebayasi sc->sc_bit = 0x01; 438 1.3.2.2 uebayasi #endif 439 1.3.2.2 uebayasi #endif 440 1.3.2.2 uebayasi } 441 1.3.2.2 uebayasi 442 1.3.2.2 uebayasi static int 443 1.3.2.2 uebayasi wzero3kbd_intr(void *arg) 444 1.3.2.2 uebayasi { 445 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 446 1.3.2.2 uebayasi 447 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) || defined(KEYTEST5) 448 1.3.2.2 uebayasi printf("wzero3kbd_intr: GPIO pin #%d = %s\n", sc->sc_key_pin, 449 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(sc->sc_key_pin) ? "on" : "off"); 450 1.3.2.2 uebayasi #endif 451 1.3.2.2 uebayasi 452 1.3.2.2 uebayasi #if defined(KEYTEST4) 453 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0) { 454 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_test_pin)) { 455 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d: L\n",sc->sc_test_pin); 456 1.3.2.2 uebayasi pxa2x0_gpio_clear_bit(sc->sc_test_pin); 457 1.3.2.2 uebayasi } else { 458 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d: H\n", sc->sc_test_pin); 459 1.3.2.2 uebayasi pxa2x0_gpio_set_bit(sc->sc_test_pin); 460 1.3.2.2 uebayasi } 461 1.3.2.2 uebayasi } 462 1.3.2.2 uebayasi #endif 463 1.3.2.2 uebayasi #if defined(KEYTEST5) 464 1.3.2.2 uebayasi printf("CPLD(%#x): value=%#x, mask=%#x\n", 465 1.3.2.2 uebayasi sc->sc_test_pin, CSR_READ4(sc->sc_test_pin), sc->sc_bit); 466 1.3.2.2 uebayasi if (CSR_READ4(sc->sc_test_pin) & sc->sc_bit) { 467 1.3.2.2 uebayasi printf("CPLD_OUT: CPLD: L\n"); 468 1.3.2.2 uebayasi CSR_WRITE4(sc->sc_test_pin, 469 1.3.2.2 uebayasi CSR_READ4(sc->sc_test_pin) & ~sc->sc_bit); 470 1.3.2.2 uebayasi } else { 471 1.3.2.2 uebayasi printf("CPLD_OUT: CPLD: H\n"); 472 1.3.2.2 uebayasi CSR_WRITE4(sc->sc_test_pin, 473 1.3.2.2 uebayasi CSR_READ4(sc->sc_test_pin) | sc->sc_bit); 474 1.3.2.2 uebayasi } 475 1.3.2.2 uebayasi #endif 476 1.3.2.2 uebayasi 477 1.3.2.2 uebayasi (void) wzero3kbd_poll1(sc); 478 1.3.2.2 uebayasi 479 1.3.2.2 uebayasi pxa2x0_gpio_clear_intr(sc->sc_key_pin); 480 1.3.2.2 uebayasi 481 1.3.2.2 uebayasi return 1; 482 1.3.2.2 uebayasi } 483 1.3.2.2 uebayasi 484 1.3.2.2 uebayasi #if defined(KEYTEST) 485 1.3.2.2 uebayasi static int 486 1.3.2.2 uebayasi wzero3kbd_intr2(void *arg) 487 1.3.2.2 uebayasi { 488 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 489 1.3.2.2 uebayasi 490 1.3.2.2 uebayasi printf("wzero3kbd_intr2: GPIO_IN: GPIO pin #%d = %s\n", sc->sc_test_pin, 491 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(sc->sc_test_pin) ? "on" : "off"); 492 1.3.2.2 uebayasi 493 1.3.2.2 uebayasi return 1; 494 1.3.2.2 uebayasi } 495 1.3.2.2 uebayasi #endif 496 1.3.2.2 uebayasi 497 1.3.2.2 uebayasi #if defined(KEYTEST3) 498 1.3.2.2 uebayasi static int 499 1.3.2.2 uebayasi wzero3kbd_intr3(void *arg) 500 1.3.2.2 uebayasi { 501 1.3.2.2 uebayasi int pin = (int)arg; 502 1.3.2.2 uebayasi 503 1.3.2.2 uebayasi printf("wzero3kbd_intr3: GPIO pin #%d = %s\n", pin, 504 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(pin) ? "on" : "off"); 505 1.3.2.2 uebayasi 506 1.3.2.2 uebayasi return 1; 507 1.3.2.2 uebayasi } 508 1.3.2.2 uebayasi #endif 509 1.3.2.2 uebayasi 510 1.3.2.2 uebayasi 511 1.3.2.2 uebayasi static void 512 1.3.2.2 uebayasi wzero3kbd_tick(void *arg) 513 1.3.2.2 uebayasi { 514 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 515 1.3.2.2 uebayasi 516 1.3.2.2 uebayasi (void) wzero3kbd_poll1(sc); 517 1.3.2.2 uebayasi 518 1.3.2.2 uebayasi callout_reset(&sc->sc_keyscan_ch, sc->sc_interval, wzero3kbd_tick, sc); 519 1.3.2.2 uebayasi } 520 1.3.2.2 uebayasi 521 1.3.2.2 uebayasi static int 522 1.3.2.2 uebayasi wzero3kbd_power_intr(void *arg) 523 1.3.2.2 uebayasi { 524 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 525 1.3.2.2 uebayasi 526 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) 527 1.3.2.2 uebayasi printf("wzero3kbd_power_intr: status = %s\n", 528 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(sc->sc_power_pin) ? "on" : "off"); 529 1.3.2.2 uebayasi #endif 530 1.3.2.2 uebayasi 531 1.3.2.2 uebayasi #if defined(KEYTEST) 532 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 533 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0) { 534 1.3.2.2 uebayasi int orig_pin = sc->sc_test_pin; 535 1.3.2.2 uebayasi pxa2x0_gpio_intr_disestablish(sc->sc_test_ih); 536 1.3.2.2 uebayasi sc->sc_test_ih = NULL; 537 1.3.2.2 uebayasi 538 1.3.2.2 uebayasi for (;;) { 539 1.3.2.2 uebayasi if (++sc->sc_test_pin >= PXA270_GPIO_NPINS) 540 1.3.2.2 uebayasi sc->sc_test_pin = 2; 541 1.3.2.2 uebayasi if (sc->sc_test_pin == orig_pin) 542 1.3.2.2 uebayasi break; 543 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 544 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 545 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 546 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 547 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 548 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 549 1.3.2.2 uebayasi && GPIO_IS_GPIO_IN(pxa2x0_gpio_get_function(sc->sc_test_pin))) 550 1.3.2.2 uebayasi break; 551 1.3.2.2 uebayasi } 552 1.3.2.2 uebayasi if (sc->sc_test_pin != orig_pin) { 553 1.3.2.2 uebayasi printf("GPIO_IN: GPIO pin #%d\n", 554 1.3.2.2 uebayasi sc->sc_test_pin); 555 1.3.2.2 uebayasi sc->sc_test_ih = 556 1.3.2.2 uebayasi pxa2x0_gpio_intr_establish(sc->sc_test_pin, 557 1.3.2.2 uebayasi IST_EDGE_BOTH, IPL_TTY, wzero3kbd_intr2,sc); 558 1.3.2.2 uebayasi } else { 559 1.3.2.2 uebayasi sc->sc_test_pin = -1; 560 1.3.2.2 uebayasi } 561 1.3.2.2 uebayasi } 562 1.3.2.2 uebayasi } 563 1.3.2.2 uebayasi #endif 564 1.3.2.2 uebayasi 565 1.3.2.2 uebayasi #if defined(KEYTEST2) 566 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 567 1.3.2.2 uebayasi sc->sc_enabled ^= 2; 568 1.3.2.2 uebayasi if (sc->sc_enabled & 2) { 569 1.3.2.2 uebayasi printf("print col/row\n"); 570 1.3.2.2 uebayasi } else { 571 1.3.2.2 uebayasi printf("keyscan\n"); 572 1.3.2.2 uebayasi } 573 1.3.2.2 uebayasi } 574 1.3.2.2 uebayasi #endif 575 1.3.2.2 uebayasi #if defined(KEYTEST4) 576 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 577 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0) { 578 1.3.2.2 uebayasi int orig_pin = sc->sc_test_pin; 579 1.3.2.2 uebayasi for (;;) { 580 1.3.2.2 uebayasi if (++sc->sc_test_pin >= PXA270_GPIO_NPINS) 581 1.3.2.2 uebayasi sc->sc_test_pin = 2; 582 1.3.2.2 uebayasi if (sc->sc_test_pin == orig_pin) 583 1.3.2.2 uebayasi break; 584 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 585 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 586 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 587 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 588 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 589 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 590 1.3.2.2 uebayasi && GPIO_IS_GPIO_OUT(pxa2x0_gpio_get_function(sc->sc_test_pin))) 591 1.3.2.2 uebayasi break; 592 1.3.2.2 uebayasi } 593 1.3.2.2 uebayasi if (sc->sc_test_pin != orig_pin) { 594 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d\n", sc->sc_test_pin); 595 1.3.2.2 uebayasi } else { 596 1.3.2.2 uebayasi sc->sc_test_pin = -1; 597 1.3.2.2 uebayasi } 598 1.3.2.2 uebayasi } 599 1.3.2.2 uebayasi } 600 1.3.2.2 uebayasi #endif 601 1.3.2.2 uebayasi #if defined(KEYTEST5) 602 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 603 1.3.2.2 uebayasi sc->sc_bit <<= 1; 604 1.3.2.2 uebayasi if (sc->sc_bit & ~0xff) { 605 1.3.2.2 uebayasi sc->sc_bit = 0x01; 606 1.3.2.2 uebayasi sc->sc_test_pin += 0x4; 607 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0x20) { 608 1.3.2.2 uebayasi sc->sc_test_pin = 0x00; 609 1.3.2.2 uebayasi } 610 1.3.2.2 uebayasi } 611 1.3.2.2 uebayasi printf("CPLD(%#x), mask=%#x\n", sc->sc_test_pin, sc->sc_bit); 612 1.3.2.2 uebayasi } 613 1.3.2.2 uebayasi #endif 614 1.3.2.2 uebayasi 615 1.3.2.2 uebayasi pxa2x0_gpio_clear_intr(sc->sc_power_pin); 616 1.3.2.2 uebayasi 617 1.3.2.2 uebayasi return 1; 618 1.3.2.2 uebayasi } 619 1.3.2.2 uebayasi 620 1.3.2.2 uebayasi static int 621 1.3.2.2 uebayasi wzero3kbd_reset_intr(void *arg) 622 1.3.2.2 uebayasi { 623 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 624 1.3.2.2 uebayasi 625 1.3.2.2 uebayasi sysmon_task_queue_sched(0, wzero3kbd_sysmon_reset_event, sc); 626 1.3.2.2 uebayasi 627 1.3.2.2 uebayasi pxa2x0_gpio_clear_intr(sc->sc_reset_pin); 628 1.3.2.2 uebayasi 629 1.3.2.2 uebayasi return 1; 630 1.3.2.2 uebayasi } 631 1.3.2.2 uebayasi 632 1.3.2.2 uebayasi static int 633 1.3.2.2 uebayasi wzero3kbd_input_establish(void *arg, struct hpckbd_if *kbdif) 634 1.3.2.2 uebayasi { 635 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 636 1.3.2.2 uebayasi 637 1.3.2.2 uebayasi /* Save hpckbd interface. */ 638 1.3.2.2 uebayasi sc->sc_hpckbd = kbdif; 639 1.3.2.2 uebayasi sc->sc_enabled = 1; 640 1.3.2.2 uebayasi 641 1.3.2.2 uebayasi return 0; 642 1.3.2.2 uebayasi } 643 1.3.2.2 uebayasi 644 1.3.2.2 uebayasi static void 645 1.3.2.2 uebayasi wzero3kbd_sysmon_reset_event(void *arg) 646 1.3.2.2 uebayasi { 647 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 648 1.3.2.2 uebayasi 649 1.3.2.2 uebayasi sysmon_pswitch_event(&sc->sc_smpsw, PSWITCH_EVENT_PRESSED); 650 1.3.2.2 uebayasi } 651 1.3.2.2 uebayasi 652 1.3.2.2 uebayasi static int 653 1.3.2.2 uebayasi wzero3kbd_poll(void *arg) 654 1.3.2.2 uebayasi { 655 1.3.2.2 uebayasi int keydown; 656 1.3.2.2 uebayasi 657 1.3.2.2 uebayasi keydown = wzero3kbd_poll1(arg); 658 1.3.2.2 uebayasi 659 1.3.2.2 uebayasi return keydown; 660 1.3.2.2 uebayasi } 661 1.3.2.2 uebayasi 662 1.3.2.2 uebayasi static int 663 1.3.2.2 uebayasi wzero3kbd_poll1(void *arg) 664 1.3.2.2 uebayasi { 665 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 666 1.3.2.2 uebayasi int row, col, data; 667 1.3.2.2 uebayasi int keycol; 668 1.3.2.2 uebayasi int keydown; 669 1.3.2.2 uebayasi int i; 670 1.3.2.2 uebayasi int s; 671 1.3.2.2 uebayasi 672 1.3.2.2 uebayasi if (!sc->sc_enabled) { 673 1.3.2.2 uebayasi DPRINTF(("wzero3kbd_poll: disabled\n")); 674 1.3.2.2 uebayasi return 0; 675 1.3.2.2 uebayasi } 676 1.3.2.2 uebayasi 677 1.3.2.2 uebayasi s = spltty(); 678 1.3.2.2 uebayasi 679 1.3.2.2 uebayasi for (col = 0; col < sc->sc_ncolumn; col++) { 680 1.3.2.2 uebayasi /* deselect column# and charge */ 681 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_L, 0); 682 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_U, 0); 683 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 1); 684 1.3.2.2 uebayasi delay(KEYWAIT); 685 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 0); 686 1.3.2.2 uebayasi 687 1.3.2.2 uebayasi /* select scan column# */ 688 1.3.2.2 uebayasi keycol = 1 << col; 689 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_L, keycol & 0xff); 690 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_U, keycol >> 8); 691 1.3.2.2 uebayasi delay(KEYWAIT); 692 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 0); 693 1.3.2.2 uebayasi 694 1.3.2.2 uebayasi /* read key data */ 695 1.3.2.2 uebayasi data = CSR_READ1(KBDDATA); 696 1.3.2.2 uebayasi for (row = 0; row < sc->sc_nrow; row++) { 697 1.3.2.2 uebayasi #ifdef KEYTEST2 698 1.3.2.2 uebayasi if (!(sc->sc_enabled & 2)) { 699 1.3.2.2 uebayasi #endif 700 1.3.2.2 uebayasi sc->sc_keystat[row + col * sc->sc_nrow] = 701 1.3.2.2 uebayasi (data >> row) & 1; 702 1.3.2.2 uebayasi #ifdef KEYTEST2 703 1.3.2.2 uebayasi } else if (data & (1 << row)) { 704 1.3.2.2 uebayasi printf("col = %d, row = %d, idx = %d, data = 0x%02x\n", col, row, row + col * sc->sc_nrow, data); 705 1.3.2.2 uebayasi } 706 1.3.2.2 uebayasi #endif 707 1.3.2.2 uebayasi } 708 1.3.2.2 uebayasi } 709 1.3.2.2 uebayasi 710 1.3.2.2 uebayasi /* deselect column# and charge */ 711 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_L, 0); 712 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_U, 0); 713 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 1); 714 1.3.2.2 uebayasi delay(KEYWAIT); 715 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 0); 716 1.3.2.2 uebayasi 717 1.3.2.2 uebayasi /* send key scan code */ 718 1.3.2.2 uebayasi keydown = 0; 719 1.3.2.2 uebayasi for (i = 0; i < sc->sc_nrow * sc->sc_ncolumn; i++) { 720 1.3.2.2 uebayasi if (sc->sc_keystat[i] == sc->sc_okeystat[i]) 721 1.3.2.2 uebayasi continue; 722 1.3.2.2 uebayasi 723 1.3.2.2 uebayasi keydown |= sc->sc_keystat[i]; 724 1.3.2.2 uebayasi hpckbd_input(sc->sc_hpckbd, sc->sc_keystat[i], i); 725 1.3.2.2 uebayasi sc->sc_okeystat[i] = sc->sc_keystat[i]; 726 1.3.2.2 uebayasi } 727 1.3.2.2 uebayasi 728 1.3.2.2 uebayasi splx(s); 729 1.3.2.2 uebayasi 730 1.3.2.2 uebayasi return keydown; 731 1.3.2.2 uebayasi } 732
Indexes created Wed Oct 01 07:09:59 GMT 2025