Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / ipxe / src / arch / i386 / core / video_subr.c

diff --git a/qemu/roms/ipxe/src/arch/i386/core/video_subr.c b/qemu/roms/ipxe/src/arch/i386/core/video_subr.c
new file mode 100644 (file)
index 0000000..3f701bd
--- /dev/null
+++ b/qemu/roms/ipxe/src/arch/i386/core/video_subr.c
@@ -0,0 +1,113 @@
+/*
+ *
+ * modified from linuxbios code
+ * by Cai Qiang <rimy2000@hotmail.com>
+ *
+ */
+
+#include "stddef.h"
+#include "string.h"
+#include <ipxe/io.h>
+#include <ipxe/console.h>
+#include <ipxe/init.h>
+#include "vga.h"
+#include <config/console.h>
+
+/* Set default console usage if applicable */
+#if ! ( defined ( CONSOLE_DIRECT_VGA ) && \
+       CONSOLE_EXPLICIT ( CONSOLE_DIRECT_VGA ) )
+#undef CONSOLE_DIRECT_VGA
+#define CONSOLE_DIRECT_VGA ( CONSOLE_USAGE_ALL & ~CONSOLE_USAGE_LOG )
+#endif
+
+struct console_driver vga_console __console_driver;
+
+static char *vidmem;           /* The video buffer */
+static int video_line, video_col;
+
+#define VIDBUFFER 0xB8000      
+
+static void memsetw(void *s, int c, unsigned int n)
+{
+       unsigned int i;
+       u16 *ss = (u16 *) s;
+
+       for (i = 0; i < n; i++) {
+               ss[i] = ( u16 ) c;
+       }
+}
+
+static void video_init(void)
+{
+       static int inited=0;
+
+       vidmem = (char *)phys_to_virt(VIDBUFFER);
+
+       if (!inited) {
+               video_line = 0;
+               video_col = 0;
+       
+               memsetw(vidmem, VGA_ATTR_CLR_WHT, 2*1024); //
+
+               inited=1;
+       }
+}
+
+static void video_scroll(void)
+{
+       int i;
+
+       memcpy(vidmem, vidmem + COLS * 2, (LINES - 1) * COLS * 2);
+       for (i = (LINES - 1) * COLS * 2; i < LINES * COLS * 2; i += 2)
+               vidmem[i] = ' ';
+}
+
+static void vga_putc(int byte)
+{
+       if (byte == '\n') {
+               video_line++;
+               video_col = 0;
+
+       } else if (byte == '\r') {
+               video_col = 0;
+
+       } else if (byte == '\b') {
+               video_col--;
+
+       } else if (byte == '\t') {
+               video_col += 4;
+
+       } else if (byte == '\a') {
+               //beep
+               //beep(500);
+
+       } else {
+               vidmem[((video_col + (video_line *COLS)) * 2)] = byte;
+               vidmem[((video_col + (video_line *COLS)) * 2) +1] = VGA_ATTR_CLR_WHT;
+               video_col++;
+       }
+       if (video_col < 0) {
+               video_col = 0;
+       }
+       if (video_col >= COLS) {
+               video_line++;
+               video_col = 0;
+       }
+       if (video_line >= LINES) {
+               video_scroll();
+               video_line--;
+       }
+       // move the cursor
+       write_crtc((video_col + (video_line *COLS)) >> 8, CRTC_CURSOR_HI);
+       write_crtc((video_col + (video_line *COLS)) & 0x0ff, CRTC_CURSOR_LO);
+}
+
+struct console_driver vga_console __console_driver = {
+       .putchar = vga_putc,
+       .disabled = CONSOLE_DISABLED,
+       .usage = CONSOLE_DIRECT_VGA,
+};
+
+struct init_fn video_init_fn __init_fn ( INIT_EARLY ) = {
+       .initialise = video_init,
+};