automake commit without merge history

grub-core/term/i386/pc/vga_text.c

@@ -0,0 +1,177 @@
+/*
+ *  GRUB  --  GRand Unified Bootloader
+ *  Copyright (C) 2007, 2008  Free Software Foundation, Inc.
+ *
+ *  GRUB is free software: you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation, either version 3 of the License, or
+ *  (at your option) any later version.
+ *
+ *  GRUB is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <grub/dl.h>
+#include <grub/i386/vga_common.h>
+#include <grub/i386/io.h>
+#include <grub/types.h>
+
+#define COLS	80
+#define ROWS	25
+
+static int grub_curr_x, grub_curr_y;
+
+#define VGA_TEXT_SCREEN		0xb8000
+
+#define CRTC_ADDR_PORT		0x3D4
+#define CRTC_DATA_PORT		0x3D5
+
+#define CRTC_CURSOR		0x0a
+#define CRTC_CURSOR_ADDR_HIGH	0x0e
+#define CRTC_CURSOR_ADDR_LOW	0x0f
+
+#define CRTC_CURSOR_DISABLE	(1 << 5)
+
+static void
+screen_write_char (int x, int y, short c)
+{
+  ((short *) VGA_TEXT_SCREEN)[y * COLS + x] = c;
+}
+
+static short
+screen_read_char (int x, int y)
+{
+  return ((short *) VGA_TEXT_SCREEN)[y * COLS + x];
+}
+
+static void
+update_cursor (void)
+{
+  unsigned int pos = grub_curr_y * COLS + grub_curr_x;
+  grub_outb (CRTC_CURSOR_ADDR_HIGH, CRTC_ADDR_PORT);
+  grub_outb (pos >> 8, CRTC_DATA_PORT);
+  grub_outb (CRTC_CURSOR_ADDR_LOW, CRTC_ADDR_PORT);
+  grub_outb (pos & 0xFF, CRTC_DATA_PORT);
+}
+
+static void
+inc_y (void)
+{
+  grub_curr_x = 0;
+  if (grub_curr_y < ROWS - 1)
+    grub_curr_y++;
+  else
+    {
+      int x, y;
+      for (y = 0; y < ROWS; y++)
+        for (x = 0; x < COLS; x++)
+          screen_write_char (x, y, screen_read_char (x, y + 1));
+    }
+}
+
+static void
+inc_x (void)
+{
+  if (grub_curr_x >= COLS - 1)
+    inc_y ();
+  else
+    grub_curr_x++;
+}
+
+void
+grub_console_real_putchar (int c)
+{
+  switch (c)
+    {
+      case '\b':
+	if (grub_curr_x != 0)
+	  screen_write_char (grub_curr_x--, grub_curr_y, ' ');
+	break;
+      case '\n':
+	inc_y ();
+	break;
+      case '\r':
+	grub_curr_x = 0;
+	break;
+      default:
+	screen_write_char (grub_curr_x,
+			   grub_curr_y, c | (grub_console_cur_color << 8));
+	inc_x ();
+    }
+
+  update_cursor ();
+}
+
+static grub_uint16_t
+grub_vga_text_getxy (void)
+{
+  return (grub_curr_x << 8) | grub_curr_y;
+}
+
+static void
+grub_vga_text_gotoxy (grub_uint8_t x, grub_uint8_t y)
+{
+  grub_curr_x = x;
+  grub_curr_y = y;
+  update_cursor ();
+}
+
+static void
+grub_vga_text_cls (void)
+{
+  int i;
+  for (i = 0; i < ROWS * COLS; i++)
+    ((short *) VGA_TEXT_SCREEN)[i] = ' ' | (grub_console_cur_color << 8);
+  grub_vga_text_gotoxy (0, 0);
+}
+
+static void
+grub_vga_text_setcursor (int on)
+{
+  grub_uint8_t old;
+  grub_outb (CRTC_CURSOR, CRTC_ADDR_PORT);
+  old = grub_inb (CRTC_DATA_PORT);
+  if (on)
+    grub_outb (old & ~CRTC_CURSOR_DISABLE, CRTC_DATA_PORT);
+  else
+    grub_outb (old | CRTC_CURSOR_DISABLE, CRTC_DATA_PORT);
+}
+
+static grub_err_t
+grub_vga_text_init_fini (void)
+{
+  grub_vga_text_cls ();
+  return 0;
+}
+
+static struct grub_term_output grub_vga_text_term =
+  {
+    .name = "vga_text",
+    .init = grub_vga_text_init_fini,
+    .fini = grub_vga_text_init_fini,
+    .putchar = grub_console_putchar,
+    .getcharwidth = grub_console_getcharwidth,
+    .getwh = grub_console_getwh,
+    .getxy = grub_vga_text_getxy,
+    .gotoxy = grub_vga_text_gotoxy,
+    .cls = grub_vga_text_cls,
+    .setcolorstate = grub_console_setcolorstate,
+    .setcolor = grub_console_setcolor,
+    .getcolor = grub_console_getcolor,
+    .setcursor = grub_vga_text_setcursor,
+  };
+
+GRUB_MOD_INIT(vga_text)
+{
+  grub_term_register_output ("vga_text", &grub_vga_text_term);
+}
+
+GRUB_MOD_FINI(vga_text)
+{
+  grub_term_unregister_output (&grub_vga_text_term);
+}