From: hpa Date: Wed, 24 Nov 2004 00:33:59 +0000 (+0000) Subject: Serial port and ANSI write support X-Git-Tag: syslinux-3.11~384 X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=8ae64c44576373b55deb30da503ee8f3b87a6f57;p=platform%2Fupstream%2Fsyslinux.git Serial port and ANSI write support --- diff --git a/com32/lib/sys/ansicon_write.c b/com32/lib/sys/ansicon_write.c new file mode 100644 index 0000000..786464b --- /dev/null +++ b/com32/lib/sys/ansicon_write.c @@ -0,0 +1,127 @@ +#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. + * + * ----------------------------------------------------------------------- */ + +/* + * ansicon_write.c + * + * Write to the screen using ANSI control codes (about as capable as + * DOS' ANSI.SYS.) + */ + +#include +#include +#include +#include +#include +#include "file.h" + +static void __constructor ansicon_init(void) +{ + static com32sys_t ireg; /* Auto-initalized to all zero */ + + ireg.eax.w[0] = 0x0005; /* Force text mode */ + __intcall(0x22, &ireg, NULL); +} + +struct curxy { + 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_COLS (*(uint16_t *)0x44A) +#define BIOS_PAGE (*(uint8_t *)0x462) +#define BIOS_FB (*(uint16_t *)0x44E) /* Current page fb address */ + +static struct { + uint8_t attr; /* Current display attribute */ +} st = { + 0x0007, /* Grey on black */ +}; + +static void ansicon_putchar(int ch) +{ + static com32sys_t ireg; + int rows = BIOS_ROWS ? BIOS_ROWS+1 : 25; + int cols = BIOS_COLS; + struct curxy xy = BIOS_CURXY[BIOS_PAGE]; + + ireg.eax.b[1] = 0x09; + ireg.eax.b[0] = ch; + ireg.ebx.b[1] = BIOS_PAGE; + ireg.ebx.b[0] = st.attr; + ireg.ecx.w[0] = 1; + __intcall(0x10, &ireg, NULL); + + xy.x++; + 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 */ + } + } + + ireg.eax.b[1] = 0x04; + ireg.ebx.b[1] = BIOS_PAGE; + ireg.edx.b[1] = curxy.y; + ireg.edx.b[0] = curxy.x; + __intcall(0x10, &ireg, NULL); /* Update cursor position */ +} + +static ssize_t ansicon_write(struct file_info *fp, const void *buf, size_t count) +{ + com32sys_t ireg; + const 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++; + } + + return n; +} + +const struct output_dev dev_ansicon_w = { + .dev_magic = __DEV_MAGIC, + .flags = __DEV_TTY | __DEV_OUTPUT, + .fileflags = O_WRONLY | O_CREAT | O_TRUNC | O_APPEND, + .write = __ansicon_write, + .close = NULL, +}; diff --git a/com32/lib/sys/serial_write.c b/com32/lib/sys/serial_write.c new file mode 100644 index 0000000..27fd73c --- /dev/null +++ b/com32/lib/sys/serial_write.c @@ -0,0 +1,67 @@ +#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. + * + * ----------------------------------------------------------------------- */ + +/* + * serial_write.c + * + * Raw writing to the serial port; no \n -> \r\n translation + */ + +#include +#include +#include +#include +#include "file.h" + +static ssize_t __serial_write(struct file_info *fp, const void *buf, size_t count) +{ + com32sys_t ireg; + const char *bufp = buf; + size_t n = 0; + + (void)fp; + + memset(&ireg, 0, sizeof ireg); + ireg.eax.b[1] = 0x04; + + while ( count-- ) { + ireg.edx.b[0] = *bufp++; + __intcall(0x21, &ireg, NULL); + n++; + } + + return n; +} + +const struct output_dev dev_serial_w = { + .dev_magic = __DEV_MAGIC, + .flags = __DEV_TTY | __DEV_OUTPUT, + .fileflags = O_WRONLY | O_CREAT | O_TRUNC | O_APPEND, + .write = __serial_write, + .close = NULL, +};