rcons_subr.c

早期freebsd实现

/*
 * Copyright (c) 1991, 1993
 *	The Regents of the University of California.  All rights reserved.
 *
 * This software was developed by the Computer Systems Engineering group
 * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
 * contributed to Berkeley.
 *
 * All advertising materials mentioning features or use of this software
 * must display the following acknowledgement:
 *	This product includes software developed by the University of
 *	California, Lawrence Berkeley Laboratory.
 *
 * 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 University of
 *	California, Berkeley and its contributors.
 * 4. Neither the name of the University 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 REGENTS 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 REGENTS 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.
 *
 *	@(#)rcons_subr.c	8.1 (Berkeley) 6/11/93
 *
 * from: $Header: rcons_subr.c,v 1.38 93/04/20 11:15:39 torek Exp $
 */

#ifdef KERNEL
#include <sys/param.h>
#include <sys/fbio.h>
#include <sys/device.h>
#include <machine/fbvar.h>
#else
#include <sys/types.h>
#include "myfbdevice.h"
#endif

#include <sparc/rcons/raster.h>

void rcons_text(struct fbdevice *, char *, int);
void rcons_pctrl(struct fbdevice *, int);
void rcons_esc(struct fbdevice *, int);
void rcons_doesc(struct fbdevice *, int);
void rcons_cursor(struct fbdevice *);
void rcons_invert(struct fbdevice *, int);
void rcons_clear2eop(struct fbdevice *);
void rcons_clear2eol(struct fbdevice *);
void rcons_scroll(struct fbdevice *, int);
void rcons_delchar(struct fbdevice *, int);
void rcons_delline(struct fbdevice *, int);
void rcons_insertchar(struct fbdevice *, int);
void rcons_insertline(struct fbdevice *, int);

extern void rcons_bell(struct fbdevice *);

#define RCONS_ISPRINT(c) ((c) >= ' ' && (c) <= '~')
#define RCONS_ISDIGIT(c) ((c) >= '0' && (c) <= '9')

/* Output (or at least handle) a string sent to the console */
void
rcons_puts(fb, str, n)
	register struct fbdevice *fb;
	register char *str;
	register int n;
{
	register int c, i, j;
	register char *cp;

	/* Jump scroll */
	/* XXX maybe this should be an option? */
	if ((fb->fb_bits & FB_INESC) == 0) {
		/* Count newlines up to an escape sequence */
		i = 0;
		j = 0;
		for (cp = str; j++ < n && *cp != '\033'; ++cp) {
			if (*cp == '\n')
				++i;
			else if (*cp == '\013')
				--i;
		}

		/* Only jump scroll two or more rows */
		if (*fb->fb_row + i >= fb->fb_maxrow + 1) {
			/* Erase the cursor (if necessary) */
			if (fb->fb_bits & FB_CURSOR)
				rcons_cursor(fb);

			rcons_scroll(fb, i);
		}
	}

	/* Process characters */
	while (--n >= 0) {
		c = *str;
		if (c == '\033') {
			/* Start an escape (perhaps aborting one in progress) */
			fb->fb_bits |= FB_INESC | FB_P0_DEFAULT | FB_P1_DEFAULT;
			fb->fb_bits &= ~(FB_P0 | FB_P1);

			/* Most parameters default to 1 */
			fb->fb_p0 = fb->fb_p1 = 1;
		} else if (fb->fb_bits & FB_INESC) {
			rcons_esc(fb, c);
		} else {
			/* Erase the cursor (if necessary) */
			if (fb->fb_bits & FB_CURSOR)
				rcons_cursor(fb);

			/* Display the character */
			if (RCONS_ISPRINT(c)) {
				/* Try to output as much as possible */
				j = fb->fb_maxcol - (*fb->fb_col + 1);
				if (j > n)
					j = n;
				for (i = 1; i < j && RCONS_ISPRINT(str[i]); ++i)
					continue;
				rcons_text(fb, str, i);
				--i;
				str += i;
				n -= i;
			} else
				rcons_pctrl(fb, c);
		}
		++str;
	}
	/* Redraw the cursor (if necessary) */
	if ((fb->fb_bits & FB_CURSOR) == 0)
		rcons_cursor(fb);
}

