/* $NetBSD: kd.c,v 1.23 2002/10/23 09:12:09 jdolecek Exp $ */ /*- * Copyright (c) 1996 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by Gordon W. Ross. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the NetBSD * Foundation, Inc. and its contributors. * 4. Neither the name of The NetBSD Foundation nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Console driver based on PROM primitives. * * This driver exists to provide a tty device that the indirect * console driver can point to. It also provides a hook that * allows another device to serve console input. This will normally * be a keyboard driver (see sys/dev/sun/kbd.c) */ #include "opt_kgdb.h" #include "fb.h" #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #if defined(RASTERCONSOLE) && NFB > 0 #include #include #endif #include #include #include #include #include #define PUT_WSIZE 64 struct kd_softc { struct device kd_dev; /* required first: base device */ struct tty *kd_tty; int rows, cols; /* Console input hook */ struct cons_channel *kd_in; }; /* * There is no point in pretending there might be * more than one keyboard/display device. */ static struct kd_softc kd_softc; static int kdparam(struct tty *, struct termios *); static void kdstart(struct tty *); static void kd_init __P((struct kd_softc *)); static void kd_cons_input __P((int)); dev_type_open(kdopen); dev_type_close(kdclose); dev_type_read(kdread); dev_type_write(kdwrite); dev_type_ioctl(kdioctl); dev_type_tty(kdtty); dev_type_poll(kdpoll); const struct cdevsw kd_cdevsw = { kdopen, kdclose, kdread, kdwrite, kdioctl, nostop, kdtty, kdpoll, nommap, ttykqfilter, D_TTY }; /* * Prepare the console tty; called on first open of /dev/console */ void kd_init(kd) struct kd_softc *kd; { struct tty *tp; tp = ttymalloc(); tp->t_oproc = kdstart; tp->t_param = kdparam; tp->t_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0); tty_attach(tp); kd->kd_tty = tp; /* * Get the console struct winsize. */ #if defined(RASTERCONSOLE) && NFB > 0 /* If the raster console driver is attached, copy its size */ kd->rows = fbrcons_rows(); kd->cols = fbrcons_cols(); rcons_ttyinit(tp); #endif /* else, consult the PROM */ switch (prom_version()) { char *prop; struct eeprom *ep; case PROM_OLDMON: if ((ep = (struct eeprom *)eeprom_va) == NULL) break; if (kd->rows == 0) kd->rows = (u_short)ep->eeTtyRows; if (kd->cols == 0) kd->cols = (u_short)ep->eeTtyCols; break; case PROM_OBP_V0: case PROM_OBP_V2: case PROM_OBP_V3: case PROM_OPENFIRM: if (kd->rows == 0 && (prop = PROM_getpropstring(optionsnode, "screen-#rows"))) { int i = 0; while (*prop != '\0') i = i * 10 + *prop++ - '0'; kd->rows = (unsigned short)i; } if (kd->cols == 0 && (prop = PROM_getpropstring(optionsnode, "screen-#columns"))) { int i = 0; while (*prop != '\0') i = i * 10 + *prop++ - '0'; kd->cols = (unsigned short)i; } break; } return; } struct tty * kdtty(dev) dev_t dev; { struct kd_softc *kd; kd = &kd_softc; /* XXX */ return (kd->kd_tty); } int kdopen(dev, flag, mode, p) dev_t dev; int flag, mode; struct proc *p; { struct kd_softc *kd; int error, s, unit; struct tty *tp; static int firstopen = 1; unit = minor(dev); if (unit != 0) return ENXIO; kd = &kd_softc; /* XXX */ if (firstopen) { kd_init(kd); firstopen = 0; } tp = kd->kd_tty; /* It's simpler to do this up here. */ if (((tp->t_state & (TS_ISOPEN | TS_XCLUDE)) == (TS_ISOPEN | TS_XCLUDE)) && (p->p_ucred->cr_uid != 0) ) { return (EBUSY); } s = spltty(); if ((tp->t_state & TS_ISOPEN) == 0) { /* First open. */ /* Notify the input device that serves us */ struct cons_channel *cc = kd->kd_in; if (cc != NULL && (error = (*cc->cc_iopen)(cc)) != 0) { return (error); } ttychars(tp); tp->t_iflag = TTYDEF_IFLAG; tp->t_oflag = TTYDEF_OFLAG; tp->t_cflag = TTYDEF_CFLAG; tp->t_lflag = TTYDEF_LFLAG; tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED; (void) kdparam(tp, &tp->t_termios); ttsetwater(tp); tp->t_winsize.ws_row = kd->rows; tp->t_winsize.ws_col = kd->cols; /* Flush pending input? Clear translator? */ /* This (pseudo)device always has SOFTCAR */ tp->t_state |= TS_CARR_ON; } splx(s); return ((*tp->t_linesw->l_open)(dev, tp)); } int kdclose(dev, flag, mode, p) dev_t dev; int flag, mode; struct proc *p; { struct kd_softc *kd; struct tty *tp; struct cons_channel *cc; kd = &kd_softc; /* XXX */ tp = kd->kd_tty; /* XXX This is for cons.c. */ if ((tp->t_state & TS_ISOPEN) == 0) return 0; (*tp->t_linesw->l_close)(tp, flag); ttyclose(tp); if ((cc = kd->kd_in) != NULL) (void)(*cc->cc_iclose)(cc); return (0); } int kdread(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { struct kd_softc *kd; struct tty *tp; kd = &kd_softc; /* XXX */ tp = kd->kd_tty; return ((*tp->t_linesw->l_read)(tp, uio, flag)); } int kdwrite(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { struct kd_softc *kd; struct tty *tp; kd = &kd_softc; /* XXX */ tp = kd->kd_tty; return ((*tp->t_linesw->l_write)(tp, uio, flag)); } int kdpoll(dev, events, p) dev_t dev; int events; struct proc *p; { struct kd_softc *kd; struct tty *tp; kd = &kd_softc; /* XXX */ tp = kd->kd_tty; return ((*tp->t_linesw->l_poll)(tp, events, p)); } int kdioctl(dev, cmd, data, flag, p) dev_t dev; u_long cmd; caddr_t data; int flag; struct proc *p; { struct kd_softc *kd; struct tty *tp; int error; kd = &kd_softc; /* XXX */ tp = kd->kd_tty; error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, p); if (error != EPASSTHROUGH) return error; error = ttioctl(tp, cmd, data, flag, p); if (error != EPASSTHROUGH) return error; /* Handle any ioctl commands specific to kbd/display. */ /* XXX - Send KB* ioctls to kbd module? */ /* XXX - Send FB* ioctls to fb module? */ return EPASSTHROUGH; } static int kdparam(tp, t) struct tty *tp; struct termios *t; { /* XXX - These are ignored... */ tp->t_ispeed = t->c_ispeed; tp->t_ospeed = t->c_ospeed; tp->t_cflag = t->c_cflag; return 0; } static void kd_later(void*); static void kd_putfb(struct tty *); static void kdstart(tp) struct tty *tp; { struct clist *cl; int s; s = spltty(); if (tp->t_state & (TS_BUSY|TS_TTSTOP|TS_TIMEOUT)) goto out; cl = &tp->t_outq; if (cl->c_cc) { tp->t_state |= TS_BUSY; if ((s & PSR_PIL) == 0) { /* called at level zero - update screen now. */ (void) spllowersoftclock(); kd_putfb(tp); (void) spltty(); tp->t_state &= ~TS_BUSY; } else { /* called at interrupt level - do it later */ callout_reset(&tp->t_rstrt_ch, 0, kd_later, tp); } } if (cl->c_cc <= tp->t_lowat) { if (tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup((caddr_t)cl); } selwakeup(&tp->t_wsel); } out: splx(s); } /* * Timeout function to do delayed writes to the screen. * Called at splsoftclock when requested by kdstart. */ static void kd_later(arg) void *arg; { struct tty *tp = arg; int s; kd_putfb(tp); s = spltty(); tp->t_state &= ~TS_BUSY; (*tp->t_linesw->l_start)(tp); splx(s); } /* * Put text on the screen using the PROM monitor. * This can take a while, so to avoid missing * interrupts, this is called at splsoftclock. */ static void kd_putfb(tp) struct tty *tp; { char buf[PUT_WSIZE]; struct clist *cl = &tp->t_outq; char *p, *end; int len; while ((len = q_to_b(cl, buf, PUT_WSIZE-1)) > 0) { /* PROM will barf if high bits are set. */ p = buf; end = buf + len; while (p < end) *p++ &= 0x7f; /* Now let the PROM print it. */ prom_putstr(buf, len); } } /* * Our "interrupt" routine for input. This is called by * the keyboard driver (dev/sun/kbd.c) at spltty. */ void kd_cons_input(c) int c; { struct kd_softc *kd = &kd_softc; struct tty *tp; /* XXX: Make sure the device is open. */ tp = kd->kd_tty; if (tp == NULL) return; if ((tp->t_state & TS_ISOPEN) == 0) return; (*tp->t_linesw->l_rint)(c, tp); } void cons_attach_input(cc, cn) struct cons_channel *cc; struct consdev *cn; { struct kd_softc *kd = &kd_softc; kd->kd_in = cc; cc->cc_upstream = kd_cons_input; } void kd_attach_input(struct cons_channel *); void kd_attach_input(cc) struct cons_channel *cc; { struct kd_softc *kd = &kd_softc; kd->kd_in = cc; cc->cc_upstream = kd_cons_input; } /* * Default PROM-based console input stream * Since the PROM does not notify us when data is available on the * input channel these functions periodically poll the PROM. */ static int kd_rom_iopen __P((struct cons_channel *)); static int kd_rom_iclose __P((struct cons_channel *)); static void kd_rom_intr __P((void *)); static struct cons_channel prom_cons_channel; int kd_rom_iopen(cc) struct cons_channel *cc; { /* Poll for ROM input 4 times per second */ callout_reset(&cc->cc_callout, hz / 4, kd_rom_intr, cc); return (0); } int kd_rom_iclose(cc) struct cons_channel *cc; { callout_stop(&cc->cc_callout); return (0); } /* * "Interrupt" routine for input through ROM vectors */ void kd_rom_intr(arg) void *arg; { struct cons_channel *cc = arg; int s, c; /* Re-schedule */ callout_reset(&cc->cc_callout, hz / 4, kd_rom_intr, cc); s = spltty(); while ((c = prom_peekchar()) >= 0) (*cc->cc_upstream)(c); splx(s); } /*****************************************************************/ int prom_stdin_node; int prom_stdout_node; char prom_stdin_args[16]; char prom_stdout_args[16]; extern void prom_cnprobe __P((struct consdev *)); static void prom_cninit __P((struct consdev *)); static int prom_cngetc __P((dev_t)); static void prom_cnputc __P((dev_t, int)); extern void prom_cnpollc __P((dev_t, int)); /* * The console is set to this one initially, * which lets us use the PROM until consinit() * is called to select a real console. */ struct consdev consdev_prom = { prom_cnprobe, prom_cninit, prom_cngetc, prom_cnputc, prom_cnpollc, NULL, }; /* * The console table pointer is statically initialized * to point to the PROM table, so that early calls to printf will work. */ struct consdev *cn_tab = &consdev_prom; void prom_cnprobe(cn) struct consdev *cn; { } static void prom_cninit(cn) struct consdev *cn; { } void prom_cnpollc(dev, on) dev_t dev; int on; { if (on) { /* Entering debugger. */ #if NFB > 0 fb_unblank(); #endif } else { /* Resuming kernel. */ } } /* * PROM console input putchar. */ static int prom_cngetc(dev) dev_t dev; { int s, c; s = splhigh(); c = prom_getchar(); splx(s); return (c); } /* * PROM console output putchar. */ static void prom_cnputc(dev, c) dev_t dev; int c; { prom_putchar(c); } /*****************************************************************/ static void prom_get_device_args __P((const char *, char *, unsigned int)); void prom_get_device_args(prop, args, sz) const char *prop; char *args; unsigned int sz; { char *cp, buffer[128]; cp = PROM_getpropstringA(findroot(), (char *)prop, buffer, sizeof buffer); /* * Extract device-specific arguments from a PROM device path (if any) */ cp = buffer + strlen(buffer); while (cp >= buffer) { if (*cp == ':') { strncpy(args, cp+1, sz); break; } cp--; } } /* * */ void consinit() { int inSource, outSink; switch (prom_version()) { case PROM_OLDMON: case PROM_OBP_V0: /* The stdio handles identify the device type */ inSource = prom_stdin(); outSink = prom_stdout(); break; case PROM_OBP_V2: case PROM_OBP_V3: case PROM_OPENFIRM: /* Save PROM arguments for device matching */ prom_get_device_args("stdin-path", prom_stdin_args, sizeof(prom_stdin_args)); prom_get_device_args("stdout-path", prom_stdout_args, sizeof(prom_stdout_args)); /* * Translate the STDIO package instance (`ihandle') -- that * the PROM has already opened for us -- to a device tree * node (i.e. a `phandle'). */ prom_stdin_node = prom_instance_to_package(prom_stdin()); if (prom_stdin_node == 0) printf("consinit: cannot convert stdin ihandle\n"); prom_stdout_node = prom_instance_to_package(prom_stdout()); if (prom_stdout_node == 0) { printf("consinit: cannot convert stdout ihandle\n"); break; } break; default: break; } /* Wire up /dev/console */ cn_tab->cn_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0); cn_tab->cn_pri = CN_INTERNAL; /* Set up initial PROM input channel for /dev/console */ prom_cons_channel.cc_dev = NULL; prom_cons_channel.cc_iopen = kd_rom_iopen; prom_cons_channel.cc_iclose = kd_rom_iclose; cons_attach_input(&prom_cons_channel, cn_tab); #ifdef KGDB zs_kgdb_init(); /* XXX */ #endif }