/* ----------------------------------------------------------------------- * * * 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; }