diff options
Diffstat (limited to 'payloads/libpayload/drivers/video')
| -rw-r--r-- | payloads/libpayload/drivers/video/vga.c | 140 | ||||
| -rw-r--r-- | payloads/libpayload/drivers/video/video.c | 160 |
2 files changed, 300 insertions, 0 deletions
diff --git a/payloads/libpayload/drivers/video/vga.c b/payloads/libpayload/drivers/video/vga.c new file mode 100644 index 0000000000..388c7b1ee7 --- /dev/null +++ b/payloads/libpayload/drivers/video/vga.c @@ -0,0 +1,140 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * 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. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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. + */ + +#include <libpayload.h> +#include <video_console.h> + +#define VGA_COLOR_WHITE 7 + +#define CRTC_INDEX 0x3d4 +#define CRTC_DATA 0x3d5 + +#define VIDEO(_r, _c)\ + ((u16 *) (0xB8000 + ((_r) * (VIDEO_COLS * 2)) + ((_c) * 2))) + +static u8 crtc_read(u8 index) +{ + outb(index, CRTC_INDEX); + return inb(CRTC_DATA); +} + +static void crtc_write(u8 data, u8 index) +{ + outb(index, CRTC_INDEX); + outb(data, CRTC_DATA); +} + +static void vga_get_cursor(unsigned int *x, unsigned int *y, unsigned int *en) +{ + unsigned int addr; + addr = ((unsigned int) crtc_read(0x0E)) << 8; + addr += crtc_read(0x0E); + + *x = addr % VIDEO_COLS; + *y = addr / VIDEO_COLS; + + *en = !(crtc_read(0x0A) & (1 << 5)); +} + +static void vga_set_cursor(unsigned int x, unsigned int y) +{ + unsigned int addr; + + addr = x + (VIDEO_COLS * y); + crtc_write(addr >> 8, 0x0E); + crtc_write(addr, 0x0E); +} + +static void vga_enable_cursor(int state) +{ + unsigned char tmp = crtc_read(0x0a); + + if (state == 0) + tmp |= (1 << 5); + + else + tmp &= ~(1 << 5); + + crtc_write(tmp, 0x0a); +} + +static void vga_clear_line(u8 row, u8 ch, u8 attr) +{ + int col; + u16 *ptr = VIDEO(0, row); + + for(col = 0; col < VIDEO_COLS; col++) + ptr[col] = ((attr & 0xFF) << 8) | (ch & 0xFF); +} + +static void vga_scroll_up(void) +{ + u16 *src = VIDEO(0,1); + u16 *dst = VIDEO(0,0); + int i; + + for(i = 0; i < (VIDEO_ROWS - 1) * VIDEO_COLS; i++) + *dst++ = *src++; + + vga_clear_line(VIDEO_ROWS - 1, ' ', VGA_COLOR_WHITE); +} + +static void vga_fill(u8 ch, u8 attr) +{ + u8 row; + for(row = 0; row < VIDEO_ROWS; row++) + vga_clear_line(row, ch, attr); +} + +static void vga_clear(void) +{ + vga_fill(' ', VGA_COLOR_WHITE); +} + +static void vga_putc(u8 row, u8 col, unsigned int c) +{ + u16 *ptr = VIDEO(row, col); + *ptr = (u16) (c & 0xFFFF); +} + +static int vga_init(void) +{ + return 0; +} + +struct video_console vga_video_console = { + .init = vga_init, + .putc = vga_putc, + .clear = vga_clear, + .scroll_up = vga_scroll_up, + + .get_cursor = vga_get_cursor, + .set_cursor = vga_set_cursor, + .enable_cursor = vga_enable_cursor, +}; diff --git a/payloads/libpayload/drivers/video/video.c b/payloads/libpayload/drivers/video/video.c new file mode 100644 index 0000000000..89c146d6ce --- /dev/null +++ b/payloads/libpayload/drivers/video/video.c @@ -0,0 +1,160 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * 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. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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. + */ + +#include <libpayload.h> +#include <video_console.h> + +#ifdef CONFIG_VGA_VIDEO_CONSOLE +extern struct video_console vga_video_console; +#endif + +static struct video_console *console_list[] = +{ +#ifdef CONFIG_VGA_VIDEO_CONSOLE + &vga_video_console, +#endif +}; + +static struct video_console *console; + +static unsigned int cursorx; +static unsigned int cursory; +static unsigned int cursor_enabled = 1; + +static void video_console_fixup_cursor(void) +{ + if (!cursor_enabled) + return; + + if (cursorx < 0) + cursorx = 0; + + if (cursory < 0) + cursory = 0; + + if (cursorx > VIDEO_COLS) { + cursorx = 0; + cursory++; + } + + while(cursory >= VIDEO_ROWS) { + console->scroll_up(); + cursory--; + } + + if (console && console->set_cursor) + console->set_cursor(cursorx, cursory); +} + +void video_console_cursor_enable(int state) +{ + if (console && console->enable_cursor) + console->enable_cursor(state); + + cursor_enabled = state; + + if (cursor_enabled) + video_console_fixup_cursor(); +} + +void video_console_clear(void) +{ + if (console) + console->clear(); + + cursorx = 0; + cursory = 0; + + if (console && console->set_cursor) + console->set_cursor(cursorx, cursory); +} + +void video_console_putc(u8 row, u8 col, unsigned int ch) +{ + if (console) + console->putc(row, col, ch); +} + +void video_console_putchar(unsigned int ch) +{ + switch(ch & 0xFF) { + case '\r': + cursorx = 0; + break; + + case '\n': + cursory++; + break; + + case '\b': + cursorx--; + break; + + case '\t': + while(cursorx % 8 && cursorx < VIDEO_COLS) { + if (console) + console->putc(cursorx, cursory, (ch & 0xFF00) | ' '); + + cursorx++; + } + break; + default: + if (console) + console->putc(cursorx++, cursory, ch); + break; + } + + video_console_fixup_cursor(); +} + +int video_console_init(void) +{ + int i; + + for(i = 0; i < ARRAY_SIZE(console_list); i++) { + if (console_list[i]->init()) + continue; + + console = console_list[i]; + + if (console->get_cursor) + console->get_cursor(&cursorx, &cursory, &cursor_enabled); + + if (cursorx) { + cursorx = 0; + cursory++; + } + + video_console_fixup_cursor(); + return 0; + } + + return 0; +} + |