/* * CDDL HEADER START * * The contents of this file are subject to the terms of the * Common Development and Distribution License, Version 1.0 only * (the "License"). You may not use this file except in compliance * with the License. * * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE * or http://www.opensolaris.org/os/licensing. * See the License for the specific language governing permissions * and limitations under the License. * * When distributing Covered Code, include this CDDL HEADER in each * file and include the License file at usr/src/OPENSOLARIS.LICENSE. * If applicable, add the following below this CDDL HEADER, with the * fields enclosed by brackets "[]" replaced with your own identifying * information: Portions Copyright [yyyy] [name of copyright owner] * * CDDL HEADER END */ /* * Copyright 2005 Sun Microsystems, Inc. All rights reserved. * Use is subject to license terms. */ #pragma ident "%Z%%M% %I% %E% SMI" /* * "Workstation console" multiplexor driver for Sun. * * Sends output to the primary frame buffer using the PROM monitor; * gets input from a stream linked below us that is the "keyboard * driver", below which is linked the primary keyboard. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) #include #endif #define MINLINES 10 #define MAXLINES 48 #define LOSCREENLINES 34 #define HISCREENLINES 48 #define MINCOLS 10 #define MAXCOLS 120 #define LOSCREENCOLS 80 #define HISCREENCOLS 120 static struct wscons { int wc_flags; /* random flags (protected by */ /* write-side exclusion lock */ dev_t wc_dev; /* major/minor for this device */ tty_common_t wc_ttycommon; /* data common to all tty drivers */ #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) int wc_pendc; /* pending output character */ int wc_defer_output; /* set if output device is "slow" */ #endif #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) struct terminal_emulator *wc_tem; /* Terminal emulator state */ #endif queue_t *wc_kbdqueue; /* "console keyboard" device queue */ /* below us */ bufcall_id_t wc_bufcallid; /* id returned by qbufcall */ timeout_id_t wc_timeoutid; /* id returned by qtimeout */ cons_polledio_t wc_polledio; /* polled I/O function pointers */ cons_polledio_t *wc_kb_polledio; /* keyboard's polledio */ unsigned int wc_kb_getpolledio_id; /* id for kb CONSOPENPOLLEDIO */ mblk_t *wc_pending_link; /* I_PLINK pending for kb polledio */ } wscons; #define WCS_ISOPEN 0x00000001 /* open is complete */ #define WCS_STOPPED 0x00000002 /* output is stopped */ #define WCS_DELAY 0x00000004 /* waiting for delay to finish */ #define WCS_BUSY 0x00000008 /* waiting for transmission to finish */ static int wcopen(queue_t *, dev_t *, int, int, cred_t *); static int wcclose(queue_t *, int, cred_t *); static int wcuwput(queue_t *, mblk_t *); static int wclrput(queue_t *, mblk_t *); static struct module_info wcm_info = { 0, "wc", 0, INFPSZ, 2048, 128 }; static struct qinit wcurinit = { putq, NULL, wcopen, wcclose, NULL, &wcm_info, NULL }; static struct qinit wcuwinit = { wcuwput, NULL, wcopen, wcclose, NULL, &wcm_info, NULL }; static struct qinit wclrinit = { wclrput, NULL, NULL, NULL, NULL, &wcm_info, NULL }; /* * We always putnext directly to the underlying queue. */ static struct qinit wclwinit = { NULL, NULL, NULL, NULL, NULL, &wcm_info, NULL }; static struct streamtab wcinfo = { &wcurinit, &wcuwinit, &wclrinit, &wclwinit, }; static int wc_info(dev_info_t *, ddi_info_cmd_t, void *, void **result); static int wc_attach(dev_info_t *, ddi_attach_cmd_t); static dev_info_t *wc_dip; DDI_DEFINE_STREAM_OPS(wc_ops, nulldev, nulldev, wc_attach, nodev, nodev, wc_info, D_MTPERMOD | D_MP, &wcinfo); static void wcreioctl(void *); static void wcioctl(queue_t *, mblk_t *); #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) static void wcopoll(void *); static void wconsout(void *); #endif static void wcrstrt(void *); static void wcstart(void); static void wc_open_kb_polledio(struct wscons *wc, queue_t *q, mblk_t *mp); static void wc_close_kb_polledio(struct wscons *wc, queue_t *q, mblk_t *mp); #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) static void wc_putchar(struct cons_polledio_arg *arg, unsigned char c); #endif static boolean_t wc_ischar(struct cons_polledio_arg *arg); static int wc_getchar(struct cons_polledio_arg *arg); static void wc_polled_enter(struct cons_polledio_arg *arg); static void wc_polled_exit(struct cons_polledio_arg *arg); static void wc_get_size(struct wscons *wscons); #include #include #include #include #include #include static struct dev_ops wc_ops; /* * Debug printing */ #ifndef DPRINTF #ifdef DEBUG /*PRINTFLIKE1*/ static void wc_dprintf(const char *fmt, ...) __KPRINTFLIKE(1); #define DPRINTF(l, m, args) \ (((l) >= wc_errlevel) && ((m) & wc_errmask) ? \ wc_dprintf args : \ (void) 0) /* * Severity levels for printing */ #define PRINT_L0 0 /* print every message */ #define PRINT_L1 1 /* debug */ #define PRINT_L2 2 /* quiet */ /* * Masks */ #define PRINT_MASK_ALL 0xFFFFFFFFU uint_t wc_errmask = PRINT_MASK_ALL; uint_t wc_errlevel = PRINT_L2; #else #define DPRINTF(l, m, args) /* NOTHING */ #endif #endif /* * Module linkage information for the kernel. */ static struct modldrv modldrv = { &mod_driverops, /* Type of module. This one is a pseudo driver */ "Workstation multiplexer Driver 'wc' %I%", &wc_ops, /* driver ops */ }; static struct modlinkage modlinkage = { MODREV_1, &modldrv, NULL }; int _init(void) { return (mod_install(&modlinkage)); } int _fini(void) { return (mod_remove(&modlinkage)); } int _info(struct modinfo *modinfop) { return (mod_info(&modlinkage, modinfop)); } /*ARGSUSED*/ static int wc_attach(dev_info_t *devi, ddi_attach_cmd_t cmd) { if (ddi_create_minor_node(devi, "wscons", S_IFCHR, 0, DDI_PSEUDO, NULL) == DDI_FAILURE) { ddi_remove_minor_node(devi, NULL); return (-1); } wc_dip = devi; return (DDI_SUCCESS); } /* ARGSUSED */ static int wc_info(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result) { int error; switch (infocmd) { case DDI_INFO_DEVT2DEVINFO: if (wc_dip == NULL) { error = DDI_FAILURE; } else { *result = (void *) wc_dip; error = DDI_SUCCESS; } break; case DDI_INFO_DEVT2INSTANCE: *result = (void *)0; error = DDI_SUCCESS; break; default: error = DDI_FAILURE; } return (error); } #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) /* * Output buffer. Protected by the per-module inner perimeter. */ #define MAXHIWAT 2000 static char obuf[MAXHIWAT]; #endif /*ARGSUSED*/ static int wcopen(queue_t *q, dev_t *devp, int flag, int sflag, cred_t *crp) { struct termios *termiosp; int len; if (getminor(*devp) != 0) return (ENXIO); /* sorry, only one per customer */ if (!(wscons.wc_flags & WCS_ISOPEN)) { mutex_init(&wscons.wc_ttycommon.t_excl, NULL, MUTEX_DEFAULT, NULL); wscons.wc_ttycommon.t_iflag = 0; /* * Get the default termios settings (cflag). * These are stored as a property in the * "options" node. */ if (ddi_getlongprop(DDI_DEV_T_ANY, ddi_root_node(), 0, "ttymodes", (caddr_t)&termiosp, &len) == DDI_PROP_SUCCESS && len == sizeof (struct termios)) { wscons.wc_ttycommon.t_cflag = termiosp->c_cflag; kmem_free(termiosp, len); } else { /* * Gack! Whine about it. */ cmn_err(CE_WARN, "wc: Couldn't get ttymodes property!\n"); } wscons.wc_ttycommon.t_iocpending = NULL; wscons.wc_flags = WCS_ISOPEN; wc_get_size(&wscons); bzero(&(wscons.wc_polledio), sizeof (wscons.wc_polledio)); wscons.wc_polledio.cons_polledio_version = CONSPOLLEDIO_V0; wscons.wc_polledio.cons_polledio_argument = (struct cons_polledio_arg *)&wscons; #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) wscons.wc_polledio.cons_polledio_putchar = wc_putchar; #else wscons.wc_polledio.cons_polledio_putchar = NULL; #endif wscons.wc_polledio.cons_polledio_getchar = wc_getchar; wscons.wc_polledio.cons_polledio_ischar = wc_ischar; wscons.wc_polledio.cons_polledio_enter = wc_polled_enter; wscons.wc_polledio.cons_polledio_exit = wc_polled_exit; #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) /* * If we're talking directly to a framebuffer, we assume * that it's a "slow" device, so that rendering should be * deferred to a timeout or softcall so that we write * a bunch of characters at once. */ wscons.wc_defer_output = prom_stdout_is_framebuffer(); #endif } if (wscons.wc_ttycommon.t_flags & TS_XCLUDE) { if (secpolicy_excl_open(crp) != 0) { return (EBUSY); } } wscons.wc_ttycommon.t_readq = q; wscons.wc_ttycommon.t_writeq = WR(q); qprocson(q); return (0); } /*ARGSUSED*/ static int wcclose(queue_t *q, int flag, cred_t *crp) { qprocsoff(q); if (wscons.wc_bufcallid != 0) { qunbufcall(q, wscons.wc_bufcallid); wscons.wc_bufcallid = 0; } if (wscons.wc_timeoutid != 0) { (void) quntimeout(q, wscons.wc_timeoutid); wscons.wc_timeoutid = 0; } ttycommon_close(&wscons.wc_ttycommon); wscons.wc_flags = 0; return (0); } /* * Put procedure for upper write queue. * Respond to M_STOP, M_START, M_IOCTL, and M_FLUSH messages here; * queue up M_BREAK, M_DELAY, and M_DATA messages for processing by * the start routine, and then call the start routine; discard * everything else. */ static int wcuwput(queue_t *q, mblk_t *mp) { switch (mp->b_datap->db_type) { case M_STOP: wscons.wc_flags |= WCS_STOPPED; freemsg(mp); break; case M_START: wscons.wc_flags &= ~WCS_STOPPED; wcstart(); freemsg(mp); break; case M_IOCTL: { struct iocblk *iocp; struct linkblk *linkp; iocp = (struct iocblk *)mp->b_rptr; switch (iocp->ioc_cmd) { case I_LINK: /* stupid, but permitted */ case I_PLINK: if (wscons.wc_kbdqueue != NULL) { /* somebody already linked */ miocnak(q, mp, 0, EINVAL); return (0); } linkp = (struct linkblk *)mp->b_cont->b_rptr; wscons.wc_kbdqueue = WR(linkp->l_qbot); mp->b_datap->db_type = M_IOCACK; iocp->ioc_count = 0; wc_open_kb_polledio(&wscons, q, mp); break; case I_UNLINK: /* stupid, but permitted */ case I_PUNLINK: linkp = (struct linkblk *)mp->b_cont->b_rptr; if (wscons.wc_kbdqueue != WR(linkp->l_qbot)) { /* not us */ miocnak(q, mp, 0, EINVAL); return (0); } mp->b_datap->db_type = M_IOCACK; iocp->ioc_count = 0; wc_close_kb_polledio(&wscons, q, mp); break; case TCSETSW: case TCSETSF: case TCSETAW: case TCSETAF: case TCSBRK: /* * The changes do not take effect until all * output queued before them is drained. * Put this message on the queue, so that * "wcstart" will see it when it's done * with the output before it. Poke the * start routine, just in case. */ (void) putq(q, mp); wcstart(); break; case CONSSETABORTENABLE: case CONSGETABORTENABLE: case KIOCSDIRECT: if (wscons.wc_kbdqueue != NULL) { (void) putnext(wscons.wc_kbdqueue, mp); break; } /* fall through */ default: /* * Do it now. */ wcioctl(q, mp); break; } break; } case M_FLUSH: if (*mp->b_rptr & FLUSHW) { /* * Flush our write queue. */ flushq(q, FLUSHDATA); /* XXX doesn't flush M_DELAY */ *mp->b_rptr &= ~FLUSHW; /* it has been flushed */ } if (*mp->b_rptr & FLUSHR) { flushq(RD(q), FLUSHDATA); qreply(q, mp); /* give the read queues a crack at it */ } else freemsg(mp); break; case M_BREAK: /* * Ignore these, as they make no sense. */ freemsg(mp); break; case M_DELAY: case M_DATA: /* * Queue the message up to be transmitted, * and poke the start routine. */ (void) putq(q, mp); wcstart(); break; default: /* * "No, I don't want a subscription to Chain Store Age, * thank you anyway." */ freemsg(mp); break; } return (0); } /* * Retry an "ioctl", now that "qbufcall" claims we may be able to allocate * the buffer we need. */ /*ARGSUSED*/ static void wcreioctl(void *arg) { queue_t *q; mblk_t *mp; wscons.wc_bufcallid = 0; q = wscons.wc_ttycommon.t_writeq; if ((mp = wscons.wc_ttycommon.t_iocpending) != NULL) { /* not pending any more */ wscons.wc_ttycommon.t_iocpending = NULL; wcioctl(q, mp); } } /* * Process an "ioctl" message sent down to us. */ static void wcioctl(queue_t *q, mblk_t *mp) { struct iocblk *iocp; size_t datasize; int error; #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) int len; #endif iocp = (struct iocblk *)mp->b_rptr; switch (iocp->ioc_cmd) { case TIOCSWINSZ: /* * Ignore all attempts to set the screen size; the * value in the EEPROM is guaranteed (modulo PROM bugs) * to be the value used by the PROM monitor code, so it * is by definition correct. Many programs (e.g., * "login" and "tset") will attempt to reset the size * to (0, 0) or (34, 80), neither of which is * necessarily correct. * We just ACK the message, so as not to disturb * programs that set the sizes. */ iocp->ioc_count = 0; /* no data returned */ mp->b_datap->db_type = M_IOCACK; qreply(q, mp); return; case CONSOPENPOLLEDIO: DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wcioctl: CONSOPENPOLLEDIO\n")); error = miocpullup(mp, sizeof (struct cons_polledio *)); if (error != 0) { miocnak(q, mp, 0, error); return; } /* * If the keyboard driver does not support polled I/O * then NAK this request. */ if (wscons.wc_kb_polledio != NULL) { /* * We are given an appropriate-sized data block, * and return a pointer to our structure in it. */ *(struct cons_polledio **)mp->b_cont->b_rptr = &wscons.wc_polledio; mp->b_datap->db_type = M_IOCACK; } else { /* * The driver does not support polled mode, so NAK * the request. */ miocnak(q, mp, 0, ENXIO); return; } qreply(q, mp); break; #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) case WC_OPEN_FB: /* * Start out pessimistic, so that we can just jump to * the reply to bail out. */ mp->b_datap->db_type = M_IOCNAK; /* * First test: really, this should be done only from * inside the kernel. Unfortunately, that information * doesn't seem to be available in a streams ioctl, * so restrict it to root only. (Perhaps we could check * for ioc_cr == kcred.) */ if ((iocp->ioc_error = secpolicy_console(iocp->ioc_cr)) != 0) goto open_fail; /* * Some miscellaneous checks... */ iocp->ioc_error = EINVAL; /* * If we're already open, fail. */ if (wscons.wc_tem != NULL) goto open_fail; /* * If we don't have exactly one continuation block, fail. */ if (mp->b_cont == NULL || mp->b_cont->b_cont != NULL) goto open_fail; /* * If there's no null terminator in the string, fail. */ len = mp->b_cont->b_wptr - mp->b_cont->b_rptr; if (memchr(mp->b_cont->b_rptr, 0, len) == NULL) goto open_fail; /* * NOTE: should eventually get default * dimensions from a property, e.g. screen-#rows. */ iocp->ioc_error = tem_init(&wscons.wc_tem, (char *)mp->b_cont->b_rptr, iocp->ioc_cr, 0, 0); /* * Of course, if the terminal emulator initialization * failed, fail. */ if (iocp->ioc_error != 0) goto open_fail; /* * Refresh terminal size with info from terminal emulator. */ wc_get_size(&wscons); /* * ... and succeed. */ mp->b_datap->db_type = M_IOCACK; open_fail: qreply(q, mp); break; case WC_CLOSE_FB: /* * There's nothing that can call this, so it's not * really implemented. */ mp->b_datap->db_type = M_IOCNAK; /* * However, if it were implemented, it would clearly * be root-only. */ if ((iocp->ioc_error = secpolicy_console(iocp->ioc_cr)) != 0) goto close_fail; iocp->ioc_error = EINVAL; close_fail: qreply(q, mp); break; #endif default: /* * The only way in which "ttycommon_ioctl" can fail is * if the "ioctl" requires a response containing data * to be returned to the user, and no mblk could be * allocated for the data. No such "ioctl" alters our * state. Thus, we always go ahead and do any * state-changes the "ioctl" calls for. If we couldn't * allocate the data, "ttycommon_ioctl" has stashed the * "ioctl" away safely, so we just call "qbufcall" to * request that we be called back when we stand a * better chance of allocating the data. */ datasize = ttycommon_ioctl(&wscons.wc_ttycommon, q, mp, &error); if (datasize != 0) { if (wscons.wc_bufcallid != 0) qunbufcall(q, wscons.wc_bufcallid); wscons.wc_bufcallid = qbufcall(q, datasize, BPRI_HI, wcreioctl, NULL); return; } if (error < 0) { if (iocp->ioc_cmd == TCSBRK) error = 0; else error = EINVAL; } if (error != 0) { iocp->ioc_error = error; mp->b_datap->db_type = M_IOCNAK; } qreply(q, mp); break; } } /* * This function gets the polled I/O structures from the lower * keyboard driver. If any initialization or resource allocation * needs to be done by the lower driver, it will be done when * the lower driver services this message. */ static void wc_open_kb_polledio(struct wscons *wscons, queue_t *q, mblk_t *mp) { mblk_t *mp2; struct iocblk *iocp; DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wc_open_kb_polledio: sending CONSOPENPOLLEDIO\n")); mp2 = mkiocb(CONSOPENPOLLEDIO); if (mp2 == NULL) { /* * If we can't get an mblk, then wait for it. */ goto nomem; } mp2->b_cont = allocb(sizeof (struct cons_polledio *), BPRI_HI); if (mp2->b_cont == NULL) { /* * If we can't get an mblk, then wait for it, and release * the mblk that we have already allocated. */ freemsg(mp2); goto nomem; } iocp = (struct iocblk *)mp2->b_rptr; iocp->ioc_count = sizeof (struct cons_polledio *); mp2->b_cont->b_wptr = mp2->b_cont->b_rptr + sizeof (struct cons_polledio *); wscons->wc_pending_link = mp; wscons->wc_kb_getpolledio_id = iocp->ioc_id; putnext(wscons->wc_kbdqueue, mp2); return; nomem: iocp = (struct iocblk *)mp->b_rptr; iocp->ioc_error = ENOMEM; mp->b_datap->db_type = M_IOCNAK; qreply(q, mp); } /* * This function releases the polled I/O structures from the lower * keyboard driver. If any de-initialization needs to be done, or * any resources need to be released, it will be done when the lower * driver services this message. */ static void wc_close_kb_polledio(struct wscons *wscons, queue_t *q, mblk_t *mp) { mblk_t *mp2; struct iocblk *iocp; DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wc_close_kb_polledio: sending CONSCLOSEPOLLEDIO\n")); mp2 = mkiocb(CONSCLOSEPOLLEDIO); if (mp2 == NULL) { /* * If we can't get an mblk, then wait for it. */ goto nomem; } mp2->b_cont = allocb(sizeof (struct cons_polledio *), BPRI_HI); if (mp2->b_cont == NULL) { /* * If we can't get an mblk, then wait for it, and release * the mblk that we have already allocated. */ freemsg(mp2); goto nomem; } iocp = (struct iocblk *)mp2->b_rptr; iocp->ioc_count = 0; wscons->wc_pending_link = mp; wscons->wc_kb_getpolledio_id = iocp->ioc_id; putnext(wscons->wc_kbdqueue, mp2); return; nomem: iocp = (struct iocblk *)mp->b_rptr; iocp->ioc_error = ENOMEM; mp->b_datap->db_type = M_IOCNAK; qreply(q, mp); } #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) /* ARGSUSED */ static void wcopoll(void *arg) { queue_t *q; q = wscons.wc_ttycommon.t_writeq; wscons.wc_timeoutid = 0; /* See if we can continue output */ if ((wscons.wc_flags & WCS_BUSY) && wscons.wc_pendc != -1) { if (prom_mayput((char)wscons.wc_pendc) == 0) { wscons.wc_pendc = -1; wscons.wc_flags &= ~WCS_BUSY; if (!(wscons.wc_flags&(WCS_DELAY|WCS_STOPPED))) wcstart(); } else wscons.wc_timeoutid = qtimeout(q, wcopoll, NULL, 1); } } #endif /* _CONSOLE_OUTPUT_VIA_FIRMWARE */ /* * Restart output on the console after a timeout. */ /* ARGSUSED */ static void wcrstrt(void *arg) { ASSERT(wscons.wc_ttycommon.t_writeq != NULL); wscons.wc_flags &= ~WCS_DELAY; wcstart(); } /* * Start console output */ static void wcstart(void) { #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) int c; ssize_t cc; #endif queue_t *q; mblk_t *bp; mblk_t *nbp; /* * If we're waiting for something to happen (delay timeout to * expire, current transmission to finish, output to be * restarted, output to finish draining), don't grab anything * new. */ if (wscons.wc_flags & (WCS_DELAY|WCS_BUSY|WCS_STOPPED)) goto out; q = wscons.wc_ttycommon.t_writeq; /* * assumes that we have been called by whoever holds the * exclusionary lock on the write-side queue (protects * wc_flags and wc_pendc). */ for (;;) { if ((bp = getq(q)) == NULL) goto out; /* nothing to transmit */ /* * We have a new message to work on. * Check whether it's a delay or an ioctl (the latter * occurs if the ioctl in question was waiting for the output * to drain). If it's one of those, process it immediately. */ switch (bp->b_datap->db_type) { case M_DELAY: /* * Arrange for "wcrstrt" to be called when the * delay expires; it will turn WCS_DELAY off, * and call "wcstart" to grab the next message. */ if (wscons.wc_timeoutid != 0) (void) quntimeout(q, wscons.wc_timeoutid); wscons.wc_timeoutid = qtimeout(q, wcrstrt, NULL, (clock_t)(*(unsigned char *)bp->b_rptr + 6)); wscons.wc_flags |= WCS_DELAY; freemsg(bp); goto out; /* wait for this to finish */ case M_IOCTL: /* * This ioctl was waiting for the output ahead of * it to drain; obviously, it has. Do it, and * then grab the next message after it. */ wcioctl(q, bp); continue; } #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) if (wscons.wc_tem != NULL) { for (nbp = bp; nbp != NULL; nbp = nbp->b_cont) { if (nbp->b_wptr > nbp->b_rptr) { (void) tem_write(wscons.wc_tem, nbp->b_rptr, nbp->b_wptr - nbp->b_rptr, kcred); } } } freemsg(bp); #else /* _CONSOLE_OUTPUT_VIA_FIRMWARE */ if ((cc = bp->b_wptr - bp->b_rptr) == 0) { freemsg(bp); continue; } /* * Direct output to the frame buffer if this device * is not the "hardware" console. */ if (wscons.wc_defer_output) { /* * Never do output here; * it takes forever. */ wscons.wc_flags |= WCS_BUSY; wscons.wc_pendc = -1; (void) putbq(q, bp); if (q->q_count > 128) { /* do it soon */ softcall(wconsout, NULL); } else { /* wait a bit */ if (wscons.wc_timeoutid != 0) (void) quntimeout(q, wscons.wc_timeoutid); wscons.wc_timeoutid = qtimeout(q, wconsout, NULL, hz / 30); } goto out; } for (;;) { c = *bp->b_rptr++; cc--; if (prom_mayput((char)c) != 0) { wscons.wc_flags |= WCS_BUSY; wscons.wc_pendc = c; if (wscons.wc_timeoutid != 0) (void) quntimeout(q, wscons.wc_timeoutid); wscons.wc_timeoutid = qtimeout(q, wcopoll, NULL, 1); if (bp != NULL) /* not done with this message yet */ (void) putbq(q, bp); goto out; } while (cc <= 0) { nbp = bp; bp = bp->b_cont; freeb(nbp); if (bp == NULL) goto out; cc = bp->b_wptr - bp->b_rptr; } } #endif } out: ; } #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) /* * Output to frame buffer console. * It takes a long time to scroll. */ /* ARGSUSED */ static void wconsout(void *dummy) { uchar_t *cp; ssize_t cc; queue_t *q; mblk_t *bp; mblk_t *nbp; char *current_position; ssize_t bytes_left; if ((q = wscons.wc_ttycommon.t_writeq) == NULL) { return; /* not attached to a stream */ } /* * Set up to copy up to MAXHIWAT bytes. */ current_position = &obuf[0]; bytes_left = MAXHIWAT; while ((bp = getq(q)) != NULL) { if (bp->b_datap->db_type == M_IOCTL) { /* * This ioctl was waiting for the output ahead of * it to drain; obviously, it has. Put it back * so that "wcstart" can handle it, and transmit * what we've got. */ (void) putbq(q, bp); goto transmit; } do { cp = bp->b_rptr; cc = bp->b_wptr - cp; while (cc != 0) { if (bytes_left == 0) { /* * Out of buffer space; put this * buffer back on the queue, and * transmit what we have. */ bp->b_rptr = cp; (void) putbq(q, bp); goto transmit; } *current_position++ = *cp++; cc--; bytes_left--; } nbp = bp; bp = bp->b_cont; freeb(nbp); } while (bp != NULL); } transmit: if ((cc = MAXHIWAT - bytes_left) != 0) console_puts(obuf, cc); wscons.wc_flags &= ~WCS_BUSY; wcstart(); } #endif /* * Put procedure for lower read queue. * Pass everything up to queue above "upper half". */ static int wclrput(queue_t *q, mblk_t *mp) { queue_t *upq; struct iocblk *iocp; DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wclrput: wclrput type = 0x%x\n", mp->b_datap->db_type)); switch (mp->b_datap->db_type) { case M_FLUSH: if (*mp->b_rptr == FLUSHW || *mp->b_rptr == FLUSHRW) { /* * Flush our write queue. */ /* XXX doesn't flush M_DELAY */ flushq(WR(q), FLUSHDATA); *mp->b_rptr = FLUSHR; /* it has been flushed */ } if (*mp->b_rptr == FLUSHR || *mp->b_rptr == FLUSHRW) { flushq(q, FLUSHDATA); *mp->b_rptr = FLUSHW; /* it has been flushed */ qreply(q, mp); /* give the read queues a crack at it */ } else freemsg(mp); break; case M_DATA: if ((upq = wscons.wc_ttycommon.t_readq) != NULL) { if (!canput(upq->q_next)) { ttycommon_qfull(&wscons.wc_ttycommon, upq); wcstart(); freemsg(mp); } else putnext(upq, mp); } else freemsg(mp); break; case M_IOCACK: case M_IOCNAK: iocp = (struct iocblk *)mp->b_rptr; if (wscons.wc_pending_link != NULL && iocp->ioc_id == wscons.wc_kb_getpolledio_id) { switch (mp->b_datap->db_type) { case M_IOCACK: switch (iocp->ioc_cmd) { case CONSOPENPOLLEDIO: DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wclrput: " "ACK CONSOPENPOLLEDIO\n")); wscons.wc_kb_polledio = *(struct cons_polledio **) mp->b_cont->b_rptr; break; case CONSCLOSEPOLLEDIO: DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wclrput: " "ACK CONSCLOSEPOLLEDIO\n")); wscons.wc_kb_polledio = NULL; wscons.wc_kbdqueue = NULL; break; default: DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wclrput: " "ACK UNKNOWN\n")); } break; case M_IOCNAK: /* * Keyboard may or may not support polled I/O. * This ioctl may have been rejected because * we only have the wc->conskbd chain built, * and the keyboard driver has not been linked * underneath conskbd yet. */ DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wclrput: NAK\n")); switch (iocp->ioc_cmd) { case CONSCLOSEPOLLEDIO: wscons.wc_kb_polledio = NULL; wscons.wc_kbdqueue = NULL; break; } break; } /* * Discard the response, replace it with the * pending response to the I_PLINK, then let it * flow upward. */ freemsg(mp); mp = wscons.wc_pending_link; wscons.wc_pending_link = NULL; wscons.wc_kb_getpolledio_id = 0; } /* FALLTHROUGH */ default: /* inc M_ERROR, M_HANGUP, M_IOCACK, M_IOCNAK, ... */ DPRINTF(PRINT_L1, PRINT_MASK_ALL, ("wclrput: Message DISCARDED\n")); if ((upq = wscons.wc_ttycommon.t_readq) != NULL) { putnext(upq, mp); } else { freemsg(mp); } break; } return (0); } /* * Auxiliary routines, for allowing the workstation console to be redirected. */ /* * Given a minor device number for a wscons instance, return a held vnode for * it. * * We currently support only one instance, for the "workstation console". */ int wcvnget(minor_t unit, vnode_t **vpp) { if (unit != 0 || rwsconsvp == NULL) return (ENXIO); /* * rwsconsvp is already held, so we don't have to do it here. */ *vpp = rwsconsvp; return (0); } /* * Release the vnode that wcvnget returned. */ /* ARGSUSED */ void wcvnrele(minor_t unit, vnode_t *vp) { /* * Nothing to do, since we only support the workstation console * instance that's held throughout the system's lifetime. */ } /* * The declaration and initialization of the wscons_srvnops has been * moved to space.c to allow "wc" to become a loadable module. */ #if defined(_CONSOLE_OUTPUT_VIA_SOFTWARE) /* * This is for systems without OBP. */ static void wc_putchar(struct cons_polledio_arg *arg, unsigned char c) { if (c == '\n') wc_putchar(arg, '\r'); if (wscons.wc_tem == NULL) { /* * We have no terminal emulator configured. We have no * recourse but to drop the output on the floor. */ return; } /* * We ignore the result code. After all, what could we do? * Write something to the console?? */ (void) tem_polled_write(wscons.wc_tem, &c, 1); } #endif /* _CONSOLE_OUTPUT_VIA_SOFTWARE */ /* * These are for systems without OBP, and for devices that cannot be * shared between Solaris and the OBP. */ static int wc_getchar(struct cons_polledio_arg *arg) { struct wscons *wscons = (struct wscons *)arg; if (wscons->wc_kb_polledio == NULL) { prom_printf("wscons: getchar with no keyboard support"); prom_printf("Halted..."); for (;;) /* HANG FOREVER */; } return (wscons->wc_kb_polledio->cons_polledio_getchar( wscons->wc_kb_polledio->cons_polledio_argument)); } static boolean_t wc_ischar(struct cons_polledio_arg *arg) { struct wscons *wscons = (struct wscons *)arg; if (wscons->wc_kb_polledio == NULL) return (B_FALSE); return (wscons->wc_kb_polledio->cons_polledio_ischar( wscons->wc_kb_polledio->cons_polledio_argument)); } static void wc_polled_enter(struct cons_polledio_arg *arg) { struct wscons *wscons = (struct wscons *)arg; if (wscons->wc_kb_polledio == NULL) return; if (wscons->wc_kb_polledio->cons_polledio_enter != NULL) { wscons->wc_kb_polledio->cons_polledio_enter( wscons->wc_kb_polledio->cons_polledio_argument); } } static void wc_polled_exit(struct cons_polledio_arg *arg) { struct wscons *wscons = (struct wscons *)arg; if (wscons->wc_kb_polledio == NULL) return; if (wscons->wc_kb_polledio->cons_polledio_exit != NULL) { wscons->wc_kb_polledio->cons_polledio_exit( wscons->wc_kb_polledio->cons_polledio_argument); } } #ifdef DEBUG static void wc_dprintf(const char *fmt, ...) { char buf[256]; va_list ap; va_start(ap, fmt); (void) vsprintf(buf, fmt, ap); va_end(ap); cmn_err(CE_CONT, "wc: %s", buf); } #endif #if defined(_CONSOLE_OUTPUT_VIA_FIRMWARE) static int atou_n(char *s, int n) { int res; res = 0; while (n > 0 && *s != '\0') { if (*s < '0' || *s > '9') return (0); res *= 10; res += *s - '0'; s++; n--; } return (res); } static int get_option_string_int(char *name) { char *data; uint_t len; int res; if (ddi_prop_lookup_byte_array(DDI_DEV_T_ANY, ddi_root_node(), 0, name, (uchar_t **)&data, &len) != DDI_PROP_SUCCESS) return (0); res = atou_n(data, len); ddi_prop_free(data); return (res); } #endif /* * Gets the number of text rows and columns and the * width and height (in pixels) of the console. */ static void wc_get_size(struct wscons *wscons) { #if defined _CONSOLE_OUTPUT_VIA_FIRMWARE static char *cols = "screen-#columns"; static char *rows = "screen-#rows"; static char *width = "screen-width"; static char *height = "screen-height"; struct winsize *t; t = &wscons->wc_ttycommon.t_size; /* * Get the number of columns */ t->ws_col = (unsigned short)get_option_string_int(cols); if (t->ws_col < MINCOLS) t->ws_col = LOSCREENCOLS; else if (t->ws_col > MAXCOLS) t->ws_col = HISCREENCOLS; /* * Get the number of rows */ t->ws_row = (unsigned short)get_option_string_int(rows); if (t->ws_row < MINLINES) t->ws_row = LOSCREENLINES; else if (t->ws_row > MAXLINES) t->ws_row = HISCREENLINES; /* * Get the size in pixels. */ t->ws_xpixel = (unsigned short)get_option_string_int(width); t->ws_ypixel = (unsigned short)get_option_string_int(height); #else /* _CONSOLE_OUTPUT_VIA_SOFTWARE */ struct winsize *t; int r, c, x, y; t = &wscons->wc_ttycommon.t_size; if (wscons->wc_tem != NULL) { tem_get_size(wscons->wc_tem, &r, &c, &x, &y); t->ws_row = (unsigned short)r; t->ws_col = (unsigned short)c; t->ws_xpixel = (unsigned short)x; t->ws_ypixel = (unsigned short)y; } else { t->ws_row = LOSCREENLINES; t->ws_col = LOSCREENCOLS; t->ws_xpixel = 0; t->ws_ypixel = 0; } #endif }