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