uint8_t x, y;
} __attribute__((packed));
#define BIOS_CURXY ((struct curxy *)0x450) /* Array for each page */
-#define BIOS_ROWS (*(uint8_t *)0x449) /* Minus one */
+#define BIOS_ROWS (*(uint8_t *)0x484) /* Minus one; if zero use 24 (= 25 lines) */
#define BIOS_COLS (*(uint16_t *)0x44A)
#define BIOS_PAGE (*(uint8_t *)0x462)
-#define BIOS_FB (*(uint16_t *)0x44E) /* Current page fb address */
enum ansi_state {
st_init, /* Normal (no ESC seen) */
st_esc, /* ESC seen */
- st_empty, /* CSI seen, empty position */
- st_digits, /* CSI seen, digits seen in this position */
+ st_csi, /* CSI seen */
};
#define MAX_PARMS 16
.saved_xy = { 0, 0 },
.state = st_init,
.nparms = 0,
- .parms = { 0, },
};
/* Erase a region of the screen */
const int cols = BIOS_COLS;
const int page = BIOS_PAGE;
struct curxy xy = BIOS_CURXY[page];
- int again;
- do {
- again = 0;
-
- switch ( st.state ) {
- case st_init:
- switch ( ch ) {
- case '\a':
- /* Ignore beep */
- break;
- case '\b':
- if ( xy.y > 0 ) xy.y--;
- break;
- case '\t':
- {
- int nsp = 8 - (xy.y & 7);
- while ( nsp-- )
- ansicon_putchar(' ');
- }
- return; /* Cursor already updated */
- case '\n':
- case '\v':
- case '\f':
- xy.y++;
- break;
- case '\r':
- xy.x = 0;
- break;
- case '\0':
- case 127:
- /* Ignore null or delete */
- break;
- case 27:
- st.state = st_esc;
- break;
- default:
- /* Print character */
- ireg.eax.b[1] = 0x09;
- ireg.eax.b[0] = ch;
- ireg.ebx.b[1] = page;
- ireg.ebx.b[0] = st.attr;
- ireg.ecx.w[0] = 1;
- __intcall(0x10, &ireg, NULL);
- xy.x++;
- break;
- }
+ switch ( st.state ) {
+ case st_init:
+ switch ( ch ) {
+ case '\a':
+ /* Ignore beep */
break;
-
- case st_esc:
- if ( ch == '[' ) {
- int i;
- st.state = st_empty;
- st.nparms = 0;
- for ( i = 0 ; i < MAX_PARMS ; i++ )
- st.parms[i] = 1; /* 1 is the default, not 0 */
- } else {
- st.state = st_init;
- again = 1;
+ case '\b':
+ if ( xy.x > 0 ) xy.x--;
+ break;
+ case '\t':
+ {
+ int nsp = 8 - (xy.x & 7);
+ while ( nsp-- )
+ ansicon_putchar(' ');
}
+ return; /* Cursor already updated */
+ case '\n':
+ case '\v':
+ case '\f':
+ xy.y++;
+ break;
+ case '\r':
+ xy.x = 0;
+ break;
+ case '\0':
+ case 127:
+ /* Ignore null or delete */
+ break;
+ case 27:
+ st.state = st_esc;
+ break;
+ default:
+ /* Print character */
+ ireg.eax.b[1] = 0x09;
+ ireg.eax.b[0] = ch;
+ ireg.ebx.b[1] = page;
+ ireg.ebx.b[0] = st.attr;
+ ireg.ecx.w[0] = 1;
+ __intcall(0x10, &ireg, NULL);
+ xy.x++;
break;
+ }
+ break;
- case st_empty:
- case st_digits:
- switch ( ch ) {
- case '0' ... '9':
- if ( st.state == st_empty ) {
- st.parms[st.nparms] = ch - '0';
- st.state = st_digits;
- } else {
- st.parms[st.nparms] = st.parms[st.nparms]*10 + (ch-'0');
- }
- break;
- case ';':
+ case st_esc:
+ if ( ch == '[' ) {
+ st.state = st_csi;
+ st.nparms = 0;
+ memset(st.parms, 0, sizeof st.parms);
+ } else {
+ st.state = st_init; /* Discard ESC+other symbol */
+ }
+ 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 >= MAX_PARMS )
st.nparms = MAX_PARMS-1;
- st.state = st_empty;
break;
- case 'A':
- {
- int y = xy.y - st.parms[0];
- xy.y = (y < 0) ? 0 : y;
- }
- break;
- case 'B':
- {
- int y = xy.y + st.parms[0];
- xy.y = (y >= rows) ? rows-1 : y;
- }
- break;
- case 'C':
- {
- int x = xy.x + st.parms[0];
- xy.x = (x >= cols) ? cols-1 : x;
- }
- break;
- case 'D':
- {
- int x = xy.x - st.parms[0];
- xy.x = (x < 0) ? 0 : x;
- }
- break;
- case 'E':
- {
- int y = xy.y + st.parms[0];
- xy.y = (y >= rows) ? rows-1 : y;
- xy.x = 0;
- }
- break;
- case 'F':
- {
- int y = xy.y - st.parms[0];
- xy.y = (y < 0) ? 0 : y;
- xy.x = 0;
- }
- break;
- case 'H':
- case 'f':
- {
- int x = st.parms[0];
- int y = st.parms[1];
-
- xy.x = (x >= cols) ? cols-1 : x;
- xy.y = (y >= rows) ? rows-1 : y;
- }
- break;
- case 'J':
- {
- if ( st.parms[0] == 2 ) {
- ansicon_erase(0, 0, cols-1, rows-1);
- } else {
- ansicon_erase(xy.x, xy.y, cols-1, xy.y);
- if ( xy.y < rows-1 )
- ansicon_erase(0, xy.y+1, cols-1, rows-1);
+ } else {
+ switch ( ch ) {
+ case 'A':
+ {
+ int y = xy.y - p0;
+ xy.y = (y < 0) ? 0 : y;
}
- }
- break;
- case 'K':
- {
- if ( st.parms[0] == 2 )
- ansicon_erase(0, xy.y, cols-1, xy.y);
- else
- ansicon_erase(xy.x, xy.y, cols-1, xy.y);
- }
- break;
- case 'm':
- {
- static const int ansi2pc[8] = { 0, 4, 2, 6, 1, 5, 3, 7 };
+ 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 'H':
+ case 'f':
+ {
+ int x = st.parms[0] - 1;
+ int y = st.parms[1] - 1;
- int i;
- for ( i = 0 ; i < st.nparms ; i++ ) {
- int a = st.parms[i];
- switch ( a ) {
+ 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:
- st.fg = 7;
- st.bg = 7;
- st.intensity = 1;
- st.underline = 0;
- st.blink = 0;
- st.reverse = 0;
+ ansicon_erase(xy.x, xy.y, cols-1, xy.y);
+ if ( xy.y < rows-1 )
+ ansicon_erase(0, xy.y+1, cols-1, rows-1);
break;
+
case 1:
- st.intensity = 2;
+ if ( xy.y > 0 )
+ ansicon_erase(0, 0, cols-1, xy.y-1);
+ if ( xy.y > 0 )
+ ansicon_erase(0, xy.y, xy.x-1, xy.y);
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;
+ ansicon_erase(0, 0, cols-1, rows-1);
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;
+
+ default:
+ /* Ignore */
break;
- case 39:
- st.fg = 7;
- st.underline = 0;
+ }
+ }
+ break;
+ case 'K':
+ {
+ switch ( st.parms[0] ) {
+ case 0:
+ ansicon_erase(xy.x, xy.y, cols-1, xy.y);
break;
- case 40 ... 47:
- st.bg = ansi2pc[a-40];
+
+ case 1:
+ if ( xy.x > 0 )
+ ansicon_erase(0, xy.y, xy.x-1, xy.y);
break;
- case 49:
- st.bg = 7;
+
+ case 2:
+ ansicon_erase(0, xy.y, cols-1, xy.y);
break;
+
default:
- /* Do nothing */
+ /* Ignore */
break;
}
}
-
- /* Turn into an attribute code */
+ break;
+ case 'm':
{
- int bg = st.bg;
- int fg;
-
- if ( st.underline )
- fg = 0x01;
- else if ( st.intensity == 0 )
- fg = 0x08;
- else
- fg = st.fg;
+ static const int ansi2pc[8] = { 0, 4, 2, 6, 1, 5, 3, 7 };
- if ( st.reverse ) {
- bg = fg & 0x07;
- fg &= 0x08;
- fg |= st.bg;
+ 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;
+ }
}
+
+ /* Turn into an attribute code */
+ {
+ int bg = st.bg;
+ int fg;
- if ( st.blink )
- bg ^= 0x08;
+ if ( st.underline )
+ fg = 0x01;
+ else if ( st.intensity == 0 )
+ fg = 0x08;
+ else
+ fg = st.fg;
- if ( st.intensity == 2 )
- fg ^= 0x08;
+ if ( st.reverse ) {
+ bg = fg & 0x07;
+ fg &= 0x08;
+ fg |= st.bg;
+ }
- st.attr = (bg << 4) | fg;
+ if ( st.blink )
+ bg ^= 0x08;
+
+ if ( st.intensity == 2 )
+ fg ^= 0x08;
+
+ st.attr = (bg << 4) | fg;
+ }
}
+ break;
+ case 's':
+ st.saved_xy = xy;
+ break;
+ case 'u':
+ xy = st.saved_xy;
+ break;
}
- break;
- case 's':
- st.saved_xy = xy;
- break;
- case 'u':
- xy = st.saved_xy;
- break;
+ st.state = st_init;
}
}
- } while ( again );
+ break;
+ }
/* If we fell off the end of the screen, adjust */
if ( xy.x >= cols ) {
xy.x = 0;
xy.y++;
- if ( xy.y >= rows ) {
- xy.y = 0;
- ireg.eax.w[0] = 0x0601;
- ireg.ebx.b[1] = st.attr;
- ireg.ecx.w[0] = 0;
- ireg.edx.b[1] = rows-1;
- ireg.edx.b[0] = cols-1;
- __intcall(0x10, &ireg, NULL); /* Scroll */
- }
+ }
+ while ( xy.y >= rows ) {
+ xy.y--;
+ ireg.eax.w[0] = 0x0601;
+ ireg.ebx.b[1] = st.attr;
+ ireg.ecx.w[0] = 0;
+ ireg.edx.b[1] = rows-1;
+ ireg.edx.b[0] = cols-1;
+ __intcall(0x10, &ireg, NULL); /* Scroll */
}
/* Update cursor position */
- ireg.eax.b[1] = 0x04;
- ireg.ebx.b[1] = BIOS_PAGE;
+ ireg.eax.b[1] = 0x02;
+ ireg.ebx.b[1] = page;
ireg.edx.b[1] = xy.y;
ireg.edx.b[0] = xy.x;
__intcall(0x10, &ireg, NULL);
}
-static ssize_t ansicon_write(struct file_info *fp, const void *buf, size_t count)
+ssize_t __ansicon_write(struct file_info *fp, const void *buf, size_t count)
{
- com32sys_t ireg;
- const char *bufp = buf;
+ const unsigned char *bufp = buf;
size_t n = 0;
(void)fp;
- memset(&ireg, 0, sizeof ireg);
- ireg.eax.b[1] = 0x04;
-
while ( count-- ) {
ansicon_putchar(*bufp++);
n++;
.dev_magic = __DEV_MAGIC,
.flags = __DEV_TTY | __DEV_OUTPUT,
.fileflags = O_WRONLY | O_CREAT | O_TRUNC | O_APPEND,
- .write = ansicon_write,
+ .write = __ansicon_write,
.close = NULL,
};
--- /dev/null
+#ident "$Id$"
+/* ----------------------------------------------------------------------- *
+ *
+ * Copyright 2004 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.
+ *
+ * ----------------------------------------------------------------------- */
+
+/*
+ * ansiserial_write.c
+ *
+ * Write to both to the ANSI console and the serial port
+ */
+
+#include <errno.h>
+#include <string.h>
+#include <com32.h>
+#include <minmax.h>
+#include "file.h"
+
+extern ssize_t __ansicon_write(struct file_info *, const void *, size_t);
+extern ssize_t __serial_write(struct file_info *, const void *, size_t);
+
+static ssize_t __ansiserial_write(struct file_info *fp, const void *buf, size_t count)
+{
+ __ansicon_write(fp, buf, count);
+ return __serial_write(fp, buf, count);
+}
+
+const struct output_dev dev_ansiserial_w = {
+ .dev_magic = __DEV_MAGIC,
+ .flags = __DEV_TTY | __DEV_OUTPUT,
+ .fileflags = O_WRONLY | O_CREAT | O_TRUNC | O_APPEND,
+ .write = __ansiserial_write,
+ .close = NULL,
+};
projects / platform / upstream / syslinux.git / commitdiff