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 (c) 1987, 2010, Oracle and/or its affiliates. All rights reserved.
24 */
25
26 /*
27 * "Workstation console" multiplexor driver for Sun.
28 *
29 * Sends output to the primary frame buffer using the PROM monitor;
30 * gets input from a stream linked below us that is the "keyboard
31 * driver", below which is linked the primary keyboard.
32 */
33
34 /*
35 * Locking Policy:
36 * This module has a D_MTPERMOD inner perimeter which means STREAMS
37 * only allows one thread to enter this module through STREAMS entry
38 * points each time -- open() close() put() srv() qtimeout().
39 * So for the most time we do not need locking in this module, but with
40 * the following exceptions:
41 *
42 * - wc shares three global variables (wc_dip, vc_active_console,
43 * vc_cons_user, vc_avl_root) with virtual console devname part
44 * (fs/dev/sdev_vtops.c) which get compiled into genunix.
45 *
46 * - wc_modechg_cb() is a callback function which will triggered when
47 * framebuffer display mode is changed.
48 *
49 * - vt_send_hotkeys() is triggered by timeout() which is not STREAMS MT
50 * safe.
51 *
52 * Based on the fact that virtual console devname part and wc_modechg_cb()
53 * only do read access to the above mentioned shared four global variables,
54 * It is safe to do locking this way:
55 * 1) all read access to the four global variables in THIS WC MODULE do not
56 * need locking;
57 * 2) all write access to the four global variables in THIS WC MODULE must
58 * hold vc_lock;
59 * 3) any access to the four global variables in either DEVNAME PART or the
60 * CALLBACK must hold vc_lock;
61 * 4) other global variables which are only shared in this wc module and only
62 * accessible through STREAMS entry points such as "vc_last_console",
63 * "vc_inuse_max_minor", "vc_target_console" and "vc_waitactive_list"
64 * do not need explict locking.
65 *
66 * wc_modechg_cb() does read access to vc_state_t::vc_flags,
67 * vc_state_t::vc_state_lock is used to protect concurrently accesses to
68 * vc_state_t::vc_flags which may happen from both through STREAMS entry
69 * points and wc_modechg_cb().
70 * Since wc_modechg_cb() only does read access to vc_state_t::vc_flags,
71 * The other parts of wc module (except wc_modechg_cb()) only has to hold
72 * vc_state_t::vc_flags when writing to vc_state_t::vc_flags.
73 *
74 * vt_send_hotkeys() could access vt_pending_vtno at the same time with
75 * the rest of wc module, vt_pending_vtno_lock is used to protect
76 * vt_pending_vtno.
77 *
78 * Lock order: vc_lock -> vc_state_t::vc_state_lock.
79 * No overlap between vc_lock and vt_pending_vtno_lock.
80 */
81
82 #include <sys/types.h>
83 #include <sys/param.h>
84 #include <sys/signal.h>
85 #include <sys/cred.h>
86 #include <sys/vnode.h>
87 #include <sys/termios.h>
88 #include <sys/termio.h>
89 #include <sys/ttold.h>
90 #include <sys/stropts.h>
91 #include <sys/stream.h>
92 #include <sys/strsun.h>
93 #include <sys/tty.h>
94 #include <sys/buf.h>
95 #include <sys/uio.h>
96 #include <sys/stat.h>
97 #include <sys/sysmacros.h>
98 #include <sys/errno.h>
99 #include <sys/proc.h>
100 #include <sys/procset.h>
101 #include <sys/fault.h>
102 #include <sys/siginfo.h>
103 #include <sys/debug.h>
104 #include <sys/session.h>
105 #include <sys/kmem.h>
106 #include <sys/cpuvar.h>
107 #include <sys/kbio.h>
108 #include <sys/strredir.h>
109 #include <sys/fs/snode.h>
110 #include <sys/consdev.h>
111 #include <sys/conf.h>
112 #include <sys/cmn_err.h>
113 #include <sys/console.h>
114 #include <sys/promif.h>
115 #include <sys/note.h>
116 #include <sys/polled_io.h>
117 #include <sys/systm.h>
118 #include <sys/ddi.h>
119 #include <sys/sunddi.h>
120 #include <sys/sunndi.h>
121 #include <sys/esunddi.h>
122 #include <sys/sunldi.h>
123 #include <sys/debug.h>
124 #include <sys/console.h>
125 #include <sys/ddi_impldefs.h>
126 #include <sys/policy.h>
127 #include <sys/modctl.h>
128 #include <sys/tem.h>
129 #include <sys/wscons.h>
130 #include <sys/vt_impl.h>
131
132 /* streams stuff */
133 _NOTE(SCHEME_PROTECTS_DATA("Unshared data", copyreq))
134 _NOTE(SCHEME_PROTECTS_DATA("Unshared data", copyresp))
135 _NOTE(SCHEME_PROTECTS_DATA("Unshared data", datab))
136 _NOTE(SCHEME_PROTECTS_DATA("Unshared data", iocblk))
137 _NOTE(SCHEME_PROTECTS_DATA("Unshared data", msgb))
138 _NOTE(SCHEME_PROTECTS_DATA("Unshared data", queue))
139
140 #define MINLINES 10
141 #define MAXLINES 48
142 #define LOSCREENLINES 34
143 #define HISCREENLINES 48
144
145 #define MINCOLS 10
146 #define MAXCOLS 120
147 #define LOSCREENCOLS 80
148 #define HISCREENCOLS 120
149
150 struct wscons_state {
151 dev_t wc_dev; /* major/minor for this device */
152 #ifdef _HAVE_TEM_FIRMWARE
153 int wc_defer_output; /* set if output device is "slow" */
154 #endif /* _HAVE_TEM_FIRMWARE */
155 queue_t *wc_kbdqueue; /* "console keyboard" device queue */
156 /* below us */
157 cons_polledio_t wc_polledio; /* polled I/O function pointers */
158 cons_polledio_t *wc_kb_polledio; /* keyboard's polledio */
159 unsigned int wc_kb_getpolledio_id; /* id for kb CONSOPENPOLLEDIO */
160 queue_t *wc_pending_wq;
161 mblk_t *wc_pending_link; /* I_PLINK pending for kb polledio */
162 } wscons;
163
164 /*
165 * This module has a D_MTPERMOD inner perimeter, so we don't need to protect
166 * the variables only shared within this module
167 */
168 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", wscons))
169 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", wscons_state))
170 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", vt_stat))
171 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", vc_waitactive_msg))
172 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", tty_common))
173 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", vt_mode))
174 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", vt_dispinfo))
175 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", winsize))
176 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data", vc_last_console))
177
178 #ifdef _HAVE_TEM_FIRMWARE
179 ssize_t wc_cons_wrtvec(promif_redir_arg_t arg, uchar_t *s, size_t n);
180 #endif /* _HAVE_TEM_FIRMWARE */
181
182 static int wcopen(queue_t *, dev_t *, int, int, cred_t *);
183 static int wcclose(queue_t *, int, cred_t *);
184 static int wcuwput(queue_t *, mblk_t *);
185 static int wclrput(queue_t *, mblk_t *);
186
187 static struct module_info wcm_info = {
188 0,
189 "wc",
190 0,
191 INFPSZ,
192 2048,
193 128
194 };
195
196 static struct qinit wcurinit = {
197 putq,
198 NULL,
199 wcopen,
200 wcclose,
201 NULL,
202 &wcm_info,
203 NULL
204 };
205
206 static struct qinit wcuwinit = {
207 wcuwput,
208 NULL,
209 wcopen,
210 wcclose,
211 NULL,
212 &wcm_info,
213 NULL
214 };
215
216 static struct qinit wclrinit = {
217 wclrput,
218 NULL,
219 NULL,
220 NULL,
221 NULL,
222 &wcm_info,
223 NULL
224 };
225
226 /*
227 * We always putnext directly to the underlying queue.
228 */
229 static struct qinit wclwinit = {
230 NULL,
231 NULL,
232 NULL,
233 NULL,
234 NULL,
235 &wcm_info,
236 NULL
237 };
238
239 static struct streamtab wcinfo = {
240 &wcurinit,
241 &wcuwinit,
242 &wclrinit,
243 &wclwinit,
244 };
245
246 static int wc_info(dev_info_t *, ddi_info_cmd_t, void *, void **result);
247 static int wc_attach(dev_info_t *, ddi_attach_cmd_t);
248
249 DDI_DEFINE_STREAM_OPS(wc_ops, nulldev, nulldev, wc_attach, nodev, nodev,
250 wc_info, D_MTPERMOD | D_MP, &wcinfo, ddi_quiesce_not_supported);
251
252 static void wcreioctl(void *);
253 static void wcioctl(queue_t *, mblk_t *);
254 #ifdef _HAVE_TEM_FIRMWARE
255 static void wcopoll(void *);
256 static void wconsout(void *);
257 #endif /* _HAVE_TEM_FIRMWARE */
258 static void wcrstrt(void *);
259 static void wcstart(void *);
260 static void wc_open_kb_polledio(struct wscons_state *wc, queue_t *q,
261 mblk_t *mp);
262 static void wc_close_kb_polledio(struct wscons_state *wc, queue_t *q,
263 mblk_t *mp);
264 static void wc_polled_putchar(cons_polledio_arg_t arg,
265 unsigned char c);
266 static boolean_t wc_polled_ischar(cons_polledio_arg_t arg);
267 static int wc_polled_getchar(cons_polledio_arg_t arg);
268 static void wc_polled_enter(cons_polledio_arg_t arg);
269 static void wc_polled_exit(cons_polledio_arg_t arg);
270 void wc_get_size(vc_state_t *pvc);
271 static void wc_modechg_cb(tem_modechg_cb_arg_t arg);
272
273 static struct dev_ops wc_ops;
274
275 /*
276 * Debug printing
277 */
278 #ifndef DPRINTF
279 #ifdef DEBUG
280 /*PRINTFLIKE1*/
281 static void wc_dprintf(const char *fmt, ...) __KPRINTFLIKE(1);
282 #define DPRINTF(l, m, args) \
283 (((l) >= wc_errlevel) && ((m) & wc_errmask) ? \
284 wc_dprintf args : \
285 (void) 0)
286 /*
287 * Severity levels for printing
288 */
289 #define PRINT_L0 0 /* print every message */
290 #define PRINT_L1 1 /* debug */
291 #define PRINT_L2 2 /* quiet */
292
293 /*
294 * Masks
295 */
296 #define PRINT_MASK_ALL 0xFFFFFFFFU
297 uint_t wc_errmask = PRINT_MASK_ALL;
298 uint_t wc_errlevel = PRINT_L2;
299
300 #else
301 #define DPRINTF(l, m, args) /* NOTHING */
302 #endif
303 #endif
304
305 /*
306 * Module linkage information for the kernel.
307 */
308 static struct modldrv modldrv = {
309 &mod_driverops, /* Type of module. This one is a pseudo driver */
310 "Workstation multiplexer Driver 'wc'",
311 &wc_ops, /* driver ops */
312 };
313
314 static struct modlinkage modlinkage = {
315 MODREV_1,
316 &modldrv,
317 NULL
318 };
319
320 int
_init(void)321 _init(void)
322 {
323 int rc;
324 if ((rc = mod_install(&modlinkage)) == 0)
325 vt_init();
326 return (rc);
327 }
328
329 int
_fini(void)330 _fini(void)
331 {
332 return (mod_remove(&modlinkage));
333 }
334
335 int
_info(struct modinfo * modinfop)336 _info(struct modinfo *modinfop)
337 {
338 return (mod_info(&modlinkage, modinfop));
339 }
340
341 /*ARGSUSED*/
342 static int
wc_attach(dev_info_t * devi,ddi_attach_cmd_t cmd)343 wc_attach(dev_info_t *devi, ddi_attach_cmd_t cmd)
344 {
345 /* create minor node for workstation hard console */
346 if (ddi_create_minor_node(devi, "wscons", S_IFCHR,
347 0, DDI_PSEUDO, NULL) == DDI_FAILURE) {
348 ddi_remove_minor_node(devi, NULL);
349 return (DDI_FAILURE);
350 }
351
352 mutex_enter(&vc_lock);
353
354 wc_dip = devi;
355
356 bzero(&(wscons.wc_polledio), sizeof (wscons.wc_polledio));
357
358 vt_resize(VC_DEFAULT_COUNT);
359
360 mutex_exit(&vc_lock);
361
362 return (DDI_SUCCESS);
363 }
364
365 /* ARGSUSED */
366 static int
wc_info(dev_info_t * dip,ddi_info_cmd_t infocmd,void * arg,void ** result)367 wc_info(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
368 void **result)
369 {
370 int error;
371
372 switch (infocmd) {
373 case DDI_INFO_DEVT2DEVINFO:
374 if (wc_dip == NULL) {
375 error = DDI_FAILURE;
376 } else {
377 *result = (void *) wc_dip;
378 error = DDI_SUCCESS;
379 }
380 break;
381 case DDI_INFO_DEVT2INSTANCE:
382 *result = (void *)0;
383 error = DDI_SUCCESS;
384 break;
385 default:
386 error = DDI_FAILURE;
387 }
388 return (error);
389 }
390
391 #ifdef _HAVE_TEM_FIRMWARE
392 /*
393 * Output buffer. Protected by the per-module inner perimeter.
394 */
395 #define MAXHIWAT 2000
396 static char obuf[MAXHIWAT];
397 #endif /* _HAVE_TEM_FIRMWARE */
398
399 static void
wc_init_polledio(void)400 wc_init_polledio(void)
401 {
402 static boolean_t polledio_inited = B_FALSE;
403 _NOTE(SCHEME_PROTECTS_DATA("D_MTPERMOD protected data",
404 polledio_inited))
405
406 if (polledio_inited)
407 return;
408
409 polledio_inited = B_TRUE;
410
411 /*
412 * Initialize the parts of the polled I/O struct that
413 * are common to both input and output modes, but which
414 * don't flag to the upper layers, which if any of the
415 * two modes are available. We don't know at this point
416 * if system is configured CONS_KFB, but we will when
417 * consconfig_dacf asks us with CONSOPENPOLLED I/O.
418 */
419 bzero(&(wscons.wc_polledio), sizeof (wscons.wc_polledio));
420 wscons.wc_polledio.cons_polledio_version =
421 CONSPOLLEDIO_V0;
422 wscons.wc_polledio.cons_polledio_argument =
423 (cons_polledio_arg_t)&wscons;
424 wscons.wc_polledio.cons_polledio_enter =
425 wc_polled_enter;
426 wscons.wc_polledio.cons_polledio_exit =
427 wc_polled_exit;
428
429 #ifdef _HAVE_TEM_FIRMWARE
430 /*
431 * If we're talking directly to a framebuffer, we assume
432 * that it's a "slow" device, so that rendering should
433 * be deferred to a timeout or softcall so that we write
434 * a bunch of characters at once.
435 */
436 wscons.wc_defer_output = prom_stdout_is_framebuffer();
437 #endif /* _HAVE_TEM_FIRMWARE */
438 }
439
440 /*ARGSUSED*/
441 static int
wcopen(queue_t * q,dev_t * devp,int flag,int sflag,cred_t * crp)442 wcopen(queue_t *q, dev_t *devp, int flag, int sflag, cred_t *crp)
443 {
444 int minor;
445
446 wc_init_polledio();
447 minor = (int)getminor(*devp);
448 return (vt_open(minor, q, crp));
449 }
450
451 /*ARGSUSED*/
452 static int
wcclose(queue_t * q,int flag,cred_t * crp)453 wcclose(queue_t *q, int flag, cred_t *crp)
454 {
455 vc_state_t *pvc = (vc_state_t *)q->q_ptr;
456
457 qprocsoff(q);
458
459 mutex_enter(&vc_lock);
460
461 /*
462 * If we are closing the VT node which
463 * /dev/vt/console_user points to, revert
464 * /dev/vt/console to /dev/console
465 */
466 if (vc_cons_user == pvc->vc_minor)
467 vc_cons_user = VT_MINOR_INVALID;
468
469 if (pvc->vc_minor == 0 || pvc->vc_minor == vc_active_console) {
470
471 /*
472 * If we lose the system console,
473 * no any other active consoles.
474 */
475 if (pvc->vc_minor == 0 && pvc->vc_minor == vc_active_console) {
476 vc_active_console = VT_MINOR_INVALID;
477 vc_last_console = VT_MINOR_INVALID;
478 }
479
480 /*
481 * just clean for our primary console
482 * and active console
483 */
484 mutex_enter(&pvc->vc_state_lock);
485 vt_clean(q, pvc);
486 mutex_exit(&pvc->vc_state_lock);
487
488 mutex_exit(&vc_lock);
489
490 return (0);
491 }
492 vt_close(q, pvc, crp);
493
494 mutex_exit(&vc_lock);
495
496 return (0);
497 }
498
499 /*
500 * Put procedure for upper write queue.
501 * Respond to M_STOP, M_START, M_IOCTL, and M_FLUSH messages here;
502 * queue up M_BREAK, M_DELAY, and M_DATA messages for processing by
503 * the start routine, and then call the start routine; discard
504 * everything else.
505 */
506 static int
wcuwput(queue_t * q,mblk_t * mp)507 wcuwput(queue_t *q, mblk_t *mp)
508 {
509 vc_state_t *pvc = (vc_state_t *)q->q_ptr;
510
511 switch (mp->b_datap->db_type) {
512
513 case M_STOP:
514 mutex_enter(&pvc->vc_state_lock);
515 pvc->vc_flags |= WCS_STOPPED;
516 mutex_exit(&pvc->vc_state_lock);
517
518 freemsg(mp);
519 break;
520
521 case M_START:
522 mutex_enter(&pvc->vc_state_lock);
523 pvc->vc_flags &= ~WCS_STOPPED;
524 mutex_exit(&pvc->vc_state_lock);
525
526 wcstart(pvc);
527 freemsg(mp);
528 break;
529
530 case M_IOCTL: {
531 struct iocblk *iocp;
532 struct linkblk *linkp;
533
534 iocp = (struct iocblk *)(void *)mp->b_rptr;
535 switch (iocp->ioc_cmd) {
536
537 case I_LINK: /* stupid, but permitted */
538 case I_PLINK:
539 if (wscons.wc_kbdqueue != NULL) {
540 /* somebody already linked */
541 miocnak(q, mp, 0, EINVAL);
542 return (0);
543 }
544 linkp = (struct linkblk *)(void *)mp->b_cont->b_rptr;
545 wscons.wc_kbdqueue = WR(linkp->l_qbot);
546 mp->b_datap->db_type = M_IOCACK;
547 iocp->ioc_count = 0;
548 wc_open_kb_polledio(&wscons, q, mp);
549 break;
550
551 case I_UNLINK: /* stupid, but permitted */
552 case I_PUNLINK:
553 linkp = (struct linkblk *)(void *)mp->b_cont->b_rptr;
554 if (wscons.wc_kbdqueue != WR(linkp->l_qbot)) {
555 /* not us */
556 miocnak(q, mp, 0, EINVAL);
557 return (0);
558 }
559
560 mp->b_datap->db_type = M_IOCACK;
561 iocp->ioc_count = 0;
562 wc_close_kb_polledio(&wscons, q, mp);
563 break;
564
565 case TCSETSW:
566 case TCSETSF:
567 case TCSETAW:
568 case TCSETAF:
569 case TCSBRK:
570 /*
571 * The changes do not take effect until all
572 * output queued before them is drained.
573 * Put this message on the queue, so that
574 * "wcstart" will see it when it's done
575 * with the output before it. Poke the
576 * start routine, just in case.
577 */
578 (void) putq(q, mp);
579 wcstart(pvc);
580 break;
581
582 case CONSSETABORTENABLE:
583 case CONSGETABORTENABLE:
584 case KIOCSDIRECT:
585 if (wscons.wc_kbdqueue != NULL) {
586 wscons.wc_pending_wq = q;
587 (void) putnext(wscons.wc_kbdqueue, mp);
588 break;
589 }
590 /* fall through */
591
592 default:
593 /*
594 * Do it now.
595 */
596 wcioctl(q, mp);
597 break;
598 }
599 break;
600 }
601
602 case M_FLUSH:
603 if (*mp->b_rptr & FLUSHW) {
604 /*
605 * Flush our write queue.
606 */
607 flushq(q, FLUSHDATA); /* XXX doesn't flush M_DELAY */
608 *mp->b_rptr &= ~FLUSHW; /* it has been flushed */
609 }
610 if (*mp->b_rptr & FLUSHR) {
611 flushq(RD(q), FLUSHDATA);
612 qreply(q, mp); /* give the read queues a crack at it */
613 } else
614 freemsg(mp);
615 break;
616
617 case M_BREAK:
618 /*
619 * Ignore these, as they make no sense.
620 */
621 freemsg(mp);
622 break;
623
624 case M_DELAY:
625 case M_DATA:
626 /*
627 * Queue the message up to be transmitted,
628 * and poke the start routine.
629 */
630 (void) putq(q, mp);
631 wcstart(pvc);
632 break;
633
634 case M_IOCDATA:
635 vt_miocdata(q, mp);
636 break;
637
638 default:
639 /*
640 * "No, I don't want a subscription to Chain Store Age,
641 * thank you anyway."
642 */
643 freemsg(mp);
644 break;
645 }
646
647 return (0);
648 }
649
650 /*
651 * Retry an "ioctl", now that "qbufcall" claims we may be able to allocate
652 * the buffer we need.
653 */
654 /*ARGSUSED*/
655 static void
wcreioctl(void * arg)656 wcreioctl(void *arg)
657 {
658 vc_state_t *pvc = (vc_state_t *)arg;
659 queue_t *q;
660 mblk_t *mp;
661
662 pvc->vc_bufcallid = 0;
663 q = pvc->vc_ttycommon.t_writeq;
664 if ((mp = pvc->vc_ttycommon.t_iocpending) != NULL) {
665 /* not pending any more */
666 pvc->vc_ttycommon.t_iocpending = NULL;
667 wcioctl(q, mp);
668 }
669 }
670
671 static int
wc_getterm(mblk_t * mp)672 wc_getterm(mblk_t *mp)
673 {
674 char *term;
675 intptr_t arg;
676 int flag = ((struct iocblk *)(void *)mp->b_rptr)->ioc_flag;
677
678 STRUCT_DECL(cons_getterm, wcterm);
679 STRUCT_INIT(wcterm, flag);
680
681 arg = *((intptr_t *)(void *)mp->b_cont->b_rptr);
682
683 if (ddi_copyin((void *)arg, STRUCT_BUF(wcterm),
684 STRUCT_SIZE(wcterm), flag) != 0) {
685 return (EFAULT);
686 }
687
688 if (consmode == CONS_FW) {
689 /* PROM terminal emulator */
690 term = "sun";
691 } else {
692 /* Kernel terminal emulator */
693 ASSERT(consmode == CONS_KFB);
694 term = "sun-color";
695 }
696
697 if (STRUCT_FGET(wcterm, cn_term_len) <
698 strlen(term) + 1) {
699 return (EOVERFLOW);
700 }
701
702 if (ddi_copyout(term,
703 STRUCT_FGETP(wcterm, cn_term_type),
704 strlen(term) + 1, flag) != 0) {
705 return (EFAULT);
706 }
707
708 return (0);
709 }
710
711 /*
712 * Process an "ioctl" message sent down to us.
713 */
714 static void
wcioctl(queue_t * q,mblk_t * mp)715 wcioctl(queue_t *q, mblk_t *mp)
716 {
717 vc_state_t *pvc = (vc_state_t *)q->q_ptr;
718 struct iocblk *iocp;
719 size_t datasize;
720 int error;
721 long len;
722
723 iocp = (struct iocblk *)(void *)mp->b_rptr;
724
725 if ((iocp->ioc_cmd & VTIOC) == VTIOC ||
726 (iocp->ioc_cmd & KDIOC) == KDIOC) {
727 vt_ioctl(q, mp);
728 return;
729 }
730
731 switch (iocp->ioc_cmd) {
732 case TIOCSWINSZ:
733 /*
734 * Ignore all attempts to set the screen size; the
735 * value in the EEPROM is guaranteed (modulo PROM bugs)
736 * to be the value used by the PROM monitor code, so it
737 * is by definition correct. Many programs (e.g.,
738 * "login" and "tset") will attempt to reset the size
739 * to (0, 0) or (34, 80), neither of which is
740 * necessarily correct.
741 * We just ACK the message, so as not to disturb
742 * programs that set the sizes.
743 */
744 iocp->ioc_count = 0; /* no data returned */
745 mp->b_datap->db_type = M_IOCACK;
746 qreply(q, mp);
747 return;
748
749 case CONSOPENPOLLEDIO:
750 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
751 ("wcioctl: CONSOPENPOLLEDIO\n"));
752
753 error = miocpullup(mp, sizeof (struct cons_polledio *));
754 if (error != 0) {
755 miocnak(q, mp, 0, error);
756 return;
757 }
758
759 /*
760 * We are given an appropriate-sized data block,
761 * and return a pointer to our structure in it.
762 */
763 if (consmode == CONS_KFB)
764 wscons.wc_polledio.cons_polledio_putchar =
765 wc_polled_putchar;
766 *(struct cons_polledio **)(void *)mp->b_cont->b_rptr =
767 &wscons.wc_polledio;
768
769 mp->b_datap->db_type = M_IOCACK;
770
771 qreply(q, mp);
772 break;
773
774 case CONS_GETTERM:
775 if ((error = wc_getterm(mp)) != 0)
776 miocnak(q, mp, 0, error);
777 else
778 miocack(q, mp, 0, 0);
779 return;
780
781 case WC_OPEN_FB:
782 /*
783 * Start out pessimistic, so that we can just jump to
784 * the reply to bail out.
785 */
786 mp->b_datap->db_type = M_IOCNAK;
787
788 /*
789 * First test: really, this should be done only from
790 * inside the kernel. Unfortunately, that information
791 * doesn't seem to be available in a streams ioctl,
792 * so restrict it to root only. (Perhaps we could check
793 * for ioc_cr == kcred.)
794 */
795 if ((iocp->ioc_error = secpolicy_console(iocp->ioc_cr)) != 0)
796 goto open_fail;
797
798 /*
799 * Some miscellaneous checks...
800 */
801 iocp->ioc_error = EINVAL;
802
803 /*
804 * If we don't have exactly one continuation block, fail.
805 */
806 if (mp->b_cont == NULL ||
807 mp->b_cont->b_cont != NULL)
808 goto open_fail;
809
810 /*
811 * If there's no null terminator in the string, fail.
812 */
813 /* LINTED E_PTRDIFF_OVERFLOW */
814 len = mp->b_cont->b_wptr - mp->b_cont->b_rptr;
815 if (memchr(mp->b_cont->b_rptr, 0, len) == NULL)
816 goto open_fail;
817
818 /*
819 * NOTE: should eventually get default
820 * dimensions from a property, e.g. screen-#rows.
821 */
822 iocp->ioc_error = tem_info_init((char *)mp->b_cont->b_rptr,
823 iocp->ioc_cr);
824 /*
825 * Of course, if the terminal emulator initialization
826 * failed, fail.
827 */
828 if (iocp->ioc_error != 0)
829 goto open_fail;
830
831 #ifdef _HAVE_TEM_FIRMWARE
832 if (prom_stdout_is_framebuffer()) {
833 /*
834 * Drivers in the console stream may emit additional
835 * messages before we are ready. This causes text
836 * overwrite on the screen. So we set the redirection
837 * here. It is safe because the ioctl in consconfig_dacf
838 * will succeed and consmode will be set to CONS_KFB.
839 */
840 prom_set_stdout_redirect(wc_cons_wrtvec,
841 (promif_redir_arg_t)NULL);
842
843 }
844 #endif /* _HAVE_TEM_FIRMWARE */
845
846 tem_register_modechg_cb(wc_modechg_cb,
847 (tem_modechg_cb_arg_t)&wscons);
848
849 /*
850 * ... and succeed.
851 */
852 mp->b_datap->db_type = M_IOCACK;
853
854 open_fail:
855 qreply(q, mp);
856 break;
857
858 case WC_CLOSE_FB:
859 /*
860 * There's nothing that can call this, so it's not
861 * really implemented.
862 */
863 mp->b_datap->db_type = M_IOCNAK;
864 /*
865 * However, if it were implemented, it would clearly
866 * be root-only.
867 */
868 if ((iocp->ioc_error = secpolicy_console(iocp->ioc_cr)) != 0)
869 goto close_fail;
870
871 iocp->ioc_error = EINVAL;
872
873 close_fail:
874 qreply(q, mp);
875 break;
876
877 default:
878
879 /*
880 * The only way in which "ttycommon_ioctl" can fail is
881 * if the "ioctl" requires a response containing data
882 * to be returned to the user, and no mblk could be
883 * allocated for the data. No such "ioctl" alters our
884 * state. Thus, we always go ahead and do any
885 * state-changes the "ioctl" calls for. If we couldn't
886 * allocate the data, "ttycommon_ioctl" has stashed the
887 * "ioctl" away safely, so we just call "qbufcall" to
888 * request that we be called back when we stand a
889 * better chance of allocating the data.
890 */
891 datasize = ttycommon_ioctl(&pvc->vc_ttycommon, q, mp, &error);
892 if (datasize != 0) {
893 if (pvc->vc_bufcallid != 0)
894 qunbufcall(q, pvc->vc_bufcallid);
895 pvc->vc_bufcallid = qbufcall(q, datasize, BPRI_HI,
896 wcreioctl, pvc);
897 return;
898 }
899
900 if (error < 0) {
901 if (iocp->ioc_cmd == TCSBRK)
902 error = 0;
903 else
904 error = EINVAL;
905 }
906 if (error != 0) {
907 iocp->ioc_error = error;
908 mp->b_datap->db_type = M_IOCNAK;
909 }
910 qreply(q, mp);
911 break;
912 }
913 }
914
915 /*
916 * This function gets the polled I/O structures from the lower
917 * keyboard driver. If any initialization or resource allocation
918 * needs to be done by the lower driver, it will be done when
919 * the lower driver services this message.
920 */
921 static void
wc_open_kb_polledio(struct wscons_state * wscons,queue_t * q,mblk_t * mp)922 wc_open_kb_polledio(struct wscons_state *wscons, queue_t *q, mblk_t *mp)
923 {
924 mblk_t *mp2;
925 struct iocblk *iocp;
926
927 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
928 ("wc_open_kb_polledio: sending CONSOPENPOLLEDIO\n"));
929
930 mp2 = mkiocb(CONSOPENPOLLEDIO);
931
932 if (mp2 == NULL) {
933 /*
934 * If we can't get an mblk, then wait for it.
935 */
936 goto nomem;
937 }
938
939 mp2->b_cont = allocb(sizeof (struct cons_polledio *), BPRI_HI);
940
941 if (mp2->b_cont == NULL) {
942 /*
943 * If we can't get an mblk, then wait for it, and release
944 * the mblk that we have already allocated.
945 */
946 freemsg(mp2);
947 goto nomem;
948 }
949
950 iocp = (struct iocblk *)(void *)mp2->b_rptr;
951
952 iocp->ioc_count = sizeof (struct cons_polledio *);
953 mp2->b_cont->b_wptr = mp2->b_cont->b_rptr +
954 sizeof (struct cons_polledio *);
955
956 wscons->wc_pending_wq = q;
957 wscons->wc_pending_link = mp;
958 wscons->wc_kb_getpolledio_id = iocp->ioc_id;
959
960 putnext(wscons->wc_kbdqueue, mp2);
961
962 return;
963
964 nomem:
965 iocp = (struct iocblk *)(void *)mp->b_rptr;
966 iocp->ioc_error = ENOMEM;
967 mp->b_datap->db_type = M_IOCNAK;
968 qreply(q, mp);
969 }
970
971 /*
972 * This function releases the polled I/O structures from the lower
973 * keyboard driver. If any de-initialization needs to be done, or
974 * any resources need to be released, it will be done when the lower
975 * driver services this message.
976 */
977 static void
wc_close_kb_polledio(struct wscons_state * wscons,queue_t * q,mblk_t * mp)978 wc_close_kb_polledio(struct wscons_state *wscons, queue_t *q, mblk_t *mp)
979 {
980 mblk_t *mp2;
981 struct iocblk *iocp;
982
983 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
984 ("wc_close_kb_polledio: sending CONSCLOSEPOLLEDIO\n"));
985
986 mp2 = mkiocb(CONSCLOSEPOLLEDIO);
987
988 if (mp2 == NULL) {
989 /*
990 * If we can't get an mblk, then wait for it.
991 */
992 goto nomem;
993 }
994
995 mp2->b_cont = allocb(sizeof (struct cons_polledio *), BPRI_HI);
996
997 if (mp2->b_cont == NULL) {
998 /*
999 * If we can't get an mblk, then wait for it, and release
1000 * the mblk that we have already allocated.
1001 */
1002 freemsg(mp2);
1003
1004 goto nomem;
1005 }
1006
1007 iocp = (struct iocblk *)(void *)mp2->b_rptr;
1008
1009 iocp->ioc_count = 0;
1010
1011 wscons->wc_pending_wq = q;
1012 wscons->wc_pending_link = mp;
1013 wscons->wc_kb_getpolledio_id = iocp->ioc_id;
1014
1015 putnext(wscons->wc_kbdqueue, mp2);
1016
1017 return;
1018
1019 nomem:
1020 iocp = (struct iocblk *)(void *)mp->b_rptr;
1021 iocp->ioc_error = ENOMEM;
1022 mp->b_datap->db_type = M_IOCNAK;
1023 qreply(q, mp);
1024 }
1025
1026 #ifdef _HAVE_TEM_FIRMWARE
1027 /* ARGSUSED */
1028 static void
wcopoll(void * arg)1029 wcopoll(void *arg)
1030 {
1031 vc_state_t *pvc = (vc_state_t *)arg;
1032 queue_t *q;
1033
1034 q = pvc->vc_ttycommon.t_writeq;
1035 pvc->vc_timeoutid = 0;
1036
1037 mutex_enter(&pvc->vc_state_lock);
1038
1039 /* See if we can continue output */
1040 if ((pvc->vc_flags & WCS_BUSY) && pvc->vc_pendc != -1) {
1041 if (prom_mayput((char)pvc->vc_pendc) == 0) {
1042 pvc->vc_pendc = -1;
1043 pvc->vc_flags &= ~WCS_BUSY;
1044 if (!(pvc->vc_flags&(WCS_DELAY|WCS_STOPPED)))
1045 wcstart(pvc);
1046 } else
1047 pvc->vc_timeoutid = qtimeout(q, wcopoll, pvc, 1);
1048 }
1049
1050 mutex_exit(&pvc->vc_state_lock);
1051 }
1052 #endif /* _HAVE_TEM_FIRMWARE */
1053
1054 /*
1055 * Restart output on the console after a timeout.
1056 */
1057 /* ARGSUSED */
1058 static void
wcrstrt(void * arg)1059 wcrstrt(void *arg)
1060 {
1061 vc_state_t *pvc = (vc_state_t *)arg;
1062
1063 ASSERT(pvc->vc_ttycommon.t_writeq != NULL);
1064
1065 mutex_enter(&pvc->vc_state_lock);
1066 pvc->vc_flags &= ~WCS_DELAY;
1067 mutex_exit(&pvc->vc_state_lock);
1068
1069 wcstart(pvc);
1070 }
1071
1072 /*
1073 * get screen terminal for current output
1074 */
1075 static tem_vt_state_t
wc_get_screen_tem(vc_state_t * pvc)1076 wc_get_screen_tem(vc_state_t *pvc)
1077 {
1078 if (!tem_initialized(pvc->vc_tem) ||
1079 tem_get_fbmode(pvc->vc_tem) != KD_TEXT)
1080 return (NULL);
1081
1082 return (pvc->vc_tem);
1083 }
1084
1085 /*
1086 * Start console output
1087 */
1088 static void
wcstart(void * arg)1089 wcstart(void *arg)
1090 {
1091 vc_state_t *pvc = (vc_state_t *)arg;
1092 tem_vt_state_t ptem = NULL;
1093 #ifdef _HAVE_TEM_FIRMWARE
1094 int c;
1095 ssize_t cc;
1096 #endif /* _HAVE_TEM_FIRMWARE */
1097 queue_t *q;
1098 mblk_t *bp;
1099 mblk_t *nbp;
1100
1101 /*
1102 * If we're waiting for something to happen (delay timeout to
1103 * expire, current transmission to finish, output to be
1104 * restarted, output to finish draining), don't grab anything
1105 * new.
1106 */
1107 if (pvc->vc_flags & (WCS_DELAY|WCS_BUSY|WCS_STOPPED))
1108 return;
1109
1110 q = pvc->vc_ttycommon.t_writeq;
1111 /*
1112 * assumes that we have been called by whoever holds the
1113 * exclusionary lock on the write-side queue (protects
1114 * vc_flags and vc_pendc).
1115 */
1116 for (;;) {
1117 if ((bp = getq(q)) == NULL)
1118 return; /* nothing to transmit */
1119
1120 /*
1121 * We have a new message to work on.
1122 * Check whether it's a delay or an ioctl (the latter
1123 * occurs if the ioctl in question was waiting for the output
1124 * to drain). If it's one of those, process it immediately.
1125 */
1126 switch (bp->b_datap->db_type) {
1127
1128 case M_DELAY:
1129 /*
1130 * Arrange for "wcrstrt" to be called when the
1131 * delay expires; it will turn WCS_DELAY off,
1132 * and call "wcstart" to grab the next message.
1133 */
1134 if (pvc->vc_timeoutid != 0)
1135 (void) quntimeout(q, pvc->vc_timeoutid);
1136 pvc->vc_timeoutid = qtimeout(q, wcrstrt, pvc,
1137 (clock_t)(*(unsigned char *)bp->b_rptr + 6));
1138
1139 mutex_enter(&pvc->vc_state_lock);
1140 pvc->vc_flags |= WCS_DELAY;
1141 mutex_exit(&pvc->vc_state_lock);
1142
1143 freemsg(bp);
1144 return; /* wait for this to finish */
1145
1146 case M_IOCTL:
1147 /*
1148 * This ioctl was waiting for the output ahead of
1149 * it to drain; obviously, it has. Do it, and
1150 * then grab the next message after it.
1151 */
1152 wcioctl(q, bp);
1153 continue;
1154 }
1155
1156 #ifdef _HAVE_TEM_FIRMWARE
1157 if (consmode == CONS_KFB) {
1158 #endif /* _HAVE_TEM_FIRMWARE */
1159 if ((ptem = wc_get_screen_tem(pvc)) != NULL) {
1160
1161 for (nbp = bp; nbp != NULL; nbp = nbp->b_cont) {
1162 if (nbp->b_wptr > nbp->b_rptr) {
1163 (void) tem_write(ptem,
1164 nbp->b_rptr,
1165 /* LINTED */
1166 nbp->b_wptr - nbp->b_rptr,
1167 kcred);
1168 }
1169 }
1170
1171 }
1172
1173 freemsg(bp);
1174
1175 #ifdef _HAVE_TEM_FIRMWARE
1176 continue;
1177 }
1178
1179 /* consmode = CONS_FW */
1180 if (pvc->vc_minor != 0) {
1181 freemsg(bp);
1182 continue;
1183 }
1184
1185 /* LINTED E_PTRDIFF_OVERFLOW */
1186 if ((cc = bp->b_wptr - bp->b_rptr) == 0) {
1187 freemsg(bp);
1188 continue;
1189 }
1190 /*
1191 * Direct output to the frame buffer if this device
1192 * is not the "hardware" console.
1193 */
1194 if (wscons.wc_defer_output) {
1195 /*
1196 * Never do output here;
1197 * it takes forever.
1198 */
1199 mutex_enter(&pvc->vc_state_lock);
1200 pvc->vc_flags |= WCS_BUSY;
1201 mutex_exit(&pvc->vc_state_lock);
1202
1203 pvc->vc_pendc = -1;
1204 (void) putbq(q, bp);
1205 if (q->q_count > 128) { /* do it soon */
1206 softcall(wconsout, pvc);
1207 } else { /* wait a bit */
1208 if (pvc->vc_timeoutid != 0)
1209 (void) quntimeout(q,
1210 pvc->vc_timeoutid);
1211 pvc->vc_timeoutid = qtimeout(q, wconsout,
1212 pvc, hz / 30);
1213 }
1214 return;
1215 }
1216 for (;;) {
1217 c = *bp->b_rptr++;
1218 cc--;
1219 if (prom_mayput((char)c) != 0) {
1220
1221 mutex_enter(&pvc->vc_state_lock);
1222 pvc->vc_flags |= WCS_BUSY;
1223 mutex_exit(&pvc->vc_state_lock);
1224
1225 pvc->vc_pendc = c;
1226 if (pvc->vc_timeoutid != 0)
1227 (void) quntimeout(q,
1228 pvc->vc_timeoutid);
1229 pvc->vc_timeoutid = qtimeout(q, wcopoll,
1230 pvc, 1);
1231 if (bp != NULL)
1232 /* not done with this message yet */
1233 (void) putbq(q, bp);
1234 return;
1235 }
1236 while (cc <= 0) {
1237 nbp = bp;
1238 bp = bp->b_cont;
1239 freeb(nbp);
1240 if (bp == NULL)
1241 return;
1242 /* LINTED E_PTRDIFF_OVERFLOW */
1243 cc = bp->b_wptr - bp->b_rptr;
1244 }
1245 }
1246 #endif /* _HAVE_TEM_FIRMWARE */
1247 }
1248 }
1249
1250 #ifdef _HAVE_TEM_FIRMWARE
1251 /*
1252 * Output to frame buffer console.
1253 * It takes a long time to scroll.
1254 */
1255 /* ARGSUSED */
1256 static void
wconsout(void * arg)1257 wconsout(void *arg)
1258 {
1259 vc_state_t *pvc = (vc_state_t *)arg;
1260 uchar_t *cp;
1261 ssize_t cc;
1262 queue_t *q;
1263 mblk_t *bp;
1264 mblk_t *nbp;
1265 char *current_position;
1266 ssize_t bytes_left;
1267
1268 if ((q = pvc->vc_ttycommon.t_writeq) == NULL) {
1269 return; /* not attached to a stream */
1270 }
1271
1272 /*
1273 * Set up to copy up to MAXHIWAT bytes.
1274 */
1275 current_position = &obuf[0];
1276 bytes_left = MAXHIWAT;
1277 while ((bp = getq(q)) != NULL) {
1278 if (bp->b_datap->db_type == M_IOCTL) {
1279 /*
1280 * This ioctl was waiting for the output ahead of
1281 * it to drain; obviously, it has. Put it back
1282 * so that "wcstart" can handle it, and transmit
1283 * what we've got.
1284 */
1285 (void) putbq(q, bp);
1286 goto transmit;
1287 }
1288
1289 do {
1290 cp = bp->b_rptr;
1291 /* LINTED E_PTRDIFF_OVERFLOW */
1292 cc = bp->b_wptr - cp;
1293 while (cc != 0) {
1294 if (bytes_left == 0) {
1295 /*
1296 * Out of buffer space; put this
1297 * buffer back on the queue, and
1298 * transmit what we have.
1299 */
1300 bp->b_rptr = cp;
1301 (void) putbq(q, bp);
1302 goto transmit;
1303 }
1304 *current_position++ = *cp++;
1305 cc--;
1306 bytes_left--;
1307 }
1308 nbp = bp;
1309 bp = bp->b_cont;
1310 freeb(nbp);
1311 } while (bp != NULL);
1312 }
1313
1314 transmit:
1315 if ((cc = MAXHIWAT - bytes_left) != 0)
1316 console_puts(obuf, cc);
1317
1318 mutex_enter(&pvc->vc_state_lock);
1319 pvc->vc_flags &= ~WCS_BUSY;
1320 mutex_exit(&pvc->vc_state_lock);
1321
1322 wcstart(pvc);
1323 }
1324 #endif /* _HAVE_TEM_FIRMWARE */
1325
1326 /*
1327 * Put procedure for lower read queue.
1328 * Pass everything up to queue above "upper half".
1329 */
1330 static int
wclrput(queue_t * q,mblk_t * mp)1331 wclrput(queue_t *q, mblk_t *mp)
1332 {
1333 vc_state_t *pvc;
1334 queue_t *upq;
1335 struct iocblk *iocp;
1336
1337 pvc = vt_minor2vc(VT_ACTIVE);
1338
1339 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
1340 ("wclrput: wclrput type = 0x%x\n", mp->b_datap->db_type));
1341
1342 switch (mp->b_datap->db_type) {
1343
1344 case M_FLUSH:
1345 if (*mp->b_rptr == FLUSHW || *mp->b_rptr == FLUSHRW) {
1346 /*
1347 * Flush our write queue.
1348 */
1349 /* XXX doesn't flush M_DELAY */
1350 flushq(WR(q), FLUSHDATA);
1351 *mp->b_rptr = FLUSHR; /* it has been flushed */
1352 }
1353 if (*mp->b_rptr == FLUSHR || *mp->b_rptr == FLUSHRW) {
1354 flushq(q, FLUSHDATA);
1355 *mp->b_rptr = FLUSHW; /* it has been flushed */
1356 qreply(q, mp); /* give the read queues a crack at it */
1357 } else
1358 freemsg(mp);
1359 break;
1360
1361 case M_DATA:
1362 if (consmode == CONS_KFB && vt_check_hotkeys(mp)) {
1363 freemsg(mp);
1364 break;
1365 }
1366
1367 if ((upq = pvc->vc_ttycommon.t_readq) != NULL) {
1368 if (!canput(upq->q_next)) {
1369 ttycommon_qfull(&pvc->vc_ttycommon, upq);
1370 wcstart(pvc);
1371 freemsg(mp);
1372 } else {
1373 putnext(upq, mp);
1374 }
1375 } else
1376 freemsg(mp);
1377 break;
1378
1379 case M_IOCACK:
1380 case M_IOCNAK:
1381 iocp = (struct iocblk *)(void *)mp->b_rptr;
1382 if (wscons.wc_pending_link != NULL &&
1383 iocp->ioc_id == wscons.wc_kb_getpolledio_id) {
1384 switch (mp->b_datap->db_type) {
1385
1386 case M_IOCACK:
1387 switch (iocp->ioc_cmd) {
1388
1389 case CONSOPENPOLLEDIO:
1390 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
1391 ("wclrput: "
1392 "ACK CONSOPENPOLLEDIO\n"));
1393 wscons.wc_kb_polledio =
1394 *(struct cons_polledio **)
1395 (void *)mp->b_cont->b_rptr;
1396 wscons.wc_polledio.
1397 cons_polledio_getchar =
1398 wc_polled_getchar;
1399 wscons.wc_polledio.
1400 cons_polledio_ischar =
1401 wc_polled_ischar;
1402 break;
1403
1404 case CONSCLOSEPOLLEDIO:
1405 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
1406 ("wclrput: "
1407 "ACK CONSCLOSEPOLLEDIO\n"));
1408 wscons.wc_kb_polledio = NULL;
1409 wscons.wc_kbdqueue = NULL;
1410 wscons.wc_polledio.
1411 cons_polledio_getchar = NULL;
1412 wscons.wc_polledio.
1413 cons_polledio_ischar = NULL;
1414 break;
1415 default:
1416 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
1417 ("wclrput: "
1418 "ACK UNKNOWN\n"));
1419 }
1420
1421 break;
1422 case M_IOCNAK:
1423 /*
1424 * Keyboard may or may not support polled I/O.
1425 * This ioctl may have been rejected because
1426 * we only have the wc->conskbd chain built,
1427 * and the keyboard driver has not been linked
1428 * underneath conskbd yet.
1429 */
1430 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
1431 ("wclrput: NAK\n"));
1432
1433 switch (iocp->ioc_cmd) {
1434
1435 case CONSCLOSEPOLLEDIO:
1436 wscons.wc_kb_polledio = NULL;
1437 wscons.wc_kbdqueue = NULL;
1438 wscons.wc_polledio.
1439 cons_polledio_getchar = NULL;
1440 wscons.wc_polledio.
1441 cons_polledio_ischar = NULL;
1442 break;
1443 }
1444 break;
1445 }
1446
1447 /*
1448 * Discard the response, replace it with the
1449 * pending response to the I_PLINK, then let it
1450 * flow upward.
1451 */
1452 freemsg(mp);
1453 mp = wscons.wc_pending_link;
1454 wscons.wc_pending_link = NULL;
1455 wscons.wc_kb_getpolledio_id = 0;
1456 }
1457 /* FALLTHROUGH */
1458
1459 default: /* inc M_ERROR, M_HANGUP, M_IOCACK, M_IOCNAK, ... */
1460 if (wscons.wc_pending_wq != NULL) {
1461 qreply(wscons.wc_pending_wq, mp);
1462 wscons.wc_pending_wq = NULL;
1463 break;
1464 }
1465
1466 if ((upq = pvc->vc_ttycommon.t_readq) != NULL) {
1467 putnext(upq, mp);
1468 } else {
1469 DPRINTF(PRINT_L1, PRINT_MASK_ALL,
1470 ("wclrput: Message DISCARDED\n"));
1471 freemsg(mp);
1472 }
1473 break;
1474 }
1475
1476 return (0);
1477 }
1478
1479 #ifdef _HAVE_TEM_FIRMWARE
1480 /*
1481 * This routine exists so that prom_write() can redirect writes
1482 * to the framebuffer through the kernel terminal emulator, if
1483 * that configuration is selected during consconfig.
1484 * When the kernel terminal emulator is enabled, consconfig_dacf
1485 * sets up the PROM output redirect vector to enter this function.
1486 * During panic the console will already be powered up as part of
1487 * calling into the prom_*() layer.
1488 */
1489 /* ARGSUSED */
1490 ssize_t
wc_cons_wrtvec(promif_redir_arg_t arg,uchar_t * s,size_t n)1491 wc_cons_wrtvec(promif_redir_arg_t arg, uchar_t *s, size_t n)
1492 {
1493 vc_state_t *pvc;
1494
1495 pvc = vt_minor2vc(VT_ACTIVE);
1496
1497 if (pvc->vc_tem == NULL)
1498 return (0);
1499
1500 ASSERT(consmode == CONS_KFB);
1501
1502 if (panicstr)
1503 polled_io_cons_write(s, n);
1504 else
1505 (void) tem_write(pvc->vc_tem, s, n, kcred);
1506
1507 return (n);
1508 }
1509 #endif /* _HAVE_TEM_FIRMWARE */
1510
1511 /*
1512 * These are for systems without OBP, and for devices that cannot be
1513 * shared between Solaris and the OBP.
1514 */
1515 static void
wc_polled_putchar(cons_polledio_arg_t arg,unsigned char c)1516 wc_polled_putchar(cons_polledio_arg_t arg, unsigned char c)
1517 {
1518 vc_state_t *pvc;
1519
1520 pvc = vt_minor2vc(VT_ACTIVE);
1521
1522 if (c == '\n')
1523 wc_polled_putchar(arg, '\r');
1524
1525 if (pvc->vc_tem == NULL) {
1526 /*
1527 * We have no terminal emulator configured. We have no
1528 * recourse but to drop the output on the floor.
1529 */
1530 return;
1531 }
1532
1533 tem_safe_polled_write(pvc->vc_tem, &c, 1);
1534 }
1535
1536 /*
1537 * These are for systems without OBP, and for devices that cannot be
1538 * shared between Solaris and the OBP.
1539 */
1540 static int
wc_polled_getchar(cons_polledio_arg_t arg)1541 wc_polled_getchar(cons_polledio_arg_t arg)
1542 {
1543 struct wscons_state *wscons = (struct wscons_state *)arg;
1544
1545 if (wscons->wc_kb_polledio == NULL) {
1546 prom_printf("wscons: getchar with no keyboard support");
1547 prom_printf("Halted...");
1548 for (;;)
1549 /* HANG FOREVER */;
1550 }
1551
1552 return (wscons->wc_kb_polledio->cons_polledio_getchar(
1553 wscons->wc_kb_polledio->cons_polledio_argument));
1554 }
1555
1556 static boolean_t
wc_polled_ischar(cons_polledio_arg_t arg)1557 wc_polled_ischar(cons_polledio_arg_t arg)
1558 {
1559 struct wscons_state *wscons = (struct wscons_state *)arg;
1560
1561 if (wscons->wc_kb_polledio == NULL)
1562 return (B_FALSE);
1563
1564 return (wscons->wc_kb_polledio->cons_polledio_ischar(
1565 wscons->wc_kb_polledio->cons_polledio_argument));
1566 }
1567
1568 static void
wc_polled_enter(cons_polledio_arg_t arg)1569 wc_polled_enter(cons_polledio_arg_t arg)
1570 {
1571 struct wscons_state *wscons = (struct wscons_state *)arg;
1572
1573 if (wscons->wc_kb_polledio == NULL)
1574 return;
1575
1576 if (wscons->wc_kb_polledio->cons_polledio_enter != NULL) {
1577 wscons->wc_kb_polledio->cons_polledio_enter(
1578 wscons->wc_kb_polledio->cons_polledio_argument);
1579 }
1580 }
1581
1582 static void
wc_polled_exit(cons_polledio_arg_t arg)1583 wc_polled_exit(cons_polledio_arg_t arg)
1584 {
1585 struct wscons_state *wscons = (struct wscons_state *)arg;
1586
1587 if (wscons->wc_kb_polledio == NULL)
1588 return;
1589
1590 if (wscons->wc_kb_polledio->cons_polledio_exit != NULL) {
1591 wscons->wc_kb_polledio->cons_polledio_exit(
1592 wscons->wc_kb_polledio->cons_polledio_argument);
1593 }
1594 }
1595
1596
1597 #ifdef DEBUG
1598 static void
wc_dprintf(const char * fmt,...)1599 wc_dprintf(const char *fmt, ...)
1600 {
1601 char buf[256];
1602 va_list ap;
1603
1604 va_start(ap, fmt);
1605 (void) vsprintf(buf, fmt, ap);
1606 va_end(ap);
1607
1608 cmn_err(CE_WARN, "wc: %s", buf);
1609 }
1610 #endif
1611
1612 /*ARGSUSED*/
1613 static void
update_property(vc_state_t * pvc,char * name,ushort_t value)1614 update_property(vc_state_t *pvc, char *name, ushort_t value)
1615 {
1616 char data[8];
1617
1618 (void) snprintf(data, sizeof (data), "%u", value);
1619
1620 (void) ddi_prop_update_string(wscons.wc_dev, wc_dip, name, data);
1621 }
1622
1623 /*
1624 * Gets the number of text rows and columns and the
1625 * width and height (in pixels) of the console.
1626 */
1627 void
wc_get_size(vc_state_t * pvc)1628 wc_get_size(vc_state_t *pvc)
1629 {
1630 struct winsize *t = &pvc->vc_ttycommon.t_size;
1631 ushort_t r = LOSCREENLINES, c = LOSCREENCOLS, x = 0, y = 0;
1632
1633 if (pvc->vc_tem != NULL)
1634 tem_get_size(&r, &c, &x, &y);
1635 #ifdef _HAVE_TEM_FIRMWARE
1636 else
1637 console_get_size(&r, &c, &x, &y);
1638 #endif /* _HAVE_TEM_FIRMWARE */
1639
1640 mutex_enter(&pvc->vc_ttycommon.t_excl);
1641 t->ws_col = c;
1642 t->ws_row = r;
1643 t->ws_xpixel = x;
1644 t->ws_ypixel = y;
1645 mutex_exit(&pvc->vc_ttycommon.t_excl);
1646
1647 if (pvc->vc_minor != 0)
1648 return;
1649
1650 /* only for the wscons:0 */
1651 update_property(pvc, "screen-#cols", c);
1652 update_property(pvc, "screen-#rows", r);
1653 update_property(pvc, "screen-width", x);
1654 update_property(pvc, "screen-height", y);
1655 }
1656
1657 /*ARGSUSED*/
1658 static void
wc_modechg_cb(tem_modechg_cb_arg_t arg)1659 wc_modechg_cb(tem_modechg_cb_arg_t arg)
1660 {
1661 minor_t index;
1662 vc_state_t *pvc;
1663
1664 mutex_enter(&vc_lock);
1665 for (index = 0; index < VC_INSTANCES_COUNT; index++) {
1666 pvc = vt_minor2vc(index);
1667
1668 mutex_enter(&pvc->vc_state_lock);
1669
1670 if ((pvc->vc_flags & WCS_ISOPEN) &&
1671 (pvc->vc_flags & WCS_INIT))
1672 wc_get_size(pvc);
1673
1674 mutex_exit(&pvc->vc_state_lock);
1675 }
1676 mutex_exit(&vc_lock);
1677 }
1678