wskbd.c revision 1.104.6.3 1 /* $NetBSD: wskbd.c,v 1.104.6.3 2007/08/09 02:37:15 jmcneill Exp $ */
2
3 /*
4 * Copyright (c) 1996, 1997 Christopher G. Demetriou. All rights reserved.
5 *
6 * Keysym translator:
7 * Contributed to The NetBSD Foundation by Juergen Hannken-Illjes.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. All advertising materials mentioning features or use of this software
18 * must display the following acknowledgement:
19 * This product includes software developed by Christopher G. Demetriou
20 * for the NetBSD Project.
21 * 4. The name of the author may not be used to endorse or promote products
22 * derived from this software without specific prior written permission
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
25 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
26 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
27 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
28 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
29 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
30 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
31 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
32 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
33 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
34 */
35
36 /*
37 * Copyright (c) 1992, 1993
38 * The Regents of the University of California. All rights reserved.
39 *
40 * This software was developed by the Computer Systems Engineering group
41 * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
42 * contributed to Berkeley.
43 *
44 * All advertising materials mentioning features or use of this software
45 * must display the following acknowledgement:
46 * This product includes software developed by the University of
47 * California, Lawrence Berkeley Laboratory.
48 *
49 * Redistribution and use in source and binary forms, with or without
50 * modification, are permitted provided that the following conditions
51 * are met:
52 * 1. Redistributions of source code must retain the above copyright
53 * notice, this list of conditions and the following disclaimer.
54 * 2. Redistributions in binary form must reproduce the above copyright
55 * notice, this list of conditions and the following disclaimer in the
56 * documentation and/or other materials provided with the distribution.
57 * 3. Neither the name of the University nor the names of its contributors
58 * may be used to endorse or promote products derived from this software
59 * without specific prior written permission.
60 *
61 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
62 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
63 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
64 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
65 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
66 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
67 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
68 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
69 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
70 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
71 * SUCH DAMAGE.
72 *
73 * @(#)kbd.c 8.2 (Berkeley) 10/30/93
74 */
75
76 /*
77 * Keyboard driver (/dev/wskbd*). Translates incoming bytes to ASCII or
78 * to `wscons_events' and passes them up to the appropriate reader.
79 */
80
81 #include <sys/cdefs.h>
82 __KERNEL_RCSID(0, "$NetBSD: wskbd.c,v 1.104.6.3 2007/08/09 02:37:15 jmcneill Exp $");
83
84 #include "opt_ddb.h"
85 #include "opt_kgdb.h"
86 #include "opt_wsdisplay_compat.h"
87
88 #include "wsdisplay.h"
89 #include "wskbd.h"
90 #include "wsmux.h"
91
92 #include <sys/param.h>
93 #include <sys/conf.h>
94 #include <sys/device.h>
95 #include <sys/ioctl.h>
96 #include <sys/poll.h>
97 #include <sys/kernel.h>
98 #include <sys/proc.h>
99 #include <sys/syslog.h>
100 #include <sys/systm.h>
101 #include <sys/callout.h>
102 #include <sys/malloc.h>
103 #include <sys/tty.h>
104 #include <sys/signalvar.h>
105 #include <sys/errno.h>
106 #include <sys/fcntl.h>
107 #include <sys/vnode.h>
108 #include <sys/kauth.h>
109
110 #include <dev/wscons/wsconsio.h>
111 #include <dev/wscons/wskbdvar.h>
112 #include <dev/wscons/wsksymdef.h>
113 #include <dev/wscons/wsksymvar.h>
114 #include <dev/wscons/wsdisplayvar.h>
115 #include <dev/wscons/wseventvar.h>
116 #include <dev/wscons/wscons_callbacks.h>
117
118 #ifdef KGDB
119 #include <sys/kgdb.h>
120 #endif
121
122 #ifdef WSKBD_DEBUG
123 #define DPRINTF(x) if (wskbddebug) printf x
124 int wskbddebug = 0;
125 #else
126 #define DPRINTF(x)
127 #endif
128
129 #include <dev/wscons/wsmuxvar.h>
130
131 struct wskbd_internal {
132 const struct wskbd_mapdata *t_keymap;
133
134 const struct wskbd_consops *t_consops;
135 void *t_consaccesscookie;
136
137 int t_modifiers;
138 int t_composelen; /* remaining entries in t_composebuf */
139 keysym_t t_composebuf[2];
140
141 int t_flags;
142 #define WSKFL_METAESC 1
143
144 #define MAXKEYSYMSPERKEY 2 /* ESC <key> at max */
145 keysym_t t_symbols[MAXKEYSYMSPERKEY];
146
147 struct wskbd_softc *t_sc; /* back pointer */
148 };
149
150 struct wskbd_softc {
151 struct wsevsrc sc_base;
152
153 struct wskbd_internal *id;
154
155 const struct wskbd_accessops *sc_accessops;
156 void *sc_accesscookie;
157
158 int sc_ledstate;
159
160 int sc_isconsole;
161
162 struct wskbd_bell_data sc_bell_data;
163 struct wskbd_keyrepeat_data sc_keyrepeat_data;
164 #ifdef WSDISPLAY_SCROLLSUPPORT
165 struct wskbd_scroll_data sc_scroll_data;
166 #endif
167
168 int sc_repeating; /* we've called timeout() */
169 callout_t sc_repeat_ch;
170 u_int sc_repeat_type;
171 int sc_repeat_value;
172
173 int sc_translating; /* xlate to chars for emulation */
174
175 int sc_maplen; /* number of entries in sc_map */
176 struct wscons_keymap *sc_map; /* current translation map */
177 kbd_t sc_layout; /* current layout */
178
179 int sc_refcnt;
180 u_char sc_dying; /* device is being detached */
181 };
182
183 #define MOD_SHIFT_L (1 << 0)
184 #define MOD_SHIFT_R (1 << 1)
185 #define MOD_SHIFTLOCK (1 << 2)
186 #define MOD_CAPSLOCK (1 << 3)
187 #define MOD_CONTROL_L (1 << 4)
188 #define MOD_CONTROL_R (1 << 5)
189 #define MOD_META_L (1 << 6)
190 #define MOD_META_R (1 << 7)
191 #define MOD_MODESHIFT (1 << 8)
192 #define MOD_NUMLOCK (1 << 9)
193 #define MOD_COMPOSE (1 << 10)
194 #define MOD_HOLDSCREEN (1 << 11)
195 #define MOD_COMMAND (1 << 12)
196 #define MOD_COMMAND1 (1 << 13)
197 #define MOD_COMMAND2 (1 << 14)
198
199 #define MOD_ANYSHIFT (MOD_SHIFT_L | MOD_SHIFT_R | MOD_SHIFTLOCK)
200 #define MOD_ANYCONTROL (MOD_CONTROL_L | MOD_CONTROL_R)
201 #define MOD_ANYMETA (MOD_META_L | MOD_META_R)
202
203 #define MOD_ONESET(id, mask) (((id)->t_modifiers & (mask)) != 0)
204 #define MOD_ALLSET(id, mask) (((id)->t_modifiers & (mask)) == (mask))
205
206 #define GETMODSTATE(src, dst) \
207 do { \
208 dst |= (src & MOD_SHIFT_L) ? MOD_SHIFT_L : 0; \
209 dst |= (src & MOD_SHIFT_R) ? MOD_SHIFT_R : 0; \
210 dst |= (src & MOD_CONTROL_L) ? MOD_CONTROL_L : 0; \
211 dst |= (src & MOD_CONTROL_R) ? MOD_CONTROL_R : 0; \
212 dst |= (src & MOD_META_L) ? MOD_META_L : 0; \
213 dst |= (src & MOD_META_R) ? MOD_META_R : 0; \
214 } while (0)
215
216 static int wskbd_match(struct device *, struct cfdata *, void *);
217 static void wskbd_attach(struct device *, struct device *, void *);
218 static int wskbd_detach(struct device *, int);
219 static int wskbd_activate(struct device *, enum devact);
220
221 static int wskbd_displayioctl(struct device *, u_long, void *, int,
222 struct lwp *);
223 #if NWSDISPLAY > 0
224 static int wskbd_set_display(struct device *, struct wsevsrc *);
225 #else
226 #define wskbd_set_display NULL
227 #endif
228
229 static inline void update_leds(struct wskbd_internal *);
230 static inline void update_modifier(struct wskbd_internal *, u_int, int, int);
231 static int internal_command(struct wskbd_softc *, u_int *, keysym_t, keysym_t);
232 static int wskbd_translate(struct wskbd_internal *, u_int, int);
233 static int wskbd_enable(struct wskbd_softc *, int);
234 #if NWSDISPLAY > 0
235 static void change_displayparam(struct wskbd_softc *, int, int, int);
236 static void wskbd_holdscreen(struct wskbd_softc *, int);
237 #endif
238
239 static int wskbd_do_ioctl_sc(struct wskbd_softc *, u_long, void *, int,
240 struct lwp *);
241 static void wskbd_deliver_event(struct wskbd_softc *sc, u_int type, int value);
242
243 #if NWSMUX > 0
244 static int wskbd_mux_open(struct wsevsrc *, struct wseventvar *);
245 static int wskbd_mux_close(struct wsevsrc *);
246 #else
247 #define wskbd_mux_open NULL
248 #define wskbd_mux_close NULL
249 #endif
250
251 static int wskbd_do_open(struct wskbd_softc *, struct wseventvar *);
252 static int wskbd_do_ioctl(struct device *, u_long, void *, int, struct lwp *);
253
254 CFATTACH_DECL(wskbd, sizeof (struct wskbd_softc),
255 wskbd_match, wskbd_attach, wskbd_detach, wskbd_activate);
256
257 extern struct cfdriver wskbd_cd;
258
259 dev_type_open(wskbdopen);
260 dev_type_close(wskbdclose);
261 dev_type_read(wskbdread);
262 dev_type_ioctl(wskbdioctl);
263 dev_type_poll(wskbdpoll);
264 dev_type_kqfilter(wskbdkqfilter);
265
266 const struct cdevsw wskbd_cdevsw = {
267 wskbdopen, wskbdclose, wskbdread, nowrite, wskbdioctl,
268 nostop, notty, wskbdpoll, nommap, wskbdkqfilter, D_OTHER
269 };
270
271 #ifndef WSKBD_DEFAULT_BELL_PITCH
272 #define WSKBD_DEFAULT_BELL_PITCH 1500 /* 1500Hz */
273 #endif
274 #ifndef WSKBD_DEFAULT_BELL_PERIOD
275 #define WSKBD_DEFAULT_BELL_PERIOD 100 /* 100ms */
276 #endif
277 #ifndef WSKBD_DEFAULT_BELL_VOLUME
278 #define WSKBD_DEFAULT_BELL_VOLUME 50 /* 50% volume */
279 #endif
280
281 struct wskbd_bell_data wskbd_default_bell_data = {
282 WSKBD_BELL_DOALL,
283 WSKBD_DEFAULT_BELL_PITCH,
284 WSKBD_DEFAULT_BELL_PERIOD,
285 WSKBD_DEFAULT_BELL_VOLUME,
286 };
287
288 #ifdef WSDISPLAY_SCROLLSUPPORT
289 struct wskbd_scroll_data wskbd_default_scroll_data = {
290 WSKBD_SCROLL_DOALL,
291 WSKBD_SCROLL_MODE_NORMAL,
292 #ifdef WSDISPLAY_SCROLLCOMBO
293 WSDISPLAY_SCROLLCOMBO,
294 #else
295 MOD_SHIFT_L,
296 #endif
297 };
298 #endif
299
300 #ifndef WSKBD_DEFAULT_KEYREPEAT_DEL1
301 #define WSKBD_DEFAULT_KEYREPEAT_DEL1 400 /* 400ms to start repeating */
302 #endif
303 #ifndef WSKBD_DEFAULT_KEYREPEAT_DELN
304 #define WSKBD_DEFAULT_KEYREPEAT_DELN 100 /* 100ms to between repeats */
305 #endif
306
307 struct wskbd_keyrepeat_data wskbd_default_keyrepeat_data = {
308 WSKBD_KEYREPEAT_DOALL,
309 WSKBD_DEFAULT_KEYREPEAT_DEL1,
310 WSKBD_DEFAULT_KEYREPEAT_DELN,
311 };
312
313 #if NWSDISPLAY > 0 || NWSMUX > 0
314 struct wssrcops wskbd_srcops = {
315 WSMUX_KBD,
316 wskbd_mux_open, wskbd_mux_close, wskbd_do_ioctl,
317 wskbd_displayioctl, wskbd_set_display
318 };
319 #endif
320
321 #if NWSDISPLAY > 0
322 static void wskbd_repeat(void *v);
323 #endif
324
325 static int wskbd_console_initted;
326 static struct wskbd_softc *wskbd_console_device;
327 static struct wskbd_internal wskbd_console_data;
328
329 static void wskbd_update_layout(struct wskbd_internal *, kbd_t);
330
331 static void
332 wskbd_update_layout(struct wskbd_internal *id, kbd_t enc)
333 {
334
335 if (enc & KB_METAESC)
336 id->t_flags |= WSKFL_METAESC;
337 else
338 id->t_flags &= ~WSKFL_METAESC;
339 }
340
341 /*
342 * Print function (for parent devices).
343 */
344 int
345 wskbddevprint(void *aux, const char *pnp)
346 {
347 #if 0
348 struct wskbddev_attach_args *ap = aux;
349 #endif
350
351 if (pnp)
352 aprint_normal("wskbd at %s", pnp);
353 #if 0
354 aprint_normal(" console %d", ap->console);
355 #endif
356
357 return (UNCONF);
358 }
359
360 int
361 wskbd_match(struct device *parent, struct cfdata *match, void *aux)
362 {
363 struct wskbddev_attach_args *ap = aux;
364
365 if (match->wskbddevcf_console != WSKBDDEVCF_CONSOLE_UNK) {
366 /*
367 * If console-ness of device specified, either match
368 * exactly (at high priority), or fail.
369 */
370 if (match->wskbddevcf_console != 0 && ap->console != 0)
371 return (10);
372 else
373 return (0);
374 }
375
376 /* If console-ness unspecified, it wins. */
377 return (1);
378 }
379
380 void
381 wskbd_attach(struct device *parent, struct device *self, void *aux)
382 {
383 struct wskbd_softc *sc = (struct wskbd_softc *)self;
384 struct wskbddev_attach_args *ap = aux;
385 #if NWSMUX > 0
386 int mux, error;
387 #endif
388
389 sc->sc_isconsole = ap->console;
390
391 #if NWSMUX > 0 || NWSDISPLAY > 0
392 sc->sc_base.me_ops = &wskbd_srcops;
393 #endif
394 #if NWSMUX > 0
395 mux = device_cfdata(&sc->sc_base.me_dv)->wskbddevcf_mux;
396 if (ap->console) {
397 /* Ignore mux for console; it always goes to the console mux. */
398 /* printf(" (mux %d ignored for console)", mux); */
399 mux = -1;
400 }
401 if (mux >= 0)
402 printf(" mux %d", mux);
403 #else
404 if (device_cfdata(&sc->sc_base.me_dv)->wskbddevcf_mux >= 0)
405 printf(" (mux ignored)");
406 #endif
407
408 if (ap->console) {
409 sc->id = &wskbd_console_data;
410 } else {
411 sc->id = malloc(sizeof(struct wskbd_internal),
412 M_DEVBUF, M_WAITOK|M_ZERO);
413 sc->id->t_keymap = ap->keymap;
414 wskbd_update_layout(sc->id, ap->keymap->layout);
415 }
416
417 callout_init(&sc->sc_repeat_ch, 0);
418
419 sc->id->t_sc = sc;
420
421 sc->sc_accessops = ap->accessops;
422 sc->sc_accesscookie = ap->accesscookie;
423 sc->sc_repeating = 0;
424 sc->sc_translating = 1;
425 sc->sc_ledstate = -1; /* force update */
426
427 if (wskbd_load_keymap(sc->id->t_keymap,
428 &sc->sc_map, &sc->sc_maplen) != 0)
429 panic("cannot load keymap");
430
431 sc->sc_layout = sc->id->t_keymap->layout;
432
433 /* set default bell and key repeat data */
434 sc->sc_bell_data = wskbd_default_bell_data;
435 sc->sc_keyrepeat_data = wskbd_default_keyrepeat_data;
436
437 #ifdef WSDISPLAY_SCROLLSUPPORT
438 sc->sc_scroll_data = wskbd_default_scroll_data;
439 #endif
440
441 if (ap->console) {
442 KASSERT(wskbd_console_initted);
443 KASSERT(wskbd_console_device == NULL);
444
445 wskbd_console_device = sc;
446
447 printf(": console keyboard");
448
449 #if NWSDISPLAY > 0
450 wsdisplay_set_console_kbd(&sc->sc_base); /* sets me_dispv */
451 if (sc->sc_base.me_dispdv != NULL)
452 printf(", using %s", sc->sc_base.me_dispdv->dv_xname);
453 #endif
454 }
455 printf("\n");
456
457 #if NWSMUX > 0
458 if (mux >= 0) {
459 error = wsmux_attach_sc(wsmux_getmux(mux), &sc->sc_base);
460 if (error)
461 printf("%s: attach error=%d\n",
462 sc->sc_base.me_dv.dv_xname, error);
463 }
464 #endif
465
466 (void)pnp_register(self, pnp_generic_power);
467 }
468
469 void
470 wskbd_cnattach(const struct wskbd_consops *consops, void *conscookie,
471 const struct wskbd_mapdata *mapdata)
472 {
473 KASSERT(!wskbd_console_initted);
474
475 wskbd_console_data.t_keymap = mapdata;
476 wskbd_update_layout(&wskbd_console_data, mapdata->layout);
477
478 wskbd_console_data.t_consops = consops;
479 wskbd_console_data.t_consaccesscookie = conscookie;
480
481 #if NWSDISPLAY > 0
482 wsdisplay_set_cons_kbd(wskbd_cngetc, wskbd_cnpollc, wskbd_cnbell);
483 #endif
484
485 wskbd_console_initted = 1;
486 }
487
488 void
489 wskbd_cndetach(void)
490 {
491 KASSERT(wskbd_console_initted);
492
493 wskbd_console_data.t_keymap = 0;
494
495 wskbd_console_data.t_consops = 0;
496 wskbd_console_data.t_consaccesscookie = 0;
497
498 #if NWSDISPLAY > 0
499 wsdisplay_unset_cons_kbd();
500 #endif
501
502 wskbd_console_initted = 0;
503 }
504
505 static void
506 wskbd_repeat(void *v)
507 {
508 struct wskbd_softc *sc = (struct wskbd_softc *)v;
509 int s = spltty();
510
511 if (!sc->sc_repeating) {
512 /*
513 * race condition: a "key up" event came in when wskbd_repeat()
514 * was already called but not yet spltty()'d
515 */
516 splx(s);
517 return;
518 }
519 if (sc->sc_translating) {
520 /* deliver keys */
521 #if NWSDISPLAY > 0
522 if (sc->sc_base.me_dispdv != NULL) {
523 int i;
524 for (i = 0; i < sc->sc_repeating; i++)
525 wsdisplay_kbdinput(sc->sc_base.me_dispdv,
526 sc->id->t_symbols[i]);
527 }
528 #endif
529 } else {
530 #if defined(WSKBD_EVENT_AUTOREPEAT)
531 /* queue event */
532 wskbd_deliver_event(sc, sc->sc_repeat_type,
533 sc->sc_repeat_value);
534 #endif /* defined(WSKBD_EVENT_AUTOREPEAT) */
535 }
536 callout_reset(&sc->sc_repeat_ch,
537 (hz * sc->sc_keyrepeat_data.delN) / 1000, wskbd_repeat, sc);
538 splx(s);
539 }
540
541 int
542 wskbd_activate(struct device *self, enum devact act)
543 {
544 struct wskbd_softc *sc = (struct wskbd_softc *)self;
545
546 if (act == DVACT_DEACTIVATE)
547 sc->sc_dying = 1;
548 return (0);
549 }
550
551 /*
552 * Detach a keyboard. To keep track of users of the softc we keep
553 * a reference count that's incremented while inside, e.g., read.
554 * If the keyboard is active and the reference count is > 0 (0 is the
555 * normal state) we post an event and then wait for the process
556 * that had the reference to wake us up again. Then we blow away the
557 * vnode and return (which will deallocate the softc).
558 */
559 int
560 wskbd_detach(struct device *self, int flags)
561 {
562 struct wskbd_softc *sc = (struct wskbd_softc *)self;
563 struct wseventvar *evar;
564 int maj, mn;
565 int s;
566
567 #if NWSMUX > 0
568 /* Tell parent mux we're leaving. */
569 if (sc->sc_base.me_parent != NULL)
570 wsmux_detach_sc(&sc->sc_base);
571 #endif
572
573 if (sc->sc_isconsole) {
574 KASSERT(wskbd_console_device == sc);
575 wskbd_console_device = NULL;
576 }
577
578 evar = sc->sc_base.me_evp;
579 if (evar != NULL && evar->io != NULL) {
580 s = spltty();
581 if (--sc->sc_refcnt >= 0) {
582 struct wscons_event event;
583
584 /* Wake everyone by generating a dummy event. */
585 event.type = 0;
586 event.value = 0;
587 if (wsevent_inject(evar, &event, 1) != 0)
588 wsevent_wakeup(evar);
589
590 /* Wait for processes to go away. */
591 if (tsleep(sc, PZERO, "wskdet", hz * 60))
592 printf("wskbd_detach: %s didn't detach\n",
593 sc->sc_base.me_dv.dv_xname);
594 }
595 splx(s);
596 }
597
598 /* locate the major number */
599 maj = cdevsw_lookup_major(&wskbd_cdevsw);
600
601 /* Nuke the vnodes for any open instances. */
602 mn = device_unit(self);
603 vdevgone(maj, mn, mn, VCHR);
604
605 return (0);
606 }
607
608 void
609 wskbd_input(struct device *dev, u_int type, int value)
610 {
611 struct wskbd_softc *sc = (struct wskbd_softc *)dev;
612 #if NWSDISPLAY > 0
613 int num, i;
614 #endif
615
616 if (sc->sc_repeating) {
617 sc->sc_repeating = 0;
618 callout_stop(&sc->sc_repeat_ch);
619 }
620
621 /* notify power management framework */
622 pnp_power_input(dev, PNP_ACTION_KEYBOARD);
623
624 #if NWSDISPLAY > 0
625 /*
626 * If /dev/wskbdN is not connected in event mode translate and
627 * send upstream.
628 */
629 if (sc->sc_translating) {
630 num = wskbd_translate(sc->id, type, value);
631 if (num > 0) {
632 if (sc->sc_base.me_dispdv != NULL) {
633 #ifdef WSDISPLAY_SCROLLSUPPORT
634 if (sc->id->t_symbols [0] != KS_Print_Screen) {
635 wsdisplay_scroll(sc->sc_base.
636 me_dispdv, WSDISPLAY_SCROLL_RESET);
637 }
638 #endif
639 for (i = 0; i < num; i++)
640 wsdisplay_kbdinput(
641 sc->sc_base.me_dispdv,
642 sc->id->t_symbols[i]);
643 }
644
645 if (sc->sc_keyrepeat_data.del1 != 0) {
646 sc->sc_repeating = num;
647 callout_reset(&sc->sc_repeat_ch,
648 (hz * sc->sc_keyrepeat_data.del1) / 1000,
649 wskbd_repeat, sc);
650 }
651 }
652 return;
653 }
654 #endif
655
656 wskbd_deliver_event(sc, type, value);
657
658 #if defined(WSKBD_EVENT_AUTOREPEAT)
659 /* Repeat key presses if set. */
660 if (type == WSCONS_EVENT_KEY_DOWN && sc->sc_keyrepeat_data.del1 != 0) {
661 sc->sc_repeat_type = type;
662 sc->sc_repeat_value = value;
663 sc->sc_repeating = 1;
664 callout_reset(&sc->sc_repeat_ch,
665 (hz * sc->sc_keyrepeat_data.del1) / 1000,
666 wskbd_repeat, sc);
667 }
668 #endif /* defined(WSKBD_EVENT_AUTOREPEAT) */
669 }
670
671 /*
672 * Keyboard is generating events. Turn this keystroke into an
673 * event and put it in the queue. If the queue is full, the
674 * keystroke is lost (sorry!).
675 */
676 static void
677 wskbd_deliver_event(struct wskbd_softc *sc, u_int type, int value)
678 {
679 struct wseventvar *evar;
680 struct wscons_event event;
681
682 evar = sc->sc_base.me_evp;
683
684 if (evar == NULL) {
685 DPRINTF(("wskbd_input: not open\n"));
686 return;
687 }
688
689 #ifdef DIAGNOSTIC
690 if (evar->q == NULL) {
691 printf("wskbd_input: evar->q=NULL\n");
692 return;
693 }
694 #endif
695
696 event.type = type;
697 event.value = value;
698 if (wsevent_inject(evar, &event, 1) != 0)
699 log(LOG_WARNING, "%s: event queue overflow\n",
700 sc->sc_base.me_dv.dv_xname);
701 }
702
703 #ifdef WSDISPLAY_COMPAT_RAWKBD
704 void
705 wskbd_rawinput(struct device *dev, u_char *tbuf, int len)
706 {
707 #if NWSDISPLAY > 0
708 struct wskbd_softc *sc = (struct wskbd_softc *)dev;
709 int i;
710
711 if (sc->sc_base.me_dispdv != NULL)
712 for (i = 0; i < len; i++)
713 wsdisplay_kbdinput(sc->sc_base.me_dispdv, tbuf[i]);
714 /* this is KS_GROUP_Ascii */
715 #endif
716 }
717 #endif /* WSDISPLAY_COMPAT_RAWKBD */
718
719 #if NWSDISPLAY > 0
720 static void
721 wskbd_holdscreen(struct wskbd_softc *sc, int hold)
722 {
723 int new_state;
724
725 if (sc->sc_base.me_dispdv != NULL) {
726 wsdisplay_kbdholdscreen(sc->sc_base.me_dispdv, hold);
727 new_state = sc->sc_ledstate;
728 if (hold) {
729 #ifdef WSDISPLAY_SCROLLSUPPORT
730 sc->sc_scroll_data.mode = WSKBD_SCROLL_MODE_HOLD;
731 #endif
732 new_state |= WSKBD_LED_SCROLL;
733 } else {
734 #ifdef WSDISPLAY_SCROLLSUPPORT
735 sc->sc_scroll_data.mode = WSKBD_SCROLL_MODE_NORMAL;
736 #endif
737 new_state &= ~WSKBD_LED_SCROLL;
738 }
739 if (new_state != sc->sc_ledstate) {
740 (*sc->sc_accessops->set_leds)(sc->sc_accesscookie,
741 new_state);
742 sc->sc_ledstate = new_state;
743 #ifdef WSDISPLAY_SCROLLSUPPORT
744 if (!hold)
745 wsdisplay_scroll(sc->sc_base.me_dispdv,
746 WSDISPLAY_SCROLL_RESET);
747 #endif
748 }
749 }
750 }
751 #endif
752
753 static int
754 wskbd_enable(struct wskbd_softc *sc, int on)
755 {
756 int error;
757
758 #if 0
759 /* I don't understand the purpose of this code. And it seems to
760 * break things, so it's out. -- Lennart
761 */
762 if (!on && (!sc->sc_translating
763 #if NWSDISPLAY > 0
764 || sc->sc_base.me_dispdv
765 #endif
766 ))
767 return (EBUSY);
768 #endif
769 #if NWSDISPLAY > 0
770 if (sc->sc_base.me_dispdv != NULL)
771 return (0);
772 #endif
773
774 /* Always cancel auto repeat when fiddling with the kbd. */
775 if (sc->sc_repeating) {
776 sc->sc_repeating = 0;
777 callout_stop(&sc->sc_repeat_ch);
778 }
779
780 error = (*sc->sc_accessops->enable)(sc->sc_accesscookie, on);
781 DPRINTF(("wskbd_enable: sc=%p on=%d res=%d\n", sc, on, error));
782 return (error);
783 }
784
785 #if NWSMUX > 0
786 int
787 wskbd_mux_open(struct wsevsrc *me, struct wseventvar *evp)
788 {
789 struct wskbd_softc *sc = (struct wskbd_softc *)me;
790
791 if (sc->sc_dying)
792 return (EIO);
793
794 if (sc->sc_base.me_evp != NULL)
795 return (EBUSY);
796
797 return (wskbd_do_open(sc, evp));
798 }
799 #endif
800
801 int
802 wskbdopen(dev_t dev, int flags, int mode, struct lwp *l)
803 {
804 struct wskbd_softc *sc;
805 struct wseventvar *evar;
806 int unit, error;
807
808 unit = minor(dev);
809 if (unit >= wskbd_cd.cd_ndevs || /* make sure it was attached */
810 (sc = wskbd_cd.cd_devs[unit]) == NULL)
811 return (ENXIO);
812
813 #if NWSMUX > 0
814 DPRINTF(("wskbdopen: %s mux=%p l=%p\n", sc->sc_base.me_dv.dv_xname,
815 sc->sc_base.me_parent, l));
816 #endif
817
818 if (sc->sc_dying)
819 return (EIO);
820
821 if ((flags & (FREAD | FWRITE)) == FWRITE)
822 /* Not opening for read, only ioctl is available. */
823 return (0);
824
825 #if NWSMUX > 0
826 if (sc->sc_base.me_parent != NULL) {
827 /* Grab the keyboard out of the greedy hands of the mux. */
828 DPRINTF(("wskbdopen: detach\n"));
829 wsmux_detach_sc(&sc->sc_base);
830 }
831 #endif
832
833 if (sc->sc_base.me_evp != NULL)
834 return (EBUSY);
835
836 evar = &sc->sc_base.me_evar;
837 wsevent_init(evar, l->l_proc);
838
839 error = wskbd_do_open(sc, evar);
840 if (error) {
841 DPRINTF(("wskbdopen: %s open failed\n",
842 sc->sc_base.me_dv.dv_xname));
843 sc->sc_base.me_evp = NULL;
844 wsevent_fini(evar);
845 }
846 return (error);
847 }
848
849 int
850 wskbd_do_open(struct wskbd_softc *sc, struct wseventvar *evp)
851 {
852 sc->sc_base.me_evp = evp;
853 sc->sc_translating = 0;
854
855 return (wskbd_enable(sc, 1));
856 }
857
858 int
859 wskbdclose(dev_t dev, int flags, int mode,
860 struct lwp *l)
861 {
862 struct wskbd_softc *sc =
863 (struct wskbd_softc *)wskbd_cd.cd_devs[minor(dev)];
864 struct wseventvar *evar = sc->sc_base.me_evp;
865
866 if (evar == NULL)
867 /* not open for read */
868 return (0);
869
870 sc->sc_base.me_evp = NULL;
871 sc->sc_translating = 1;
872 (void)wskbd_enable(sc, 0);
873 wsevent_fini(evar);
874
875 return (0);
876 }
877
878 #if NWSMUX > 0
879 int
880 wskbd_mux_close(struct wsevsrc *me)
881 {
882 struct wskbd_softc *sc = (struct wskbd_softc *)me;
883
884 sc->sc_base.me_evp = NULL;
885 sc->sc_translating = 1;
886 (void)wskbd_enable(sc, 0);
887
888 return (0);
889 }
890 #endif
891
892 int
893 wskbdread(dev_t dev, struct uio *uio, int flags)
894 {
895 struct wskbd_softc *sc = wskbd_cd.cd_devs[minor(dev)];
896 int error;
897
898 if (sc->sc_dying)
899 return (EIO);
900
901 #ifdef DIAGNOSTIC
902 if (sc->sc_base.me_evp == NULL) {
903 printf("wskbdread: evp == NULL\n");
904 return (EINVAL);
905 }
906 #endif
907
908 sc->sc_refcnt++;
909 error = wsevent_read(sc->sc_base.me_evp, uio, flags);
910 if (--sc->sc_refcnt < 0) {
911 wakeup(sc);
912 error = EIO;
913 }
914 return (error);
915 }
916
917 int
918 wskbdioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
919 {
920 return (wskbd_do_ioctl(wskbd_cd.cd_devs[minor(dev)], cmd, data, flag,l));
921 }
922
923 /* A wrapper around the ioctl() workhorse to make reference counting easy. */
924 int
925 wskbd_do_ioctl(struct device *dv, u_long cmd, void *data, int flag,
926 struct lwp *l)
927 {
928 struct wskbd_softc *sc = (struct wskbd_softc *)dv;
929 int error;
930
931 sc->sc_refcnt++;
932 error = wskbd_do_ioctl_sc(sc, cmd, data, flag, l);
933 if (--sc->sc_refcnt < 0)
934 wakeup(sc);
935 return (error);
936 }
937
938 int
939 wskbd_do_ioctl_sc(struct wskbd_softc *sc, u_long cmd, void *data, int flag,
940 struct lwp *l)
941 {
942
943 /*
944 * Try the generic ioctls that the wskbd interface supports.
945 */
946 switch (cmd) {
947 case FIONBIO: /* we will remove this someday (soon???) */
948 return (0);
949
950 case FIOASYNC:
951 if (sc->sc_base.me_evp == NULL)
952 return (EINVAL);
953 sc->sc_base.me_evp->async = *(int *)data != 0;
954 return (0);
955
956 case FIOSETOWN:
957 if (sc->sc_base.me_evp == NULL)
958 return (EINVAL);
959 if (-*(int *)data != sc->sc_base.me_evp->io->p_pgid
960 && *(int *)data != sc->sc_base.me_evp->io->p_pid)
961 return (EPERM);
962 return (0);
963
964 case TIOCSPGRP:
965 if (sc->sc_base.me_evp == NULL)
966 return (EINVAL);
967 if (*(int *)data != sc->sc_base.me_evp->io->p_pgid)
968 return (EPERM);
969 return (0);
970 }
971
972 /*
973 * Try the keyboard driver for WSKBDIO ioctls. It returns EPASSTHROUGH
974 * if it didn't recognize the request.
975 */
976 return (wskbd_displayioctl(&sc->sc_base.me_dv, cmd, data, flag, l));
977 }
978
979 /*
980 * WSKBDIO ioctls, handled in both emulation mode and in ``raw'' mode.
981 * Some of these have no real effect in raw mode, however.
982 */
983 static int
984 wskbd_displayioctl(struct device *dev, u_long cmd, void *data, int flag,
985 struct lwp *l)
986 {
987 #ifdef WSDISPLAY_SCROLLSUPPORT
988 struct wskbd_scroll_data *usdp, *ksdp;
989 #endif
990 struct wskbd_softc *sc = (struct wskbd_softc *)dev;
991 struct wskbd_bell_data *ubdp, *kbdp;
992 struct wskbd_keyrepeat_data *ukdp, *kkdp;
993 struct wskbd_map_data *umdp;
994 struct wskbd_mapdata md;
995 struct proc *p = l ? l->l_proc : NULL;
996 kbd_t enc;
997 void *tbuf;
998 int len, error;
999
1000 switch (cmd) {
1001 #define SETBELL(dstp, srcp, dfltp) \
1002 do { \
1003 (dstp)->pitch = ((srcp)->which & WSKBD_BELL_DOPITCH) ? \
1004 (srcp)->pitch : (dfltp)->pitch; \
1005 (dstp)->period = ((srcp)->which & WSKBD_BELL_DOPERIOD) ? \
1006 (srcp)->period : (dfltp)->period; \
1007 (dstp)->volume = ((srcp)->which & WSKBD_BELL_DOVOLUME) ? \
1008 (srcp)->volume : (dfltp)->volume; \
1009 (dstp)->which = WSKBD_BELL_DOALL; \
1010 } while (0)
1011
1012 case WSKBDIO_BELL:
1013 if ((flag & FWRITE) == 0)
1014 return (EACCES);
1015 return ((*sc->sc_accessops->ioctl)(sc->sc_accesscookie,
1016 WSKBDIO_COMPLEXBELL, (void *)&sc->sc_bell_data, flag, l));
1017
1018 case WSKBDIO_COMPLEXBELL:
1019 if ((flag & FWRITE) == 0)
1020 return (EACCES);
1021 ubdp = (struct wskbd_bell_data *)data;
1022 SETBELL(ubdp, ubdp, &sc->sc_bell_data);
1023 return ((*sc->sc_accessops->ioctl)(sc->sc_accesscookie,
1024 WSKBDIO_COMPLEXBELL, (void *)ubdp, flag, l));
1025
1026 case WSKBDIO_SETBELL:
1027 if ((flag & FWRITE) == 0)
1028 return (EACCES);
1029 kbdp = &sc->sc_bell_data;
1030 setbell:
1031 ubdp = (struct wskbd_bell_data *)data;
1032 SETBELL(kbdp, ubdp, kbdp);
1033 return (0);
1034
1035 case WSKBDIO_GETBELL:
1036 kbdp = &sc->sc_bell_data;
1037 getbell:
1038 ubdp = (struct wskbd_bell_data *)data;
1039 SETBELL(ubdp, kbdp, kbdp);
1040 return (0);
1041
1042 case WSKBDIO_SETDEFAULTBELL:
1043 if (p && (error = kauth_authorize_generic(l->l_cred,
1044 KAUTH_GENERIC_ISSUSER, NULL)) != 0)
1045 return (error);
1046 kbdp = &wskbd_default_bell_data;
1047 goto setbell;
1048
1049
1050 case WSKBDIO_GETDEFAULTBELL:
1051 kbdp = &wskbd_default_bell_data;
1052 goto getbell;
1053
1054 #undef SETBELL
1055
1056 #define SETKEYREPEAT(dstp, srcp, dfltp) \
1057 do { \
1058 (dstp)->del1 = ((srcp)->which & WSKBD_KEYREPEAT_DODEL1) ? \
1059 (srcp)->del1 : (dfltp)->del1; \
1060 (dstp)->delN = ((srcp)->which & WSKBD_KEYREPEAT_DODELN) ? \
1061 (srcp)->delN : (dfltp)->delN; \
1062 (dstp)->which = WSKBD_KEYREPEAT_DOALL; \
1063 } while (0)
1064
1065 case WSKBDIO_SETKEYREPEAT:
1066 if ((flag & FWRITE) == 0)
1067 return (EACCES);
1068 kkdp = &sc->sc_keyrepeat_data;
1069 setkeyrepeat:
1070 ukdp = (struct wskbd_keyrepeat_data *)data;
1071 SETKEYREPEAT(kkdp, ukdp, kkdp);
1072 return (0);
1073
1074 case WSKBDIO_GETKEYREPEAT:
1075 kkdp = &sc->sc_keyrepeat_data;
1076 getkeyrepeat:
1077 ukdp = (struct wskbd_keyrepeat_data *)data;
1078 SETKEYREPEAT(ukdp, kkdp, kkdp);
1079 return (0);
1080
1081 case WSKBDIO_SETDEFAULTKEYREPEAT:
1082 if ((error = kauth_authorize_generic(l->l_cred,
1083 KAUTH_GENERIC_ISSUSER, NULL)) != 0)
1084 return (error);
1085 kkdp = &wskbd_default_keyrepeat_data;
1086 goto setkeyrepeat;
1087
1088
1089 case WSKBDIO_GETDEFAULTKEYREPEAT:
1090 kkdp = &wskbd_default_keyrepeat_data;
1091 goto getkeyrepeat;
1092
1093 #ifdef WSDISPLAY_SCROLLSUPPORT
1094 #define SETSCROLLMOD(dstp, srcp, dfltp) \
1095 do { \
1096 (dstp)->mode = ((srcp)->which & WSKBD_SCROLL_DOMODE) ? \
1097 (srcp)->mode : (dfltp)->mode; \
1098 (dstp)->modifier = ((srcp)->which & WSKBD_SCROLL_DOMODIFIER) ? \
1099 (srcp)->modifier : (dfltp)->modifier; \
1100 (dstp)->which = WSKBD_SCROLL_DOALL; \
1101 } while (0)
1102
1103 case WSKBDIO_SETSCROLL:
1104 usdp = (struct wskbd_scroll_data *)data;
1105 ksdp = &sc->sc_scroll_data;
1106 SETSCROLLMOD(ksdp, usdp, ksdp);
1107 return (0);
1108
1109 case WSKBDIO_GETSCROLL:
1110 usdp = (struct wskbd_scroll_data *)data;
1111 ksdp = &sc->sc_scroll_data;
1112 SETSCROLLMOD(usdp, ksdp, ksdp);
1113 return (0);
1114 #else
1115 case WSKBDIO_GETSCROLL:
1116 case WSKBDIO_SETSCROLL:
1117 return ENODEV;
1118 #endif
1119
1120 #undef SETKEYREPEAT
1121
1122 case WSKBDIO_SETMAP:
1123 if ((flag & FWRITE) == 0)
1124 return (EACCES);
1125 umdp = (struct wskbd_map_data *)data;
1126 if (umdp->maplen > WSKBDIO_MAXMAPLEN)
1127 return (EINVAL);
1128
1129 len = umdp->maplen*sizeof(struct wscons_keymap);
1130 tbuf = malloc(len, M_TEMP, M_WAITOK);
1131 error = copyin(umdp->map, tbuf, len);
1132 if (error == 0) {
1133 wskbd_init_keymap(umdp->maplen,
1134 &sc->sc_map, &sc->sc_maplen);
1135 memcpy(sc->sc_map, tbuf, len);
1136 /* drop the variant bits handled by the map */
1137 sc->sc_layout = KB_USER |
1138 (KB_VARIANT(sc->sc_layout) & KB_HANDLEDBYWSKBD);
1139 wskbd_update_layout(sc->id, sc->sc_layout);
1140 }
1141 free(tbuf, M_TEMP);
1142 return(error);
1143
1144 case WSKBDIO_GETMAP:
1145 umdp = (struct wskbd_map_data *)data;
1146 if (umdp->maplen > sc->sc_maplen)
1147 umdp->maplen = sc->sc_maplen;
1148 error = copyout(sc->sc_map, umdp->map,
1149 umdp->maplen*sizeof(struct wscons_keymap));
1150 return(error);
1151
1152 case WSKBDIO_GETENCODING:
1153 *((kbd_t *) data) = sc->sc_layout;
1154 return(0);
1155
1156 case WSKBDIO_SETENCODING:
1157 if ((flag & FWRITE) == 0)
1158 return (EACCES);
1159 enc = *((kbd_t *)data);
1160 if (KB_ENCODING(enc) == KB_USER) {
1161 /* user map must already be loaded */
1162 if (KB_ENCODING(sc->sc_layout) != KB_USER)
1163 return (EINVAL);
1164 /* map variants make no sense */
1165 if (KB_VARIANT(enc) & ~KB_HANDLEDBYWSKBD)
1166 return (EINVAL);
1167 } else {
1168 md = *(sc->id->t_keymap); /* structure assignment */
1169 md.layout = enc;
1170 error = wskbd_load_keymap(&md, &sc->sc_map,
1171 &sc->sc_maplen);
1172 if (error)
1173 return (error);
1174 }
1175 sc->sc_layout = enc;
1176 wskbd_update_layout(sc->id, enc);
1177 return (0);
1178 }
1179
1180 /*
1181 * Try the keyboard driver for WSKBDIO ioctls. It returns -1
1182 * if it didn't recognize the request, and in turn we return
1183 * -1 if we didn't recognize the request.
1184 */
1185 /* printf("kbdaccess\n"); */
1186 error = (*sc->sc_accessops->ioctl)(sc->sc_accesscookie, cmd, data,
1187 flag, l);
1188 #ifdef WSDISPLAY_COMPAT_RAWKBD
1189 if (!error && cmd == WSKBDIO_SETMODE && *(int *)data == WSKBD_RAW) {
1190 int s = spltty();
1191 sc->id->t_modifiers &= ~(MOD_SHIFT_L | MOD_SHIFT_R
1192 | MOD_CONTROL_L | MOD_CONTROL_R
1193 | MOD_META_L | MOD_META_R
1194 | MOD_COMMAND
1195 | MOD_COMMAND1 | MOD_COMMAND2);
1196 if (sc->sc_repeating) {
1197 sc->sc_repeating = 0;
1198 callout_stop(&sc->sc_repeat_ch);
1199 }
1200 splx(s);
1201 }
1202 #endif
1203 return (error);
1204 }
1205
1206 int
1207 wskbdpoll(dev_t dev, int events, struct lwp *l)
1208 {
1209 struct wskbd_softc *sc = wskbd_cd.cd_devs[minor(dev)];
1210
1211 if (sc->sc_base.me_evp == NULL)
1212 return (POLLERR);
1213 return (wsevent_poll(sc->sc_base.me_evp, events, l));
1214 }
1215
1216 int
1217 wskbdkqfilter(dev_t dev, struct knote *kn)
1218 {
1219 struct wskbd_softc *sc = wskbd_cd.cd_devs[minor(dev)];
1220
1221 if (sc->sc_base.me_evp == NULL)
1222 return (1);
1223 return (wsevent_kqfilter(sc->sc_base.me_evp, kn));
1224 }
1225
1226 #if NWSDISPLAY > 0
1227
1228 int
1229 wskbd_pickfree(void)
1230 {
1231 int i;
1232 struct wskbd_softc *sc;
1233
1234 for (i = 0; i < wskbd_cd.cd_ndevs; i++) {
1235 if ((sc = wskbd_cd.cd_devs[i]) == NULL)
1236 continue;
1237 if (sc->sc_base.me_dispdv == NULL)
1238 return (i);
1239 }
1240 return (-1);
1241 }
1242
1243 struct wsevsrc *
1244 wskbd_set_console_display(struct device *displaydv, struct wsevsrc *me)
1245 {
1246 struct wskbd_softc *sc = wskbd_console_device;
1247
1248 if (sc == NULL)
1249 return (NULL);
1250 sc->sc_base.me_dispdv = displaydv;
1251 #if NWSMUX > 0
1252 (void)wsmux_attach_sc((struct wsmux_softc *)me, &sc->sc_base);
1253 #endif
1254 return (&sc->sc_base);
1255 }
1256
1257 int
1258 wskbd_set_display(struct device *dv, struct wsevsrc *me)
1259 {
1260 struct wskbd_softc *sc = (struct wskbd_softc *)dv;
1261 struct device *displaydv = me != NULL ? me->me_dispdv : NULL;
1262 struct device *odisplaydv;
1263 int error;
1264
1265 DPRINTF(("wskbd_set_display: %s me=%p odisp=%p disp=%p cons=%d\n",
1266 dv->dv_xname, me, sc->sc_base.me_dispdv, displaydv,
1267 sc->sc_isconsole));
1268
1269 if (sc->sc_isconsole)
1270 return (EBUSY);
1271
1272 if (displaydv != NULL) {
1273 if (sc->sc_base.me_dispdv != NULL)
1274 return (EBUSY);
1275 } else {
1276 if (sc->sc_base.me_dispdv == NULL)
1277 return (ENXIO);
1278 }
1279
1280 odisplaydv = sc->sc_base.me_dispdv;
1281 sc->sc_base.me_dispdv = NULL;
1282 error = wskbd_enable(sc, displaydv != NULL);
1283 sc->sc_base.me_dispdv = displaydv;
1284 if (error) {
1285 sc->sc_base.me_dispdv = odisplaydv;
1286 return (error);
1287 }
1288
1289 if (displaydv)
1290 aprint_verbose("%s: connecting to %s\n",
1291 sc->sc_base.me_dv.dv_xname, displaydv->dv_xname);
1292 else
1293 aprint_verbose("%s: disconnecting from %s\n",
1294 sc->sc_base.me_dv.dv_xname, odisplaydv->dv_xname);
1295
1296 return (0);
1297 }
1298
1299 #endif /* NWSDISPLAY > 0 */
1300
1301 #if NWSMUX > 0
1302 int
1303 wskbd_add_mux(int unit, struct wsmux_softc *muxsc)
1304 {
1305 struct wskbd_softc *sc;
1306
1307 if (unit < 0 || unit >= wskbd_cd.cd_ndevs ||
1308 (sc = wskbd_cd.cd_devs[unit]) == NULL)
1309 return (ENXIO);
1310
1311 if (sc->sc_base.me_parent != NULL || sc->sc_base.me_evp != NULL)
1312 return (EBUSY);
1313
1314 return (wsmux_attach_sc(muxsc, &sc->sc_base));
1315 }
1316 #endif
1317
1318 /*
1319 * Console interface.
1320 */
1321 int
1322 wskbd_cngetc(dev_t dev)
1323 {
1324 static int num = 0;
1325 static int pos;
1326 u_int type;
1327 int data;
1328 keysym_t ks;
1329
1330 if (!wskbd_console_initted)
1331 return 0;
1332
1333 if (wskbd_console_device != NULL &&
1334 !wskbd_console_device->sc_translating)
1335 return 0;
1336
1337 for(;;) {
1338 if (num-- > 0) {
1339 ks = wskbd_console_data.t_symbols[pos++];
1340 if (KS_GROUP(ks) == KS_GROUP_Ascii)
1341 return (KS_VALUE(ks));
1342 } else {
1343 (*wskbd_console_data.t_consops->getc)
1344 (wskbd_console_data.t_consaccesscookie,
1345 &type, &data);
1346 if (type == WSCONS_EVENT_ASCII) {
1347 /*
1348 * We assume that when the driver falls back
1349 * to deliver pure ASCII it is in a state that
1350 * it can not track press/release events
1351 * reliable - so we clear all previously
1352 * accumulated modifier state.
1353 */
1354 wskbd_console_data.t_modifiers = 0;
1355 return(data);
1356 }
1357 num = wskbd_translate(&wskbd_console_data, type, data);
1358 pos = 0;
1359 }
1360 }
1361 }
1362
1363 void
1364 wskbd_cnpollc(dev_t dev, int poll)
1365 {
1366
1367 if (!wskbd_console_initted)
1368 return;
1369
1370 if (wskbd_console_device != NULL &&
1371 !wskbd_console_device->sc_translating)
1372 return;
1373
1374 (*wskbd_console_data.t_consops->pollc)
1375 (wskbd_console_data.t_consaccesscookie, poll);
1376 }
1377
1378 void
1379 wskbd_cnbell(dev_t dev, u_int pitch, u_int period, u_int volume)
1380 {
1381
1382 if (!wskbd_console_initted)
1383 return;
1384
1385 if (wskbd_console_data.t_consops->bell != NULL)
1386 (*wskbd_console_data.t_consops->bell)
1387 (wskbd_console_data.t_consaccesscookie, pitch, period,
1388 volume);
1389 }
1390
1391 static inline void
1392 update_leds(struct wskbd_internal *id)
1393 {
1394 int new_state;
1395
1396 new_state = 0;
1397 if (id->t_modifiers & (MOD_SHIFTLOCK | MOD_CAPSLOCK))
1398 new_state |= WSKBD_LED_CAPS;
1399 if (id->t_modifiers & MOD_NUMLOCK)
1400 new_state |= WSKBD_LED_NUM;
1401 if (id->t_modifiers & MOD_COMPOSE)
1402 new_state |= WSKBD_LED_COMPOSE;
1403 if (id->t_modifiers & MOD_HOLDSCREEN)
1404 new_state |= WSKBD_LED_SCROLL;
1405
1406 if (id->t_sc && new_state != id->t_sc->sc_ledstate) {
1407 (*id->t_sc->sc_accessops->set_leds)
1408 (id->t_sc->sc_accesscookie, new_state);
1409 id->t_sc->sc_ledstate = new_state;
1410 }
1411 }
1412
1413 static inline void
1414 update_modifier(struct wskbd_internal *id, u_int type, int toggle, int mask)
1415 {
1416 if (toggle) {
1417 if (type == WSCONS_EVENT_KEY_DOWN)
1418 id->t_modifiers ^= mask;
1419 } else {
1420 if (type == WSCONS_EVENT_KEY_DOWN)
1421 id->t_modifiers |= mask;
1422 else
1423 id->t_modifiers &= ~mask;
1424 }
1425 }
1426
1427 #if NWSDISPLAY > 0
1428 static void
1429 change_displayparam(struct wskbd_softc *sc, int param, int updown,
1430 int wraparound)
1431 {
1432 int res;
1433 struct wsdisplay_param dp;
1434
1435 dp.param = param;
1436 res = wsdisplay_param(sc->sc_base.me_dispdv, WSDISPLAYIO_GETPARAM, &dp);
1437
1438 if (res == EINVAL)
1439 return; /* no such parameter */
1440
1441 dp.curval += updown;
1442 if (dp.max < dp.curval)
1443 dp.curval = wraparound ? dp.min : dp.max;
1444 else
1445 if (dp.curval < dp.min)
1446 dp.curval = wraparound ? dp.max : dp.min;
1447 wsdisplay_param(sc->sc_base.me_dispdv, WSDISPLAYIO_SETPARAM, &dp);
1448 }
1449 #endif
1450
1451 static int
1452 internal_command(struct wskbd_softc *sc, u_int *type, keysym_t ksym,
1453 keysym_t ksym2)
1454 {
1455 #ifdef WSDISPLAY_SCROLLSUPPORT
1456 u_int state = 0;
1457 #endif
1458 switch (ksym) {
1459 case KS_Cmd_VolumeToggle:
1460 if (*type == WSCONS_EVENT_KEY_DOWN)
1461 pnp_power_audio(NULL, PNP_ACTION_VOLUME_MUTE);
1462 break;
1463 case KS_Cmd_VolumeUp:
1464 if (*type == WSCONS_EVENT_KEY_DOWN)
1465 pnp_power_audio(NULL, PNP_ACTION_VOLUME_UP);
1466 break;
1467 case KS_Cmd_VolumeDown:
1468 if (*type == WSCONS_EVENT_KEY_DOWN)
1469 pnp_power_audio(NULL, PNP_ACTION_VOLUME_DOWN);
1470 break;
1471 #ifdef WSDISPLAY_SCROLLSUPPORT
1472 case KS_Cmd_ScrollFastUp:
1473 case KS_Cmd_ScrollFastDown:
1474 if (*type == WSCONS_EVENT_KEY_DOWN) {
1475 GETMODSTATE(sc->id->t_modifiers, state);
1476 if ((sc->sc_scroll_data.mode == WSKBD_SCROLL_MODE_HOLD
1477 && MOD_ONESET(sc->id, MOD_HOLDSCREEN))
1478 || (sc->sc_scroll_data.mode == WSKBD_SCROLL_MODE_NORMAL
1479 && sc->sc_scroll_data.modifier == state)) {
1480 update_modifier(sc->id, *type, 0, MOD_COMMAND);
1481 wsdisplay_scroll(sc->sc_base.me_dispdv,
1482 (ksym == KS_Cmd_ScrollFastUp) ?
1483 WSDISPLAY_SCROLL_BACKWARD :
1484 WSDISPLAY_SCROLL_FORWARD);
1485 return (1);
1486 } else {
1487 return (0);
1488 }
1489 }
1490
1491 case KS_Cmd_ScrollSlowUp:
1492 case KS_Cmd_ScrollSlowDown:
1493 if (*type == WSCONS_EVENT_KEY_DOWN) {
1494 GETMODSTATE(sc->id->t_modifiers, state);
1495 if ((sc->sc_scroll_data.mode == WSKBD_SCROLL_MODE_HOLD
1496 && MOD_ONESET(sc->id, MOD_HOLDSCREEN))
1497 || (sc->sc_scroll_data.mode == WSKBD_SCROLL_MODE_NORMAL
1498 && sc->sc_scroll_data.modifier == state)) {
1499 update_modifier(sc->id, *type, 0, MOD_COMMAND);
1500 wsdisplay_scroll(sc->sc_base.me_dispdv,
1501 (ksym == KS_Cmd_ScrollSlowUp) ?
1502 WSDISPLAY_SCROLL_BACKWARD | WSDISPLAY_SCROLL_LOW:
1503 WSDISPLAY_SCROLL_FORWARD | WSDISPLAY_SCROLL_LOW);
1504 return (1);
1505 } else {
1506 return (0);
1507 }
1508 }
1509 #endif
1510
1511 case KS_Cmd:
1512 update_modifier(sc->id, *type, 0, MOD_COMMAND);
1513 ksym = ksym2;
1514 break;
1515
1516 case KS_Cmd1:
1517 update_modifier(sc->id, *type, 0, MOD_COMMAND1);
1518 break;
1519
1520 case KS_Cmd2:
1521 update_modifier(sc->id, *type, 0, MOD_COMMAND2);
1522 break;
1523 }
1524
1525 if (*type != WSCONS_EVENT_KEY_DOWN ||
1526 (! MOD_ONESET(sc->id, MOD_COMMAND) &&
1527 ! MOD_ALLSET(sc->id, MOD_COMMAND1 | MOD_COMMAND2)))
1528 return (0);
1529
1530 #if defined(DDB) || defined(KGDB)
1531 if (ksym == KS_Cmd_Debugger) {
1532 if (sc->sc_isconsole) {
1533 #ifdef DDB
1534 console_debugger();
1535 #endif
1536 #ifdef KGDB
1537 kgdb_connect(1);
1538 #endif
1539 }
1540 /* discard this key (ddb discarded command modifiers) */
1541 *type = WSCONS_EVENT_KEY_UP;
1542 return (1);
1543 }
1544 #endif
1545
1546 #if NWSDISPLAY > 0
1547 if (sc->sc_base.me_dispdv == NULL)
1548 return (0);
1549
1550 switch (ksym) {
1551 case KS_Cmd_Screen0:
1552 case KS_Cmd_Screen1:
1553 case KS_Cmd_Screen2:
1554 case KS_Cmd_Screen3:
1555 case KS_Cmd_Screen4:
1556 case KS_Cmd_Screen5:
1557 case KS_Cmd_Screen6:
1558 case KS_Cmd_Screen7:
1559 case KS_Cmd_Screen8:
1560 case KS_Cmd_Screen9:
1561 wsdisplay_switch(sc->sc_base.me_dispdv, ksym - KS_Cmd_Screen0, 0);
1562 return (1);
1563 case KS_Cmd_ResetEmul:
1564 wsdisplay_reset(sc->sc_base.me_dispdv, WSDISPLAY_RESETEMUL);
1565 return (1);
1566 case KS_Cmd_ResetClose:
1567 wsdisplay_reset(sc->sc_base.me_dispdv, WSDISPLAY_RESETCLOSE);
1568 return (1);
1569 case KS_Cmd_BacklightOn:
1570 case KS_Cmd_BacklightOff:
1571 case KS_Cmd_BacklightToggle:
1572 change_displayparam(sc, WSDISPLAYIO_PARAM_BACKLIGHT,
1573 ksym == KS_Cmd_BacklightOff ? -1 : 1,
1574 ksym == KS_Cmd_BacklightToggle ? 1 : 0);
1575 return (1);
1576 case KS_Cmd_BrightnessUp:
1577 case KS_Cmd_BrightnessDown:
1578 case KS_Cmd_BrightnessRotate:
1579 change_displayparam(sc, WSDISPLAYIO_PARAM_BRIGHTNESS,
1580 ksym == KS_Cmd_BrightnessDown ? -1 : 1,
1581 ksym == KS_Cmd_BrightnessRotate ? 1 : 0);
1582 return (1);
1583 case KS_Cmd_ContrastUp:
1584 case KS_Cmd_ContrastDown:
1585 case KS_Cmd_ContrastRotate:
1586 change_displayparam(sc, WSDISPLAYIO_PARAM_CONTRAST,
1587 ksym == KS_Cmd_ContrastDown ? -1 : 1,
1588 ksym == KS_Cmd_ContrastRotate ? 1 : 0);
1589 return (1);
1590 }
1591 #endif
1592
1593 return (0);
1594 }
1595
1596 static int
1597 wskbd_translate(struct wskbd_internal *id, u_int type, int value)
1598 {
1599 struct wskbd_softc *sc = id->t_sc;
1600 keysym_t ksym, res, *group;
1601 struct wscons_keymap kpbuf, *kp;
1602 int iscommand = 0;
1603
1604 if (type == WSCONS_EVENT_ALL_KEYS_UP) {
1605 id->t_modifiers &= ~(MOD_SHIFT_L | MOD_SHIFT_R
1606 | MOD_CONTROL_L | MOD_CONTROL_R
1607 | MOD_META_L | MOD_META_R
1608 | MOD_MODESHIFT
1609 | MOD_COMMAND | MOD_COMMAND1 | MOD_COMMAND2);
1610 update_leds(id);
1611 return (0);
1612 }
1613
1614 if (sc != NULL) {
1615 if (value < 0 || value >= sc->sc_maplen) {
1616 #ifdef DEBUG
1617 printf("wskbd_translate: keycode %d out of range\n",
1618 value);
1619 #endif
1620 return (0);
1621 }
1622 kp = sc->sc_map + value;
1623 } else {
1624 kp = &kpbuf;
1625 wskbd_get_mapentry(id->t_keymap, value, kp);
1626 }
1627
1628 /* if this key has a command, process it first */
1629 if (sc != NULL && kp->command != KS_voidSymbol)
1630 iscommand = internal_command(sc, &type, kp->command,
1631 kp->group1[0]);
1632
1633 /* Now update modifiers */
1634 switch (kp->group1[0]) {
1635 case KS_Shift_L:
1636 update_modifier(id, type, 0, MOD_SHIFT_L);
1637 break;
1638
1639 case KS_Shift_R:
1640 update_modifier(id, type, 0, MOD_SHIFT_R);
1641 break;
1642
1643 case KS_Shift_Lock:
1644 update_modifier(id, type, 1, MOD_SHIFTLOCK);
1645 break;
1646
1647 case KS_Caps_Lock:
1648 update_modifier(id, type, 1, MOD_CAPSLOCK);
1649 break;
1650
1651 case KS_Control_L:
1652 update_modifier(id, type, 0, MOD_CONTROL_L);
1653 break;
1654
1655 case KS_Control_R:
1656 update_modifier(id, type, 0, MOD_CONTROL_R);
1657 break;
1658
1659 case KS_Alt_L:
1660 update_modifier(id, type, 0, MOD_META_L);
1661 break;
1662
1663 case KS_Alt_R:
1664 update_modifier(id, type, 0, MOD_META_R);
1665 break;
1666
1667 case KS_Mode_switch:
1668 update_modifier(id, type, 0, MOD_MODESHIFT);
1669 break;
1670
1671 case KS_Num_Lock:
1672 update_modifier(id, type, 1, MOD_NUMLOCK);
1673 break;
1674
1675 #if NWSDISPLAY > 0
1676 case KS_Hold_Screen:
1677 if (sc != NULL) {
1678 update_modifier(id, type, 1, MOD_HOLDSCREEN);
1679 wskbd_holdscreen(sc, id->t_modifiers & MOD_HOLDSCREEN);
1680 }
1681 break;
1682 #endif
1683 }
1684
1685 /* If this is a key release or we are in command mode, we are done */
1686 if (type != WSCONS_EVENT_KEY_DOWN || iscommand) {
1687 update_leds(id);
1688 return (0);
1689 }
1690
1691 /* Get the keysym */
1692 if (id->t_modifiers & MOD_MODESHIFT)
1693 group = & kp->group2[0];
1694 else
1695 group = & kp->group1[0];
1696
1697 if ((id->t_modifiers & MOD_NUMLOCK) != 0 &&
1698 KS_GROUP(group[1]) == KS_GROUP_Keypad) {
1699 if (MOD_ONESET(id, MOD_ANYSHIFT))
1700 ksym = group[0];
1701 else
1702 ksym = group[1];
1703 } else if (! MOD_ONESET(id, MOD_ANYSHIFT | MOD_CAPSLOCK)) {
1704 ksym = group[0];
1705 } else if (MOD_ONESET(id, MOD_CAPSLOCK)) {
1706 if (! MOD_ONESET(id, MOD_SHIFT_L | MOD_SHIFT_R))
1707 ksym = group[0];
1708 else
1709 ksym = group[1];
1710 if (ksym >= KS_a && ksym <= KS_z)
1711 ksym += KS_A - KS_a;
1712 else if (ksym >= KS_agrave && ksym <= KS_thorn &&
1713 ksym != KS_division)
1714 ksym += KS_Agrave - KS_agrave;
1715 } else if (MOD_ONESET(id, MOD_ANYSHIFT)) {
1716 ksym = group[1];
1717 } else {
1718 ksym = group[0];
1719 }
1720
1721 /* Process compose sequence and dead accents */
1722 res = KS_voidSymbol;
1723
1724 switch (KS_GROUP(ksym)) {
1725 case KS_GROUP_Ascii:
1726 case KS_GROUP_Keypad:
1727 case KS_GROUP_Function:
1728 res = ksym;
1729 break;
1730
1731 case KS_GROUP_Mod:
1732 if (ksym == KS_Multi_key) {
1733 update_modifier(id, 1, 0, MOD_COMPOSE);
1734 id->t_composelen = 2;
1735 }
1736 break;
1737
1738 case KS_GROUP_Dead:
1739 if (id->t_composelen == 0) {
1740 update_modifier(id, 1, 0, MOD_COMPOSE);
1741 id->t_composelen = 1;
1742 id->t_composebuf[0] = ksym;
1743 } else
1744 res = ksym;
1745 break;
1746 }
1747
1748 if (res == KS_voidSymbol) {
1749 update_leds(id);
1750 return (0);
1751 }
1752
1753 if (id->t_composelen > 0) {
1754 id->t_composebuf[2 - id->t_composelen] = res;
1755 if (--id->t_composelen == 0) {
1756 res = wskbd_compose_value(id->t_composebuf);
1757 update_modifier(id, 0, 0, MOD_COMPOSE);
1758 } else {
1759 return (0);
1760 }
1761 }
1762
1763 update_leds(id);
1764
1765 /* We are done, return the symbol */
1766 if (KS_GROUP(res) == KS_GROUP_Ascii) {
1767 if (MOD_ONESET(id, MOD_ANYCONTROL)) {
1768 if ((res >= KS_at && res <= KS_z) || res == KS_space)
1769 res = res & 0x1f;
1770 else if (res == KS_2)
1771 res = 0x00;
1772 else if (res >= KS_3 && res <= KS_7)
1773 res = KS_Escape + (res - KS_3);
1774 else if (res == KS_8)
1775 res = KS_Delete;
1776 }
1777 if (MOD_ONESET(id, MOD_ANYMETA)) {
1778 if (id->t_flags & WSKFL_METAESC) {
1779 id->t_symbols[0] = KS_Escape;
1780 id->t_symbols[1] = res;
1781 return (2);
1782 } else
1783 res |= 0x80;
1784 }
1785 }
1786
1787 id->t_symbols[0] = res;
1788 return (1);
1789 }
1790