1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright (c) 1999 Kazutaka YOKOTA <[email protected]>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer as
12 * the first lines of this file unmodified.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 */
29
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32
33 #include "opt_kbd.h"
34
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/kernel.h>
38 #include <sys/malloc.h>
39 #include <sys/conf.h>
40 #include <sys/fcntl.h>
41 #include <sys/poll.h>
42 #include <sys/priv.h>
43 #include <sys/proc.h>
44 #include <sys/selinfo.h>
45 #include <sys/sysctl.h>
46 #include <sys/uio.h>
47
48 #include <sys/kbio.h>
49
50 #include <dev/evdev/input-event-codes.h>
51 #include <dev/kbd/kbdreg.h>
52
53 #define KBD_INDEX(dev) dev2unit(dev)
54
55 #define KB_QSIZE 512
56 #define KB_BUFSIZE 64
57
58 typedef struct genkbd_softc {
59 int gkb_flags; /* flag/status bits */
60 #define KB_ASLEEP (1 << 0)
61 struct selinfo gkb_rsel;
62 char gkb_q[KB_QSIZE]; /* input queue */
63 unsigned int gkb_q_start;
64 unsigned int gkb_q_length;
65 } genkbd_softc_t;
66
67 static u_char *genkbd_get_fkeystr(keyboard_t *kbd, int fkey, size_t *len);
68 static void genkbd_diag(keyboard_t *kbd, int level);
69
70 static SLIST_HEAD(, keyboard_driver) keyboard_drivers =
71 SLIST_HEAD_INITIALIZER(keyboard_drivers);
72
73 SET_DECLARE(kbddriver_set, keyboard_driver_t);
74
75 /* local arrays */
76
77 /*
78 * We need at least one entry each in order to initialize a keyboard
79 * for the kernel console. The arrays will be increased dynamically
80 * when necessary.
81 */
82
83 static int keyboards = 1;
84 static keyboard_t *kbd_ini;
85 static keyboard_t **keyboard = &kbd_ini;
86
87 static int keymap_restrict_change;
88 static SYSCTL_NODE(_hw, OID_AUTO, kbd, CTLFLAG_RD | CTLFLAG_MPSAFE, 0,
89 "kbd");
90 SYSCTL_INT(_hw_kbd, OID_AUTO, keymap_restrict_change, CTLFLAG_RW,
91 &keymap_restrict_change, 0, "restrict ability to change keymap");
92
93 #define ARRAY_DELTA 4
94
95 static int
kbd_realloc_array(void)96 kbd_realloc_array(void)
97 {
98 keyboard_t **new_kbd;
99 int newsize;
100 int s;
101
102 s = spltty();
103 newsize = rounddown(keyboards + ARRAY_DELTA, ARRAY_DELTA);
104 new_kbd = malloc(sizeof(*new_kbd)*newsize, M_DEVBUF, M_NOWAIT|M_ZERO);
105 if (new_kbd == NULL) {
106 splx(s);
107 return (ENOMEM);
108 }
109 bcopy(keyboard, new_kbd, sizeof(*keyboard)*keyboards);
110 if (keyboards > 1)
111 free(keyboard, M_DEVBUF);
112 keyboard = new_kbd;
113 keyboards = newsize;
114 splx(s);
115
116 if (bootverbose)
117 printf("kbd: new array size %d\n", keyboards);
118
119 return (0);
120 }
121
122 /*
123 * Low-level keyboard driver functions
124 * Keyboard subdrivers, such as the AT keyboard driver and the USB keyboard
125 * driver, call these functions to initialize the keyboard_t structure
126 * and register it to the virtual keyboard driver `kbd'.
127 */
128
129 /* initialize the keyboard_t structure */
130 void
kbd_init_struct(keyboard_t * kbd,char * name,int type,int unit,int config,int port,int port_size)131 kbd_init_struct(keyboard_t *kbd, char *name, int type, int unit, int config,
132 int port, int port_size)
133 {
134 kbd->kb_flags = KB_NO_DEVICE; /* device has not been found */
135 kbd->kb_name = name;
136 kbd->kb_type = type;
137 kbd->kb_unit = unit;
138 kbd->kb_config = config & ~KB_CONF_PROBE_ONLY;
139 kbd->kb_led = 0; /* unknown */
140 kbd->kb_io_base = port;
141 kbd->kb_io_size = port_size;
142 kbd->kb_data = NULL;
143 kbd->kb_keymap = NULL;
144 kbd->kb_accentmap = NULL;
145 kbd->kb_fkeytab = NULL;
146 kbd->kb_fkeytab_size = 0;
147 kbd->kb_delay1 = KB_DELAY1; /* these values are advisory only */
148 kbd->kb_delay2 = KB_DELAY2;
149 kbd->kb_count = 0L;
150 bzero(kbd->kb_lastact, sizeof(kbd->kb_lastact));
151 }
152
153 void
kbd_set_maps(keyboard_t * kbd,keymap_t * keymap,accentmap_t * accmap,fkeytab_t * fkeymap,int fkeymap_size)154 kbd_set_maps(keyboard_t *kbd, keymap_t *keymap, accentmap_t *accmap,
155 fkeytab_t *fkeymap, int fkeymap_size)
156 {
157 kbd->kb_keymap = keymap;
158 kbd->kb_accentmap = accmap;
159 kbd->kb_fkeytab = fkeymap;
160 kbd->kb_fkeytab_size = fkeymap_size;
161 }
162
163 /* declare a new keyboard driver */
164 int
kbd_add_driver(keyboard_driver_t * driver)165 kbd_add_driver(keyboard_driver_t *driver)
166 {
167
168 if ((driver->flags & KBDF_REGISTERED) != 0)
169 return (0);
170
171 KASSERT(SLIST_NEXT(driver, link) == NULL,
172 ("%s: keyboard driver list garbage detected", __func__));
173 if (driver->kbdsw->get_fkeystr == NULL)
174 driver->kbdsw->get_fkeystr = genkbd_get_fkeystr;
175 if (driver->kbdsw->diag == NULL)
176 driver->kbdsw->diag = genkbd_diag;
177
178 driver->flags |= KBDF_REGISTERED;
179 SLIST_INSERT_HEAD(&keyboard_drivers, driver, link);
180 return (0);
181 }
182
183 int
kbd_delete_driver(keyboard_driver_t * driver)184 kbd_delete_driver(keyboard_driver_t *driver)
185 {
186
187 if ((driver->flags & KBDF_REGISTERED) == 0)
188 return (EINVAL);
189
190 driver->flags &= ~KBDF_REGISTERED;
191 SLIST_REMOVE(&keyboard_drivers, driver, keyboard_driver, link);
192 SLIST_NEXT(driver, link) = NULL;
193 return (0);
194 }
195
196 /* register a keyboard and associate it with a function table */
197 int
kbd_register(keyboard_t * kbd)198 kbd_register(keyboard_t *kbd)
199 {
200 const keyboard_driver_t *p;
201 keyboard_t *mux;
202 keyboard_info_t ki;
203 int index;
204
205 mux = kbd_get_keyboard(kbd_find_keyboard("kbdmux", -1));
206
207 for (index = 0; index < keyboards; ++index) {
208 if (keyboard[index] == NULL)
209 break;
210 }
211 if (index >= keyboards) {
212 if (kbd_realloc_array())
213 return (-1);
214 }
215
216 kbd->kb_index = index;
217 KBD_UNBUSY(kbd);
218 KBD_VALID(kbd);
219 kbd->kb_active = 0; /* disabled until someone calls kbd_enable() */
220 kbd->kb_token = NULL;
221 kbd->kb_callback.kc_func = NULL;
222 kbd->kb_callback.kc_arg = NULL;
223
224 SLIST_FOREACH(p, &keyboard_drivers, link) {
225 if (strcmp(p->name, kbd->kb_name) == 0) {
226 kbd->kb_drv = p;
227 keyboard[index] = kbd;
228
229 if (mux != NULL) {
230 bzero(&ki, sizeof(ki));
231 strcpy(ki.kb_name, kbd->kb_name);
232 ki.kb_unit = kbd->kb_unit;
233
234 (void)kbdd_ioctl(mux, KBADDKBD, (caddr_t) &ki);
235 }
236
237 return (index);
238 }
239 }
240
241 return (-1);
242 }
243
244 int
kbd_unregister(keyboard_t * kbd)245 kbd_unregister(keyboard_t *kbd)
246 {
247 int error;
248 int s;
249
250 if ((kbd->kb_index < 0) || (kbd->kb_index >= keyboards))
251 return (ENOENT);
252 if (keyboard[kbd->kb_index] != kbd)
253 return (ENOENT);
254
255 s = spltty();
256 if (KBD_IS_BUSY(kbd)) {
257 error = (*kbd->kb_callback.kc_func)(kbd, KBDIO_UNLOADING,
258 kbd->kb_callback.kc_arg);
259 if (error) {
260 splx(s);
261 return (error);
262 }
263 if (KBD_IS_BUSY(kbd)) {
264 splx(s);
265 return (EBUSY);
266 }
267 }
268 KBD_INVALID(kbd);
269 keyboard[kbd->kb_index] = NULL;
270
271 splx(s);
272 return (0);
273 }
274
275 /* find a function table by the driver name */
276 keyboard_switch_t *
kbd_get_switch(char * driver)277 kbd_get_switch(char *driver)
278 {
279 const keyboard_driver_t *p;
280
281 SLIST_FOREACH(p, &keyboard_drivers, link) {
282 if (strcmp(p->name, driver) == 0)
283 return (p->kbdsw);
284 }
285
286 return (NULL);
287 }
288
289 /*
290 * Keyboard client functions
291 * Keyboard clients, such as the console driver `syscons' and the keyboard
292 * cdev driver, use these functions to claim and release a keyboard for
293 * exclusive use.
294 */
295
296 /*
297 * find the keyboard specified by a driver name and a unit number
298 * starting at given index
299 */
300 int
kbd_find_keyboard2(char * driver,int unit,int index)301 kbd_find_keyboard2(char *driver, int unit, int index)
302 {
303 int i;
304
305 if ((index < 0) || (index >= keyboards))
306 return (-1);
307
308 for (i = index; i < keyboards; ++i) {
309 if (keyboard[i] == NULL)
310 continue;
311 if (!KBD_IS_VALID(keyboard[i]))
312 continue;
313 if (strcmp("*", driver) && strcmp(keyboard[i]->kb_name, driver))
314 continue;
315 if ((unit != -1) && (keyboard[i]->kb_unit != unit))
316 continue;
317 return (i);
318 }
319
320 return (-1);
321 }
322
323 /* find the keyboard specified by a driver name and a unit number */
324 int
kbd_find_keyboard(char * driver,int unit)325 kbd_find_keyboard(char *driver, int unit)
326 {
327 return (kbd_find_keyboard2(driver, unit, 0));
328 }
329
330 /* allocate a keyboard */
331 int
kbd_allocate(char * driver,int unit,void * id,kbd_callback_func_t * func,void * arg)332 kbd_allocate(char *driver, int unit, void *id, kbd_callback_func_t *func,
333 void *arg)
334 {
335 int index;
336 int s;
337
338 if (func == NULL)
339 return (-1);
340
341 s = spltty();
342 index = kbd_find_keyboard(driver, unit);
343 if (index >= 0) {
344 if (KBD_IS_BUSY(keyboard[index])) {
345 splx(s);
346 return (-1);
347 }
348 keyboard[index]->kb_token = id;
349 KBD_BUSY(keyboard[index]);
350 keyboard[index]->kb_callback.kc_func = func;
351 keyboard[index]->kb_callback.kc_arg = arg;
352 kbdd_clear_state(keyboard[index]);
353 }
354 splx(s);
355 return (index);
356 }
357
358 int
kbd_release(keyboard_t * kbd,void * id)359 kbd_release(keyboard_t *kbd, void *id)
360 {
361 int error;
362 int s;
363
364 s = spltty();
365 if (!KBD_IS_VALID(kbd) || !KBD_IS_BUSY(kbd)) {
366 error = EINVAL;
367 } else if (kbd->kb_token != id) {
368 error = EPERM;
369 } else {
370 kbd->kb_token = NULL;
371 KBD_UNBUSY(kbd);
372 kbd->kb_callback.kc_func = NULL;
373 kbd->kb_callback.kc_arg = NULL;
374 kbdd_clear_state(kbd);
375 error = 0;
376 }
377 splx(s);
378 return (error);
379 }
380
381 int
kbd_change_callback(keyboard_t * kbd,void * id,kbd_callback_func_t * func,void * arg)382 kbd_change_callback(keyboard_t *kbd, void *id, kbd_callback_func_t *func,
383 void *arg)
384 {
385 int error;
386 int s;
387
388 s = spltty();
389 if (!KBD_IS_VALID(kbd) || !KBD_IS_BUSY(kbd)) {
390 error = EINVAL;
391 } else if (kbd->kb_token != id) {
392 error = EPERM;
393 } else if (func == NULL) {
394 error = EINVAL;
395 } else {
396 kbd->kb_callback.kc_func = func;
397 kbd->kb_callback.kc_arg = arg;
398 error = 0;
399 }
400 splx(s);
401 return (error);
402 }
403
404 /* get a keyboard structure */
405 keyboard_t *
kbd_get_keyboard(int index)406 kbd_get_keyboard(int index)
407 {
408 if ((index < 0) || (index >= keyboards))
409 return (NULL);
410 if (keyboard[index] == NULL)
411 return (NULL);
412 if (!KBD_IS_VALID(keyboard[index]))
413 return (NULL);
414 return (keyboard[index]);
415 }
416
417 /*
418 * The back door for the console driver; configure keyboards
419 * This function is for the kernel console to initialize keyboards
420 * at very early stage.
421 */
422
423 int
kbd_configure(int flags)424 kbd_configure(int flags)
425 {
426 const keyboard_driver_t *p;
427
428 SLIST_FOREACH(p, &keyboard_drivers, link) {
429 if (p->configure != NULL)
430 (*p->configure)(flags);
431 }
432
433 return (0);
434 }
435
436 #ifdef KBD_INSTALL_CDEV
437
438 /*
439 * Virtual keyboard cdev driver functions
440 * The virtual keyboard driver dispatches driver functions to
441 * appropriate subdrivers.
442 */
443
444 #define KBD_UNIT(dev) dev2unit(dev)
445
446 static d_open_t genkbdopen;
447 static d_close_t genkbdclose;
448 static d_read_t genkbdread;
449 static d_write_t genkbdwrite;
450 static d_ioctl_t genkbdioctl;
451 static d_poll_t genkbdpoll;
452
453
454 static struct cdevsw kbd_cdevsw = {
455 .d_version = D_VERSION,
456 .d_flags = D_NEEDGIANT | D_GIANTOK,
457 .d_open = genkbdopen,
458 .d_close = genkbdclose,
459 .d_read = genkbdread,
460 .d_write = genkbdwrite,
461 .d_ioctl = genkbdioctl,
462 .d_poll = genkbdpoll,
463 .d_name = "kbd",
464 };
465
466 int
kbd_attach(keyboard_t * kbd)467 kbd_attach(keyboard_t *kbd)
468 {
469
470 if (kbd->kb_index >= keyboards)
471 return (EINVAL);
472 if (keyboard[kbd->kb_index] != kbd)
473 return (EINVAL);
474
475 kbd->kb_dev = make_dev(&kbd_cdevsw, kbd->kb_index, UID_ROOT, GID_WHEEL,
476 0600, "%s%r", kbd->kb_name, kbd->kb_unit);
477 make_dev_alias(kbd->kb_dev, "kbd%r", kbd->kb_index);
478 kbd->kb_dev->si_drv1 = malloc(sizeof(genkbd_softc_t), M_DEVBUF,
479 M_WAITOK | M_ZERO);
480 printf("kbd%d at %s%d\n", kbd->kb_index, kbd->kb_name, kbd->kb_unit);
481 return (0);
482 }
483
484 int
kbd_detach(keyboard_t * kbd)485 kbd_detach(keyboard_t *kbd)
486 {
487
488 if (kbd->kb_index >= keyboards)
489 return (EINVAL);
490 if (keyboard[kbd->kb_index] != kbd)
491 return (EINVAL);
492
493 free(kbd->kb_dev->si_drv1, M_DEVBUF);
494 destroy_dev(kbd->kb_dev);
495
496 return (0);
497 }
498
499 /*
500 * Generic keyboard cdev driver functions
501 * Keyboard subdrivers may call these functions to implement common
502 * driver functions.
503 */
504
505 static void
genkbd_putc(genkbd_softc_t * sc,char c)506 genkbd_putc(genkbd_softc_t *sc, char c)
507 {
508 unsigned int p;
509
510 if (sc->gkb_q_length == KB_QSIZE)
511 return;
512
513 p = (sc->gkb_q_start + sc->gkb_q_length) % KB_QSIZE;
514 sc->gkb_q[p] = c;
515 sc->gkb_q_length++;
516 }
517
518 static size_t
genkbd_getc(genkbd_softc_t * sc,char * buf,size_t len)519 genkbd_getc(genkbd_softc_t *sc, char *buf, size_t len)
520 {
521
522 /* Determine copy size. */
523 if (sc->gkb_q_length == 0)
524 return (0);
525 if (len >= sc->gkb_q_length)
526 len = sc->gkb_q_length;
527 if (len >= KB_QSIZE - sc->gkb_q_start)
528 len = KB_QSIZE - sc->gkb_q_start;
529
530 /* Copy out data and progress offset. */
531 memcpy(buf, sc->gkb_q + sc->gkb_q_start, len);
532 sc->gkb_q_start = (sc->gkb_q_start + len) % KB_QSIZE;
533 sc->gkb_q_length -= len;
534
535 return (len);
536 }
537
538 static kbd_callback_func_t genkbd_event;
539
540 static int
genkbdopen(struct cdev * dev,int mode,int flag,struct thread * td)541 genkbdopen(struct cdev *dev, int mode, int flag, struct thread *td)
542 {
543 keyboard_t *kbd;
544 genkbd_softc_t *sc;
545 int s;
546 int i;
547
548 s = spltty();
549 sc = dev->si_drv1;
550 kbd = kbd_get_keyboard(KBD_INDEX(dev));
551 if ((sc == NULL) || (kbd == NULL) || !KBD_IS_VALID(kbd)) {
552 splx(s);
553 return (ENXIO);
554 }
555 i = kbd_allocate(kbd->kb_name, kbd->kb_unit, sc,
556 genkbd_event, (void *)sc);
557 if (i < 0) {
558 splx(s);
559 return (EBUSY);
560 }
561 /* assert(i == kbd->kb_index) */
562 /* assert(kbd == kbd_get_keyboard(i)) */
563
564 /*
565 * NOTE: even when we have successfully claimed a keyboard,
566 * the device may still be missing (!KBD_HAS_DEVICE(kbd)).
567 */
568
569 sc->gkb_q_length = 0;
570 splx(s);
571
572 return (0);
573 }
574
575 static int
genkbdclose(struct cdev * dev,int mode,int flag,struct thread * td)576 genkbdclose(struct cdev *dev, int mode, int flag, struct thread *td)
577 {
578 keyboard_t *kbd;
579 genkbd_softc_t *sc;
580 int s;
581
582 /*
583 * NOTE: the device may have already become invalid.
584 * kbd == NULL || !KBD_IS_VALID(kbd)
585 */
586 s = spltty();
587 sc = dev->si_drv1;
588 kbd = kbd_get_keyboard(KBD_INDEX(dev));
589 if ((sc == NULL) || (kbd == NULL) || !KBD_IS_VALID(kbd)) {
590 /* XXX: we shall be forgiving and don't report error... */
591 } else {
592 kbd_release(kbd, (void *)sc);
593 }
594 splx(s);
595 return (0);
596 }
597
598 static int
genkbdread(struct cdev * dev,struct uio * uio,int flag)599 genkbdread(struct cdev *dev, struct uio *uio, int flag)
600 {
601 keyboard_t *kbd;
602 genkbd_softc_t *sc;
603 u_char buffer[KB_BUFSIZE];
604 int len;
605 int error;
606 int s;
607
608 /* wait for input */
609 s = spltty();
610 sc = dev->si_drv1;
611 kbd = kbd_get_keyboard(KBD_INDEX(dev));
612 if ((sc == NULL) || (kbd == NULL) || !KBD_IS_VALID(kbd)) {
613 splx(s);
614 return (ENXIO);
615 }
616 while (sc->gkb_q_length == 0) {
617 if (flag & O_NONBLOCK) {
618 splx(s);
619 return (EWOULDBLOCK);
620 }
621 sc->gkb_flags |= KB_ASLEEP;
622 error = tsleep(sc, PZERO | PCATCH, "kbdrea", 0);
623 kbd = kbd_get_keyboard(KBD_INDEX(dev));
624 if ((kbd == NULL) || !KBD_IS_VALID(kbd)) {
625 splx(s);
626 return (ENXIO); /* our keyboard has gone... */
627 }
628 if (error) {
629 sc->gkb_flags &= ~KB_ASLEEP;
630 splx(s);
631 return (error);
632 }
633 }
634 splx(s);
635
636 /* copy as much input as possible */
637 error = 0;
638 while (uio->uio_resid > 0) {
639 len = imin(uio->uio_resid, sizeof(buffer));
640 len = genkbd_getc(sc, buffer, len);
641 if (len <= 0)
642 break;
643 error = uiomove(buffer, len, uio);
644 if (error)
645 break;
646 }
647
648 return (error);
649 }
650
651 static int
genkbdwrite(struct cdev * dev,struct uio * uio,int flag)652 genkbdwrite(struct cdev *dev, struct uio *uio, int flag)
653 {
654 keyboard_t *kbd;
655
656 kbd = kbd_get_keyboard(KBD_INDEX(dev));
657 if ((kbd == NULL) || !KBD_IS_VALID(kbd))
658 return (ENXIO);
659 return (ENODEV);
660 }
661
662 static int
genkbdioctl(struct cdev * dev,u_long cmd,caddr_t arg,int flag,struct thread * td)663 genkbdioctl(struct cdev *dev, u_long cmd, caddr_t arg, int flag, struct thread *td)
664 {
665 keyboard_t *kbd;
666 int error;
667
668 kbd = kbd_get_keyboard(KBD_INDEX(dev));
669 if ((kbd == NULL) || !KBD_IS_VALID(kbd))
670 return (ENXIO);
671 error = kbdd_ioctl(kbd, cmd, arg);
672 if (error == ENOIOCTL)
673 error = ENODEV;
674 return (error);
675 }
676
677 static int
genkbdpoll(struct cdev * dev,int events,struct thread * td)678 genkbdpoll(struct cdev *dev, int events, struct thread *td)
679 {
680 keyboard_t *kbd;
681 genkbd_softc_t *sc;
682 int revents;
683 int s;
684
685 revents = 0;
686 s = spltty();
687 sc = dev->si_drv1;
688 kbd = kbd_get_keyboard(KBD_INDEX(dev));
689 if ((sc == NULL) || (kbd == NULL) || !KBD_IS_VALID(kbd)) {
690 revents = POLLHUP; /* the keyboard has gone */
691 } else if (events & (POLLIN | POLLRDNORM)) {
692 if (sc->gkb_q_length > 0)
693 revents = events & (POLLIN | POLLRDNORM);
694 else
695 selrecord(td, &sc->gkb_rsel);
696 }
697 splx(s);
698 return (revents);
699 }
700
701 static int
genkbd_event(keyboard_t * kbd,int event,void * arg)702 genkbd_event(keyboard_t *kbd, int event, void *arg)
703 {
704 genkbd_softc_t *sc;
705 size_t len;
706 u_char *cp;
707 int mode;
708 u_int c;
709
710 /* assert(KBD_IS_VALID(kbd)) */
711 sc = (genkbd_softc_t *)arg;
712
713 switch (event) {
714 case KBDIO_KEYINPUT:
715 break;
716 case KBDIO_UNLOADING:
717 /* the keyboard is going... */
718 kbd_release(kbd, (void *)sc);
719 if (sc->gkb_flags & KB_ASLEEP) {
720 sc->gkb_flags &= ~KB_ASLEEP;
721 wakeup(sc);
722 }
723 selwakeuppri(&sc->gkb_rsel, PZERO);
724 return (0);
725 default:
726 return (EINVAL);
727 }
728
729 /* obtain the current key input mode */
730 if (kbdd_ioctl(kbd, KDGKBMODE, (caddr_t)&mode))
731 mode = K_XLATE;
732
733 /* read all pending input */
734 while (kbdd_check_char(kbd)) {
735 c = kbdd_read_char(kbd, FALSE);
736 if (c == NOKEY)
737 continue;
738 if (c == ERRKEY) /* XXX: ring bell? */
739 continue;
740 if (!KBD_IS_BUSY(kbd))
741 /* the device is not open, discard the input */
742 continue;
743
744 /* store the byte as is for K_RAW and K_CODE modes */
745 if (mode != K_XLATE) {
746 genkbd_putc(sc, KEYCHAR(c));
747 continue;
748 }
749
750 /* K_XLATE */
751 if (c & RELKEY) /* key release is ignored */
752 continue;
753
754 /* process special keys; most of them are just ignored... */
755 if (c & SPCLKEY) {
756 switch (KEYCHAR(c)) {
757 default:
758 /* ignore them... */
759 continue;
760 case BTAB: /* a backtab: ESC [ Z */
761 genkbd_putc(sc, 0x1b);
762 genkbd_putc(sc, '[');
763 genkbd_putc(sc, 'Z');
764 continue;
765 }
766 }
767
768 /* normal chars, normal chars with the META, function keys */
769 switch (KEYFLAGS(c)) {
770 case 0: /* a normal char */
771 genkbd_putc(sc, KEYCHAR(c));
772 break;
773 case MKEY: /* the META flag: prepend ESC */
774 genkbd_putc(sc, 0x1b);
775 genkbd_putc(sc, KEYCHAR(c));
776 break;
777 case FKEY | SPCLKEY: /* a function key, return string */
778 cp = kbdd_get_fkeystr(kbd, KEYCHAR(c), &len);
779 if (cp != NULL) {
780 while (len-- > 0)
781 genkbd_putc(sc, *cp++);
782 }
783 break;
784 }
785 }
786
787 /* wake up sleeping/polling processes */
788 if (sc->gkb_q_length > 0) {
789 if (sc->gkb_flags & KB_ASLEEP) {
790 sc->gkb_flags &= ~KB_ASLEEP;
791 wakeup(sc);
792 }
793 selwakeuppri(&sc->gkb_rsel, PZERO);
794 }
795
796 return (0);
797 }
798
799 #endif /* KBD_INSTALL_CDEV */
800
801 /*
802 * Generic low-level keyboard functions
803 * The low-level functions in the keyboard subdriver may use these
804 * functions.
805 */
806
807 #ifndef KBD_DISABLE_KEYMAP_LOAD
808 static int key_change_ok(struct keyent_t *, struct keyent_t *, struct thread *);
809 static int keymap_change_ok(keymap_t *, keymap_t *, struct thread *);
810 static int accent_change_ok(accentmap_t *, accentmap_t *, struct thread *);
811 static int fkey_change_ok(fkeytab_t *, fkeyarg_t *, struct thread *);
812 #endif
813
814 int
genkbd_commonioctl(keyboard_t * kbd,u_long cmd,caddr_t arg)815 genkbd_commonioctl(keyboard_t *kbd, u_long cmd, caddr_t arg)
816 {
817 keymap_t *mapp;
818 okeymap_t *omapp;
819 keyarg_t *keyp;
820 fkeyarg_t *fkeyp;
821 int s;
822 int i, j;
823 int error;
824
825 s = spltty();
826 switch (cmd) {
827
828 case KDGKBINFO: /* get keyboard information */
829 ((keyboard_info_t *)arg)->kb_index = kbd->kb_index;
830 i = imin(strlen(kbd->kb_name) + 1,
831 sizeof(((keyboard_info_t *)arg)->kb_name));
832 bcopy(kbd->kb_name, ((keyboard_info_t *)arg)->kb_name, i);
833 ((keyboard_info_t *)arg)->kb_unit = kbd->kb_unit;
834 ((keyboard_info_t *)arg)->kb_type = kbd->kb_type;
835 ((keyboard_info_t *)arg)->kb_config = kbd->kb_config;
836 ((keyboard_info_t *)arg)->kb_flags = kbd->kb_flags;
837 break;
838
839 case KDGKBTYPE: /* get keyboard type */
840 *(int *)arg = kbd->kb_type;
841 break;
842
843 case KDGETREPEAT: /* get keyboard repeat rate */
844 ((int *)arg)[0] = kbd->kb_delay1;
845 ((int *)arg)[1] = kbd->kb_delay2;
846 break;
847
848 case GIO_KEYMAP: /* get keyboard translation table */
849 error = copyout(kbd->kb_keymap, *(void **)arg,
850 sizeof(keymap_t));
851 splx(s);
852 return (error);
853 case OGIO_KEYMAP: /* get keyboard translation table (compat) */
854 mapp = kbd->kb_keymap;
855 omapp = (okeymap_t *)arg;
856 omapp->n_keys = mapp->n_keys;
857 for (i = 0; i < NUM_KEYS; i++) {
858 for (j = 0; j < NUM_STATES; j++)
859 omapp->key[i].map[j] =
860 mapp->key[i].map[j];
861 omapp->key[i].spcl = mapp->key[i].spcl;
862 omapp->key[i].flgs = mapp->key[i].flgs;
863 }
864 break;
865 case PIO_KEYMAP: /* set keyboard translation table */
866 case OPIO_KEYMAP: /* set keyboard translation table (compat) */
867 #ifndef KBD_DISABLE_KEYMAP_LOAD
868 mapp = malloc(sizeof *mapp, M_TEMP, M_WAITOK);
869 if (cmd == OPIO_KEYMAP) {
870 omapp = (okeymap_t *)arg;
871 mapp->n_keys = omapp->n_keys;
872 for (i = 0; i < NUM_KEYS; i++) {
873 for (j = 0; j < NUM_STATES; j++)
874 mapp->key[i].map[j] =
875 omapp->key[i].map[j];
876 mapp->key[i].spcl = omapp->key[i].spcl;
877 mapp->key[i].flgs = omapp->key[i].flgs;
878 }
879 } else {
880 error = copyin(*(void **)arg, mapp, sizeof *mapp);
881 if (error != 0) {
882 splx(s);
883 free(mapp, M_TEMP);
884 return (error);
885 }
886 }
887
888 error = keymap_change_ok(kbd->kb_keymap, mapp, curthread);
889 if (error != 0) {
890 splx(s);
891 free(mapp, M_TEMP);
892 return (error);
893 }
894 bzero(kbd->kb_accentmap, sizeof(*kbd->kb_accentmap));
895 bcopy(mapp, kbd->kb_keymap, sizeof(*kbd->kb_keymap));
896 free(mapp, M_TEMP);
897 break;
898 #else
899 splx(s);
900 return (ENODEV);
901 #endif
902
903 case GIO_KEYMAPENT: /* get keyboard translation table entry */
904 keyp = (keyarg_t *)arg;
905 if (keyp->keynum >= sizeof(kbd->kb_keymap->key) /
906 sizeof(kbd->kb_keymap->key[0])) {
907 splx(s);
908 return (EINVAL);
909 }
910 bcopy(&kbd->kb_keymap->key[keyp->keynum], &keyp->key,
911 sizeof(keyp->key));
912 break;
913 case PIO_KEYMAPENT: /* set keyboard translation table entry */
914 #ifndef KBD_DISABLE_KEYMAP_LOAD
915 keyp = (keyarg_t *)arg;
916 if (keyp->keynum >= sizeof(kbd->kb_keymap->key) /
917 sizeof(kbd->kb_keymap->key[0])) {
918 splx(s);
919 return (EINVAL);
920 }
921 error = key_change_ok(&kbd->kb_keymap->key[keyp->keynum],
922 &keyp->key, curthread);
923 if (error != 0) {
924 splx(s);
925 return (error);
926 }
927 bcopy(&keyp->key, &kbd->kb_keymap->key[keyp->keynum],
928 sizeof(keyp->key));
929 break;
930 #else
931 splx(s);
932 return (ENODEV);
933 #endif
934
935 case GIO_DEADKEYMAP: /* get accent key translation table */
936 bcopy(kbd->kb_accentmap, arg, sizeof(*kbd->kb_accentmap));
937 break;
938 case PIO_DEADKEYMAP: /* set accent key translation table */
939 #ifndef KBD_DISABLE_KEYMAP_LOAD
940 error = accent_change_ok(kbd->kb_accentmap,
941 (accentmap_t *)arg, curthread);
942 if (error != 0) {
943 splx(s);
944 return (error);
945 }
946 bcopy(arg, kbd->kb_accentmap, sizeof(*kbd->kb_accentmap));
947 break;
948 #else
949 splx(s);
950 return (ENODEV);
951 #endif
952
953 case GETFKEY: /* get functionkey string */
954 fkeyp = (fkeyarg_t *)arg;
955 if (fkeyp->keynum >= kbd->kb_fkeytab_size) {
956 splx(s);
957 return (EINVAL);
958 }
959 bcopy(kbd->kb_fkeytab[fkeyp->keynum].str, fkeyp->keydef,
960 kbd->kb_fkeytab[fkeyp->keynum].len);
961 fkeyp->flen = kbd->kb_fkeytab[fkeyp->keynum].len;
962 break;
963 case SETFKEY: /* set functionkey string */
964 #ifndef KBD_DISABLE_KEYMAP_LOAD
965 fkeyp = (fkeyarg_t *)arg;
966 if (fkeyp->keynum >= kbd->kb_fkeytab_size) {
967 splx(s);
968 return (EINVAL);
969 }
970 error = fkey_change_ok(&kbd->kb_fkeytab[fkeyp->keynum],
971 fkeyp, curthread);
972 if (error != 0) {
973 splx(s);
974 return (error);
975 }
976 kbd->kb_fkeytab[fkeyp->keynum].len = min(fkeyp->flen, MAXFK);
977 bcopy(fkeyp->keydef, kbd->kb_fkeytab[fkeyp->keynum].str,
978 kbd->kb_fkeytab[fkeyp->keynum].len);
979 break;
980 #else
981 splx(s);
982 return (ENODEV);
983 #endif
984
985 default:
986 splx(s);
987 return (ENOIOCTL);
988 }
989
990 splx(s);
991 return (0);
992 }
993
994 #ifndef KBD_DISABLE_KEYMAP_LOAD
995 #define RESTRICTED_KEY(key, i) \
996 ((key->spcl & (0x80 >> i)) && \
997 (key->map[i] == RBT || key->map[i] == SUSP || \
998 key->map[i] == STBY || key->map[i] == DBG || \
999 key->map[i] == PNC || key->map[i] == HALT || \
1000 key->map[i] == PDWN))
1001
1002 static int
key_change_ok(struct keyent_t * oldkey,struct keyent_t * newkey,struct thread * td)1003 key_change_ok(struct keyent_t *oldkey, struct keyent_t *newkey, struct thread *td)
1004 {
1005 int i;
1006
1007 /* Low keymap_restrict_change means any changes are OK. */
1008 if (keymap_restrict_change <= 0)
1009 return (0);
1010
1011 /* High keymap_restrict_change means only root can change the keymap. */
1012 if (keymap_restrict_change >= 2) {
1013 for (i = 0; i < NUM_STATES; i++)
1014 if (oldkey->map[i] != newkey->map[i])
1015 return priv_check(td, PRIV_KEYBOARD);
1016 if (oldkey->spcl != newkey->spcl)
1017 return priv_check(td, PRIV_KEYBOARD);
1018 if (oldkey->flgs != newkey->flgs)
1019 return priv_check(td, PRIV_KEYBOARD);
1020 return (0);
1021 }
1022
1023 /* Otherwise we have to see if any special keys are being changed. */
1024 for (i = 0; i < NUM_STATES; i++) {
1025 /*
1026 * If either the oldkey or the newkey action is restricted
1027 * then we must make sure that the action doesn't change.
1028 */
1029 if (!RESTRICTED_KEY(oldkey, i) && !RESTRICTED_KEY(newkey, i))
1030 continue;
1031 if ((oldkey->spcl & (0x80 >> i)) == (newkey->spcl & (0x80 >> i))
1032 && oldkey->map[i] == newkey->map[i])
1033 continue;
1034 return priv_check(td, PRIV_KEYBOARD);
1035 }
1036
1037 return (0);
1038 }
1039
1040 static int
keymap_change_ok(keymap_t * oldmap,keymap_t * newmap,struct thread * td)1041 keymap_change_ok(keymap_t *oldmap, keymap_t *newmap, struct thread *td)
1042 {
1043 int keycode, error;
1044
1045 for (keycode = 0; keycode < NUM_KEYS; keycode++) {
1046 if ((error = key_change_ok(&oldmap->key[keycode],
1047 &newmap->key[keycode], td)) != 0)
1048 return (error);
1049 }
1050 return (0);
1051 }
1052
1053 static int
accent_change_ok(accentmap_t * oldmap,accentmap_t * newmap,struct thread * td)1054 accent_change_ok(accentmap_t *oldmap, accentmap_t *newmap, struct thread *td)
1055 {
1056 struct acc_t *oldacc, *newacc;
1057 int accent, i;
1058
1059 if (keymap_restrict_change <= 2)
1060 return (0);
1061
1062 if (oldmap->n_accs != newmap->n_accs)
1063 return priv_check(td, PRIV_KEYBOARD);
1064
1065 for (accent = 0; accent < oldmap->n_accs; accent++) {
1066 oldacc = &oldmap->acc[accent];
1067 newacc = &newmap->acc[accent];
1068 if (oldacc->accchar != newacc->accchar)
1069 return priv_check(td, PRIV_KEYBOARD);
1070 for (i = 0; i < NUM_ACCENTCHARS; ++i) {
1071 if (oldacc->map[i][0] != newacc->map[i][0])
1072 return priv_check(td, PRIV_KEYBOARD);
1073 if (oldacc->map[i][0] == 0) /* end of table */
1074 break;
1075 if (oldacc->map[i][1] != newacc->map[i][1])
1076 return priv_check(td, PRIV_KEYBOARD);
1077 }
1078 }
1079
1080 return (0);
1081 }
1082
1083 static int
fkey_change_ok(fkeytab_t * oldkey,fkeyarg_t * newkey,struct thread * td)1084 fkey_change_ok(fkeytab_t *oldkey, fkeyarg_t *newkey, struct thread *td)
1085 {
1086 if (keymap_restrict_change <= 3)
1087 return (0);
1088
1089 if (oldkey->len != newkey->flen ||
1090 bcmp(oldkey->str, newkey->keydef, oldkey->len) != 0)
1091 return priv_check(td, PRIV_KEYBOARD);
1092
1093 return (0);
1094 }
1095 #endif
1096
1097 /* get a pointer to the string associated with the given function key */
1098 static u_char *
genkbd_get_fkeystr(keyboard_t * kbd,int fkey,size_t * len)1099 genkbd_get_fkeystr(keyboard_t *kbd, int fkey, size_t *len)
1100 {
1101 if (kbd == NULL)
1102 return (NULL);
1103 fkey -= F_FN;
1104 if (fkey > kbd->kb_fkeytab_size)
1105 return (NULL);
1106 *len = kbd->kb_fkeytab[fkey].len;
1107 return (kbd->kb_fkeytab[fkey].str);
1108 }
1109
1110 /* diagnostic dump */
1111 static char *
get_kbd_type_name(int type)1112 get_kbd_type_name(int type)
1113 {
1114 static struct {
1115 int type;
1116 char *name;
1117 } name_table[] = {
1118 { KB_84, "AT 84" },
1119 { KB_101, "AT 101/102" },
1120 { KB_OTHER, "generic" },
1121 };
1122 int i;
1123
1124 for (i = 0; i < nitems(name_table); ++i) {
1125 if (type == name_table[i].type)
1126 return (name_table[i].name);
1127 }
1128 return ("unknown");
1129 }
1130
1131 static void
genkbd_diag(keyboard_t * kbd,int level)1132 genkbd_diag(keyboard_t *kbd, int level)
1133 {
1134 if (level > 0) {
1135 printf("kbd%d: %s%d, %s (%d), config:0x%x, flags:0x%x",
1136 kbd->kb_index, kbd->kb_name, kbd->kb_unit,
1137 get_kbd_type_name(kbd->kb_type), kbd->kb_type,
1138 kbd->kb_config, kbd->kb_flags);
1139 if (kbd->kb_io_base > 0)
1140 printf(", port:0x%x-0x%x", kbd->kb_io_base,
1141 kbd->kb_io_base + kbd->kb_io_size - 1);
1142 printf("\n");
1143 }
1144 }
1145
1146 #define set_lockkey_state(k, s, l) \
1147 if (!((s) & l ## DOWN)) { \
1148 int i; \
1149 (s) |= l ## DOWN; \
1150 (s) ^= l ## ED; \
1151 i = (s) & LOCK_MASK; \
1152 (void)kbdd_ioctl((k), KDSETLED, (caddr_t)&i); \
1153 }
1154
1155 static u_int
save_accent_key(keyboard_t * kbd,u_int key,int * accents)1156 save_accent_key(keyboard_t *kbd, u_int key, int *accents)
1157 {
1158 int i;
1159
1160 /* make an index into the accent map */
1161 i = key - F_ACC + 1;
1162 if ((i > kbd->kb_accentmap->n_accs)
1163 || (kbd->kb_accentmap->acc[i - 1].accchar == 0)) {
1164 /* the index is out of range or pointing to an empty entry */
1165 *accents = 0;
1166 return (ERRKEY);
1167 }
1168
1169 /*
1170 * If the same accent key has been hit twice, produce the accent
1171 * char itself.
1172 */
1173 if (i == *accents) {
1174 key = kbd->kb_accentmap->acc[i - 1].accchar;
1175 *accents = 0;
1176 return (key);
1177 }
1178
1179 /* remember the index and wait for the next key */
1180 *accents = i;
1181 return (NOKEY);
1182 }
1183
1184 static u_int
make_accent_char(keyboard_t * kbd,u_int ch,int * accents)1185 make_accent_char(keyboard_t *kbd, u_int ch, int *accents)
1186 {
1187 struct acc_t *acc;
1188 int i;
1189
1190 acc = &kbd->kb_accentmap->acc[*accents - 1];
1191 *accents = 0;
1192
1193 /*
1194 * If the accent key is followed by the space key,
1195 * produce the accent char itself.
1196 */
1197 if (ch == ' ')
1198 return (acc->accchar);
1199
1200 /* scan the accent map */
1201 for (i = 0; i < NUM_ACCENTCHARS; ++i) {
1202 if (acc->map[i][0] == 0) /* end of table */
1203 break;
1204 if (acc->map[i][0] == ch)
1205 return (acc->map[i][1]);
1206 }
1207 /* this char cannot be accented... */
1208 return (ERRKEY);
1209 }
1210
1211 int
genkbd_keyaction(keyboard_t * kbd,int keycode,int up,int * shiftstate,int * accents)1212 genkbd_keyaction(keyboard_t *kbd, int keycode, int up, int *shiftstate,
1213 int *accents)
1214 {
1215 struct keyent_t *key;
1216 int state = *shiftstate;
1217 int action;
1218 int f;
1219 int i;
1220
1221 i = keycode;
1222 f = state & (AGRS | ALKED);
1223 if ((f == AGRS1) || (f == AGRS2) || (f == ALKED))
1224 i += ALTGR_OFFSET;
1225 key = &kbd->kb_keymap->key[i];
1226 i = ((state & SHIFTS) ? 1 : 0)
1227 | ((state & CTLS) ? 2 : 0)
1228 | ((state & ALTS) ? 4 : 0);
1229 if (((key->flgs & FLAG_LOCK_C) && (state & CLKED))
1230 || ((key->flgs & FLAG_LOCK_N) && (state & NLKED)) )
1231 i ^= 1;
1232
1233 if (up) { /* break: key released */
1234 action = kbd->kb_lastact[keycode];
1235 kbd->kb_lastact[keycode] = NOP;
1236 switch (action) {
1237 case LSHA:
1238 if (state & SHIFTAON) {
1239 set_lockkey_state(kbd, state, ALK);
1240 state &= ~ALKDOWN;
1241 }
1242 action = LSH;
1243 /* FALL THROUGH */
1244 case LSH:
1245 state &= ~SHIFTS1;
1246 break;
1247 case RSHA:
1248 if (state & SHIFTAON) {
1249 set_lockkey_state(kbd, state, ALK);
1250 state &= ~ALKDOWN;
1251 }
1252 action = RSH;
1253 /* FALL THROUGH */
1254 case RSH:
1255 state &= ~SHIFTS2;
1256 break;
1257 case LCTRA:
1258 if (state & SHIFTAON) {
1259 set_lockkey_state(kbd, state, ALK);
1260 state &= ~ALKDOWN;
1261 }
1262 action = LCTR;
1263 /* FALL THROUGH */
1264 case LCTR:
1265 state &= ~CTLS1;
1266 break;
1267 case RCTRA:
1268 if (state & SHIFTAON) {
1269 set_lockkey_state(kbd, state, ALK);
1270 state &= ~ALKDOWN;
1271 }
1272 action = RCTR;
1273 /* FALL THROUGH */
1274 case RCTR:
1275 state &= ~CTLS2;
1276 break;
1277 case LALTA:
1278 if (state & SHIFTAON) {
1279 set_lockkey_state(kbd, state, ALK);
1280 state &= ~ALKDOWN;
1281 }
1282 action = LALT;
1283 /* FALL THROUGH */
1284 case LALT:
1285 state &= ~ALTS1;
1286 break;
1287 case RALTA:
1288 if (state & SHIFTAON) {
1289 set_lockkey_state(kbd, state, ALK);
1290 state &= ~ALKDOWN;
1291 }
1292 action = RALT;
1293 /* FALL THROUGH */
1294 case RALT:
1295 state &= ~ALTS2;
1296 break;
1297 case ASH:
1298 state &= ~AGRS1;
1299 break;
1300 case META:
1301 state &= ~METAS1;
1302 break;
1303 case NLK:
1304 state &= ~NLKDOWN;
1305 break;
1306 case CLK:
1307 state &= ~CLKDOWN;
1308 break;
1309 case SLK:
1310 state &= ~SLKDOWN;
1311 break;
1312 case ALK:
1313 state &= ~ALKDOWN;
1314 break;
1315 case NOP:
1316 /* release events of regular keys are not reported */
1317 *shiftstate &= ~SHIFTAON;
1318 return (NOKEY);
1319 }
1320 *shiftstate = state & ~SHIFTAON;
1321 return (SPCLKEY | RELKEY | action);
1322 } else { /* make: key pressed */
1323 action = key->map[i];
1324 state &= ~SHIFTAON;
1325 if (key->spcl & (0x80 >> i)) {
1326 /* special keys */
1327 if (kbd->kb_lastact[keycode] == NOP)
1328 kbd->kb_lastact[keycode] = action;
1329 if (kbd->kb_lastact[keycode] != action)
1330 action = NOP;
1331 switch (action) {
1332 /* LOCKING KEYS */
1333 case NLK:
1334 set_lockkey_state(kbd, state, NLK);
1335 break;
1336 case CLK:
1337 set_lockkey_state(kbd, state, CLK);
1338 break;
1339 case SLK:
1340 set_lockkey_state(kbd, state, SLK);
1341 break;
1342 case ALK:
1343 set_lockkey_state(kbd, state, ALK);
1344 break;
1345 /* NON-LOCKING KEYS */
1346 case SPSC: case RBT: case SUSP: case STBY:
1347 case DBG: case NEXT: case PREV: case PNC:
1348 case HALT: case PDWN:
1349 *accents = 0;
1350 break;
1351 case BTAB:
1352 *accents = 0;
1353 action |= BKEY;
1354 break;
1355 case LSHA:
1356 state |= SHIFTAON;
1357 action = LSH;
1358 /* FALL THROUGH */
1359 case LSH:
1360 state |= SHIFTS1;
1361 break;
1362 case RSHA:
1363 state |= SHIFTAON;
1364 action = RSH;
1365 /* FALL THROUGH */
1366 case RSH:
1367 state |= SHIFTS2;
1368 break;
1369 case LCTRA:
1370 state |= SHIFTAON;
1371 action = LCTR;
1372 /* FALL THROUGH */
1373 case LCTR:
1374 state |= CTLS1;
1375 break;
1376 case RCTRA:
1377 state |= SHIFTAON;
1378 action = RCTR;
1379 /* FALL THROUGH */
1380 case RCTR:
1381 state |= CTLS2;
1382 break;
1383 case LALTA:
1384 state |= SHIFTAON;
1385 action = LALT;
1386 /* FALL THROUGH */
1387 case LALT:
1388 state |= ALTS1;
1389 break;
1390 case RALTA:
1391 state |= SHIFTAON;
1392 action = RALT;
1393 /* FALL THROUGH */
1394 case RALT:
1395 state |= ALTS2;
1396 break;
1397 case ASH:
1398 state |= AGRS1;
1399 break;
1400 case META:
1401 state |= METAS1;
1402 break;
1403 case NOP:
1404 *shiftstate = state;
1405 return (NOKEY);
1406 default:
1407 /* is this an accent (dead) key? */
1408 *shiftstate = state;
1409 if (action >= F_ACC && action <= L_ACC) {
1410 action = save_accent_key(kbd, action,
1411 accents);
1412 switch (action) {
1413 case NOKEY:
1414 case ERRKEY:
1415 return (action);
1416 default:
1417 if (state & METAS)
1418 return (action | MKEY);
1419 else
1420 return (action);
1421 }
1422 /* NOT REACHED */
1423 }
1424 /* other special keys */
1425 if (*accents > 0) {
1426 *accents = 0;
1427 return (ERRKEY);
1428 }
1429 if (action >= F_FN && action <= L_FN)
1430 action |= FKEY;
1431 /* XXX: return fkey string for the FKEY? */
1432 return (SPCLKEY | action);
1433 }
1434 *shiftstate = state;
1435 return (SPCLKEY | action);
1436 } else {
1437 /* regular keys */
1438 kbd->kb_lastact[keycode] = NOP;
1439 *shiftstate = state;
1440 if (*accents > 0) {
1441 /* make an accented char */
1442 action = make_accent_char(kbd, action, accents);
1443 if (action == ERRKEY)
1444 return (action);
1445 }
1446 if (state & METAS)
1447 action |= MKEY;
1448 return (action);
1449 }
1450 }
1451 /* NOT REACHED */
1452 }
1453
1454 void
kbd_ev_event(keyboard_t * kbd,uint16_t type,uint16_t code,int32_t value)1455 kbd_ev_event(keyboard_t *kbd, uint16_t type, uint16_t code, int32_t value)
1456 {
1457 int delay[2], led = 0, leds, oleds;
1458
1459 if (type == EV_LED) {
1460 leds = oleds = KBD_LED_VAL(kbd);
1461 switch (code) {
1462 case LED_CAPSL:
1463 led = CLKED;
1464 break;
1465 case LED_NUML:
1466 led = NLKED;
1467 break;
1468 case LED_SCROLLL:
1469 led = SLKED;
1470 break;
1471 }
1472
1473 if (value)
1474 leds |= led;
1475 else
1476 leds &= ~led;
1477
1478 if (leds != oleds)
1479 kbdd_ioctl(kbd, KDSETLED, (caddr_t)&leds);
1480
1481 } else if (type == EV_REP && code == REP_DELAY) {
1482 delay[0] = value;
1483 delay[1] = kbd->kb_delay2;
1484 kbdd_ioctl(kbd, KDSETREPEAT, (caddr_t)delay);
1485 } else if (type == EV_REP && code == REP_PERIOD) {
1486 delay[0] = kbd->kb_delay1;
1487 delay[1] = value;
1488 kbdd_ioctl(kbd, KDSETREPEAT, (caddr_t)delay);
1489 }
1490 }
1491
1492 void
kbdinit(void)1493 kbdinit(void)
1494 {
1495 keyboard_driver_t *drv, **list;
1496
1497 SET_FOREACH(list, kbddriver_set) {
1498 drv = *list;
1499
1500 /*
1501 * The following printfs will almost universally get dropped,
1502 * with exception to kernel configs with EARLY_PRINTF and
1503 * special setups where msgbufinit() is called early with a
1504 * static buffer to capture output occurring before the dynamic
1505 * message buffer is mapped.
1506 */
1507 if (kbd_add_driver(drv) != 0)
1508 printf("kbd: failed to register driver '%s'\n",
1509 drv->name);
1510 else if (bootverbose)
1511 printf("kbd: registered driver '%s'\n",
1512 drv->name);
1513 }
1514
1515 }
1516