Avoid suffering from wrong CS_SEGSEL syndrome.

[netwatch.git] / video / text.c

diff --git a/video/text.c b/video/text.c
index 962af0ca0afc65d7587e11f0970336cc4fd15b7f..4f35f97b34822f857a0e478d06d0bf9fdef11a3a 100644 (file)
--- a/video/text.c
+++ b/video/text.c
@@ -5,55 +5,91 @@
 #include <stdint.h>
 #include <output.h>
 #include <smram.h>
 #include <stdint.h>
 #include <output.h>
 #include <smram.h>

+#include <crc32.h>
+#include <video_defines.h>

 
 static unsigned char _font[256 * 32];
 
 
 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;
 /* 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();
        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 */);
        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);
        smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
        memcpy(_font, p2v(0xB8000), sizeof(_font));
        smram_restore_state(old_state);

+

        outb(0x3CF, oldread);
        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)
 {
 }
 
 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 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();
        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++)
        {
                cx = x;
        smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
        for (cy = y; cy < (y + h); cy++)
        {
                cx = x;

-               texty = cy / 14;
+               texty = cy / 16;

                textx = cx / 9;
                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++)
                {
                for (cx = x; cx < (x + w); cx++)
                {

-                       unsigned int pos = cx % 9;
+                       unsigned int pos = cx % 8;

                        if (pos == 0)
                        {
                        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];
+                               textx = cx / 8;
+                               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 */
                        }
                        /* XXX always BGR888 */
                        if (pos == 8)   /* 9th pixel is cloned */


@@ -76,42 +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)
 {
 
 uint32_t text_checksum(int x, int y, int w, int h)
 {

-       unsigned char *video = (unsigned char *)0xB8000;
-       unsigned int textx = x / 9;
-       unsigned int texty = y / 14;
+       unsigned char *video = (unsigned char *)vga_base();
+       unsigned int textx = x / 8;
+       unsigned int texty = y / 16;

        int cx, cy;
        int cx, cy;

-       unsigned char ch, at;

        uint32_t cksm = 0;
        smram_state_t old_state = smram_save_state();
        
        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++)
        {
                cx = x;
        smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
        
        for (cy = y; cy < (y + h); cy++)
        {
                cx = x;

-               texty = cy / 14;
-               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);
-               }
+               texty = cy / 16;
+               textx = cx / 8;
+               cksm = crc32(video + texty * 160 + textx * 2, (w / 8) * 2 + 2, cksm);   /* Err on the side of 'too many'. */

        }
        
        smram_restore_state(old_state);
        
        }
        
        smram_restore_state(old_state);
        

-       outputf("checksum: %08x", cksm);
-       

        return cksm;
 }
        return cksm;
 }