2 * Copyright (C) 2008 by Nathan Whitehorn. All rights reserved.
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions
7 * 1. Redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution.
13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
14 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
15 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
16 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
17 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
18 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
19 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
20 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
21 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
22 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 #include <sys/cdefs.h>
26 __FBSDID("$FreeBSD$");
28 #include <sys/param.h>
30 #include <sys/kernel.h>
32 #include <sys/systm.h>
33 #include <sys/types.h>
36 #include <sys/consio.h>
39 #include <dev/ofw/openfirm.h>
43 #include "mambocall.h"
45 #define MAMBOBURSTLEN 128 /* max number of bytes to write in one chunk */
47 #define MAMBO_CONSOLE_WRITE 0
48 #define MAMBO_CONSOLE_READ 60
50 static tsw_outwakeup_t mambotty_outwakeup;
52 static struct ttydevsw mambo_ttydevsw = {
53 .tsw_flags = TF_NOPREFIX,
54 .tsw_outwakeup = mambotty_outwakeup,
58 static struct callout mambo_callout;
59 static struct tty *tp = NULL;
62 static int alt_break_state;
65 static void mambo_timeout(void *);
67 static cn_probe_t mambo_cnprobe;
68 static cn_init_t mambo_cninit;
69 static cn_term_t mambo_cnterm;
70 static cn_getc_t mambo_cngetc;
71 static cn_putc_t mambo_cnputc;
72 static cn_grab_t mambo_cngrab;
73 static cn_ungrab_t mambo_cnungrab;
75 CONSOLE_DRIVER(mambo);
78 cn_drvinit(void *unused)
81 if (mambo_consdev.cn_pri != CN_DEAD &&
82 mambo_consdev.cn_name[0] != '\0') {
83 if (OF_finddevice("/mambo") == -1)
86 tp = tty_alloc(&mambo_ttydevsw, NULL);
87 tty_init_console(tp, 0);
88 tty_makedev(tp, NULL, "%s", "mambocons");
92 callout_init(&mambo_callout, CALLOUT_MPSAFE);
93 callout_reset(&mambo_callout, polltime, mambo_timeout, NULL);
97 SYSINIT(cndev, SI_SUB_CONFIGURE, SI_ORDER_MIDDLE, cn_drvinit, NULL);
100 mambotty_outwakeup(struct tty *tp)
103 u_char buf[MAMBOBURSTLEN];
106 len = ttydisc_getc(tp, buf, sizeof buf);
109 mambocall(MAMBO_CONSOLE_WRITE, buf, (register_t)len, 1UL);
114 mambo_timeout(void *v)
119 while ((c = mambo_cngetc(NULL)) != -1)
120 ttydisc_rint(tp, c, 0);
121 ttydisc_rint_done(tp);
124 callout_reset(&mambo_callout, polltime, mambo_timeout, NULL);
128 mambo_cnprobe(struct consdev *cp)
130 if (OF_finddevice("/mambo") == -1) {
131 cp->cn_pri = CN_DEAD;
135 cp->cn_pri = CN_NORMAL;
139 mambo_cninit(struct consdev *cp)
142 /* XXX: This is the alias, but that should be good enough */
143 strcpy(cp->cn_name, "mambocons");
147 mambo_cnterm(struct consdev *cp)
152 mambo_cngrab(struct consdev *cp)
157 mambo_cnungrab(struct consdev *cp)
162 mambo_cngetc(struct consdev *cp)
166 ch = mambocall(MAMBO_CONSOLE_READ);
168 if (ch > 0 && ch < 0xff) {
170 kdb_alt_break(ch, &alt_break_state);
179 mambo_cnputc(struct consdev *cp, int c)
184 mambocall(MAMBO_CONSOLE_WRITE, &cbuf, 1UL, 1UL);