#include "opt_ddb.h"
#include "opt_comconsole.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/caps.h>
#include <sys/conf.h>
#include <sys/cons.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <sys/reboot.h>
#include <sys/sysctl.h>
#include <sys/tty.h>
#include <sys/uio.h>
#include <sys/msgport.h>
#include <sys/msgport2.h>
#include <sys/device.h>
#include <ddb/ddb.h>
#include <machine/cpu.h>
static d_open_t cnopen;
static d_close_t cnclose;
static d_read_t cnread;
static d_write_t cnwrite;
static d_ioctl_t cnioctl;
static d_kqfilter_t cnkqfilter;
static int cnintercept(struct dev_generic_args *ap);
#define CDEV_MAJOR 0
static struct dev_ops cn_ops = {
{ "console", 0, D_TTY | D_MPSAFE },
.d_open = cnopen,
.d_close = cnclose,
.d_read = cnread,
.d_write = cnwrite,
.d_ioctl = cnioctl,
.d_kqfilter = cnkqfilter,
};
static struct dev_ops cn_iops = {
{ "intercept", 0, D_TTY | D_MPSAFE },
.d_default = cnintercept
};
static struct dev_ops *cn_fwd_ops;
static cdev_t cn_dev;
#if 0
SYSCTL_OPAQUE(_machdep, CPU_CONSDEV, consdev, CTLFLAG_RD,
&cn_udev, sizeof cn_udev, "T,udev_t", "");
#endif
static int cn_mute;
#ifdef BREAK_TO_DEBUGGER
int break_to_debugger = 1;
#else
int break_to_debugger = 0;
#endif
TUNABLE_INT("kern.break_to_debugger", &break_to_debugger);
SYSCTL_INT(_kern, OID_AUTO, break_to_debugger, CTLFLAG_RW,
&break_to_debugger, 0, "");
#ifdef ALT_BREAK_TO_DEBUGGER
int alt_break_to_debugger = 1;
#else
int alt_break_to_debugger = 0;
#endif
TUNABLE_INT("kern.alt_break_to_debugger", &alt_break_to_debugger);
SYSCTL_INT(_kern, OID_AUTO, alt_break_to_debugger, CTLFLAG_RW,
&alt_break_to_debugger, 0, "");
int cons_unavail = 0;
int sysbeep_enable = 1;
static u_char cn_is_open;
static int openmode, openflag;
static cdev_t cn_devfsdev;
static u_char cn_phys_is_open;
static u_char console_pausing;
static char *console_pausestr=
"<pause; press any key to proceed to next line or '.' to end pause mode>";
struct consdev *cn_tab;
struct consdev *gdb_tab;
SYSCTL_INT(_kern, OID_AUTO, sysbeep_enable, CTLFLAG_RW, &sysbeep_enable, 0, "");
static uint32_t console_rdev;
SYSCTL_INT(_kern, OID_AUTO, console_rdev, CTLFLAG_RW,
&console_rdev, 0, "");
CONS_DRIVER(cons, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL);
SET_DECLARE(cons_set, struct consdev);
void
cninit(void)
{
struct consdev *best_cp, *cp, **list;
lwkt_gettoken(&tty_token);
lwkt_gettoken(&vga_token);
cn_mute = ((boothowto & (RB_MUTE
|RB_SINGLE
|RB_VERBOSE
|RB_ASKNAME)) == RB_MUTE);
best_cp = NULL;
SET_FOREACH(list, cons_set) {
cp = *list;
if (cp->cn_probe == NULL)
continue;
(*cp->cn_probe)(cp);
if (cp->cn_pri > CN_DEAD && cp->cn_probegood &&
(best_cp == NULL || cp->cn_pri > best_cp->cn_pri))
best_cp = cp;
}
if (best_cp == NULL) {
if (cn_tab != NULL && cn_tab->cn_term != NULL)
(*cn_tab->cn_term)(cn_tab);
goto done;
}
(*best_cp->cn_init)(best_cp);
if (cn_tab != NULL && cn_tab != best_cp) {
if (cn_tab->cn_term != NULL)
(*cn_tab->cn_term)(cn_tab);
}
if (boothowto & RB_PAUSE)
console_pausing = 1;
done:
cn_tab = best_cp;
lwkt_reltoken(&vga_token);
lwkt_reltoken(&tty_token);
}
void
cninit_finish(void)
{
if ((cn_tab == NULL) || cn_mute)
return;
if (cn_tab->cn_dev == NULL) {
cn_tab->cn_init_fini(cn_tab);
if (cn_tab->cn_dev == NULL) {
kprintf("Unable to hook console! cn_tab %p\n", cn_tab);
return;
}
}
cn_fwd_ops = dev_ops_intercept(cn_tab->cn_dev, &cn_iops);
cn_dev = cn_tab->cn_dev;
if (cn_dev) {
console_rdev = makeudev(cn_dev->si_umajor,
(cn_dev->si_uminor == 255 ?
0 : cn_dev->si_uminor));
} else {
console_rdev = 0;
}
console_pausing = 0;
}
static void
cnuninit(void)
{
if (cn_tab == NULL)
return;
if (cn_fwd_ops)
dev_ops_restore(cn_tab->cn_dev, cn_fwd_ops);
cn_fwd_ops = NULL;
cn_dev = NULL;
}
static int
sysctl_kern_consmute(SYSCTL_HANDLER_ARGS)
{
int error;
int ocn_mute;
ocn_mute = cn_mute;
error = sysctl_handle_int(oidp, &cn_mute, 0, req);
if((error == 0) && (cn_tab != NULL) && (req->newptr != NULL)) {
if(ocn_mute && !cn_mute) {
cninit_finish();
if (cn_is_open) {
error = dev_dopen(cn_dev, openflag, openmode,
curproc->p_ucred, NULL, NULL);
}
if ( error != 0) cnuninit();
} else if (!ocn_mute && cn_mute) {
if (cn_is_open) {
error = dev_dclose(cn_dev, openflag,
openmode, NULL);
}
if (error == 0)
cnuninit();
}
if (error != 0) {
cn_mute = ocn_mute;
}
}
return (error);
}
SYSCTL_PROC(_kern, OID_AUTO, consmute, CTLTYPE_INT|CTLFLAG_RW,
0, sizeof cn_mute, sysctl_kern_consmute, "I", "");
static int
cnintercept(struct dev_generic_args *ap)
{
int error;
if (ap->a_desc == &dev_open_desc) {
error = cnopen((struct dev_open_args *)ap);
} else if (ap->a_desc == &dev_close_desc) {
error = cnclose((struct dev_close_args *)ap);
} else if (cn_fwd_ops) {
error = dev_doperate_ops(cn_fwd_ops, ap);
} else {
error = ENXIO;
}
return (error);
}
static int
cnopen(struct dev_open_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
int flag = ap->a_oflags;
int mode = ap->a_devtype;
cdev_t cndev;
cdev_t physdev;
int retval = 0;
if (caps_priv_check_self(SYSCAP_RESTRICTEDROOT))
return (EPERM);
if (cn_tab == NULL || cn_fwd_ops == NULL)
return (0);
cndev = cn_tab->cn_dev;
physdev = (dev == cn_devfsdev) ? cndev : dev;
if (!cn_mute) {
ap->a_head.a_dev = physdev;
retval = dev_doperate_ops(cn_fwd_ops, &ap->a_head);
}
if (retval == 0) {
if (dev == cndev) {
cn_phys_is_open = 1;
} else if (physdev == cndev) {
openmode = mode;
openflag = flag;
cn_is_open = 1;
}
dev->si_tty = cndev->si_tty;
}
return (retval);
}
static int
cnclose(struct dev_close_args *ap)
{
struct tty *cn_tp;
cdev_t cndev;
cdev_t physdev;
cdev_t dev = ap->a_head.a_dev;
if (cn_tab == NULL || cn_fwd_ops == NULL)
return(0);
cndev = cn_tab->cn_dev;
cn_tp = cndev->si_tty;
physdev = (dev == cn_devfsdev) ? cndev : dev;
if (dev == cndev) {
cn_phys_is_open = 0;
if (cn_is_open) {
if (cn_tp) {
ttyclearsession(cn_tp);
}
return(0);
}
} else if (physdev == cndev) {
cn_is_open = 0;
if (cn_phys_is_open)
return(0);
dev = cndev;
}
if (cn_fwd_ops) {
ap->a_head.a_dev = dev;
return (dev_doperate_ops(cn_fwd_ops, &ap->a_head));
}
return (0);
}
static int
cnread(struct dev_read_args *ap)
{
if (cn_tab == NULL || cn_fwd_ops == NULL)
return (0);
ap->a_head.a_dev = cn_tab->cn_dev;
return (dev_doperate(&ap->a_head));
}
static int
cnwrite(struct dev_write_args *ap)
{
struct uio *uio = ap->a_uio;
cdev_t dev;
if (cn_tab == NULL || cn_fwd_ops == NULL) {
uio->uio_resid = 0;
return (0);
}
if (constty)
dev = constty->t_dev;
else
dev = cn_tab->cn_dev;
log_console(uio);
ap->a_head.a_dev = dev;
return (dev_doperate(&ap->a_head));
}
static int
cnioctl(struct dev_ioctl_args *ap)
{
int error;
if (cn_tab == NULL || cn_fwd_ops == NULL)
return (0);
KKASSERT(curproc != NULL);
if (ap->a_cmd == TIOCCONS && constty) {
if (ap->a_cred) {
error = caps_priv_check(ap->a_cred,
SYSCAP_RESTRICTEDROOT);
if (error)
return (error);
}
constty = NULL;
return (0);
}
ap->a_head.a_dev = cn_tab->cn_dev;
return (dev_doperate(&ap->a_head));
}
static int
cnkqfilter(struct dev_kqfilter_args *ap)
{
if ((cn_tab == NULL) || cn_mute || cn_fwd_ops == NULL)
return (1);
ap->a_head.a_dev = cn_tab->cn_dev;
return (dev_doperate(&ap->a_head));
}
int
cngetc(void)
{
int c;
if ((cn_tab == NULL) || cn_mute)
return (-1);
c = (*cn_tab->cn_getc)(cn_tab->cn_private);
if (c == '\r') c = '\n';
return (c);
}
int
cncheckc(void)
{
if ((cn_tab == NULL) || cn_mute)
return (-1);
return ((*cn_tab->cn_checkc)(cn_tab->cn_private));
}
void
cnpoll(int on)
{
if ((cn_tab == NULL) || cn_mute)
return;
if (cn_tab->cn_poll)
((*cn_tab->cn_poll)(cn_tab->cn_private, on));
}
void
cnputc(int c)
{
char *cp;
if ((cn_tab == NULL) || cn_mute)
return;
if (c) {
if (c == '\n')
(*cn_tab->cn_putc)(cn_tab->cn_private, '\r');
(*cn_tab->cn_putc)(cn_tab->cn_private, c);
#ifdef DDB
if (console_pausing && !db_active && (c == '\n')) {
#else
if (console_pausing && (c == '\n')) {
#endif
for(cp=console_pausestr; *cp != '\0'; cp++)
(*cn_tab->cn_putc)(cn_tab->cn_private, *cp);
if (cngetc() == '.')
console_pausing = 0;
(*cn_tab->cn_putc)(cn_tab->cn_private, '\r');
for(cp=console_pausestr; *cp != '\0'; cp++)
(*cn_tab->cn_putc)(cn_tab->cn_private, ' ');
(*cn_tab->cn_putc)(cn_tab->cn_private, '\r');
}
}
}
void
cndbctl(int on)
{
static int refcount;
if (cn_tab == NULL)
return;
if (!on)
refcount--;
if (refcount == 0 && cn_tab->cn_dbctl != NULL)
(*cn_tab->cn_dbctl)(cn_tab->cn_private, on);
if (on)
refcount++;
}
static void
cn_drvinit(void *unused)
{
cn_devfsdev = make_only_devfs_dev(&cn_ops, 0, UID_ROOT, GID_WHEEL,
0600, "console");
}
SYSINIT(cndev, SI_SUB_DRIVERS, SI_ORDER_MIDDLE + CDEV_MAJOR, cn_drvinit, NULL);