dtkbd.c revision 1.9
1/* $NetBSD: dtkbd.c,v 1.9 2011/06/04 01:37:36 tsutsui Exp $ */ 2 3/*- 4 * Copyright (c) 2002, 2003 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Andrew Doran. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32#include <sys/cdefs.h> 33__KERNEL_RCSID(0, "$NetBSD: dtkbd.c,v 1.9 2011/06/04 01:37:36 tsutsui Exp $"); 34 35#include "locators.h" 36 37#include <sys/param.h> 38#include <sys/systm.h> 39#include <sys/device.h> 40#include <sys/ioctl.h> 41#include <sys/callout.h> 42 43#include <dev/wscons/wsconsio.h> 44#include <dev/wscons/wskbdvar.h> 45#include <dev/wscons/wsksymdef.h> 46#include <dev/wscons/wsksymvar.h> 47#include <dev/dec/wskbdmap_lk201.h> 48#include <dev/tc/tcvar.h> 49 50#include <machine/bus.h> 51 52#include <pmax/tc/dtreg.h> 53#include <pmax/tc/dtvar.h> 54 55#include <pmax/pmax/cons.h> 56 57struct dtkbd_softc { 58 device_t sc_dev; 59 device_t sc_wskbddev; 60 int sc_enabled; 61}; 62 63int dtkbd_match(device_t, cfdata_t, void *); 64void dtkbd_attach(device_t, device_t, void *); 65int dtkbd_enable(void *, int); 66int dtkbd_ioctl(void *, u_long, void *, int, struct lwp *); 67void dtkbd_cngetc(void *, u_int *, int *); 68void dtkbd_cnpollc(void *, int); 69int dtkbd_process_msg(struct dt_msg *, u_int *, int *); 70void dtkbd_handler(void *, struct dt_msg *); 71void dtkbd_set_leds(void *, int); 72 73const struct wskbd_accessops dtkbd_accessops = { 74 dtkbd_enable, 75 dtkbd_set_leds, 76 dtkbd_ioctl, 77}; 78 79const struct wskbd_consops dtkbd_consops = { 80 dtkbd_cngetc, 81 dtkbd_cnpollc, 82}; 83 84CFATTACH_DECL_NEW(dtkbd, sizeof(struct dtkbd_softc), 85 dtkbd_match, dtkbd_attach, NULL, NULL); 86 87const struct wskbd_mapdata dtkbd_keymapdata = { 88 lkkbd_keydesctab, 89#ifdef DTKBD_LAYOUT 90 DTKBD_LAYOUT, 91#else 92 KB_US | KB_LK401, 93#endif 94}; 95 96int dtkbd_isconsole; 97uint8_t dtkbd_map[10]; 98int dtkbd_maplen; 99 100int 101dtkbd_match(device_t parent, cfdata_t cf, void *aux) 102{ 103 struct dt_attach_args *dta; 104 105 dta = aux; 106 return (dta->dta_addr == DT_ADDR_KBD); 107} 108 109void 110dtkbd_attach(device_t parent, device_t self, void *aux) 111{ 112 struct dt_softc *dt; 113 struct dtkbd_softc *sc; 114 struct wskbddev_attach_args a; 115 116 dt = device_private(parent); 117 sc = device_private(self); 118 sc->sc_dev = self; 119 120 printf("\n"); 121 122 if (dt_establish_handler(dt, &dt_kbd_dv, sc, dtkbd_handler)) { 123 printf("%s: unable to establish handler\n", device_xname(self)); 124 return; 125 } 126 127 sc->sc_enabled = 1; 128 129 a.console = dtkbd_isconsole; 130 a.keymap = &dtkbd_keymapdata; 131 a.accessops = &dtkbd_accessops; 132 a.accesscookie = sc; 133 sc->sc_wskbddev = config_found(self, &a, wskbddevprint); 134} 135 136void 137dtkbd_cnattach(void) 138{ 139 140 dtkbd_isconsole = 1; 141 dt_cninit(); 142 143 wskbd_cnattach(&dtkbd_consops, &dtkbd_map, &dtkbd_keymapdata); 144} 145 146int 147dtkbd_enable(void *v, int on) 148{ 149 struct dtkbd_softc *sc; 150 151 sc = v; 152 sc->sc_enabled = on; 153 154 return (0); 155} 156 157void 158dtkbd_cngetc(void *v, u_int *type, int *data) 159{ 160 struct dt_msg msg; 161 static u_int types[20]; 162 static int cnt, i, vals[20]; 163 164 while (i >= cnt) { 165 for (;;) { 166 if (dt_msg_get(&msg, 0) == DT_GET_DONE) 167 if (msg.src == dt_kbd_addr && 168 !DT_CTL_P(msg.ctl)) 169 break; 170 DELAY(1000); 171 } 172 173 cnt = dtkbd_process_msg(&msg, types, vals); 174 i = 0; 175 } 176 177 *type = types[i++]; 178 *data = vals[i++]; 179} 180 181void 182dtkbd_cnpollc(void *v, int on) 183{ 184 185 /* XXX */ 186} 187 188int 189dtkbd_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l) 190{ 191 struct dtkbd_softc *sc; 192 193 sc = v; 194 195 switch (cmd) { 196 case WSKBDIO_GTYPE: 197 *(int *)data = WSKBD_TYPE_LK201; 198 return 0; 199 default: 200 /* XXX */ 201 return (EPASSTHROUGH); 202 } 203} 204 205void 206dtkbd_set_leds(void *v, int state) 207{ 208 209 /* XXX */ 210} 211 212void 213dtkbd_handler(void *cookie, struct dt_msg *msg) 214{ 215 struct dtkbd_softc *sc; 216 u_int types[20]; 217 int i, cnt, vals[20]; 218 219 sc = cookie; 220 221 if (!sc->sc_enabled) 222 return; 223 224 cnt = dtkbd_process_msg(msg, types, vals); 225 for (i = 0; i < cnt; i++) 226 wskbd_input(sc->sc_wskbddev, types[i], vals[i]); 227} 228 229int 230dtkbd_process_msg(struct dt_msg *msg, u_int *types, int *vals) 231{ 232 u_int len, c, count; 233 int i, j; 234 235 len = DT_CTL_LEN(msg->ctl); 236 237 if ((msg->body[0] < DT_KBD_KEY_MIN && msg->body[0] != DT_KBD_EMPTY) || 238 len > 10) { 239 printf("dtkbd0: error: %x %x %x\n", len, msg->body[0], 240 msg->body[1]); 241 242 /* 243 * Fake an "all ups" to avoid the stuck key syndrome. 244 */ 245 msg->body[0] = DT_KBD_EMPTY; 246 len = 1; 247 } 248 249 if (msg->body[0] == DT_KBD_EMPTY) { 250 types[0] = WSCONS_EVENT_ALL_KEYS_UP; 251 vals[0] = 0; 252 dtkbd_maplen = 0; 253 return (1); 254 } 255 256 count = 0; 257 258 for (i = 0; i < len; i++) { 259 c = msg->body[i]; 260 261 for (j = 0; j < dtkbd_maplen; j++) 262 if (dtkbd_map[j] == c) 263 break; 264 265 if (j == dtkbd_maplen) { 266 types[count] = WSCONS_EVENT_KEY_DOWN; 267 vals[count] = c - MIN_LK201_KEY; 268 count++; 269 } 270 } 271 272 for (j = 0; j < dtkbd_maplen; j++) { 273 c = dtkbd_map[j]; 274 275 for (i = 0; i < len; i++) 276 if (msg->body[i] == c) 277 break; 278 279 if (i == len) { 280 types[count] = WSCONS_EVENT_KEY_UP; 281 vals[count] = c - MIN_LK201_KEY; 282 count++; 283 } 284 } 285 286 memcpy(dtkbd_map, msg->body, len); 287 dtkbd_maplen = len; 288 289 return (count); 290} 291