X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/74032daeb88c104c67738774827440f4264b371e..826e2bd2a1aa8d425989ee3d38d5dd5a8040b9f8:/video/text.c

diff --git a/video/text.c b/video/text.c
index e7b0db3..f6c9f52 100644
--- a/video/text.c
+++ b/video/text.c
@@ -5,54 +5,91 @@
 #include <stdint.h>
 #include <output.h>
 #include <smram.h>
+#include <crc32.h>
+#include <video_defines.h>
 
 static unsigned char _font[256 * 32];
 
+/* XXX reunify this with vga-overlay? */
+#define VRAM_BASE		0xA0000UL
+#define TEXT_CONSOLE_OFFSET	0x18000UL 
+
+#define TEXT_CONSOLE_BASE	(VRAM_BASE + TEXT_CONSOLE_OFFSET)
+
+static unsigned char vga_read(unsigned char idx)
+{
+	outb(CRTC_IDX_REG, idx);
+	return inb(CRTC_DATA_REG);
+}
+
+static char * vga_base()
+{
+	return (char *) (
+		TEXT_CONSOLE_BASE
+		+ (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9)
+		+ (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1)
+	);
+}
+
 /* Must be called from a firstrun context, where we don't care about saving
  * 0x3CE state. */
 void text_init()
 {
 	unsigned char oldread;
+
 	smram_state_t old_state = smram_save_state();
-	outb(0x3CE, 0x05 /* Mode register */);
-	outb(0x3CF, inb(0x3CF) & ~(0x10 /* Odd/even */));
+	outb(0x3CE, 0x06 /* Miscellaneous */);
+	outb(0x3CF, 0x0C);
+	outb(0x3C4, 0x04 /* Seq memory mode */);
+	outb(0x3C5, inb(0x3C5) | 0x04);
+	outb(0x3CE, 0x05 /* Mode */);
+	outb(0x3CF, inb(0x3CF) & ~0x10);
 	outb(0x3CE, 0x04 /* Read register */);
 	oldread = inb(0x3CF);
 	outb(0x3CF, 0x02 /* Font plane */);
+
 	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
 	memcpy(_font, p2v(0xB8000), sizeof(_font));
 	smram_restore_state(old_state);
+
 	outb(0x3CF, oldread);
+	outb(0x3CE, 0x06 /* Miscellaneous */);
+	outb(0x3CF, 0x0E);
+	outb(0x3CE, 0x05 /* Mode */);
+	outb(0x3CF, inb(0x3CF) | 0x10);
+	outb(0x3C4, 0x04 /* Seq memory mode */);
+	outb(0x3C5, inb(0x3C5) & ~0x04);
 }
 
 void text_render(char *buf, int x, int y, int w, int h)
 {
-	unsigned char *video = (unsigned char *)0xB8000;
+	unsigned char *video = (unsigned char *)vga_base();
 	unsigned int textx = x / 9;
-	unsigned int texty = y / 14;
+	unsigned int texty = y / 16;
 	unsigned int cx, cy;
 	unsigned char ch, at, font;
 	smram_state_t old_state = smram_save_state();
 	
-	outputf("text_render: buf %08x, (%d,%d),(%d,%d)", buf, x, y, w, h);
+	outputf("text_render: (%d,%d),(%d,%d)", x, y, w, h);
 	
 	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
 	for (cy = y; cy < (y + h); cy++)
 	{
-		texty = cy / 14;
+		cx = x;
+		texty = cy / 16;
 		textx = cx / 9;
-		ch = video[texty * 50 + textx * 2];
-		at = video[texty * 50 + textx * 2 + 1];
-		font = _font[ch * 32 + cy % 14];
+		ch = video[texty * 160 + textx * 2];
+		at = video[texty * 160 + textx * 2 + 1];
+		font = _font[ch * 32 + cy % 16];
 		for (cx = x; cx < (x + w); cx++)
 		{
 			unsigned int pos = cx % 9;
 			if (pos == 0)
 			{
 				textx = cx / 9;
-				ch = video[texty * 50 + textx * 2];
-				at = video[texty * 50 + textx * 2 + 1];
-				font = _font[ch * 32 + cy % 14];
+				ch = video[texty * 160 + textx * 2];
+				at = video[texty * 160 + textx * 2 + 1];
+				font = _font[ch * 32 + cy % 16];
 			}
 			/* XXX always BGR888 */
 			if (pos == 8)	/* 9th pixel is cloned */
@@ -75,41 +112,24 @@ void text_render(char *buf, int x, int y, int w, int h)
 
 uint32_t text_checksum(int x, int y, int w, int h)
 {
-	unsigned char *video = (unsigned char *)0xB8000;
+	unsigned char *video = (unsigned char *)vga_base();
 	unsigned int textx = x / 9;
-	unsigned int texty = y / 14;
+	unsigned int texty = y / 16;
 	int cx, cy;
-	unsigned char ch, at;
 	uint32_t cksm = 0;
 	smram_state_t old_state = smram_save_state();
 	
-	outputf("checksum: (%d,%d),(%d,%d)", x,y,w,h);
-	
 	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
 	
 	for (cy = y; cy < (y + h); cy++)
 	{
-		texty = cy / 14;
+		cx = x;
+		texty = cy / 16;
 		textx = cx / 9;
-		ch = video[texty * 50 + textx * 2];
-		at = video[texty * 50 + textx * 2 + 1];
-		for (cx = x; cx < (x + w); cx++)
-		{
-			unsigned int pos = cx % 9;
-			if (pos == 0)
-			{
-				textx = cx / 9;
-				ch = video[texty * 50 + textx * 2];
-				at = video[texty * 50 + textx * 2 + 1];
-			}
-			
-			cksm += ch + (at << 16);
-		}
+		cksm = crc32(video + texty * 160 + textx * 2, (w / 9) * 2 + 2, cksm);	/* Err on the side of 'too many'. */
 	}
 	
 	smram_restore_state(old_state);
 	
-	outputf("checksum: %08x", cksm);
-	
 	return cksm;
 }