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