1 /* $NetBSD: epockbd.c,v 1.2 2013/06/22 13:53:30 kiyohara Exp $ */ 2 /* 3 * Copyright (c) 2013 KIYOHARA Takashi 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 17 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 19 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 20 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 21 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 23 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 24 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25 * POSSIBILITY OF SUCH DAMAGE. 26 */ 27 #include <sys/cdefs.h> 28 __KERNEL_RCSID(0, "$NetBSD: epockbd.c,v 1.2 2013/06/22 13:53:30 kiyohara Exp $"); 29 30 #include <sys/param.h> 31 #include <sys/bus.h> 32 #include <sys/callout.h> 33 #include <sys/device.h> 34 #include <sys/errno.h> 35 #include <sys/kernel.h> 36 37 #include <dev/wscons/wsconsio.h> 38 #include <dev/wscons/wskbdvar.h> 39 #include <dev/wscons/wsksymdef.h> 40 #include <dev/wscons/wsksymvar.h> 41 42 #include <epoc32/dev/epockbdvar.h> 43 #include <epoc32/dev/epockbdmap.h> 44 45 #define EPOCKBD_COLUMN0 8 46 47 #define EPOCKBD_SCAN_READ(sc) \ 48 bus_space_read_1((sc)->sc_scant, (sc)->sc_scanh, 0) 49 #define EPOCKBD_SCAN_WRITE(sc, cmd) \ 50 bus_space_write_1((sc)->sc_scant, (sc)->sc_scanh, 0, (cmd)) 51 #define EPOCKBD_DATA_READ(sc) \ 52 bus_space_read_1((sc)->sc_datat, (sc)->sc_datah, 0) 53 54 #define EPOC2WS_KBD_DATA(r, c) (((c) << 3) + (31 - __builtin_clz(r)) + 1) 55 56 static int epockbd_enable(void *, int); 57 static void epockbd_set_leds(void *, int); 58 static int epockbd_ioctl(void *, u_long, void *, int, struct lwp *); 59 60 static void epockbd_poll(void *); 61 62 static void epockbd_cngetc(void *, u_int *, int *); 63 static void epockbd_cnpollc(void *, int); 64 65 static struct wskbd_consops epockbd_consops = { 66 epockbd_cngetc, 67 epockbd_cnpollc, 68 NULL 69 }; 70 71 static struct wskbd_accessops epockbd_accessops = { 72 epockbd_enable, 73 epockbd_set_leds, 74 epockbd_ioctl, 75 }; 76 77 static struct wskbd_mapdata epockbd_mapdata = { 78 epockbd_keydesctab, 79 KB_UK, 80 }; 81 82 static int is_console; 83 84 void 85 epockbd_attach(struct epockbd_softc *sc) 86 { 87 struct wskbddev_attach_args aa; 88 89 aprint_normal("\n"); 90 aprint_naive("\n"); 91 92 if (is_console) 93 wskbd_cnattach(&epockbd_consops, sc, &epockbd_mapdata); 94 95 callout_init(&sc->sc_c, 0); 96 callout_reset(&sc->sc_c, hz, epockbd_poll, sc); 97 sc->sc_flags |= EPOCKBD_FLAG_ENABLE; 98 99 aa.console = is_console; 100 aa.keymap = &epockbd_mapdata; 101 aa.accessops = &epockbd_accessops; 102 aa.accesscookie = sc; 103 sc->sc_wskbddev = config_found(sc->sc_dev, &aa, wskbddevprint); 104 } 105 106 /* 107 * wskbd(9) functions 108 */ 109 110 static int 111 epockbd_enable(void *v, int on) 112 { 113 struct epockbd_softc *sc = v; 114 115 if (on) { 116 sc->sc_flags |= EPOCKBD_FLAG_ENABLE; 117 callout_schedule(&sc->sc_c, hz / 20); 118 } else { 119 sc->sc_flags &= ~EPOCKBD_FLAG_ENABLE; 120 callout_stop(&sc->sc_c); 121 } 122 return 0; 123 } 124 125 static void 126 epockbd_set_leds(void *v, int on) 127 { 128 /* Nothing */ 129 } 130 131 static int 132 epockbd_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l) 133 { 134 135 switch (cmd) { 136 case WSKBDIO_GTYPE: 137 *(int *)data = WSKBD_TYPE_EPOC; 138 return 0; 139 140 case WSKBDIO_SETLEDS: 141 return 0; 142 143 case WSKBDIO_GETLEDS: 144 *(int *)data = 0; 145 return 0; 146 147 #ifdef WSDISPLAY_COMPAT_RAWKBD 148 case WSKBDIO_SETMODE: 149 *(int *)data == WSKBD_RAW; 150 sc->sc_flags |= EPOCKBD_FLAG_RAW; 151 152 /* Not yet...: return 0; */ 153 #endif 154 } 155 return EPASSTHROUGH; 156 } 157 158 static void 159 epockbd_poll(void *v) 160 { 161 struct epockbd_softc *sc = v; 162 u_int type; 163 int data; 164 165 epockbd_cngetc(v, &type, &data); 166 if (data != 0) 167 wskbd_input(sc->sc_wskbddev, type, data); 168 169 callout_schedule(&sc->sc_c, hz / 20); 170 } 171 172 void 173 epockbd_cnattach(void) 174 { 175 176 is_console = 1; 177 } 178 179 static void 180 epockbd_cngetc(void *conscookie, u_int *type, int *data) 181 { 182 struct epockbd_softc *sc = conscookie; 183 uint8_t cmd, key, mask; 184 int column, row; 185 #if 1 186 /* 187 * For some machines which return a strange response, it calculates 188 * using this variable. 189 */ 190 int pc = 0, pr = 0; 191 #endif 192 193 *type = 0; 194 *data = 0; 195 mask = (1 << sc->sc_kbd_nrow) - 1; 196 for (column = 0; column < sc->sc_kbd_ncolumn; column++) { 197 delay(16); 198 cmd = EPOCKBD_SCAN_READ(sc); 199 cmd &= ~0xf; 200 cmd |= (EPOCKBD_COLUMN0 + column); 201 EPOCKBD_SCAN_WRITE(sc, cmd); 202 delay(16); 203 key = EPOCKBD_DATA_READ(sc) & mask; 204 if (sc->sc_state[column] != key) { 205 row = sc->sc_state[column] ^ key; 206 sc->sc_state[column] = key; 207 #if 1 208 if (*data == 0 || 209 (row == pr && pc == 0 && 210 column == sc->sc_kbd_ncolumn - 1)) 211 #else 212 if (*data == 0) 213 #endif 214 { 215 if (key & row) 216 *type = WSCONS_EVENT_KEY_DOWN; 217 else 218 *type = WSCONS_EVENT_KEY_UP; 219 *data = EPOC2WS_KBD_DATA(row, column); 220 #if 1 221 pc = column; 222 pr = row; 223 #endif 224 } 225 } 226 } 227 } 228 229 /* ARGSUSED */ 230 static void 231 epockbd_cnpollc(void *conckookie, int on) 232 { 233 /* Nothing */ 234 } 235