1/*- 2 * Copyright (C) 2008 by Nathan Whitehorn. All rights reserved. 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 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. 12 * 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. 23 */ 24 25#include <sys/cdefs.h> 26__FBSDID("$FreeBSD: releng/10.3/sys/powerpc/mambo/mambo_console.c 228631 2011-12-17 15:08:43Z avg $"); 27 28#include <sys/param.h> 29#include <sys/kdb.h> 30#include <sys/kernel.h> 31#include <sys/priv.h> 32#include <sys/systm.h> 33#include <sys/types.h> 34#include <sys/conf.h> 35#include <sys/cons.h> 36#include <sys/consio.h> 37#include <sys/tty.h> 38 39#include <dev/ofw/openfirm.h> 40 41#include <ddb/ddb.h> 42 43#include "mambocall.h" 44 45#define MAMBOBURSTLEN 128 /* max number of bytes to write in one chunk */ 46 47#define MAMBO_CONSOLE_WRITE 0 48#define MAMBO_CONSOLE_READ 60 49 50static tsw_outwakeup_t mambotty_outwakeup; 51 52static struct ttydevsw mambo_ttydevsw = { 53 .tsw_flags = TF_NOPREFIX, 54 .tsw_outwakeup = mambotty_outwakeup, 55}; 56 57static int polltime; 58static struct callout mambo_callout; 59static struct tty *tp = NULL; 60 61#if defined(KDB) 62static int alt_break_state; 63#endif 64 65static void mambo_timeout(void *); 66 67static cn_probe_t mambo_cnprobe; 68static cn_init_t mambo_cninit; 69static cn_term_t mambo_cnterm; 70static cn_getc_t mambo_cngetc; 71static cn_putc_t mambo_cnputc; 72static cn_grab_t mambo_cngrab; 73static cn_ungrab_t mambo_cnungrab; 74 75CONSOLE_DRIVER(mambo); 76 77static void 78cn_drvinit(void *unused) 79{ 80 81 if (mambo_consdev.cn_pri != CN_DEAD && 82 mambo_consdev.cn_name[0] != '\0') { 83 if (OF_finddevice("/mambo") == -1) 84 return; 85 86 tp = tty_alloc(&mambo_ttydevsw, NULL); 87 tty_init_console(tp, 0); 88 tty_makedev(tp, NULL, "%s", "mambocons"); 89 90 polltime = 1; 91 92 callout_init(&mambo_callout, CALLOUT_MPSAFE); 93 callout_reset(&mambo_callout, polltime, mambo_timeout, NULL); 94 } 95} 96 97SYSINIT(cndev, SI_SUB_CONFIGURE, SI_ORDER_MIDDLE, cn_drvinit, NULL); 98 99static void 100mambotty_outwakeup(struct tty *tp) 101{ 102 int len; 103 u_char buf[MAMBOBURSTLEN]; 104 105 for (;;) { 106 len = ttydisc_getc(tp, buf, sizeof buf); 107 if (len == 0) 108 break; 109 mambocall(MAMBO_CONSOLE_WRITE, buf, (register_t)len, 1UL); 110 } 111} 112 113static void 114mambo_timeout(void *v) 115{ 116 int c; 117 118 tty_lock(tp); 119 while ((c = mambo_cngetc(NULL)) != -1) 120 ttydisc_rint(tp, c, 0); 121 ttydisc_rint_done(tp); 122 tty_unlock(tp); 123 124 callout_reset(&mambo_callout, polltime, mambo_timeout, NULL); 125} 126 127static void 128mambo_cnprobe(struct consdev *cp) 129{ 130 if (OF_finddevice("/mambo") == -1) { 131 cp->cn_pri = CN_DEAD; 132 return; 133 } 134 135 cp->cn_pri = CN_NORMAL; 136} 137 138static void 139mambo_cninit(struct consdev *cp) 140{ 141 142 /* XXX: This is the alias, but that should be good enough */ 143 strcpy(cp->cn_name, "mambocons"); 144} 145 146static void 147mambo_cnterm(struct consdev *cp) 148{ 149} 150 151static void 152mambo_cngrab(struct consdev *cp) 153{ 154} 155 156static void 157mambo_cnungrab(struct consdev *cp) 158{ 159} 160 161static int 162mambo_cngetc(struct consdev *cp) 163{ 164 int ch; 165 166 ch = mambocall(MAMBO_CONSOLE_READ); 167 168 if (ch > 0 && ch < 0xff) { 169#if defined(KDB) 170 kdb_alt_break(ch, &alt_break_state); 171#endif 172 return (ch); 173 } 174 175 return (-1); 176} 177 178static void 179mambo_cnputc(struct consdev *cp, int c) 180{ 181 char cbuf; 182 183 cbuf = c; 184 mambocall(MAMBO_CONSOLE_WRITE, &cbuf, 1UL, 1UL); 185} 186