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