path: root/contrib/syslinux-4.02/com32/lib/sys/ansi.c

/* ----------------------------------------------------------------------- *
 *
 *   Copyright 2004-2008 H. Peter Anvin - All Rights Reserved
 *
 *   Permission is hereby granted, free of charge, to any person
 *   obtaining a copy of this software and associated documentation
 *   files (the "Software"), to deal in the Software without
 *   restriction, including without limitation the rights to use,
 *   copy, modify, merge, publish, distribute, sublicense, and/or
 *   sell copies of the Software, and to permit persons to whom
 *   the Software is furnished to do so, subject to the following
 *   conditions:
 *
 *   The above copyright notice and this permission notice shall
 *   be included in all copies or substantial portions of the Software.
 *
 *   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 *   EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
 *   OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 *   NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
 *   HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
 *   WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 *   FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 *   OTHER DEALINGS IN THE SOFTWARE.
 *
 * ----------------------------------------------------------------------- */

/*
 * ansi.c
 *
 * ANSI character code engine
 */

#include <string.h>
#include <colortbl.h>
#include "ansi.h"

static const struct term_state default_state = {
    .state = st_init,
    .pvt = false,
    .nparms = 0,
    .xy = {0, 0},
    .cindex = 0,		/* First color table entry */
    .vtgraphics = false,
    .intensity = 1,
    .underline = false,
    .blink = false,
    .reverse = false,
    .fg = 7,
    .bg = 0,
    .autocr = true,	  	/* Mimic \n -> \r\n conversion by default */
    .autowrap = true,		/* Wrap lines by default */
    .saved_xy = {0, 0},
    .cursor = true,
};

/* DEC VT graphics to codepage 437 table (characters 0x60-0x7F only) */
static const char decvt_to_cp437[] = {
    0004, 0261, 0007, 0007, 0007, 0007, 0370, 0361,
    0007, 0007, 0331, 0277, 0332, 0300, 0305, 0304,
    0304, 0304, 0137, 0137, 0303, 0264, 0301, 0302,
    0263, 0363, 0362, 0343, 0330, 0234, 0007, 00
};

void __ansi_init(const struct term_info *ti)
{
    memcpy(ti->ts, &default_state, sizeof default_state);
}