/* Actually write a string to the frame buffer */
void
rcons_text(fb, str, n)
	register struct fbdevice *fb;
	register char *str;
	register int n;
{
	register int x, y, op;

	x = *fb->fb_col * fb->fb_font->width + fb->fb_xorigin;
	y = *fb->fb_row * fb->fb_font->height +
	    fb->fb_font_ascent + fb->fb_yorigin;
	op = RAS_SRC;
	if (((fb->fb_bits & FB_STANDOUT) != 0) ^
	    ((fb->fb_bits & FB_INVERT) != 0))
		op = RAS_NOT(op);
	raster_textn(fb->fb_sp, x, y, op, fb->fb_font, str, n);
	*fb->fb_col += n;
	if (*fb->fb_col >= fb->fb_maxcol) {
		*fb->fb_col = 0;
		(*fb->fb_row)++;
	}
	if (*fb->fb_row >= fb->fb_maxrow)
		rcons_scroll(fb, 1);
}

/* Handle a control character sent to the console */
void
rcons_pctrl(fb, c)
	register struct fbdevice *fb;
	register int c;
{

	switch (c) {

	case '\r':	/* Carriage return */
		*fb->fb_col = 0;
		break;

	case '\b':	/* Backspace */
		if (*fb->fb_col > 0)
			(*fb->fb_col)--;
		break;

	case '\013':	/* Vertical tab */
		if (*fb->fb_row > 0)
			(*fb->fb_row)--;
		break;

	case '\f':	/* Formfeed */
		*fb->fb_row = *fb->fb_col = 0;
		rcons_clear2eop(fb);
		break;

	case '\n':	/* Linefeed */
		(*fb->fb_row)++;
		if (*fb->fb_row >= fb->fb_maxrow)
			rcons_scroll(fb, 1);
		break;

	case '\007':	/* Bell */
		rcons_bell(fb);
		break;

	case '\t':	/* Horizontal tab */
		*fb->fb_col = (*fb->fb_col + 8) & ~7;
		if (*fb->fb_col >= fb->fb_maxcol)
			*fb->fb_col = fb->fb_maxcol - 1;
		break;
	}
}

/* Handle the next character in an escape sequence */
void
rcons_esc(fb, c)
	register struct fbdevice *fb;
	register int c;
{

	if (c == '[') {
		/* Parameter 0 */
		fb->fb_bits &= ~FB_P1;
		fb->fb_bits |= FB_P0;
	} else if (c == ';') {
		/* Parameter 1 */
		fb->fb_bits &= ~FB_P0;
		fb->fb_bits |= FB_P1;
	} else if (RCONS_ISDIGIT(c)) {
		/* Add a digit to a parameter */
		if (fb->fb_bits & FB_P0) {
			/* Parameter 0 */
			if (fb->fb_bits & FB_P0_DEFAULT) {
				fb->fb_bits &= ~FB_P0_DEFAULT;
				fb->fb_p0 = 0;
			}
			fb->fb_p0 *= 10;
			fb->fb_p0 += c - '0';
		} else if (fb->fb_bits & FB_P1) {
			/* Parameter 1 */
			if (fb->fb_bits & FB_P1_DEFAULT) {
				fb->fb_bits &= ~FB_P1_DEFAULT;
				fb->fb_p1 = 0;
			}
			fb->fb_p1 *= 10;
			fb->fb_p1 += c - '0';
		}
	} else {
		/* Erase the cursor (if necessary) */
		if (fb->fb_bits & FB_CURSOR)
			rcons_cursor(fb);

		/* Process the completed escape sequence */
		rcons_doesc(fb, c);
		fb->fb_bits &= ~FB_INESC;
	}
}

/* Process a complete escape sequence */
void
rcons_doesc(fb, c)
	register struct fbdevice *fb;
	register int c;
{

#ifdef notdef
	/* XXX add escape sequence to enable visual (and audible) bell */
	fb->fb_bits = FB_VISBELL;
#endif

	switch (c) {

	case '@':
		/* Insert Character (ICH) */
		rcons_insertchar(fb, fb->fb_p0);
		break;

	case 'A':
		/* Cursor Up (CUU) */
		*fb->fb_row -= fb->fb_p0;
		if (*fb->fb_row < 0)
			*fb->fb_row = 0;
		break;

	case 'B':
		/* Cursor Down (CUD) */
		*fb->fb_row += fb->fb_p0;
		if (*fb->fb_row >= fb->fb_maxrow)
			*fb->fb_row = fb->fb_maxrow - 1;
		break;

	case 'C':
		/* Cursor Forward (CUF) */
		*fb->fb_col += fb->fb_p0;
		if (*fb->fb_col >= fb->fb_maxcol)
			*fb->fb_col = fb->fb_maxcol - 1;
		break;