wzero3_kbd.c revision 1.3.2.3
1 1.3.2.2 uebayasi /* $NetBSD: wzero3_kbd.c,v 1.3.2.3 2010/08/17 06:44:26 uebayasi Exp $ */ 2 1.3.2.2 uebayasi 3 1.3.2.2 uebayasi /* 4 1.3.2.3 uebayasi * Copyright (c) 2008, 2009, 2010 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.3 2010/08/17 06:44:26 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.3 uebayasi * WS003SH/WS004SH/WS007SH 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.3 uebayasi row#1 (none) (none) (none) R Y (none) I O P (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.3 uebayasi row#5 (none) Z X - Space / (none) UP (none) (none) (none) Fn 164 1.3.2.3 uebayasi row#6 (none) MOJI HAN/ZEN OK (none) , LEFT DOWN RIGHT (none) (none) (none) 165 1.3.2.3 uebayasi */ 166 1.3.2.3 uebayasi 167 1.3.2.3 uebayasi /* 168 1.3.2.3 uebayasi * WS020SH keyscan map 169 1.3.2.3 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 170 1.3.2.3 uebayasi row#0 Ctrl (none) (none) (none) (none) (none) (none) (none) Del (none) ROTATE (none) 171 1.3.2.3 uebayasi row#1 (none) (none) (none) R Y (none) I O P (none) MEDIA (none) 172 1.3.2.3 uebayasi row#2 Tab Q E T G U J K (none) (none) (none) (none) 173 1.3.2.3 uebayasi row#3 (none) W S F V H M L (none) (none) LShift (none) 174 1.3.2.3 uebayasi row#4 (none) A D C B N . (none) Enter (none) RShift (none) 175 1.3.2.3 uebayasi row#5 (none) Z X - Space / (none) UP (none) DOWN (none) Fn 176 1.3.2.3 uebayasi row#6 (none) MOJI HAN/ZEN OK (none) , LEFT (none) RIGHT (none) (none) (none) 177 1.3.2.2 uebayasi */ 178 1.3.2.2 uebayasi 179 1.3.2.2 uebayasi static const struct wzero3kbd_model { 180 1.3.2.2 uebayasi platid_mask_t *platid; 181 1.3.2.2 uebayasi int key_pin; 182 1.3.2.2 uebayasi int power_pin; 183 1.3.2.2 uebayasi int reset_pin; 184 1.3.2.2 uebayasi int ncolumn; 185 1.3.2.2 uebayasi int nrow; 186 1.3.2.2 uebayasi } wzero3kbd_table[] = { 187 1.3.2.2 uebayasi /* WS003SH */ 188 1.3.2.2 uebayasi { 189 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS003SH, 190 1.3.2.2 uebayasi -1, /* XXX */ 191 1.3.2.2 uebayasi GPIO_WS003SH_POWER_BUTTON, 192 1.3.2.2 uebayasi -1, /* None */ 193 1.3.2.2 uebayasi WS003SH_NCOLUMN, 194 1.3.2.2 uebayasi WS003SH_NROW, 195 1.3.2.2 uebayasi }, 196 1.3.2.2 uebayasi /* WS004SH */ 197 1.3.2.2 uebayasi { 198 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS004SH, 199 1.3.2.2 uebayasi -1, /* XXX */ 200 1.3.2.2 uebayasi GPIO_WS003SH_POWER_BUTTON, 201 1.3.2.2 uebayasi -1, /* None */ 202 1.3.2.2 uebayasi WS003SH_NCOLUMN, 203 1.3.2.2 uebayasi WS003SH_NROW, 204 1.3.2.2 uebayasi }, 205 1.3.2.2 uebayasi /* WS007SH */ 206 1.3.2.2 uebayasi { 207 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS007SH, 208 1.3.2.2 uebayasi -1, /* XXX */ 209 1.3.2.2 uebayasi GPIO_WS007SH_POWER_BUTTON, 210 1.3.2.2 uebayasi GPIO_WS007SH_RESET_BUTTON, 211 1.3.2.2 uebayasi WS003SH_NCOLUMN, 212 1.3.2.2 uebayasi WS003SH_NROW, 213 1.3.2.2 uebayasi }, 214 1.3.2.2 uebayasi /* WS011SH */ 215 1.3.2.2 uebayasi { 216 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS011SH, 217 1.3.2.2 uebayasi -1, /* XXX */ 218 1.3.2.2 uebayasi GPIO_WS011SH_POWER_BUTTON, 219 1.3.2.2 uebayasi GPIO_WS011SH_RESET_BUTTON, 220 1.3.2.2 uebayasi WS003SH_NCOLUMN, 221 1.3.2.2 uebayasi WS003SH_NROW, 222 1.3.2.2 uebayasi }, 223 1.3.2.2 uebayasi /* WS020SH */ 224 1.3.2.2 uebayasi { 225 1.3.2.2 uebayasi &platid_mask_MACH_SHARP_WZERO3_WS020SH, 226 1.3.2.2 uebayasi -1, /* XXX */ 227 1.3.2.3 uebayasi GPIO_WS020SH_POWER_BUTTON, 228 1.3.2.3 uebayasi GPIO_WS020SH_RESET_BUTTON, 229 1.3.2.2 uebayasi WS003SH_NCOLUMN, 230 1.3.2.2 uebayasi WS003SH_NROW, 231 1.3.2.2 uebayasi }, 232 1.3.2.2 uebayasi 233 1.3.2.2 uebayasi { NULL, -1, -1, -1, 0, 0, } 234 1.3.2.2 uebayasi }; 235 1.3.2.2 uebayasi 236 1.3.2.2 uebayasi static const struct wzero3kbd_model * 237 1.3.2.2 uebayasi wzero3kbd_lookup(void) 238 1.3.2.2 uebayasi { 239 1.3.2.2 uebayasi const struct wzero3kbd_model *model; 240 1.3.2.2 uebayasi 241 1.3.2.2 uebayasi for (model = wzero3kbd_table; model->platid != NULL; model++) { 242 1.3.2.2 uebayasi if (platid_match(&platid, model->platid)) { 243 1.3.2.2 uebayasi return model; 244 1.3.2.2 uebayasi } 245 1.3.2.2 uebayasi } 246 1.3.2.2 uebayasi return NULL; 247 1.3.2.2 uebayasi } 248 1.3.2.2 uebayasi 249 1.3.2.2 uebayasi static int 250 1.3.2.2 uebayasi wzero3kbd_match(struct device *parent, struct cfdata *cf, void *aux) 251 1.3.2.2 uebayasi { 252 1.3.2.2 uebayasi 253 1.3.2.2 uebayasi if (strcmp(cf->cf_name, "wzero3kbd") != 0) 254 1.3.2.2 uebayasi return 0; 255 1.3.2.2 uebayasi if (wzero3kbd_lookup() == NULL) 256 1.3.2.2 uebayasi return 0; 257 1.3.2.2 uebayasi return 1; 258 1.3.2.2 uebayasi } 259 1.3.2.2 uebayasi 260 1.3.2.2 uebayasi static void 261 1.3.2.2 uebayasi wzero3kbd_attach(struct device *parent, struct device *self, void *aux) 262 1.3.2.2 uebayasi { 263 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = device_private(self); 264 1.3.2.2 uebayasi struct pxaip_attach_args *pxa = (struct pxaip_attach_args *)aux; 265 1.3.2.2 uebayasi struct hpckbd_attach_args haa; 266 1.3.2.2 uebayasi const struct wzero3kbd_model *model; 267 1.3.2.2 uebayasi 268 1.3.2.2 uebayasi sc->sc_dev = self; 269 1.3.2.2 uebayasi 270 1.3.2.2 uebayasi model = wzero3kbd_lookup(); 271 1.3.2.2 uebayasi if (model == NULL) { 272 1.3.2.2 uebayasi aprint_error(": unknown model\n"); 273 1.3.2.2 uebayasi return; 274 1.3.2.2 uebayasi } 275 1.3.2.2 uebayasi 276 1.3.2.2 uebayasi aprint_normal(": keyboard\n"); 277 1.3.2.2 uebayasi aprint_naive("\n"); 278 1.3.2.2 uebayasi 279 1.3.2.2 uebayasi sc->sc_key_pin = model->key_pin; 280 1.3.2.2 uebayasi sc->sc_power_pin = model->power_pin; 281 1.3.2.2 uebayasi sc->sc_reset_pin = model->reset_pin; 282 1.3.2.2 uebayasi sc->sc_ncolumn = model->ncolumn; 283 1.3.2.2 uebayasi sc->sc_nrow = model->nrow; 284 1.3.2.2 uebayasi 285 1.3.2.2 uebayasi sc->sc_iot = pxa->pxa_iot; 286 1.3.2.2 uebayasi if (bus_space_map(sc->sc_iot, PXA2X0_CS2_START, REGMAPSIZE, 0, 287 1.3.2.2 uebayasi &sc->sc_ioh)) { 288 1.3.2.2 uebayasi aprint_error_dev(self, "couldn't map registers.\n"); 289 1.3.2.2 uebayasi return; 290 1.3.2.2 uebayasi } 291 1.3.2.2 uebayasi 292 1.3.2.2 uebayasi sc->sc_okeystat = malloc(sc->sc_nrow * sc->sc_ncolumn, M_DEVBUF, 293 1.3.2.2 uebayasi M_NOWAIT | M_ZERO); 294 1.3.2.2 uebayasi sc->sc_keystat = malloc(sc->sc_nrow * sc->sc_ncolumn, M_DEVBUF, 295 1.3.2.2 uebayasi M_NOWAIT | M_ZERO); 296 1.3.2.2 uebayasi if (sc->sc_okeystat == NULL || sc->sc_keystat == NULL) { 297 1.3.2.2 uebayasi aprint_error_dev(self, "couldn't alloc memory.\n"); 298 1.3.2.2 uebayasi if (sc->sc_okeystat) 299 1.3.2.2 uebayasi free(sc->sc_okeystat, M_DEVBUF); 300 1.3.2.2 uebayasi if (sc->sc_keystat) 301 1.3.2.2 uebayasi free(sc->sc_keystat, M_DEVBUF); 302 1.3.2.2 uebayasi return; 303 1.3.2.2 uebayasi } 304 1.3.2.2 uebayasi 305 1.3.2.2 uebayasi sc->sc_if.hii_ctx = sc; 306 1.3.2.2 uebayasi sc->sc_if.hii_establish = wzero3kbd_input_establish; 307 1.3.2.2 uebayasi sc->sc_if.hii_poll = wzero3kbd_poll; 308 1.3.2.2 uebayasi 309 1.3.2.2 uebayasi /* Attach console if not using serial. */ 310 1.3.2.2 uebayasi if (!(bootinfo->bi_cnuse & BI_CNUSE_SERIAL)) 311 1.3.2.2 uebayasi hpckbd_cnattach(&sc->sc_if); 312 1.3.2.2 uebayasi 313 1.3.2.2 uebayasi /* Install interrupt handler. */ 314 1.3.2.2 uebayasi if (sc->sc_key_pin >= 0) { 315 1.3.2.2 uebayasi pxa2x0_gpio_set_function(sc->sc_key_pin, GPIO_IN); 316 1.3.2.2 uebayasi sc->sc_key_ih = pxa2x0_gpio_intr_establish(sc->sc_key_pin, 317 1.3.2.2 uebayasi IST_EDGE_BOTH, IPL_TTY, wzero3kbd_intr, sc); 318 1.3.2.2 uebayasi if (sc->sc_key_ih == NULL) { 319 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 320 1.3.2.2 uebayasi "couldn't establish key interrupt\n"); 321 1.3.2.2 uebayasi } 322 1.3.2.2 uebayasi } else { 323 1.3.2.2 uebayasi sc->sc_interval = KEY_INTERVAL / (1000 / hz); 324 1.3.2.2 uebayasi if (sc->sc_interval < 1) 325 1.3.2.2 uebayasi sc->sc_interval = 1; 326 1.3.2.2 uebayasi callout_init(&sc->sc_keyscan_ch, 0); 327 1.3.2.2 uebayasi callout_reset(&sc->sc_keyscan_ch, sc->sc_interval, 328 1.3.2.2 uebayasi wzero3kbd_tick, sc); 329 1.3.2.2 uebayasi } 330 1.3.2.2 uebayasi 331 1.3.2.2 uebayasi /* power key */ 332 1.3.2.2 uebayasi if (sc->sc_power_pin >= 0) { 333 1.3.2.2 uebayasi pxa2x0_gpio_set_function(sc->sc_power_pin, GPIO_IN); 334 1.3.2.2 uebayasi sc->sc_power_ih = pxa2x0_gpio_intr_establish( 335 1.3.2.2 uebayasi sc->sc_power_pin, IST_EDGE_BOTH, IPL_TTY, 336 1.3.2.2 uebayasi wzero3kbd_power_intr, sc); 337 1.3.2.2 uebayasi if (sc->sc_power_ih == NULL) { 338 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 339 1.3.2.2 uebayasi "couldn't establish power key interrupt\n"); 340 1.3.2.2 uebayasi } 341 1.3.2.2 uebayasi } 342 1.3.2.2 uebayasi 343 1.3.2.2 uebayasi /* reset button */ 344 1.3.2.2 uebayasi if (sc->sc_reset_pin >= 0) { 345 1.3.2.2 uebayasi pxa2x0_gpio_set_function(sc->sc_reset_pin, GPIO_IN); 346 1.3.2.2 uebayasi sc->sc_reset_ih = pxa2x0_gpio_intr_establish( 347 1.3.2.2 uebayasi sc->sc_reset_pin, IST_EDGE_BOTH, IPL_TTY, 348 1.3.2.2 uebayasi wzero3kbd_reset_intr, sc); 349 1.3.2.2 uebayasi if (sc->sc_reset_ih == NULL) { 350 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 351 1.3.2.2 uebayasi "couldn't establish reset key interrupt\n"); 352 1.3.2.2 uebayasi } 353 1.3.2.2 uebayasi 354 1.3.2.2 uebayasi sc->sc_smpsw.smpsw_name = device_xname(self); 355 1.3.2.2 uebayasi sc->sc_smpsw.smpsw_type = PSWITCH_TYPE_RESET; 356 1.3.2.2 uebayasi if (sysmon_pswitch_register(&sc->sc_smpsw) != 0) { 357 1.3.2.2 uebayasi aprint_error_dev(sc->sc_dev, 358 1.3.2.2 uebayasi "unable to register reset event handler\n"); 359 1.3.2.2 uebayasi } 360 1.3.2.2 uebayasi } 361 1.3.2.2 uebayasi 362 1.3.2.2 uebayasi /* Attach hpckbd. */ 363 1.3.2.2 uebayasi haa.haa_ic = &sc->sc_if; 364 1.3.2.2 uebayasi config_found(self, &haa, hpckbd_print); 365 1.3.2.2 uebayasi 366 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) || defined(KEYTEST5) 367 1.3.2.2 uebayasi sc->sc_test_ih = NULL; 368 1.3.2.2 uebayasi sc->sc_test_pin = -1; 369 1.3.2.2 uebayasi sc->sc_nouse_pin = -1; 370 1.3.2.2 uebayasi sc->sc_nouse_pin2 = -1; 371 1.3.2.2 uebayasi sc->sc_nouse_pin3 = -1; 372 1.3.2.2 uebayasi sc->sc_bit = 0x01; 373 1.3.2.2 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS003SH) 374 1.3.2.2 uebayasi || platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS004SH)) { 375 1.3.2.2 uebayasi sc->sc_nouse_pin = GPIO_WS003SH_SD_DETECT; /* SD_DETECT */ 376 1.3.2.2 uebayasi sc->sc_nouse_pin2 = 86; /* Vsync? */ 377 1.3.2.2 uebayasi sc->sc_nouse_pin3 = 89; /* RESET? */ 378 1.3.2.2 uebayasi } 379 1.3.2.2 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS007SH)) { 380 1.3.2.2 uebayasi sc->sc_nouse_pin = GPIO_WS007SH_SD_DETECT; /* SD_DETECT */ 381 1.3.2.2 uebayasi sc->sc_nouse_pin2 = 77; /* Vsync? */ 382 1.3.2.2 uebayasi } 383 1.3.2.2 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS011SH)) { 384 1.3.2.2 uebayasi sc->sc_nouse_pin = GPIO_WS011SH_SD_DETECT; /* SD_DETECT */ 385 1.3.2.2 uebayasi sc->sc_nouse_pin2 = 77; /* Vsync? */ 386 1.3.2.2 uebayasi } 387 1.3.2.3 uebayasi if (platid_match(&platid, &platid_mask_MACH_SHARP_WZERO3_WS020SH)) { 388 1.3.2.3 uebayasi sc->sc_nouse_pin = GPIO_WS020SH_SD_DETECT; /* SD_DETECT */ 389 1.3.2.3 uebayasi sc->sc_nouse_pin2 = 77; /* Vsync? */ 390 1.3.2.3 uebayasi } 391 1.3.2.2 uebayasi 392 1.3.2.2 uebayasi #ifdef KEYTEST 393 1.3.2.2 uebayasi for (sc->sc_test_pin = 2; sc->sc_test_pin < PXA270_GPIO_NPINS; sc->sc_test_pin++) { 394 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 395 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 396 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 397 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 398 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 399 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 400 1.3.2.2 uebayasi && GPIO_IS_GPIO_IN(pxa2x0_gpio_get_function(sc->sc_test_pin))) 401 1.3.2.2 uebayasi break; 402 1.3.2.2 uebayasi } 403 1.3.2.2 uebayasi if (sc->sc_test_pin < PXA270_GPIO_NPINS) { 404 1.3.2.2 uebayasi printf("GPIO_IN: GPIO pin #%d\n", sc->sc_test_pin); 405 1.3.2.2 uebayasi sc->sc_test_ih = pxa2x0_gpio_intr_establish(sc->sc_test_pin, 406 1.3.2.2 uebayasi IST_EDGE_BOTH, IPL_TTY, wzero3kbd_intr2, sc); 407 1.3.2.2 uebayasi } else { 408 1.3.2.2 uebayasi sc->sc_test_pin = -1; 409 1.3.2.2 uebayasi } 410 1.3.2.2 uebayasi #endif 411 1.3.2.2 uebayasi 412 1.3.2.2 uebayasi #ifdef KEYTEST3 413 1.3.2.2 uebayasi { 414 1.3.2.2 uebayasi int i; 415 1.3.2.2 uebayasi printf("pin: "); 416 1.3.2.2 uebayasi for (i = 0; i < PXA270_GPIO_NPINS; i++) { 417 1.3.2.2 uebayasi if (i == sc->sc_nouse_pin 418 1.3.2.2 uebayasi || i == sc->sc_nouse_pin2 419 1.3.2.2 uebayasi || i == sc->sc_nouse_pin3 420 1.3.2.2 uebayasi || i == sc->sc_key_pin 421 1.3.2.2 uebayasi || i == sc->sc_power_pin 422 1.3.2.2 uebayasi || i == sc->sc_reset_pin) 423 1.3.2.2 uebayasi continue; 424 1.3.2.2 uebayasi 425 1.3.2.2 uebayasi printf("%d, ", i); 426 1.3.2.2 uebayasi if (GPIO_IS_GPIO_IN(pxa2x0_gpio_get_function(i))) { 427 1.3.2.2 uebayasi pxa2x0_gpio_intr_establish(i, IST_EDGE_BOTH, 428 1.3.2.2 uebayasi IPL_TTY, wzero3kbd_intr3, (void *)(long)i); 429 1.3.2.2 uebayasi } 430 1.3.2.2 uebayasi } 431 1.3.2.2 uebayasi } 432 1.3.2.2 uebayasi #endif 433 1.3.2.2 uebayasi 434 1.3.2.2 uebayasi #ifdef KEYTEST4 435 1.3.2.2 uebayasi for (sc->sc_test_pin = 2; sc->sc_test_pin < PXA270_GPIO_NPINS; sc->sc_test_pin++) { 436 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 437 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 438 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 439 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 440 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 441 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 442 1.3.2.2 uebayasi && GPIO_IS_GPIO_OUT(pxa2x0_gpio_get_function(sc->sc_test_pin))) 443 1.3.2.2 uebayasi break; 444 1.3.2.2 uebayasi } 445 1.3.2.2 uebayasi if (sc->sc_test_pin < PXA270_GPIO_NPINS) { 446 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d\n", sc->sc_test_pin); 447 1.3.2.2 uebayasi } else { 448 1.3.2.2 uebayasi sc->sc_test_pin = -1; 449 1.3.2.2 uebayasi } 450 1.3.2.2 uebayasi #endif 451 1.3.2.2 uebayasi #ifdef KEYTEST5 452 1.3.2.2 uebayasi sc->sc_test_pin = 0x00; 453 1.3.2.2 uebayasi sc->sc_bit = 0x01; 454 1.3.2.2 uebayasi #endif 455 1.3.2.2 uebayasi #endif 456 1.3.2.2 uebayasi } 457 1.3.2.2 uebayasi 458 1.3.2.2 uebayasi static int 459 1.3.2.2 uebayasi wzero3kbd_intr(void *arg) 460 1.3.2.2 uebayasi { 461 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 462 1.3.2.2 uebayasi 463 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) || defined(KEYTEST5) 464 1.3.2.2 uebayasi printf("wzero3kbd_intr: GPIO pin #%d = %s\n", sc->sc_key_pin, 465 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(sc->sc_key_pin) ? "on" : "off"); 466 1.3.2.2 uebayasi #endif 467 1.3.2.2 uebayasi 468 1.3.2.2 uebayasi #if defined(KEYTEST4) 469 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0) { 470 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_test_pin)) { 471 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d: L\n",sc->sc_test_pin); 472 1.3.2.2 uebayasi pxa2x0_gpio_clear_bit(sc->sc_test_pin); 473 1.3.2.2 uebayasi } else { 474 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d: H\n", sc->sc_test_pin); 475 1.3.2.2 uebayasi pxa2x0_gpio_set_bit(sc->sc_test_pin); 476 1.3.2.2 uebayasi } 477 1.3.2.2 uebayasi } 478 1.3.2.2 uebayasi #endif 479 1.3.2.2 uebayasi #if defined(KEYTEST5) 480 1.3.2.2 uebayasi printf("CPLD(%#x): value=%#x, mask=%#x\n", 481 1.3.2.2 uebayasi sc->sc_test_pin, CSR_READ4(sc->sc_test_pin), sc->sc_bit); 482 1.3.2.2 uebayasi if (CSR_READ4(sc->sc_test_pin) & sc->sc_bit) { 483 1.3.2.2 uebayasi printf("CPLD_OUT: CPLD: L\n"); 484 1.3.2.2 uebayasi CSR_WRITE4(sc->sc_test_pin, 485 1.3.2.2 uebayasi CSR_READ4(sc->sc_test_pin) & ~sc->sc_bit); 486 1.3.2.2 uebayasi } else { 487 1.3.2.2 uebayasi printf("CPLD_OUT: CPLD: H\n"); 488 1.3.2.2 uebayasi CSR_WRITE4(sc->sc_test_pin, 489 1.3.2.2 uebayasi CSR_READ4(sc->sc_test_pin) | sc->sc_bit); 490 1.3.2.2 uebayasi } 491 1.3.2.2 uebayasi #endif 492 1.3.2.2 uebayasi 493 1.3.2.2 uebayasi (void) wzero3kbd_poll1(sc); 494 1.3.2.2 uebayasi 495 1.3.2.2 uebayasi pxa2x0_gpio_clear_intr(sc->sc_key_pin); 496 1.3.2.2 uebayasi 497 1.3.2.2 uebayasi return 1; 498 1.3.2.2 uebayasi } 499 1.3.2.2 uebayasi 500 1.3.2.2 uebayasi #if defined(KEYTEST) 501 1.3.2.2 uebayasi static int 502 1.3.2.2 uebayasi wzero3kbd_intr2(void *arg) 503 1.3.2.2 uebayasi { 504 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 505 1.3.2.2 uebayasi 506 1.3.2.2 uebayasi printf("wzero3kbd_intr2: GPIO_IN: GPIO pin #%d = %s\n", sc->sc_test_pin, 507 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(sc->sc_test_pin) ? "on" : "off"); 508 1.3.2.2 uebayasi 509 1.3.2.2 uebayasi return 1; 510 1.3.2.2 uebayasi } 511 1.3.2.2 uebayasi #endif 512 1.3.2.2 uebayasi 513 1.3.2.2 uebayasi #if defined(KEYTEST3) 514 1.3.2.2 uebayasi static int 515 1.3.2.2 uebayasi wzero3kbd_intr3(void *arg) 516 1.3.2.2 uebayasi { 517 1.3.2.2 uebayasi int pin = (int)arg; 518 1.3.2.2 uebayasi 519 1.3.2.2 uebayasi printf("wzero3kbd_intr3: GPIO pin #%d = %s\n", pin, 520 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(pin) ? "on" : "off"); 521 1.3.2.2 uebayasi 522 1.3.2.2 uebayasi return 1; 523 1.3.2.2 uebayasi } 524 1.3.2.2 uebayasi #endif 525 1.3.2.2 uebayasi 526 1.3.2.2 uebayasi 527 1.3.2.2 uebayasi static void 528 1.3.2.2 uebayasi wzero3kbd_tick(void *arg) 529 1.3.2.2 uebayasi { 530 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 531 1.3.2.2 uebayasi 532 1.3.2.2 uebayasi (void) wzero3kbd_poll1(sc); 533 1.3.2.2 uebayasi 534 1.3.2.3 uebayasi callout_schedule(&sc->sc_keyscan_ch, sc->sc_interval); 535 1.3.2.2 uebayasi } 536 1.3.2.2 uebayasi 537 1.3.2.2 uebayasi static int 538 1.3.2.2 uebayasi wzero3kbd_power_intr(void *arg) 539 1.3.2.2 uebayasi { 540 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 541 1.3.2.2 uebayasi 542 1.3.2.2 uebayasi #if defined(KEYTEST) || defined(KEYTEST2) || defined(KEYTEST3) || defined(KEYTEST4) 543 1.3.2.2 uebayasi printf("wzero3kbd_power_intr: status = %s\n", 544 1.3.2.2 uebayasi pxa2x0_gpio_get_bit(sc->sc_power_pin) ? "on" : "off"); 545 1.3.2.2 uebayasi #endif 546 1.3.2.2 uebayasi 547 1.3.2.2 uebayasi #if defined(KEYTEST) 548 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 549 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0) { 550 1.3.2.2 uebayasi int orig_pin = sc->sc_test_pin; 551 1.3.2.2 uebayasi pxa2x0_gpio_intr_disestablish(sc->sc_test_ih); 552 1.3.2.2 uebayasi sc->sc_test_ih = NULL; 553 1.3.2.2 uebayasi 554 1.3.2.2 uebayasi for (;;) { 555 1.3.2.2 uebayasi if (++sc->sc_test_pin >= PXA270_GPIO_NPINS) 556 1.3.2.2 uebayasi sc->sc_test_pin = 2; 557 1.3.2.2 uebayasi if (sc->sc_test_pin == orig_pin) 558 1.3.2.2 uebayasi break; 559 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 560 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 561 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 562 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 563 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 564 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 565 1.3.2.2 uebayasi && GPIO_IS_GPIO_IN(pxa2x0_gpio_get_function(sc->sc_test_pin))) 566 1.3.2.2 uebayasi break; 567 1.3.2.2 uebayasi } 568 1.3.2.2 uebayasi if (sc->sc_test_pin != orig_pin) { 569 1.3.2.2 uebayasi printf("GPIO_IN: GPIO pin #%d\n", 570 1.3.2.2 uebayasi sc->sc_test_pin); 571 1.3.2.2 uebayasi sc->sc_test_ih = 572 1.3.2.2 uebayasi pxa2x0_gpio_intr_establish(sc->sc_test_pin, 573 1.3.2.2 uebayasi IST_EDGE_BOTH, IPL_TTY, wzero3kbd_intr2,sc); 574 1.3.2.2 uebayasi } else { 575 1.3.2.2 uebayasi sc->sc_test_pin = -1; 576 1.3.2.2 uebayasi } 577 1.3.2.2 uebayasi } 578 1.3.2.2 uebayasi } 579 1.3.2.2 uebayasi #endif 580 1.3.2.2 uebayasi 581 1.3.2.2 uebayasi #if defined(KEYTEST2) 582 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 583 1.3.2.2 uebayasi sc->sc_enabled ^= 2; 584 1.3.2.2 uebayasi if (sc->sc_enabled & 2) { 585 1.3.2.2 uebayasi printf("print col/row\n"); 586 1.3.2.2 uebayasi } else { 587 1.3.2.2 uebayasi printf("keyscan\n"); 588 1.3.2.2 uebayasi } 589 1.3.2.2 uebayasi } 590 1.3.2.2 uebayasi #endif 591 1.3.2.2 uebayasi #if defined(KEYTEST4) 592 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 593 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0) { 594 1.3.2.2 uebayasi int orig_pin = sc->sc_test_pin; 595 1.3.2.2 uebayasi for (;;) { 596 1.3.2.2 uebayasi if (++sc->sc_test_pin >= PXA270_GPIO_NPINS) 597 1.3.2.2 uebayasi sc->sc_test_pin = 2; 598 1.3.2.2 uebayasi if (sc->sc_test_pin == orig_pin) 599 1.3.2.2 uebayasi break; 600 1.3.2.2 uebayasi if (sc->sc_test_pin != sc->sc_nouse_pin 601 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin2 602 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_nouse_pin3 603 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_key_pin 604 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_power_pin 605 1.3.2.2 uebayasi && sc->sc_test_pin != sc->sc_reset_pin 606 1.3.2.2 uebayasi && GPIO_IS_GPIO_OUT(pxa2x0_gpio_get_function(sc->sc_test_pin))) 607 1.3.2.2 uebayasi break; 608 1.3.2.2 uebayasi } 609 1.3.2.2 uebayasi if (sc->sc_test_pin != orig_pin) { 610 1.3.2.2 uebayasi printf("GPIO_OUT: GPIO pin #%d\n", sc->sc_test_pin); 611 1.3.2.2 uebayasi } else { 612 1.3.2.2 uebayasi sc->sc_test_pin = -1; 613 1.3.2.2 uebayasi } 614 1.3.2.2 uebayasi } 615 1.3.2.2 uebayasi } 616 1.3.2.2 uebayasi #endif 617 1.3.2.2 uebayasi #if defined(KEYTEST5) 618 1.3.2.2 uebayasi if (pxa2x0_gpio_get_bit(sc->sc_power_pin)) { 619 1.3.2.2 uebayasi sc->sc_bit <<= 1; 620 1.3.2.2 uebayasi if (sc->sc_bit & ~0xff) { 621 1.3.2.2 uebayasi sc->sc_bit = 0x01; 622 1.3.2.2 uebayasi sc->sc_test_pin += 0x4; 623 1.3.2.2 uebayasi if (sc->sc_test_pin >= 0x20) { 624 1.3.2.2 uebayasi sc->sc_test_pin = 0x00; 625 1.3.2.2 uebayasi } 626 1.3.2.2 uebayasi } 627 1.3.2.2 uebayasi printf("CPLD(%#x), mask=%#x\n", sc->sc_test_pin, sc->sc_bit); 628 1.3.2.2 uebayasi } 629 1.3.2.2 uebayasi #endif 630 1.3.2.2 uebayasi 631 1.3.2.2 uebayasi pxa2x0_gpio_clear_intr(sc->sc_power_pin); 632 1.3.2.2 uebayasi 633 1.3.2.2 uebayasi return 1; 634 1.3.2.2 uebayasi } 635 1.3.2.2 uebayasi 636 1.3.2.2 uebayasi static int 637 1.3.2.2 uebayasi wzero3kbd_reset_intr(void *arg) 638 1.3.2.2 uebayasi { 639 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 640 1.3.2.2 uebayasi 641 1.3.2.2 uebayasi sysmon_task_queue_sched(0, wzero3kbd_sysmon_reset_event, sc); 642 1.3.2.2 uebayasi 643 1.3.2.2 uebayasi pxa2x0_gpio_clear_intr(sc->sc_reset_pin); 644 1.3.2.2 uebayasi 645 1.3.2.2 uebayasi return 1; 646 1.3.2.2 uebayasi } 647 1.3.2.2 uebayasi 648 1.3.2.2 uebayasi static int 649 1.3.2.2 uebayasi wzero3kbd_input_establish(void *arg, struct hpckbd_if *kbdif) 650 1.3.2.2 uebayasi { 651 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 652 1.3.2.2 uebayasi 653 1.3.2.2 uebayasi /* Save hpckbd interface. */ 654 1.3.2.2 uebayasi sc->sc_hpckbd = kbdif; 655 1.3.2.2 uebayasi sc->sc_enabled = 1; 656 1.3.2.2 uebayasi 657 1.3.2.2 uebayasi return 0; 658 1.3.2.2 uebayasi } 659 1.3.2.2 uebayasi 660 1.3.2.2 uebayasi static void 661 1.3.2.2 uebayasi wzero3kbd_sysmon_reset_event(void *arg) 662 1.3.2.2 uebayasi { 663 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 664 1.3.2.2 uebayasi 665 1.3.2.2 uebayasi sysmon_pswitch_event(&sc->sc_smpsw, PSWITCH_EVENT_PRESSED); 666 1.3.2.2 uebayasi } 667 1.3.2.2 uebayasi 668 1.3.2.2 uebayasi static int 669 1.3.2.2 uebayasi wzero3kbd_poll(void *arg) 670 1.3.2.2 uebayasi { 671 1.3.2.2 uebayasi int keydown; 672 1.3.2.2 uebayasi 673 1.3.2.2 uebayasi keydown = wzero3kbd_poll1(arg); 674 1.3.2.2 uebayasi 675 1.3.2.2 uebayasi return keydown; 676 1.3.2.2 uebayasi } 677 1.3.2.2 uebayasi 678 1.3.2.2 uebayasi static int 679 1.3.2.2 uebayasi wzero3kbd_poll1(void *arg) 680 1.3.2.2 uebayasi { 681 1.3.2.2 uebayasi struct wzero3kbd_softc *sc = (struct wzero3kbd_softc *)arg; 682 1.3.2.2 uebayasi int row, col, data; 683 1.3.2.2 uebayasi int keycol; 684 1.3.2.2 uebayasi int keydown; 685 1.3.2.2 uebayasi int i; 686 1.3.2.2 uebayasi int s; 687 1.3.2.2 uebayasi 688 1.3.2.2 uebayasi if (!sc->sc_enabled) { 689 1.3.2.2 uebayasi DPRINTF(("wzero3kbd_poll: disabled\n")); 690 1.3.2.2 uebayasi return 0; 691 1.3.2.2 uebayasi } 692 1.3.2.2 uebayasi 693 1.3.2.2 uebayasi s = spltty(); 694 1.3.2.2 uebayasi 695 1.3.2.2 uebayasi for (col = 0; col < sc->sc_ncolumn; col++) { 696 1.3.2.2 uebayasi /* deselect column# and charge */ 697 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_L, 0); 698 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_U, 0); 699 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 1); 700 1.3.2.2 uebayasi delay(KEYWAIT); 701 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 0); 702 1.3.2.2 uebayasi 703 1.3.2.2 uebayasi /* select scan column# */ 704 1.3.2.2 uebayasi keycol = 1 << col; 705 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_L, keycol & 0xff); 706 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_U, keycol >> 8); 707 1.3.2.2 uebayasi delay(KEYWAIT); 708 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 0); 709 1.3.2.2 uebayasi 710 1.3.2.2 uebayasi /* read key data */ 711 1.3.2.2 uebayasi data = CSR_READ1(KBDDATA); 712 1.3.2.2 uebayasi for (row = 0; row < sc->sc_nrow; row++) { 713 1.3.2.2 uebayasi #ifdef KEYTEST2 714 1.3.2.2 uebayasi if (!(sc->sc_enabled & 2)) { 715 1.3.2.2 uebayasi #endif 716 1.3.2.2 uebayasi sc->sc_keystat[row + col * sc->sc_nrow] = 717 1.3.2.2 uebayasi (data >> row) & 1; 718 1.3.2.2 uebayasi #ifdef KEYTEST2 719 1.3.2.2 uebayasi } else if (data & (1 << row)) { 720 1.3.2.2 uebayasi printf("col = %d, row = %d, idx = %d, data = 0x%02x\n", col, row, row + col * sc->sc_nrow, data); 721 1.3.2.2 uebayasi } 722 1.3.2.2 uebayasi #endif 723 1.3.2.2 uebayasi } 724 1.3.2.2 uebayasi } 725 1.3.2.2 uebayasi 726 1.3.2.2 uebayasi /* deselect column# and charge */ 727 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_L, 0); 728 1.3.2.2 uebayasi CSR_WRITE1(KBDCOL_U, 0); 729 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 1); 730 1.3.2.2 uebayasi delay(KEYWAIT); 731 1.3.2.2 uebayasi CSR_WRITE1(KBDCHARGE, 0); 732 1.3.2.2 uebayasi 733 1.3.2.2 uebayasi /* send key scan code */ 734 1.3.2.2 uebayasi keydown = 0; 735 1.3.2.2 uebayasi for (i = 0; i < sc->sc_nrow * sc->sc_ncolumn; i++) { 736 1.3.2.2 uebayasi if (sc->sc_keystat[i] == sc->sc_okeystat[i]) 737 1.3.2.2 uebayasi continue; 738 1.3.2.2 uebayasi 739 1.3.2.2 uebayasi keydown |= sc->sc_keystat[i]; 740 1.3.2.2 uebayasi hpckbd_input(sc->sc_hpckbd, sc->sc_keystat[i], i); 741 1.3.2.2 uebayasi sc->sc_okeystat[i] = sc->sc_keystat[i]; 742 1.3.2.2 uebayasi } 743 1.3.2.2 uebayasi 744 1.3.2.2 uebayasi splx(s); 745 1.3.2.2 uebayasi 746 1.3.2.2 uebayasi return keydown; 747 1.3.2.2 uebayasi } 748
Indexes created Wed Oct 01 07:09:59 GMT 2025