void __ansi_putchar(const struct term_info *ti, uint8_t ch)
{
    const struct ansi_ops *op = ti->op;
    struct term_state *st = ti->ts;
    const int rows = ti->rows;
    const int cols = ti->cols;
    struct curxy xy = st->xy;

    switch (st->state) {
    case st_init:
	switch (ch) {
	case 1 ... 5:
	    st->state = st_tbl;
	    st->parms[0] = ch;
	    break;
	case '\a':
	    op->beep();
	    break;
	case '\b':
	    if (xy.x > 0)
		xy.x--;
	    break;
	case '\t':
	    {
		int nsp = 8 - (xy.x & 7);
		while (nsp--)
		    __ansi_putchar(ti, ' ');
	    }
	    return;		/* Cursor already updated */
	case '\n':
	case '\v':
	case '\f':
	    xy.y++;
	    if (st->autocr)
		xy.x = 0;
	    break;
	case '\r':
	    xy.x = 0;
	    break;
	case 127:
	    /* Ignore delete */
	    break;
	case 14:
	    st->vtgraphics = 1;
	    break;
	case 15:
	    st->vtgraphics = 0;
	    break;
	case 27:
	    st->state = st_esc;
	    break;
	default:
	    /* Print character */
	    if (ch >= 32) {
		if (st->vtgraphics && (ch & 0xe0) == 0x60)
		    ch = decvt_to_cp437[ch - 0x60];

		op->write_char(xy.x, xy.y, ch, st);
		xy.x++;
	    }
	    break;
	}
	break;

    case st_esc:
	switch (ch) {
	case '%':
	case '(':
	case ')':
	case '#':
	    /* Ignore this plus the subsequent character, allows
	       compatibility with Linux sequence to set charset */
	    break;
	case '[':
	    st->state = st_csi;
	    st->nparms = 0;
	    st->pvt = false;
	    memset(st->parms, 0, sizeof st->parms);
	    break;
	case 'c':
	    /* Reset terminal */
	    memcpy(&st, &default_state, sizeof st);
	    op->erase(st, 0, 0, cols - 1, rows - 1);
	    xy.x = xy.y = 0;
	    st->state = st_init;
	    break;
	default:
	    /* Ignore sequence */
	    st->state = st_init;
	    break;
	}
	break;

    case st_csi:
	{
	    int p0 = st->parms[0] ? st->parms[0] : 1;

	    if (ch >= '0' && ch <= '9') {
		st->parms[st->nparms] = st->parms[st->nparms] * 10 + (ch - '0');
	    } else if (ch == ';') {
		st->nparms++;
		if (st->nparms >= ANSI_MAX_PARMS)
		    st->nparms = ANSI_MAX_PARMS - 1;
		break;
	    } else if (ch == '?') {
		st->pvt = true;
	    } else {
		switch (ch) {
		case 'A':
		    {
			int y = xy.y - p0;
			xy.y = (y < 0) ? 0 : y;
		    }
		    break;
		case 'B':
		    {
			int y = xy.y + p0;
			xy.y = (y >= rows) ? rows - 1 : y;
		    }
		    break;
		case 'C':
		    {
			int x = xy.x + p0;
			xy.x = (x >= cols) ? cols - 1 : x;
		    }
		    break;
		case 'D':
		    {
			int x = xy.x - p0;
			xy.x = (x < 0) ? 0 : x;
		    }
		    break;
		case 'E':
		    {
			int y = xy.y + p0;
			xy.y = (y >= rows) ? rows - 1 : y;
			xy.x = 0;
		    }
		    break;
		case 'F':
		    {
			int y = xy.y - p0;
			xy.y = (y < 0) ? 0 : y;
			xy.x = 0;
		    }
		    break;
		case 'G':
		case '\'':
		    {
			int x = st->parms[0] - 1;
			xy.x = (x >= cols) ? cols - 1 : (x < 0) ? 0 : x;
		    }
		    break;
		case 'H':
		case 'f':
		    {
			int y = st->parms[0] - 1;
			int x = st->parms[1] - 1;

			xy.x = (x >= cols) ? cols - 1 : (x < 0) ? 0 : x;
			xy.y = (y >= rows) ? rows - 1 : (y < 0) ? 0 : y;
		    }
		    break;
		case 'J':
		    {
			switch (st->parms[0]) {
			case 0:
			    op->erase(st, xy.x, xy.y, cols - 1, xy.y);
			    if (xy.y < rows - 1)
				op->erase(st, 0, xy.y + 1, cols - 1, rows - 1);
			    break;

			case 1:
			    if (xy.y > 0)
				op->erase(st, 0, 0, cols - 1, xy.y - 1);
			    if (xy.y > 0)
				op->erase(st, 0, xy.y, xy.x - 1, xy.y);
			    break;

			case 2:
			    op->erase(st, 0, 0, cols - 1, rows - 1);
			    break;

			default:
			    /* Ignore */
			    break;
			}
		    }
		    break;
		case 'K':
		    {
			switch (st->parms[0]) {
			case 0:
			    op->erase(st, xy.x, xy.y, cols - 1, xy.y);
			    break;

			case 1:
			    if (xy.x > 0)
				op->erase(st, 0, xy.y, xy.x - 1, xy.y);
			    break;

			case 2:
			    op->erase(st, 0, xy.y, cols - 1, xy.y);
			    break;

			default:
			    /* Ignore */
			    break;
			}
		    }
		    break;
		case 'h':
		case 'l':
		{
		    bool set = (ch == 'h');
		    switch (st->parms[0]) {
		    case 7:	/* DECAWM */
			st->autowrap = set;
			break;
		    case 20:	/* LNM */
			st->autocr = set;
			break;
		    case 25:	/* DECTECM */
			st->cursor = set;
			op->showcursor(st);
			break;
		    default:
			/* Ignore */
			break;
		    }
		    break;
		}
		case 'm':
		    {
			static const int ansi2pc[8] =
			    { 0, 4, 2, 6, 1, 5, 3, 7 };

			int i;
			for (i = 0; i <= st->nparms; i++) {
			    int a = st->parms[i];
			    switch (a) {
			    case 0:
				st->fg = 7;
				st->bg = 0;
				st->intensity = 1;
				st->underline = 0;
				st->blink = 0;
				st->reverse = 0;
				break;
			    case 1:
				st->intensity = 2;
				break;
			    case 2:
				st->intensity = 0;
				break;
			    case 4:
				st->underline = 1;
				break;
			    case 5:
				st->blink = 1;
				break;
			    case 7:
				st->reverse = 1;
				break;
			    case 21:
			    case 22:
				st->intensity = 1;
				break;
			    case 24:
				st->underline = 0;
				break;
			    case 25:
				st->blink = 0;
				break;
			    case 27:
				st->reverse = 0;
				break;
			    case 30 ... 37:
				st->fg = ansi2pc[a - 30];
				break;
			    case 38:
				st->fg = 7;
				st->underline = 1;
				break;
			    case 39:
				st->fg = 7;
				st->underline = 0;
				break;
			    case 40 ... 47:
				st->bg = ansi2pc[a - 40];
				break;
			    case 49:
				st->bg = 7;
				break;
			    default:
				/* Do nothing */
				break;
			    }
			}
		    }
		    break;
		case 's':
		    st->saved_xy = xy;
		    break;
		case 'u':
		    xy = st->saved_xy;
		    break;
		default:	/* Includes CAN and SUB */
		    break;	/* Drop unknown sequence */
		}
		st->state = st_init;
	    }
	}
	break;

    case st_tbl:
	st->parms[1] = 0;
	if (ch == '#')
	    st->state = st_tblc;
	else
	    st->state = st_init;
	break;

    case st_tblc:
	{
	    unsigned int n = (unsigned char)ch - '0';
	    const char *p;

	    if (n < 10) {
		st->parms[1] = st->parms[1] * 10 + n;

		if (!--st->parms[0]) {
		    if (st->parms[1] < console_color_table_size) {
			/* Set the color table index */
			st->cindex = st->parms[1];

			/* See if there are any other attributes we care about */
			p = console_color_table[st->parms[1]].ansi;
			if (p) {
			    st->state = st_esc;
			    __ansi_putchar(ti, '[');
			    __ansi_putchar(ti, '0');
			    __ansi_putchar(ti, ';');
			    while (*p)
				__ansi_putchar(ti, *p++);
			    __ansi_putchar(ti, 'm');
			}
		    }
		    st->state = st_init;
		}
	    } else {
		st->state = st_init;
	    }
	}
	break;
    }

    /* If we fell off the end of the screen, adjust */
    if (xy.x >= cols) {
	if (st->autowrap) {
	    xy.x = 0;
	    xy.y++;
	} else {
	    xy.x = cols - 1;
	}
    }
    while (xy.y >= rows) {
	xy.y--;
	op->scroll_up(st);
    }

    /* Update cursor position */
    op->set_cursor(xy.x, xy.y, st->cursor);
    st->xy = xy;
}