f6def40e18
At the moment grab and ungrab methods of all console drivers are no-ops. Current intended meaning of the calls is that the kernel takes control of console input. In the future the semantics may be extended to mean that the calling thread takes full ownership of the console (e.g. console output from other threads could be suspended). Inspired by: bde MFC after: 2 months
186 lines
4.1 KiB
C
186 lines
4.1 KiB
C
/*-
|
|
* Copyright (C) 2008 by Nathan Whitehorn. All rights reserved.
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 TOOLS GMBH 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.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kdb.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/priv.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/types.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/cons.h>
|
|
#include <sys/consio.h>
|
|
#include <sys/tty.h>
|
|
|
|
#include <dev/ofw/openfirm.h>
|
|
|
|
#include <ddb/ddb.h>
|
|
|
|
#include "mambocall.h"
|
|
|
|
#define MAMBOBURSTLEN 128 /* max number of bytes to write in one chunk */
|
|
|
|
#define MAMBO_CONSOLE_WRITE 0
|
|
#define MAMBO_CONSOLE_READ 60
|
|
|
|
static tsw_outwakeup_t mambotty_outwakeup;
|
|
|
|
static struct ttydevsw mambo_ttydevsw = {
|
|
.tsw_flags = TF_NOPREFIX,
|
|
.tsw_outwakeup = mambotty_outwakeup,
|
|
};
|
|
|
|
static int polltime;
|
|
static struct callout mambo_callout;
|
|
static struct tty *tp = NULL;
|
|
|
|
#if defined(KDB)
|
|
static int alt_break_state;
|
|
#endif
|
|
|
|
static void mambo_timeout(void *);
|
|
|
|
static cn_probe_t mambo_cnprobe;
|
|
static cn_init_t mambo_cninit;
|
|
static cn_term_t mambo_cnterm;
|
|
static cn_getc_t mambo_cngetc;
|
|
static cn_putc_t mambo_cnputc;
|
|
static cn_grab_t mambo_cngrab;
|
|
static cn_ungrab_t mambo_cnungrab;
|
|
|
|
CONSOLE_DRIVER(mambo);
|
|
|
|
static void
|
|
cn_drvinit(void *unused)
|
|
{
|
|
|
|
if (mambo_consdev.cn_pri != CN_DEAD &&
|
|
mambo_consdev.cn_name[0] != '\0') {
|
|
if (OF_finddevice("/mambo") == -1)
|
|
return;
|
|
|
|
tp = tty_alloc(&mambo_ttydevsw, NULL);
|
|
tty_init_console(tp, 0);
|
|
tty_makedev(tp, NULL, "%s", "mambocons");
|
|
|
|
polltime = 1;
|
|
|
|
callout_init(&mambo_callout, CALLOUT_MPSAFE);
|
|
callout_reset(&mambo_callout, polltime, mambo_timeout, NULL);
|
|
}
|
|
}
|
|
|
|
SYSINIT(cndev, SI_SUB_CONFIGURE, SI_ORDER_MIDDLE, cn_drvinit, NULL);
|
|
|
|
static void
|
|
mambotty_outwakeup(struct tty *tp)
|
|
{
|
|
int len;
|
|
u_char buf[MAMBOBURSTLEN];
|
|
|
|
for (;;) {
|
|
len = ttydisc_getc(tp, buf, sizeof buf);
|
|
if (len == 0)
|
|
break;
|
|
mambocall(MAMBO_CONSOLE_WRITE, buf, (register_t)len, 1UL);
|
|
}
|
|
}
|
|
|
|
static void
|
|
mambo_timeout(void *v)
|
|
{
|
|
int c;
|
|
|
|
tty_lock(tp);
|
|
while ((c = mambo_cngetc(NULL)) != -1)
|
|
ttydisc_rint(tp, c, 0);
|
|
ttydisc_rint_done(tp);
|
|
tty_unlock(tp);
|
|
|
|
callout_reset(&mambo_callout, polltime, mambo_timeout, NULL);
|
|
}
|
|
|
|
static void
|
|
mambo_cnprobe(struct consdev *cp)
|
|
{
|
|
if (OF_finddevice("/mambo") == -1) {
|
|
cp->cn_pri = CN_DEAD;
|
|
return;
|
|
}
|
|
|
|
cp->cn_pri = CN_NORMAL;
|
|
}
|
|
|
|
static void
|
|
mambo_cninit(struct consdev *cp)
|
|
{
|
|
|
|
/* XXX: This is the alias, but that should be good enough */
|
|
strcpy(cp->cn_name, "mambocons");
|
|
}
|
|
|
|
static void
|
|
mambo_cnterm(struct consdev *cp)
|
|
{
|
|
}
|
|
|
|
static void
|
|
mambo_cngrab(struct consdev *cp)
|
|
{
|
|
}
|
|
|
|
static void
|
|
mambo_cnungrab(struct consdev *cp)
|
|
{
|
|
}
|
|
|
|
static int
|
|
mambo_cngetc(struct consdev *cp)
|
|
{
|
|
int ch;
|
|
|
|
ch = mambocall(MAMBO_CONSOLE_READ);
|
|
|
|
if (ch > 0 && ch < 0xff) {
|
|
#if defined(KDB)
|
|
kdb_alt_break(ch, &alt_break_state);
|
|
#endif
|
|
return (ch);
|
|
}
|
|
|
|
return (-1);
|
|
}
|
|
|
|
static void
|
|
mambo_cnputc(struct consdev *cp, int c)
|
|
{
|
|
char cbuf;
|
|
|
|
cbuf = c;
|
|
mambocall(MAMBO_CONSOLE_WRITE, &cbuf, 1UL, 1UL);
|
|
}
|