1 /*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21
22 /*
23 * Copyright 2009 Sun Microsystems, Inc. All rights reserved.
24 * Use is subject to license terms.
25 */
26
27 /*
28 * Generic keyboard support: streams and administration.
29 */
30
31 #define KEYMAP_SIZE_VARIABLE
32
33 #include <sys/types.h>
34 #include <sys/cred.h>
35 #include <sys/stream.h>
36 #include <sys/stropts.h>
37 #include <sys/strsun.h>
38 #include <sys/ddi.h>
39 #include <sys/vuid_event.h>
40 #include <sys/modctl.h>
41 #include <sys/errno.h>
42 #include <sys/kmem.h>
43 #include <sys/cmn_err.h>
44 #include <sys/kbd.h>
45 #include <sys/kbio.h>
46 #include <sys/consdev.h>
47 #include <sys/kbtrans.h>
48 #include <sys/policy.h>
49 #include <sys/sunldi.h>
50 #include <sys/class.h>
51 #include <sys/spl.h>
52 #include "kbtrans_lower.h"
53 #include "kbtrans_streams.h"
54
55 #ifdef DEBUG
56 int kbtrans_errmask;
57 int kbtrans_errlevel;
58 #endif
59
60 #define KB_NR_FUNCKEYS 12
61
62 /*
63 * Repeat rates set in static variables so they can be tweeked with
64 * debugger.
65 */
66 static int kbtrans_repeat_rate;
67 static int kbtrans_repeat_delay;
68
69 /* Printing message on q overflow */
70 static int kbtrans_overflow_msg = 1;
71
72 /*
73 * This value corresponds approximately to max 10 fingers
74 */
75 static int kbtrans_downs_size = 15;
76
77 /*
78 * modload support
79 */
80 extern struct mod_ops mod_miscops;
81
82 static struct modlmisc modlmisc = {
83 &mod_miscops, /* Type of module */
84 "kbtrans (key translation)"
85 };
86
87 static struct modlinkage modlinkage = {
88 MODREV_1, (void *)&modlmisc, NULL
89 };
90
91 int
92 _init(void)
93 {
94 return (mod_install(&modlinkage));
95 }
96
97 int
98 _fini(void)
99 {
100 return (mod_remove(&modlinkage));
101 }
102
103 int
104 _info(struct modinfo *modinfop)
105 {
106 return (mod_info(&modlinkage, modinfop));
107 }
108
109 /*
110 * Internal Function Prototypes
111 */
112 static char *kbtrans_strsetwithdecimal(char *, uint_t, uint_t);
113 static void kbtrans_set_translation_callback(struct kbtrans *);
114 static void kbtrans_reioctl(void *);
115 static void kbtrans_send_esc_event(char, struct kbtrans *);
116 static void kbtrans_keypressed(struct kbtrans *, uchar_t, Firm_event *,
117 ushort_t);
118 static void kbtrans_putbuf(char *, queue_t *);
119 static void kbtrans_cancelrpt(struct kbtrans *);
120 static void kbtrans_queuepress(struct kbtrans *, uchar_t, Firm_event *);
121 static void kbtrans_putcode(register struct kbtrans *, uint_t);
122 static void kbtrans_keyreleased(struct kbtrans *, uchar_t);
123 static void kbtrans_queueevent(struct kbtrans *, Firm_event *);
124 static void kbtrans_untrans_keypressed_raw(struct kbtrans *, kbtrans_key_t);
125 static void kbtrans_untrans_keyreleased_raw(struct kbtrans *,
126 kbtrans_key_t);
127 static void kbtrans_ascii_keypressed(struct kbtrans *, uint_t,
128 kbtrans_key_t, uint_t);
129 static void kbtrans_ascii_keyreleased(struct kbtrans *, kbtrans_key_t);
130 static void kbtrans_ascii_setup_repeat(struct kbtrans *, uint_t,
131 kbtrans_key_t);
132 static void kbtrans_trans_event_keypressed(struct kbtrans *, uint_t,
133 kbtrans_key_t, uint_t);
134 static void kbtrans_trans_event_keyreleased(struct kbtrans *,
135 kbtrans_key_t);
136 static void kbtrans_trans_event_setup_repeat(struct kbtrans *, uint_t,
137 kbtrans_key_t);
138 static void kbtrans_rpt(void *);
139 static void kbtrans_setled(struct kbtrans *);
140 static void kbtrans_flush(struct kbtrans *);
141 static enum kbtrans_message_response kbtrans_ioctl(struct kbtrans *upper,
142 mblk_t *mp);
143 static int kbtrans_setkey(struct kbtrans_lower *, struct kiockey *,
144 cred_t *);
145 static int kbtrans_getkey(struct kbtrans_lower *, struct kiockey *);
146 static int kbtrans_skey(struct kbtrans_lower *, struct kiockeymap *,
147 cred_t *cr);
148 static int kbtrans_gkey(struct kbtrans_lower *, struct kiockeymap *);
149
150 /*
151 * Keyboard Translation Mode (TR_NONE)
152 *
153 * Functions to be called when keyboard translation is turned off
154 * and up/down key codes are reported.
155 */
156 struct keyboard_callback untrans_event_callback = {
157 kbtrans_untrans_keypressed_raw,
158 kbtrans_untrans_keyreleased_raw,
159 NULL,
160 NULL,
161 NULL,
162 NULL,
163 NULL,
164 };
165
166 /*
167 * Keyboard Translation Mode (TR_ASCII)
168 *
169 * Functions to be called when ISO 8859/1 codes are reported
170 */
171 struct keyboard_callback ascii_callback = {
172 NULL,
173 NULL,
174 kbtrans_ascii_keypressed,
175 kbtrans_ascii_keyreleased,
176 kbtrans_ascii_setup_repeat,
177 kbtrans_cancelrpt,
178 kbtrans_setled,
179 };
180
181 /*
182 * Keyboard Translation Mode (TR_EVENT)
183 *
184 * Functions to be called when firm_events are reported.
185 */
186 struct keyboard_callback trans_event_callback = {
187 NULL,
188 NULL,
189 kbtrans_trans_event_keypressed,
190 kbtrans_trans_event_keyreleased,
191 kbtrans_trans_event_setup_repeat,
192 kbtrans_cancelrpt,
193 kbtrans_setled,
194 };
195
196 static void
197 progressbar_key_abort_thread(struct kbtrans *upper)
198 {
199 ldi_ident_t li;
200 extern void progressbar_key_abort(ldi_ident_t);
201
202 if (ldi_ident_from_stream(upper->kbtrans_streams_readq, &li) != 0) {
203 cmn_err(CE_NOTE, "!ldi_ident_from_stream failed");
204 } else {
205 mutex_enter(&upper->progressbar_key_abort_lock);
206 while (upper->progressbar_key_abort_flag == 0)
207 cv_wait(&upper->progressbar_key_abort_cv,
208 &upper->progressbar_key_abort_lock);
209 if (upper->progressbar_key_abort_flag == 1) {
210 mutex_exit(&upper->progressbar_key_abort_lock);
211 progressbar_key_abort(li);
212 } else {
213 mutex_exit(&upper->progressbar_key_abort_lock);
214 }
215 ldi_ident_release(li);
216 }
217
218 thread_exit();
219 }
220
221 /*
222 * kbtrans_streams_init:
223 * Initialize the stream, keytables, callbacks, etc.
224 */
225 int
226 kbtrans_streams_init(
227 queue_t *q,
228 int sflag,
229 struct kbtrans_hardware *hw,
230 struct kbtrans_callbacks *hw_cb,
231 struct kbtrans **ret_kbd,
232 int initial_leds,
233 int initial_led_mask)
234 {
235 struct kbtrans *upper;
236 struct kbtrans_lower *lower;
237 kthread_t *tid;
238
239 /*
240 * Default to relatively generic tables.
241 */
242 extern signed char kb_compose_map[];
243 extern struct compose_sequence_t kb_compose_table[];
244 extern struct fltaccent_sequence_t kb_fltaccent_table[];
245 extern char keystringtab[][KTAB_STRLEN];
246 extern unsigned char kb_numlock_table[];
247
248 /* Set these up only once so that they could be changed from adb */
249 if (!kbtrans_repeat_rate) {
250 kbtrans_repeat_rate = (hz+29)/30;
251 kbtrans_repeat_delay = hz/2;
252 }
253
254 switch (sflag) {
255
256 case MODOPEN:
257 break;
258
259 case CLONEOPEN:
260 DPRINTF(PRINT_L1, PRINT_MASK_OPEN, (NULL,
261 "kbtrans_streams_init: Clone open not supported"));
262
263 return (EINVAL);
264 }
265
266 /* allocate keyboard state structure */
267 upper = kmem_zalloc(sizeof (struct kbtrans), KM_SLEEP);
268
269 *ret_kbd = upper;
270
271 upper->kbtrans_polled_buf[0] = '\0';
272 upper->kbtrans_polled_pending_chars = upper->kbtrans_polled_buf;
273
274 upper->kbtrans_streams_hw = hw;
275 upper->kbtrans_streams_hw_callbacks = hw_cb;
276 upper->kbtrans_streams_readq = q;
277 upper->kbtrans_streams_iocpending = NULL;
278 upper->kbtrans_streams_translatable = TR_CAN;
279 upper->kbtrans_overflow_cnt = 0;
280 upper->kbtrans_streams_translate_mode = TR_ASCII;
281
282 /* Set the translation callback based on the translation type */
283 kbtrans_set_translation_callback(upper);
284
285 lower = &upper->kbtrans_lower;
286
287 /*
288 * Set defaults for relatively generic tables.
289 */
290 lower->kbtrans_compose_map = kb_compose_map;
291 lower->kbtrans_compose_table = kb_compose_table;
292 lower->kbtrans_fltaccent_table = kb_fltaccent_table;
293 lower->kbtrans_numlock_table = kb_numlock_table;
294 lower->kbtrans_keystringtab = keystringtab;
295
296 lower->kbtrans_upper = upper;
297 lower->kbtrans_compat = 1;
298
299 /*
300 * We have a generic default for the LED state, and let the
301 * hardware-specific driver supply overrides.
302 */
303 lower->kbtrans_led_state = 0;
304 lower->kbtrans_led_state &= ~initial_led_mask;
305 lower->kbtrans_led_state |= initial_leds;
306 lower->kbtrans_togglemask = 0;
307
308 if (lower->kbtrans_led_state & LED_CAPS_LOCK)
309 lower->kbtrans_togglemask |= CAPSMASK;
310 if (lower->kbtrans_led_state & LED_NUM_LOCK)
311 lower->kbtrans_togglemask |= NUMLOCKMASK;
312
313 #if defined(SCROLLMASK)
314 if (lower->kbtrans_led_state & LED_SCROLL_LOCK)
315 lower->kbtrans_togglemask |= SCROLLMASK;
316 #endif
317
318 lower->kbtrans_shiftmask = lower->kbtrans_togglemask;
319
320 upper->kbtrans_streams_vuid_addr.ascii = ASCII_FIRST;
321 upper->kbtrans_streams_vuid_addr.top = TOP_FIRST;
322 upper->kbtrans_streams_vuid_addr.vkey = VKEY_FIRST;
323
324 /* Allocate dynamic memory for downs table */
325 upper->kbtrans_streams_num_downs_entries = kbtrans_downs_size;
326 upper->kbtrans_streams_downs_bytes =
327 (uint32_t)(kbtrans_downs_size * sizeof (Key_event));
328 upper->kbtrans_streams_downs =
329 kmem_zalloc(upper->kbtrans_streams_downs_bytes, KM_SLEEP);
330 upper->kbtrans_streams_abortable = B_FALSE;
331
332 upper->kbtrans_streams_flags = KBTRANS_STREAMS_OPEN;
333
334 upper->progressbar_key_abort_flag = 0;
335 cv_init(&upper->progressbar_key_abort_cv, NULL, CV_DEFAULT, NULL);
336 /* this counts on no keyboards being above ipl 12 */
337 mutex_init(&upper->progressbar_key_abort_lock, NULL, MUTEX_SPIN,
338 (void *)ipltospl(12));
339 tid = thread_create(NULL, 0, progressbar_key_abort_thread, upper,
340 0, &p0, TS_RUN, minclsyspri);
341 upper->progressbar_key_abort_t_did = tid->t_did;
342
343 DPRINTF(PRINT_L1, PRINT_MASK_OPEN, (upper, "kbtrans_streams_init "
344 "exiting"));
345 return (0);
346 }
347
348
349 /*
350 * kbtrans_streams_fini:
351 * Free structures and uninitialize the stream
352 */
353 int
354 kbtrans_streams_fini(struct kbtrans *upper)
355 {
356 /*
357 * Since we're about to destroy our private data, turn off
358 * our open flag first, so we don't accept any more input
359 * and try to use that data.
360 */
361 upper->kbtrans_streams_flags = 0;
362
363 /* clear all timeouts */
364 if (upper->kbtrans_streams_bufcallid) {
365 qunbufcall(upper->kbtrans_streams_readq,
366 upper->kbtrans_streams_bufcallid);
367 }
368 if (upper->kbtrans_streams_rptid) {
369 (void) quntimeout(upper->kbtrans_streams_readq,
370 upper->kbtrans_streams_rptid);
371 }
372 kmem_free(upper->kbtrans_streams_downs,
373 upper->kbtrans_streams_downs_bytes);
374
375 mutex_enter(&upper->progressbar_key_abort_lock);
376 if (upper->progressbar_key_abort_flag == 0) {
377 upper->progressbar_key_abort_flag = 2;
378 cv_signal(&upper->progressbar_key_abort_cv);
379 mutex_exit(&upper->progressbar_key_abort_lock);
380 thread_join(upper->progressbar_key_abort_t_did);
381 } else {
382 mutex_exit(&upper->progressbar_key_abort_lock);
383 }
384 cv_destroy(&upper->progressbar_key_abort_cv);
385 mutex_destroy(&upper->progressbar_key_abort_lock);
386
387 kmem_free(upper, sizeof (struct kbtrans));
388
389 DPRINTF(PRINT_L1, PRINT_MASK_CLOSE, (upper, "kbtrans_streams_fini "
390 "exiting"));
391 return (0);
392 }
393
394 /*
395 * kbtrans_streams_releaseall :
396 * This function releases all the held keys.
397 */
398 void
399 kbtrans_streams_releaseall(struct kbtrans *upper)
400 {
401 register struct key_event *ke;
402 register int i;
403
404 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (NULL, "USBKBM RELEASE ALL\n"));
405
406 /* Scan table of down key stations */
407 for (i = 0, ke = upper->kbtrans_streams_downs;
408 i < upper->kbtrans_streams_num_downs_entries; i++, ke++) {
409
410 /* Key station not zero */
411 if (ke->key_station) {
412
413 kbtrans_keyreleased(upper, ke->key_station);
414 /* kbtrans_keyreleased resets downs entry */
415 }
416 }
417 }
418
419 /*
420 * kbtrans_streams_message:
421 * keyboard module output queue put procedure: handles M_IOCTL
422 * messages.
423 *
424 * Return KBTRANS_MESSAGE_HANDLED if the message was handled by
425 * kbtrans and KBTRANS_MESSAGE_NOT_HANDLED otherwise. If
426 * KBTRANS_MESSAGE_HANDLED is returned, no further action is required.
427 * If KBTRANS_MESSAGE_NOT_HANDLED is returned, the hardware module
428 * is responsible for any action.
429 */
430 enum kbtrans_message_response
431 kbtrans_streams_message(struct kbtrans *upper, register mblk_t *mp)
432 {
433 queue_t *q = upper->kbtrans_streams_readq;
434 enum kbtrans_message_response ret;
435
436 DPRINTF(PRINT_L1, PRINT_MASK_ALL, (upper,
437 "kbtrans_streams_message entering"));
438 /*
439 * Process M_FLUSH, and some M_IOCTL, messages here; pass
440 * everything else down.
441 */
442 switch (mp->b_datap->db_type) {
443
444 case M_IOCTL:
445 ret = kbtrans_ioctl(upper, mp);
446 break;
447
448 case M_FLUSH:
449 if (*mp->b_rptr & FLUSHW)
450 flushq(q, FLUSHDATA);
451 if (*mp->b_rptr & FLUSHR)
452 flushq(RD(q), FLUSHDATA);
453 /*
454 * White lie: we say we didn't handle the message,
455 * so that it gets handled by our client.
456 */
457 ret = KBTRANS_MESSAGE_NOT_HANDLED;
458 break;
459
460 default:
461 ret = KBTRANS_MESSAGE_NOT_HANDLED;
462 break;
463
464 }
465 DPRINTF(PRINT_L1, PRINT_MASK_ALL, (upper,
466 "kbtrans_streams_message exiting\n"));
467
468 return (ret);
469 }
470
471 /*
472 * kbtrans_streams_key:
473 * When a key is pressed or released, the hardware module should
474 * call kbtrans, passing the key number and its new
475 * state. kbtrans is responsible for autorepeat handling;
476 * the hardware module should report only actual press/release
477 * events, suppressing any hardware-generated autorepeat.
478 */
479 void
480 kbtrans_streams_key(
481 struct kbtrans *upper,
482 kbtrans_key_t key,
483 enum keystate state)
484 {
485 struct kbtrans_lower *lower;
486 struct keyboard *kp;
487
488 lower = &upper->kbtrans_lower;
489 kp = lower->kbtrans_keyboard;
490
491 /* trigger switch back to text mode */
492 mutex_enter(&upper->progressbar_key_abort_lock);
493 if (upper->progressbar_key_abort_flag == 0) {
494 upper->progressbar_key_abort_flag = 1;
495 cv_signal(&upper->progressbar_key_abort_cv);
496 }
497 mutex_exit(&upper->progressbar_key_abort_lock);
498
499 if (upper->kbtrans_streams_abortable) {
500 switch (upper->kbtrans_streams_abort_state) {
501 case ABORT_NORMAL:
502 if (state != KEY_PRESSED)
503 break;
504
505 if (key == (kbtrans_key_t)kp->k_abort1 ||
506 key == (kbtrans_key_t)kp->k_abort1a) {
507 upper->kbtrans_streams_abort_state =
508 ABORT_ABORT1_RECEIVED;
509 upper->kbtrans_streams_abort1_key = key;
510 return;
511 }
512 /* Shift key needs to be sent to upper immediately */
513 if (key == (kbtrans_key_t)kp->k_newabort1 ||
514 key == (kbtrans_key_t)kp->k_newabort1a) {
515 upper->kbtrans_streams_abort_state =
516 NEW_ABORT_ABORT1_RECEIVED;
517 upper->kbtrans_streams_new_abort1_key = key;
518 }
519 break;
520 case ABORT_ABORT1_RECEIVED:
521 upper->kbtrans_streams_abort_state = ABORT_NORMAL;
522 if (state == KEY_PRESSED &&
523 key == (kbtrans_key_t)kp->k_abort2) {
524 abort_sequence_enter((char *)NULL);
525 return;
526 } else {
527 kbtrans_processkey(lower,
528 upper->kbtrans_streams_callback,
529 upper->kbtrans_streams_abort1_key,
530 KEY_PRESSED);
531 }
532 break;
533 case NEW_ABORT_ABORT1_RECEIVED:
534 upper->kbtrans_streams_abort_state = ABORT_NORMAL;
535 if (state == KEY_PRESSED &&
536 key == (kbtrans_key_t)kp->k_newabort2) {
537 abort_sequence_enter((char *)NULL);
538 kbtrans_processkey(lower,
539 upper->kbtrans_streams_callback,
540 upper->kbtrans_streams_new_abort1_key,
541 KEY_RELEASED);
542 return;
543 }
544 }
545 }
546
547 kbtrans_processkey(lower, upper->kbtrans_streams_callback, key, state);
548 }
549
550 /*
551 * kbtrans_streams_set_keyboard:
552 * At any time after calling kbtrans_streams_init, the hardware
553 * module should make this call to report the id of the keyboard
554 * attached. id is the keyboard type, typically KB_SUN4,
555 * KB_PC, or KB_USB.
556 */
557 void
558 kbtrans_streams_set_keyboard(
559 struct kbtrans *upper,
560 int id,
561 struct keyboard *k)
562 {
563 upper->kbtrans_lower.kbtrans_keyboard = k;
564 upper->kbtrans_streams_id = id;
565 }
566
567 /*
568 * kbtrans_streams_has_reset:
569 * At any time between kbtrans_streams_init and kbtrans_streams_fini,
570 * the hardware module can call this routine to report that the
571 * keyboard has been reset, e.g. by being unplugged and reattached.
572 */
573 /*ARGSUSED*/
574 void
575 kbtrans_streams_has_reset(struct kbtrans *upper)
576 {
577 /*
578 * If this routine is implemented it should probably (a)
579 * simulate releases of all pressed keys and (b) call
580 * the hardware module to set the LEDs.
581 */
582 }
583
584 /*
585 * kbtrans_streams_enable:
586 * This is the routine that is called back when the the stream is ready
587 * to take messages.
588 */
589 void
590 kbtrans_streams_enable(struct kbtrans *upper)
591 {
592 /* Set the LED's */
593 kbtrans_setled(upper);
594 }
595
596 /*
597 * kbtrans_streams_setled():
598 * This is the routine that is called to only update the led state
599 * in kbtrans.
600 */
601 void
602 kbtrans_streams_setled(struct kbtrans *upper, int led_state)
603 {
604 struct kbtrans_lower *lower;
605
606 lower = &upper->kbtrans_lower;
607 lower->kbtrans_led_state = (uchar_t)led_state;
608
609 if (lower->kbtrans_led_state & LED_CAPS_LOCK)
610 lower->kbtrans_togglemask |= CAPSMASK;
611 if (lower->kbtrans_led_state & LED_NUM_LOCK)
612 lower->kbtrans_togglemask |= NUMLOCKMASK;
613
614 #if defined(SCROLLMASK)
615 if (lower->kbtrans_led_state & LED_SCROLL_LOCK)
616 lower->kbtrans_togglemask |= SCROLLMASK;
617 #endif
618
619 lower->kbtrans_shiftmask = lower->kbtrans_togglemask;
620
621 }
622
623 /*
624 * kbtrans_streams_set_queue:
625 * Set the overlying queue, to support multiplexors.
626 */
627 void
628 kbtrans_streams_set_queue(struct kbtrans *upper, queue_t *q)
629 {
630
631 upper->kbtrans_streams_readq = q;
632 }
633
634 /*
635 * kbtrans_streams_get_queue:
636 * Return the overlying queue.
637 */
638 queue_t *
639 kbtrans_streams_get_queue(struct kbtrans *upper)
640 {
641 return (upper->kbtrans_streams_readq);
642 }
643
644 /*
645 * kbtrans_streams_untimeout
646 * Cancell all timeout
647 */
648 void
649 kbtrans_streams_untimeout(struct kbtrans *upper)
650 {
651 /* clear all timeouts */
652 if (upper->kbtrans_streams_bufcallid) {
653 qunbufcall(upper->kbtrans_streams_readq,
654 upper->kbtrans_streams_bufcallid);
655 upper->kbtrans_streams_bufcallid = 0;
656 }
657 if (upper->kbtrans_streams_rptid) {
658 (void) quntimeout(upper->kbtrans_streams_readq,
659 upper->kbtrans_streams_rptid);
660 upper->kbtrans_streams_rptid = 0;
661 }
662 }
663
664 /*
665 * kbtrans_reioctl:
666 * This function is set up as call-back function should an ioctl fail
667 * to allocate required resources.
668 */
669 static void
670 kbtrans_reioctl(void *arg)
671 {
672 struct kbtrans *upper = (struct kbtrans *)arg;
673 mblk_t *mp;
674
675 upper->kbtrans_streams_bufcallid = 0;
676
677 if ((mp = upper->kbtrans_streams_iocpending) != NULL) {
678 /* not pending any more */
679 upper->kbtrans_streams_iocpending = NULL;
680 (void) kbtrans_ioctl(upper, mp);
681 }
682 }
683
684 /*
685 * kbtrans_ioctl:
686 * process ioctls we recognize and own. Otherwise, pass it down.
687 */
688 static enum kbtrans_message_response
689 kbtrans_ioctl(struct kbtrans *upper, register mblk_t *mp)
690 {
691 register struct iocblk *iocp;
692 register short new_translate;
693 register Vuid_addr_probe *addr_probe;
694 register short *addr_ptr;
695 size_t ioctlrespsize;
696 int err = 0;
697 struct kbtrans_lower *lower;
698 mblk_t *datap;
699 int translate;
700
701 static int kiocgetkey, kiocsetkey;
702
703 lower = &upper->kbtrans_lower;
704
705 iocp = (struct iocblk *)mp->b_rptr;
706
707 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper,
708 "kbtrans_ioctl: ioc_cmd 0x%x - ", iocp->ioc_cmd));
709 switch (iocp->ioc_cmd) {
710
711 case VUIDSFORMAT:
712 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "VUIDSFORMAT\n"));
713
714 err = miocpullup(mp, sizeof (int));
715 if (err != 0)
716 break;
717 new_translate = (*(int *)mp->b_cont->b_rptr == VUID_NATIVE) ?
718 TR_ASCII : TR_EVENT;
719
720 if (new_translate == upper->kbtrans_streams_translate_mode)
721 break;
722 upper->kbtrans_streams_translate_mode = new_translate;
723
724 kbtrans_set_translation_callback(upper);
725
726 kbtrans_flush(upper);
727 break;
728
729 case KIOCTRANS:
730 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCTRANS\n"));
731 err = miocpullup(mp, sizeof (int));
732 if (err != 0)
733 break;
734 new_translate = *(int *)mp->b_cont->b_rptr;
735 if (new_translate == upper->kbtrans_streams_translate_mode)
736 break;
737 upper->kbtrans_streams_translate_mode = new_translate;
738 kbtrans_set_translation_callback(upper);
739
740 kbtrans_flush(upper);
741 break;
742
743 case KIOCSLED:
744 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSLED\n"));
745
746 err = miocpullup(mp, sizeof (uchar_t));
747 if (err != 0)
748 break;
749 lower->kbtrans_led_state = *(uchar_t *)mp->b_cont->b_rptr;
750
751 kbtrans_setled(upper);
752 break;
753
754 case KIOCGLED:
755 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGLED\n"));
756 if ((datap = allocb(sizeof (uchar_t), BPRI_HI)) == NULL) {
757 ioctlrespsize = sizeof (int);
758 goto allocfailure;
759 }
760
761 *(uchar_t *)datap->b_wptr = lower->kbtrans_led_state;
762 datap->b_wptr += sizeof (uchar_t);
763 if (mp->b_cont)
764 freemsg(mp->b_cont);
765 mp->b_cont = datap;
766 iocp->ioc_count = sizeof (uchar_t);
767 break;
768
769 case VUIDGFORMAT:
770 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "VUIDGFORMAT\n"));
771 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
772 ioctlrespsize = sizeof (int);
773 goto allocfailure;
774 }
775 *(int *)datap->b_wptr =
776 (upper->kbtrans_streams_translate_mode == TR_EVENT ||
777 upper->kbtrans_streams_translate_mode == TR_UNTRANS_EVENT) ?
778 VUID_FIRM_EVENT: VUID_NATIVE;
779 datap->b_wptr += sizeof (int);
780 if (mp->b_cont) /* free msg to prevent memory leak */
781 freemsg(mp->b_cont);
782 mp->b_cont = datap;
783 iocp->ioc_count = sizeof (int);
784 break;
785
786 case KIOCGTRANS:
787 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGTRANS\n"));
788 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
789 ioctlrespsize = sizeof (int);
790 goto allocfailure;
791 }
792 *(int *)datap->b_wptr = upper->kbtrans_streams_translate_mode;
793 datap->b_wptr += sizeof (int);
794 if (mp->b_cont) /* free msg to prevent memory leak */
795 freemsg(mp->b_cont);
796 mp->b_cont = datap;
797 iocp->ioc_count = sizeof (int);
798 break;
799
800 case VUIDSADDR:
801 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "VUIDSADDR\n"));
802
803 err = miocpullup(mp, sizeof (Vuid_addr_probe));
804 if (err != 0)
805 break;
806 addr_probe = (Vuid_addr_probe *)mp->b_cont->b_rptr;
807 switch (addr_probe->base) {
808
809 case ASCII_FIRST:
810 addr_ptr = &upper->kbtrans_streams_vuid_addr.ascii;
811 break;
812
813 case TOP_FIRST:
814 addr_ptr = &upper->kbtrans_streams_vuid_addr.top;
815 break;
816
817 case VKEY_FIRST:
818 addr_ptr = &upper->kbtrans_streams_vuid_addr.vkey;
819 break;
820
821 default:
822 err = ENODEV;
823 }
824
825 if ((err == 0) && (*addr_ptr != addr_probe->data.next)) {
826 *addr_ptr = addr_probe->data.next;
827 kbtrans_flush(upper);
828 }
829 break;
830
831 case VUIDGADDR:
832 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "VUIDGADDR\n"));
833
834 err = miocpullup(mp, sizeof (Vuid_addr_probe));
835 if (err != 0)
836 break;
837 addr_probe = (Vuid_addr_probe *)mp->b_cont->b_rptr;
838 switch (addr_probe->base) {
839
840 case ASCII_FIRST:
841 addr_probe->data.current =
842 upper->kbtrans_streams_vuid_addr.ascii;
843 break;
844
845 case TOP_FIRST:
846 addr_probe->data.current =
847 upper->kbtrans_streams_vuid_addr.top;
848 break;
849
850 case VKEY_FIRST:
851 addr_probe->data.current =
852 upper->kbtrans_streams_vuid_addr.vkey;
853 break;
854
855 default:
856 err = ENODEV;
857 }
858 break;
859
860 case KIOCTRANSABLE:
861 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCTRANSABLE\n"));
862
863 err = miocpullup(mp, sizeof (int));
864 if (err != 0)
865 break;
866 /*
867 * called during console setup in kbconfig()
868 * If set to false, means we are a serial keyboard,
869 * and we should pass all data up without modification.
870 */
871 translate = *(int *)mp->b_cont->b_rptr;
872 if (upper->kbtrans_streams_translatable != translate)
873 upper->kbtrans_streams_translatable = translate;
874
875 if (translate != TR_CAN)
876 DPRINTF(PRINT_L4, PRINT_MASK_ALL, (upper,
877 "Cannot translate keyboard using tables.\n"));
878 break;
879
880 case KIOCGTRANSABLE:
881 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGTRANSABLE\n"));
882 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
883 ioctlrespsize = sizeof (int);
884 goto allocfailure;
885 }
886 *(int *)datap->b_wptr = upper->kbtrans_streams_translatable;
887 datap->b_wptr += sizeof (int);
888 if (mp->b_cont) /* free msg to prevent memory leak */
889 freemsg(mp->b_cont);
890 mp->b_cont = datap;
891 iocp->ioc_count = sizeof (int);
892 break;
893
894 case KIOCSCOMPAT:
895 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSCOMPAT\n"));
896
897 err = miocpullup(mp, sizeof (int));
898 if (err != 0)
899 break;
900 lower->kbtrans_compat = *(int *)mp->b_cont->b_rptr;
901 break;
902
903 case KIOCGCOMPAT:
904 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGCOMPAT\n"));
905 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
906 ioctlrespsize = sizeof (int);
907 goto allocfailure;
908 }
909 *(int *)datap->b_wptr = lower->kbtrans_compat;
910 datap->b_wptr += sizeof (int);
911 if (mp->b_cont) /* free msg to prevent memory leak */
912 freemsg(mp->b_cont);
913 mp->b_cont = datap;
914 iocp->ioc_count = sizeof (int);
915 break;
916
917 case KIOCSETKEY:
918 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSETKEY %d\n",
919 kiocsetkey++));
920 err = miocpullup(mp, sizeof (struct kiockey));
921 if (err != 0)
922 break;
923 err = kbtrans_setkey(&upper->kbtrans_lower,
924 (struct kiockey *)mp->b_cont->b_rptr, iocp->ioc_cr);
925 /*
926 * Since this only affects any subsequent key presses,
927 * don't flush soft state. One might want to
928 * toggle the keytable entries dynamically.
929 */
930 break;
931
932 case KIOCGETKEY:
933 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGETKEY %d\n",
934 kiocgetkey++));
935 err = miocpullup(mp, sizeof (struct kiockey));
936 if (err != 0)
937 break;
938 err = kbtrans_getkey(&upper->kbtrans_lower,
939 (struct kiockey *)mp->b_cont->b_rptr);
940 break;
941
942 case KIOCSKEY:
943 err = miocpullup(mp, sizeof (struct kiockeymap));
944 if (err != 0)
945 break;
946 err = kbtrans_skey(&upper->kbtrans_lower,
947 (struct kiockeymap *)mp->b_cont->b_rptr, iocp->ioc_cr);
948 /*
949 * Since this only affects any subsequent key presses,
950 * don't flush soft state. One might want to
951 * toggle the keytable entries dynamically.
952 */
953 break;
954
955 case KIOCGKEY:
956 err = miocpullup(mp, sizeof (struct kiockeymap));
957 if (err != 0)
958 break;
959 err = kbtrans_gkey(&upper->kbtrans_lower,
960 (struct kiockeymap *)mp->b_cont->b_rptr);
961 break;
962
963 case KIOCSDIRECT:
964 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSDIRECT\n"));
965 kbtrans_flush(upper);
966 break;
967
968 case KIOCGDIRECT:
969 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSGDIRECT\n"));
970 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
971 ioctlrespsize = sizeof (int);
972 goto allocfailure;
973 }
974 *(int *)datap->b_wptr = 1; /* always direct */
975 datap->b_wptr += sizeof (int);
976 if (mp->b_cont) /* free msg to prevent memory leak */
977 freemsg(mp->b_cont);
978 mp->b_cont = datap;
979 iocp->ioc_count = sizeof (int);
980 break;
981
982 case KIOCTYPE:
983 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCTYPE\n"));
984 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
985 ioctlrespsize = sizeof (int);
986 goto allocfailure;
987 }
988 *(int *)datap->b_wptr = upper->kbtrans_streams_id;
989 datap->b_wptr += sizeof (int);
990 if (mp->b_cont) /* free msg to prevent memory leak */
991 freemsg(mp->b_cont);
992 mp->b_cont = datap;
993 iocp->ioc_count = sizeof (int);
994 break;
995
996 case CONSSETABORTENABLE:
997 /*
998 * Peek as it goes by; must be a TRANSPARENT ioctl.
999 */
1000 if (iocp->ioc_count != TRANSPARENT) {
1001 err = EINVAL;
1002 break;
1003 }
1004
1005 upper->kbtrans_streams_abortable =
1006 (boolean_t)*(intptr_t *)mp->b_cont->b_rptr;
1007
1008 /*
1009 * Let the hardware module see it too.
1010 */
1011 return (KBTRANS_MESSAGE_NOT_HANDLED);
1012
1013 case KIOCGRPTDELAY:
1014 /*
1015 * Report the autorepeat delay, unit in millisecond
1016 */
1017 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGRPTDELAY\n"));
1018 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
1019 ioctlrespsize = sizeof (int);
1020 goto allocfailure;
1021 }
1022 *(int *)datap->b_wptr = TICK_TO_MSEC(kbtrans_repeat_delay);
1023 datap->b_wptr += sizeof (int);
1024
1025 /* free msg to prevent memory leak */
1026 if (mp->b_cont != NULL)
1027 freemsg(mp->b_cont);
1028 mp->b_cont = datap;
1029 iocp->ioc_count = sizeof (int);
1030 break;
1031
1032 case KIOCSRPTDELAY:
1033 /*
1034 * Set the autorepeat delay
1035 */
1036 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSRPTDELAY\n"));
1037 err = miocpullup(mp, sizeof (int));
1038
1039 if (err != 0)
1040 break;
1041
1042 /* validate the input */
1043 if (*(int *)mp->b_cont->b_rptr < KIOCRPTDELAY_MIN) {
1044 err = EINVAL;
1045 break;
1046 }
1047 kbtrans_repeat_delay = MSEC_TO_TICK(*(int *)mp->b_cont->b_rptr);
1048 if (kbtrans_repeat_delay <= 0)
1049 kbtrans_repeat_delay = 1;
1050 break;
1051
1052 case KIOCGRPTRATE:
1053 /*
1054 * Report the autorepeat rate
1055 */
1056 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCGRPTRATE\n"));
1057 if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
1058 ioctlrespsize = sizeof (int);
1059 goto allocfailure;
1060 }
1061 *(int *)datap->b_wptr = TICK_TO_MSEC(kbtrans_repeat_rate);
1062 datap->b_wptr += sizeof (int);
1063
1064 /* free msg to prevent memory leak */
1065 if (mp->b_cont != NULL)
1066 freemsg(mp->b_cont);
1067 mp->b_cont = datap;
1068 iocp->ioc_count = sizeof (int);
1069 break;
1070
1071 case KIOCSRPTRATE:
1072 /*
1073 * Set the autorepeat rate
1074 */
1075 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "KIOCSRPTRATE\n"));
1076 err = miocpullup(mp, sizeof (int));
1077
1078 if (err != 0)
1079 break;
1080
1081 /* validate the input */
1082 if (*(int *)mp->b_cont->b_rptr < KIOCRPTRATE_MIN) {
1083 err = EINVAL;
1084 break;
1085 }
1086 kbtrans_repeat_rate = MSEC_TO_TICK(*(int *)mp->b_cont->b_rptr);
1087 if (kbtrans_repeat_rate <= 0)
1088 kbtrans_repeat_rate = 1;
1089 break;
1090
1091 default:
1092 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (upper, "unknown\n"));
1093 return (KBTRANS_MESSAGE_NOT_HANDLED);
1094 } /* end switch */
1095
1096 if (err != 0) {
1097 iocp->ioc_rval = 0;
1098 iocp->ioc_error = err;
1099 mp->b_datap->db_type = M_IOCNAK;
1100 } else {
1101 iocp->ioc_rval = 0;
1102 iocp->ioc_error = 0; /* brain rot */
1103 mp->b_datap->db_type = M_IOCACK;
1104 }
1105 putnext(upper->kbtrans_streams_readq, mp);
1106
1107 return (KBTRANS_MESSAGE_HANDLED);
1108
1109 allocfailure:
1110 /*
1111 * We needed to allocate something to handle this "ioctl", but
1112 * couldn't; save this "ioctl" and arrange to get called back when
1113 * it's more likely that we can get what we need.
1114 * If there's already one being saved, throw it out, since it
1115 * must have timed out.
1116 */
1117 if (upper->kbtrans_streams_iocpending != NULL)
1118 freemsg(upper->kbtrans_streams_iocpending);
1119 upper->kbtrans_streams_iocpending = mp;
1120 if (upper->kbtrans_streams_bufcallid) {
1121 qunbufcall(upper->kbtrans_streams_readq,
1122 upper->kbtrans_streams_bufcallid);
1123 }
1124 upper->kbtrans_streams_bufcallid =
1125 qbufcall(upper->kbtrans_streams_readq, ioctlrespsize, BPRI_HI,
1126 kbtrans_reioctl, upper);
1127 /*
1128 * This is a white lie... we *will* handle it, eventually.
1129 */
1130 return (KBTRANS_MESSAGE_HANDLED);
1131 }
1132
1133 /*
1134 * kbtrans_flush:
1135 * Flush data upstream
1136 */
1137 static void
1138 kbtrans_flush(register struct kbtrans *upper)
1139 {
1140 register queue_t *q;
1141
1142 /* Flush pending data already sent upstream */
1143 if ((q = upper->kbtrans_streams_readq) != NULL && q->q_next != NULL)
1144 (void) putnextctl1(q, M_FLUSH, FLUSHR);
1145
1146 /* Flush pending ups */
1147 bzero(upper->kbtrans_streams_downs, upper->kbtrans_streams_downs_bytes);
1148
1149 kbtrans_cancelrpt(upper);
1150 }
1151
1152 /*
1153 * kbtrans_setled:
1154 * Update the keyboard LEDs to match the current keyboard state.
1155 */
1156 static void
1157 kbtrans_setled(struct kbtrans *upper)
1158 {
1159 upper->kbtrans_streams_hw_callbacks->kbtrans_streams_setled(
1160 upper->kbtrans_streams_hw,
1161 upper->kbtrans_lower.kbtrans_led_state);
1162 }
1163
1164 /*
1165 * kbtrans_rpt:
1166 * If a key is held down, this function is set up to be called
1167 * after kbtrans_repeat_rate time elapses.
1168 */
1169 static void
1170 kbtrans_rpt(void *arg)
1171 {
1172 struct kbtrans *upper = arg;
1173 struct kbtrans_lower *lower = &upper->kbtrans_lower;
1174
1175 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (NULL,
1176 "kbtrans_rpt: repeat key %X\n",
1177 lower->kbtrans_repeatkey));
1178
1179 upper->kbtrans_streams_rptid = 0;
1180
1181 /*
1182 * NB: polled code zaps kbtrans_repeatkey without cancelling
1183 * timeout.
1184 */
1185 if (lower->kbtrans_repeatkey != 0) {
1186 kbtrans_keyreleased(upper, lower->kbtrans_repeatkey);
1187
1188 kbtrans_processkey(lower,
1189 upper->kbtrans_streams_callback,
1190 lower->kbtrans_repeatkey,
1191 KEY_PRESSED);
1192
1193 upper->kbtrans_streams_rptid =
1194 qtimeout(upper->kbtrans_streams_readq, kbtrans_rpt,
1195 (caddr_t)upper, kbtrans_repeat_rate);
1196 }
1197 }
1198
1199 /*
1200 * kbtrans_cancelrpt:
1201 * Cancel the repeating key
1202 */
1203 static void
1204 kbtrans_cancelrpt(struct kbtrans *upper)
1205 {
1206 upper->kbtrans_lower.kbtrans_repeatkey = 0;
1207
1208 if (upper->kbtrans_streams_rptid != 0) {
1209 (void) quntimeout(upper->kbtrans_streams_readq,
1210 upper->kbtrans_streams_rptid);
1211 upper->kbtrans_streams_rptid = 0;
1212 }
1213 }
1214
1215 /*
1216 * kbtrans_send_esc_event:
1217 * Send character up stream. Used for the case of
1218 * sending strings upstream.
1219 */
1220 static void
1221 kbtrans_send_esc_event(char c, register struct kbtrans *upper)
1222 {
1223 Firm_event fe;
1224
1225 fe.id = c;
1226 fe.value = 1;
1227 fe.pair_type = FE_PAIR_NONE;
1228 fe.pair = 0;
1229 /*
1230 * Pretend as if each cp pushed and released
1231 * Calling kbtrans_queueevent avoids addr translation
1232 * and pair base determination of kbtrans_keypressed.
1233 */
1234 kbtrans_queueevent(upper, &fe);
1235 fe.value = 0;
1236 kbtrans_queueevent(upper, &fe);
1237 }
1238
1239 /*
1240 * kbtrans_strsetwithdecimal:
1241 * Used for expanding a function key to the ascii equivalent
1242 */
1243 static char *
1244 kbtrans_strsetwithdecimal(char *buf, uint_t val, uint_t maxdigs)
1245 {
1246 int hradix = 5;
1247 char *bp;
1248 int lowbit;
1249 char *tab = "0123456789abcdef";
1250
1251 bp = buf + maxdigs;
1252 *(--bp) = '\0';
1253 while (val) {
1254 lowbit = val & 1;
1255 val = (val >> 1);
1256 *(--bp) = tab[val % hradix * 2 + lowbit];
1257 val /= hradix;
1258 }
1259 return (bp);
1260 }
1261
1262 /*
1263 * kbtrans_keypressed:
1264 * Modify Firm event to be sent up the stream
1265 */
1266 static void
1267 kbtrans_keypressed(struct kbtrans *upper, uchar_t key_station,
1268 Firm_event *fe, ushort_t base)
1269 {
1270
1271 register short id_addr;
1272 struct kbtrans_lower *lower = &upper->kbtrans_lower;
1273
1274 /* Set pair values */
1275 if (fe->id < (ushort_t)VKEY_FIRST) {
1276 /*
1277 * If CTRLed, find the ID that would have been used had it
1278 * not been CTRLed.
1279 */
1280 if (lower->kbtrans_shiftmask & (CTRLMASK | CTLSMASK)) {
1281 unsigned short *ke;
1282 unsigned int mask;
1283
1284 mask = lower->kbtrans_shiftmask &
1285 ~(CTRLMASK | CTLSMASK | UPMASK);
1286
1287 ke = kbtrans_find_entry(lower, mask, key_station);
1288 if (ke == NULL)
1289 return;
1290
1291 base = *ke;
1292 }
1293 if (base != fe->id) {
1294 fe->pair_type = FE_PAIR_SET;
1295 fe->pair = (uchar_t)base;
1296
1297 goto send;
1298 }
1299 }
1300 fe->pair_type = FE_PAIR_NONE;
1301 fe->pair = 0;
1302
1303 send:
1304 /* Adjust event id address for multiple keyboard/workstation support */
1305 switch (vuid_id_addr(fe->id)) {
1306 case ASCII_FIRST:
1307 id_addr = upper->kbtrans_streams_vuid_addr.ascii;
1308 break;
1309 case TOP_FIRST:
1310 id_addr = upper->kbtrans_streams_vuid_addr.top;
1311 break;
1312 case VKEY_FIRST:
1313 id_addr = upper->kbtrans_streams_vuid_addr.vkey;
1314 break;
1315 default:
1316 id_addr = vuid_id_addr(fe->id);
1317 break;
1318 }
1319 fe->id = vuid_id_offset(fe->id) | id_addr;
1320
1321 kbtrans_queuepress(upper, key_station, fe);
1322 }
1323
1324 /*
1325 * kbtrans_queuepress:
1326 * Add keypress to the "downs" table
1327 */
1328 static void
1329 kbtrans_queuepress(struct kbtrans *upper,
1330 uchar_t key_station, Firm_event *fe)
1331 {
1332 register struct key_event *ke, *ke_free;
1333 register int i;
1334
1335 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (NULL, "kbtrans_queuepress:"
1336 " key=%d", key_station));
1337
1338 ke_free = 0;
1339
1340 /* Scan table of down key stations */
1341
1342 for (i = 0, ke = upper->kbtrans_streams_downs;
1343 i < upper->kbtrans_streams_num_downs_entries; i++, ke++) {
1344
1345 /* Keycode already down? */
1346 if (ke->key_station == key_station) {
1347
1348 DPRINTF(PRINT_L0, PRINT_MASK_ALL,
1349 (NULL, "kbtrans: Double "
1350 "entry in downs table (%d,%d)!\n",
1351 key_station, i));
1352
1353 goto add_event;
1354 }
1355
1356 if (ke->key_station == 0)
1357 ke_free = ke;
1358 }
1359
1360 if (ke_free) {
1361 ke = ke_free;
1362 goto add_event;
1363 }
1364
1365 ke = upper->kbtrans_streams_downs;
1366
1367 add_event:
1368 ke->key_station = key_station;
1369 ke->event = *fe;
1370 kbtrans_queueevent(upper, fe);
1371 }
1372
1373 /*
1374 * kbtrans_keyreleased:
1375 * Remove entry from the downs table
1376 */
1377 static void
1378 kbtrans_keyreleased(register struct kbtrans *upper, uchar_t key_station)
1379 {
1380 register struct key_event *ke;
1381 register int i;
1382
1383 DPRINTF(PRINT_L0, PRINT_MASK_ALL, (NULL, "RELEASE key=%d\n",
1384 key_station));
1385
1386 if (upper->kbtrans_streams_translate_mode != TR_EVENT &&
1387 upper->kbtrans_streams_translate_mode != TR_UNTRANS_EVENT) {
1388
1389 return;
1390 }
1391
1392 /* Scan table of down key stations */
1393 for (i = 0, ke = upper->kbtrans_streams_downs;
1394 i < upper->kbtrans_streams_num_downs_entries;
1395 i++, ke++) {
1396 /* Found? */
1397 if (ke->key_station == key_station) {
1398 ke->key_station = 0;
1399 ke->event.value = 0;
1400 kbtrans_queueevent(upper, &ke->event);
1401 }
1402 }
1403
1404 /*
1405 * Ignore if couldn't find because may be called twice
1406 * for the same key station in the case of the kbtrans_rpt
1407 * routine being called unnecessarily.
1408 */
1409 }
1410
1411
1412 /*
1413 * kbtrans_putcode:
1414 * Pass a keycode up the stream, if you can, otherwise throw it away.
1415 */
1416 static void
1417 kbtrans_putcode(register struct kbtrans *upper, uint_t code)
1418 {
1419 register mblk_t *bp;
1420
1421 /*
1422 * If we can't send it up, then we just drop it.
1423 */
1424 if (!canputnext(upper->kbtrans_streams_readq)) {
1425
1426 return;
1427 }
1428
1429 /*
1430 * Allocate a messsage block to send up.
1431 */
1432 if ((bp = allocb(sizeof (uint_t), BPRI_HI)) == NULL) {
1433
1434 cmn_err(CE_WARN, "kbtrans_putcode: Can't allocate block\
1435 for keycode.");
1436
1437 return;
1438 }
1439
1440 /*
1441 * We will strip out any high order information here.
1442 */
1443 /* NOTE the implicit cast here */
1444 *bp->b_wptr++ = (uchar_t)code;
1445
1446 /*
1447 * Send the message up.
1448 */
1449 (void) putnext(upper->kbtrans_streams_readq, bp);
1450 }
1451
1452
1453 /*
1454 * kbtrans_putbuf:
1455 * Pass generated keycode sequence to upstream, if possible.
1456 */
1457 static void
1458 kbtrans_putbuf(char *buf, queue_t *q)
1459 {
1460 register mblk_t *bp;
1461
1462 if (!canputnext(q)) {
1463 cmn_err(CE_WARN, "kbtrans_putbuf: Can't put block for keycode");
1464 } else {
1465 if ((bp = allocb((int)strlen(buf), BPRI_HI)) == NULL) {
1466 cmn_err(CE_WARN, "kbtrans_putbuf: "
1467 "Can't allocate block for keycode");
1468 } else {
1469 while (*buf) {
1470 *bp->b_wptr++ = *buf;
1471 buf++;
1472 }
1473 putnext(q, bp);
1474 }
1475 }
1476 }
1477
1478 /*
1479 * kbtrans_queueevent:
1480 * Pass a VUID "firm event" up the stream, if you can.
1481 */
1482 static void
1483 kbtrans_queueevent(struct kbtrans *upper, Firm_event *fe)
1484 {
1485 register queue_t *q;
1486 register mblk_t *bp;
1487
1488 if ((q = upper->kbtrans_streams_readq) == NULL)
1489
1490 return;
1491
1492 if (!canputnext(q)) {
1493 if (kbtrans_overflow_msg) {
1494 DPRINTF(PRINT_L2, PRINT_MASK_ALL, (NULL,
1495 "kbtrans: Buffer flushed when overflowed."));
1496 }
1497
1498 kbtrans_flush(upper);
1499 upper->kbtrans_overflow_cnt++;
1500 } else {
1501 if ((bp = allocb(sizeof (Firm_event), BPRI_HI)) == NULL) {
1502 cmn_err(CE_WARN, "kbtrans_queueevent: Can't allocate \
1503 block for event.");
1504 } else {
1505 uniqtime32(&fe->time);
1506 *(Firm_event *)bp->b_wptr = *fe;
1507 bp->b_wptr += sizeof (Firm_event);
1508 (void) putnext(q, bp);
1509
1510
1511 }
1512 }
1513 }
1514
1515 /*
1516 * kbtrans_set_translation_callback:
1517 * This code sets the translation_callback pointer based on the
1518 * translation mode.
1519 */
1520 static void
1521 kbtrans_set_translation_callback(register struct kbtrans *upper)
1522 {
1523 switch (upper->kbtrans_streams_translate_mode) {
1524
1525 default:
1526 case TR_ASCII:
1527 upper->vt_switch_keystate = VT_SWITCH_KEY_NONE;
1528
1529 /* Discard any obsolete CTRL/ALT/SHIFT keys */
1530 upper->kbtrans_lower.kbtrans_shiftmask &=
1531 ~(CTRLMASK | ALTMASK | SHIFTMASK);
1532 upper->kbtrans_lower.kbtrans_togglemask &=
1533 ~(CTRLMASK | ALTMASK | SHIFTMASK);
1534
1535 upper->kbtrans_streams_callback = &ascii_callback;
1536
1537 break;
1538
1539 case TR_EVENT:
1540 upper->kbtrans_streams_callback = &trans_event_callback;
1541
1542 break;
1543
1544 case TR_UNTRANS_EVENT:
1545 upper->kbtrans_streams_callback = &untrans_event_callback;
1546
1547 break;
1548 }
1549 }
1550
1551 /*
1552 * kbtrans_untrans_keypressed_raw:
1553 * This is the callback we get if we are in TR_UNTRANS_EVENT and a
1554 * key is pressed. This code will just send the scancode up the
1555 * stream.
1556 */
1557 static void
1558 kbtrans_untrans_keypressed_raw(struct kbtrans *upper, kbtrans_key_t key)
1559 {
1560 Firm_event fe;
1561
1562 bzero(&fe, sizeof (fe));
1563
1564 /*
1565 * fill in the event
1566 */
1567 fe.id = (unsigned short)key;
1568 fe.value = 1;
1569
1570 /*
1571 * Send the event upstream.
1572 */
1573 kbtrans_queuepress(upper, key, &fe);
1574 }
1575
1576 /*
1577 * kbtrans_untrans_keyreleased_raw:
1578 * This is the callback we get if we are in TR_UNTRANS_EVENT mode
1579 * and a key is released. This code will just send the scancode up
1580 * the stream.
1581 */
1582 static void
1583 kbtrans_untrans_keyreleased_raw(struct kbtrans *upper, kbtrans_key_t key)
1584 {
1585 /*
1586 * Deal with a key released event.
1587 */
1588 kbtrans_keyreleased(upper, key);
1589 }
1590
1591 /*
1592 * kbtrans_vt_compose:
1593 * To compose the key sequences for virtual terminal switching.
1594 *
1595 * 'ALTL + F#' for 1-12 terminals
1596 * 'ALTGR + F#' for 13-24 terminals
1597 * 'ALT + UPARROW' for last terminal
1598 * 'ALT + LEFTARROW' for previous terminal
1599 * 'ALT + RIGHTARROW' for next terminal
1600 *
1601 * the vt switching message is encoded as:
1602 *
1603 * -------------------------------------------------------------
1604 * | \033 | 'Q' | vtno + 'A' | opcode | 'z' | '\0' |
1605 * -------------------------------------------------------------
1606 *
1607 * opcode:
1608 * 'B' to switch to previous terminal
1609 * 'F' to switch to next terminal
1610 * 'L' to switch to last terminal
1611 * 'H' to switch to the terminal as specified by vtno,
1612 * which is from 1 to 24.
1613 *
1614 * Here keyid is the keycode of UPARROW, LEFTARROW, or RIGHTARROW
1615 * when it is a kind of arrow key as indicated by is_arrow_key,
1616 * otherwise it indicates a function key and keyid is the number
1617 * corresponding to that function key.
1618 */
1619 static void
1620 kbtrans_vt_compose(struct kbtrans *upper, unsigned short keyid,
1621 boolean_t is_arrow_key, char *buf)
1622 {
1623 char *bufp;
1624
1625 bufp = buf;
1626 *bufp++ = '\033'; /* Escape */
1627 *bufp++ = 'Q';
1628 if (is_arrow_key) {
1629 *bufp++ = 'A';
1630 switch (keyid) {
1631 case UPARROW: /* last vt */
1632 *bufp++ = 'L';
1633 break;
1634 case LEFTARROW: /* previous vt */
1635 *bufp++ = 'B';
1636 break;
1637 case RIGHTARROW: /* next vt */
1638 *bufp++ = 'F';
1639 break;
1640 default:
1641 break;
1642 }
1643 } else {
1644 /* this is funckey specifying vtno for switch */
1645 *bufp++ = keyid +
1646 (upper->vt_switch_keystate - VT_SWITCH_KEY_ALT) *
1647 KB_NR_FUNCKEYS + 'A';
1648 *bufp++ = 'H';
1649 }
1650 *bufp++ = 'z';
1651 *bufp = '\0';
1652
1653 /*
1654 * Send the result upstream.
1655 */
1656 kbtrans_putbuf(buf, upper->kbtrans_streams_readq);
1657
1658 }
1659
1660 /*
1661 * kbtrans_ascii_keypressed:
1662 * This is the code if we are in TR_ASCII mode and a key
1663 * is pressed. This is where we will do any special processing that
1664 * is specific to ASCII key translation.
1665 */
1666 /* ARGSUSED */
1667 static void
1668 kbtrans_ascii_keypressed(
1669 struct kbtrans *upper,
1670 uint_t entrytype,
1671 kbtrans_key_t key,
1672 uint_t entry)
1673 {
1674 register char *cp;
1675 register char *bufp;
1676 char buf[14];
1677 unsigned short keyid;
1678 struct kbtrans_lower *lower = &upper->kbtrans_lower;
1679
1680 /*
1681 * Based on the type of key, we may need to do some ASCII
1682 * specific post processing. Note that the translated entry
1683 * is constructed as the actual keycode plus entrytype. see
1684 * sys/kbd.h for details of each entrytype.
1685 */
1686 switch (entrytype) {
1687
1688 case BUCKYBITS:
1689 return;
1690
1691 case SHIFTKEYS:
1692 keyid = entry & 0xFF;
1693 if (keyid == ALT) {
1694 upper->vt_switch_keystate = VT_SWITCH_KEY_ALT;
1695 } else if (keyid == ALTGRAPH) {
1696 upper->vt_switch_keystate = VT_SWITCH_KEY_ALTGR;
1697 }
1698 return;
1699
1700 case FUNNY:
1701 /*
1702 * There is no ascii equivalent. We will ignore these
1703 * keys
1704 */
1705 return;
1706
1707 case FUNCKEYS:
1708 if (upper->vt_switch_keystate > VT_SWITCH_KEY_NONE) {
1709 if (entry >= TOPFUNC &&
1710 entry < (TOPFUNC + KB_NR_FUNCKEYS)) {
1711
1712 /*
1713 * keyid is the number correspoding to F#
1714 * and its value is from 1 to 12.
1715 */
1716 keyid = (entry & 0xF) + 1;
1717
1718 kbtrans_vt_compose(upper, keyid, B_FALSE, buf);
1719 return;
1720 }
1721 }
1722
1723 /*
1724 * We need to expand this key to get the ascii
1725 * equivalent. These are the function keys (F1, F2 ...)
1726 */
1727 bufp = buf;
1728 cp = kbtrans_strsetwithdecimal(bufp + 2,
1729 (uint_t)((entry & 0x003F) + 192),
1730 sizeof (buf) - 5);
1731 *bufp++ = '\033'; /* Escape */
1732 *bufp++ = '[';
1733 while (*cp != '\0')
1734 *bufp++ = *cp++;
1735 *bufp++ = 'z';
1736 *bufp = '\0';
1737
1738 /*
1739 * Send the result upstream.
1740 */
1741 kbtrans_putbuf(buf, upper->kbtrans_streams_readq);
1742
1743 return;
1744
1745 case STRING:
1746 if (upper->vt_switch_keystate > VT_SWITCH_KEY_NONE) {
1747 keyid = entry & 0xFF;
1748 if (keyid == UPARROW ||
1749 keyid == RIGHTARROW ||
1750 keyid == LEFTARROW) {
1751
1752 kbtrans_vt_compose(upper, keyid, B_TRUE, buf);
1753 return;
1754 }
1755 }
1756
1757 /*
1758 * These are the multi byte keys (Home, Up, Down ...)
1759 */
1760 cp = &lower->kbtrans_keystringtab[entry & 0x0F][0];
1761
1762 /*
1763 * Copy the string from the keystringtable, and send it
1764 * upstream a character at a time.
1765 */
1766 while (*cp != '\0') {
1767
1768 kbtrans_putcode(upper, (uchar_t)*cp);
1769
1770 cp++;
1771 }
1772
1773 return;
1774
1775 case PADKEYS:
1776 /*
1777 * These are the keys on the keypad. Look up the
1778 * answer in the kb_numlock_table and send it upstream.
1779 */
1780 kbtrans_putcode(upper,
1781 lower->kbtrans_numlock_table[entry&0x1F]);
1782
1783 return;
1784
1785 case 0: /* normal character */
1786 default:
1787 break;
1788 }
1789
1790 /*
1791 * Send the byte upstream.
1792 */
1793 kbtrans_putcode(upper, entry);
1794
1795 }
1796
1797 #define KB_SCANCODE_ALT 0xe2
1798 #define KB_SCANCODE_ALTGRAPH 0xe6
1799
1800 /*
1801 * kbtrans_ascii_keyreleased:
1802 * This is the function if we are in TR_ASCII mode and a key
1803 * is released. ASCII doesn't have the concept of released keys,
1804 * or make/break codes. So there is nothing for us to do except
1805 * checking 'Alt/AltGraph' release key in order to reset the state
1806 * of vt switch key sequence.
1807 */
1808 /* ARGSUSED */
1809 static void
1810 kbtrans_ascii_keyreleased(struct kbtrans *upper, kbtrans_key_t key)
1811 {
1812 if (key == KB_SCANCODE_ALT || key == KB_SCANCODE_ALTGRAPH) {
1813 upper->vt_switch_keystate = VT_SWITCH_KEY_NONE;
1814 }
1815 }
1816
1817 /*
1818 * kbtrans_ascii_setup_repeat:
1819 * This is the function if we are in TR_ASCII mode and the
1820 * translation module has decided that a key needs to be repeated.
1821 */
1822 /* ARGSUSED */
1823 static void
1824 kbtrans_ascii_setup_repeat(
1825 struct kbtrans *upper,
1826 uint_t entrytype,
1827 kbtrans_key_t key)
1828 {
1829 struct kbtrans_lower *lower = &upper->kbtrans_lower;
1830
1831 /*
1832 * Cancel any currently repeating keys. This will be a new
1833 * key to repeat.
1834 */
1835 kbtrans_cancelrpt(upper);
1836
1837 /*
1838 * Set the value of the key to be repeated.
1839 */
1840 lower->kbtrans_repeatkey = key;
1841
1842 /*
1843 * Start the timeout for repeating this key. kbtrans_rpt will
1844 * be called to repeat the key.
1845 */
1846 upper->kbtrans_streams_rptid = qtimeout(upper->kbtrans_streams_readq,
1847 kbtrans_rpt, (caddr_t)upper, kbtrans_repeat_delay);
1848 }
1849
1850 /*
1851 * kbtrans_trans_event_keypressed:
1852 * This is the function if we are in TR_EVENT mode and a key
1853 * is pressed. This is where we will do any special processing that
1854 * is specific to EVENT key translation.
1855 */
1856 static void
1857 kbtrans_trans_event_keypressed(
1858 struct kbtrans *upper,
1859 uint_t entrytype,
1860 kbtrans_key_t key,
1861 uint_t entry)
1862 {
1863 Firm_event fe;
1864 register char *cp;
1865 struct kbtrans_lower *lower = &upper->kbtrans_lower;
1866
1867 /*
1868 * Based on the type of key, we may need to do some EVENT
1869 * specific post processing.
1870 */
1871 switch (entrytype) {
1872
1873 case SHIFTKEYS:
1874 /*
1875 * Relying on ordinal correspondence between
1876 * vuid_event.h SHIFT_META-SHIFT_TOP &
1877 * kbd.h METABIT-SYSTEMBIT in order to
1878 * correctly translate entry into fe.id.
1879 */
1880 fe.id = SHIFT_CAPSLOCK + (entry & 0x0F);
1881 fe.value = 1;
1882 kbtrans_keypressed(upper, key, &fe, fe.id);
1883
1884 return;
1885
1886 case BUCKYBITS:
1887 /*
1888 * Relying on ordinal correspondence between
1889 * vuid_event.h SHIFT_CAPSLOCK-SHIFT_RIGHTCTRL &
1890 * kbd.h CAPSLOCK-RIGHTCTRL in order to
1891 * correctly translate entry into fe.id.
1892 */
1893 fe.id = SHIFT_META + (entry & 0x0F);
1894 fe.value = 1;
1895 kbtrans_keypressed(upper, key, &fe, fe.id);
1896
1897 return;
1898
1899 case FUNCKEYS:
1900 /*
1901 * Take advantage of the similar
1902 * ordering of kbd.h function keys and
1903 * vuid_event.h function keys to do a
1904 * simple translation to achieve a
1905 * mapping between the 2 different
1906 * address spaces.
1907 */
1908 fe.id = KEY_LEFTFIRST + (entry & 0x003F);
1909 fe.value = 1;
1910
1911 /*
1912 * Assume "up" table only generates
1913 * shift changes.
1914 */
1915 kbtrans_keypressed(upper, key, &fe, fe.id);
1916
1917 /*
1918 * Function key events can be expanded
1919 * by terminal emulator software to
1920 * produce the standard escape sequence
1921 * generated by the TR_ASCII case above
1922 * if a function key event is not used
1923 * by terminal emulator software
1924 * directly.
1925 */
1926 return;
1927
1928 case STRING:
1929 /*
1930 * These are the multi byte keys (Home, Up, Down ...)
1931 */
1932 cp = &lower->kbtrans_keystringtab[entry & 0x0F][0];
1933
1934 /*
1935 * Copy the string from the keystringtable, and send it
1936 * upstream a character at a time.
1937 */
1938 while (*cp != '\0') {
1939
1940 kbtrans_send_esc_event(*cp, upper);
1941
1942 cp++;
1943 }
1944
1945 return;
1946
1947 case PADKEYS:
1948 /*
1949 * Take advantage of the similar
1950 * ordering of kbd.h keypad keys and
1951 * vuid_event.h keypad keys to do a
1952 * simple translation to achieve a
1953 * mapping between the 2 different
1954 * address spaces.
1955 */
1956 fe.id = VKEY_FIRSTPAD + (entry & 0x001F);
1957 fe.value = 1;
1958
1959 /*
1960 * Assume "up" table only generates
1961 * shift changes.
1962 */
1963 kbtrans_keypressed(upper, key, &fe, fe.id);
1964
1965 /*
1966 * Keypad key events can be expanded
1967 * by terminal emulator software to
1968 * produce the standard ascii character
1969 * generated by the TR_ASCII case above
1970 * if a keypad key event is not used
1971 * by terminal emulator software
1972 * directly.
1973 */
1974 return;
1975
1976 case FUNNY:
1977 /*
1978 * These are not events.
1979 */
1980 switch (entry) {
1981 case IDLE:
1982 case RESET:
1983 case ERROR:
1984 /*
1985 * Something has happened. Mark all keys as released.
1986 */
1987 kbtrans_streams_releaseall(upper);
1988 break;
1989 }
1990
1991 return;
1992
1993 case 0: /* normal character */
1994 default:
1995 break;
1996 }
1997
1998 /*
1999 * Send the event upstream.
2000 */
2001 fe.id = entry;
2002
2003 fe.value = 1;
2004
2005 kbtrans_queueevent(upper, &fe);
2006 }
2007
2008 /*
2009 * kbtrans_trans_event_keyreleased:
2010 * This is the function if we are in TR_EVENT mode and a key
2011 * is released.
2012 */
2013 /* ARGSUSED */
2014 static void
2015 kbtrans_trans_event_keyreleased(struct kbtrans *upper, kbtrans_key_t key)
2016 {
2017 /*
2018 * Mark the key as released and send an event upstream.
2019 */
2020 kbtrans_keyreleased(upper, key);
2021 }
2022
2023 /*
2024 * kbtrans_trans_event_setup_repeat:
2025 * This is the function if we are in TR_EVENT mode and the
2026 * translation module has decided that a key needs to be repeated.
2027 * We will set a timeout to retranslate the repeat key.
2028 */
2029 static void
2030 kbtrans_trans_event_setup_repeat(
2031 struct kbtrans *upper,
2032 uint_t entrytype,
2033 kbtrans_key_t key)
2034 {
2035 struct kbtrans_lower *lower = &upper->kbtrans_lower;
2036
2037 /*
2038 * Function keys and keypad keys do not repeat when we are in
2039 * EVENT mode.
2040 */
2041 if (entrytype == FUNCKEYS || entrytype == PADKEYS) {
2042
2043 return;
2044 }
2045
2046 /*
2047 * Cancel any currently repeating keys. This will be a new
2048 * key to repeat.
2049 */
2050 kbtrans_cancelrpt(upper);
2051
2052 /*
2053 * Set the value of the key to be repeated.
2054 */
2055 lower->kbtrans_repeatkey = key;
2056
2057 /*
2058 * Start the timeout for repeating this key. kbtrans_rpt will
2059 * be called to repeat the key.
2060 */
2061 upper->kbtrans_streams_rptid = qtimeout(upper->kbtrans_streams_readq,
2062 kbtrans_rpt, (caddr_t)upper, kbtrans_repeat_delay);
2063 }
2064
2065 /*
2066 * Administer the key tables.
2067 */
2068
2069 /*
2070 * Old special codes.
2071 */
2072 #define OLD_SHIFTKEYS 0x80
2073 #define OLD_BUCKYBITS 0x90
2074 #define OLD_FUNNY 0xA0
2075 #define OLD_FA_UMLAUT 0xA9
2076 #define OLD_FA_CFLEX 0xAA
2077 #define OLD_FA_TILDE 0xAB
2078 #define OLD_FA_CEDILLA 0xAC
2079 #define OLD_FA_ACUTE 0xAD
2080 #define OLD_FA_GRAVE 0xAE
2081 #define OLD_ISOCHAR 0xAF
2082 #define OLD_STRING 0xB0
2083 #define OLD_LEFTFUNC 0xC0
2084 #define OLD_RIGHTFUNC 0xD0
2085 #define OLD_TOPFUNC 0xE0
2086 #define OLD_BOTTOMFUNC 0xF0
2087
2088 /*
2089 * Map old special codes to new ones.
2090 * Indexed by ((old special code) >> 4) & 0x07; add (old special code) & 0x0F.
2091 */
2092 static ushort_t special_old_to_new[] = {
2093 SHIFTKEYS,
2094 BUCKYBITS,
2095 FUNNY,
2096 STRING,
2097 LEFTFUNC,
2098 RIGHTFUNC,
2099 TOPFUNC,
2100 BOTTOMFUNC,
2101 };
2102
2103
2104 /*
2105 * kbtrans_setkey:
2106 * Set individual keystation translation from old-style entry.
2107 */
2108 static int
2109 kbtrans_setkey(struct kbtrans_lower *lower, struct kiockey *key, cred_t *cr)
2110 {
2111 int strtabindex, i;
2112 unsigned short *ke;
2113 register int tablemask;
2114 register ushort_t entry;
2115 register struct keyboard *kp;
2116
2117 kp = lower->kbtrans_keyboard;
2118
2119 if (key->kio_station >= kp->k_keymap_size)
2120
2121 return (EINVAL);
2122
2123 if (lower->kbtrans_keyboard == NULL)
2124
2125 return (EINVAL);
2126
2127 tablemask = key->kio_tablemask;
2128
2129 switch (tablemask) {
2130 case KIOCABORT1:
2131 case KIOCABORT1A:
2132 case KIOCABORT2:
2133 i = secpolicy_console(cr);
2134 if (i != 0)
2135 return (i);
2136
2137 switch (tablemask) {
2138 case KIOCABORT1:
2139 kp->k_abort1 = key->kio_station;
2140 break;
2141 case KIOCABORT1A:
2142 kp->k_abort1a = key->kio_station;
2143 break;
2144 case KIOCABORT2:
2145 kp->k_abort2 = key->kio_station;
2146 break;
2147 }
2148 return (0);
2149 }
2150
2151 if (tablemask & ALTGRAPHMASK)
2152 return (EINVAL);
2153
2154 ke = kbtrans_find_entry(lower, (uint_t)tablemask, key->kio_station);
2155 if (ke == NULL)
2156 return (EINVAL);
2157
2158 if (key->kio_entry >= (uchar_t)OLD_STRING &&
2159 key->kio_entry <= (uchar_t)(OLD_STRING + 15)) {
2160 strtabindex = key->kio_entry - OLD_STRING;
2161 bcopy(key->kio_string,
2162 lower->kbtrans_keystringtab[strtabindex], KTAB_STRLEN);
2163 lower->kbtrans_keystringtab[strtabindex][KTAB_STRLEN-1] = '\0';
2164 }
2165
2166 entry = key->kio_entry;
2167
2168 /*
2169 * There's nothing we need do with OLD_ISOCHAR.
2170 */
2171 if (entry != OLD_ISOCHAR) {
2172 if (entry & 0x80) {
2173 if (entry >= OLD_FA_UMLAUT && entry <= OLD_FA_GRAVE)
2174 entry = FA_CLASS + (entry & 0x0F) - 9;
2175 else
2176 entry =
2177 special_old_to_new[entry >> 4 & 0x07]
2178 + (entry & 0x0F);
2179 }
2180 }
2181
2182 *ke = entry;
2183
2184 return (0);
2185 }
2186
2187
2188 /*
2189 * Map new special codes to old ones.
2190 * Indexed by (new special code) >> 8; add (new special code) & 0xFF.
2191 */
2192 static uchar_t special_new_to_old[] = {
2193 0, /* normal */
2194 OLD_SHIFTKEYS, /* SHIFTKEYS */
2195 OLD_BUCKYBITS, /* BUCKYBITS */
2196 OLD_FUNNY, /* FUNNY */
2197 OLD_FA_UMLAUT, /* FA_CLASS */
2198 OLD_STRING, /* STRING */
2199 OLD_LEFTFUNC, /* FUNCKEYS */
2200 };
2201
2202
2203 /*
2204 * kbtrans_getkey:
2205 * Get individual keystation translation as old-style entry.
2206 */
2207 static int
2208 kbtrans_getkey(struct kbtrans_lower *lower, struct kiockey *key)
2209 {
2210 int strtabindex;
2211 unsigned short *ke;
2212 register ushort_t entry;
2213 struct keyboard *kp;
2214
2215 kp = lower->kbtrans_keyboard;
2216
2217 if (key->kio_station >= kp->k_keymap_size)
2218 return (EINVAL);
2219
2220 if (lower->kbtrans_keyboard == NULL)
2221 return (EINVAL);
2222
2223 switch (key->kio_tablemask) {
2224 case KIOCABORT1:
2225 key->kio_station = kp->k_abort1;
2226 return (0);
2227 case KIOCABORT1A:
2228 key->kio_station = kp->k_abort1a;
2229 return (0);
2230 case KIOCABORT2:
2231 key->kio_station = kp->k_abort2;
2232 return (0);
2233 }
2234
2235 ke = kbtrans_find_entry(lower, (uint_t)key->kio_tablemask,
2236 key->kio_station);
2237 if (ke == NULL)
2238 return (EINVAL);
2239
2240 entry = *ke;
2241
2242 if (entry & 0xFF00)
2243 key->kio_entry =
2244 special_new_to_old[(ushort_t)(entry & 0xFF00) >> 8]
2245 + (entry & 0x00FF);
2246 else {
2247 if (entry & 0x80)
2248 key->kio_entry = (ushort_t)OLD_ISOCHAR; /* you lose */
2249 else
2250 key->kio_entry = (ushort_t)entry;
2251 }
2252
2253 if (entry >= STRING && entry <= (uchar_t)(STRING + 15)) {
2254 strtabindex = entry - STRING;
2255 bcopy(lower->kbtrans_keystringtab[strtabindex],
2256 key->kio_string, KTAB_STRLEN);
2257 }
2258 return (0);
2259 }
2260
2261
2262 /*
2263 * kbtrans_skey:
2264 * Set individual keystation translation from new-style entry.
2265 */
2266 static int
2267 kbtrans_skey(struct kbtrans_lower *lower, struct kiockeymap *key, cred_t *cr)
2268 {
2269 int strtabindex, i;
2270 unsigned short *ke;
2271 struct keyboard *kp;
2272
2273 kp = lower->kbtrans_keyboard;
2274
2275 if (key->kio_station >= kp->k_keymap_size) {
2276 return (EINVAL);
2277
2278 }
2279
2280 if (lower->kbtrans_keyboard == NULL) {
2281 return (EINVAL);
2282 }
2283
2284 switch (key->kio_tablemask) {
2285 case KIOCABORT1:
2286 case KIOCABORT1A:
2287 case KIOCABORT2:
2288 i = secpolicy_console(cr);
2289 if (i != 0)
2290 return (i);
2291 switch (key->kio_tablemask) {
2292 case KIOCABORT1:
2293 kp->k_abort1 = key->kio_station;
2294 break;
2295 case KIOCABORT1A:
2296 kp->k_abort1a = key->kio_station;
2297 break;
2298 case KIOCABORT2:
2299 kp->k_abort2 = key->kio_station;
2300 break;
2301 }
2302 return (0);
2303 }
2304
2305 ke = kbtrans_find_entry(lower, (uint_t)key->kio_tablemask,
2306 key->kio_station);
2307 if (ke == NULL)
2308 return (EINVAL);
2309
2310 if (key->kio_entry >= STRING &&
2311 key->kio_entry <= (ushort_t)(STRING + 15)) {
2312 strtabindex = key->kio_entry-STRING;
2313 bcopy(key->kio_string,
2314 lower->kbtrans_keystringtab[strtabindex], KTAB_STRLEN);
2315 lower->kbtrans_keystringtab[strtabindex][KTAB_STRLEN-1] = '\0';
2316 }
2317
2318 *ke = key->kio_entry;
2319
2320 return (0);
2321 }
2322
2323
2324 /*
2325 * kbtrans_gkey:
2326 * Get individual keystation translation as new-style entry.
2327 */
2328 static int
2329 kbtrans_gkey(struct kbtrans_lower *lower, struct kiockeymap *key)
2330 {
2331 int strtabindex;
2332 unsigned short *ke;
2333 struct keyboard *kp;
2334
2335 kp = lower->kbtrans_keyboard;
2336
2337 if (key->kio_station >= kp->k_keymap_size)
2338 return (EINVAL);
2339
2340 if (lower->kbtrans_keyboard == NULL)
2341 return (EINVAL);
2342
2343 switch (key->kio_tablemask) {
2344 case KIOCABORT1:
2345 key->kio_station = kp->k_abort1;
2346 return (0);
2347 case KIOCABORT1A:
2348 key->kio_station = kp->k_abort1a;
2349 return (0);
2350 case KIOCABORT2:
2351 key->kio_station = kp->k_abort2;
2352 return (0);
2353 }
2354
2355 ke = kbtrans_find_entry(lower, (uint_t)key->kio_tablemask,
2356 key->kio_station);
2357 if (ke == NULL)
2358 return (EINVAL);
2359
2360 key->kio_entry = *ke;
2361
2362 if (key->kio_entry >= STRING &&
2363 key->kio_entry <= (ushort_t)(STRING + 15)) {
2364 strtabindex = key->kio_entry-STRING;
2365 bcopy(lower->kbtrans_keystringtab[strtabindex],
2366 key->kio_string, KTAB_STRLEN);
2367 }
2368 return (0);
2369 }