Add a first cut at text.

[netwatch.git] / aseg-paging / smi.c

diff --git a/aseg-paging/smi.c b/aseg-paging/smi.c
index eada78df797f1e81514c0977649bf13c5bfc5e25..d519341a9370446fdbe8e1e65e56419271f4abb4 100644 (file)
--- a/aseg-paging/smi.c
+++ b/aseg-paging/smi.c
@@ -5,6 +5,9 @@
 #include <smi.h>
 #include <pci-bother.h>
 #include <serial.h>
 #include <smi.h>
 #include <pci-bother.h>
 #include <serial.h>

+#include <fb.h>
+#include <output.h>
+#include <msr.h>

 #include "../net/net.h"
 #include "vga-overlay.h"
 
 #include "../net/net.h"
 #include "vga-overlay.h"
 


@@ -15,27 +18,27 @@ unsigned char vgasave = 0;
 void smi_entry(void)
 {
        char statstr[512];
 void smi_entry(void)
 {
        char statstr[512];

-       outb(0x80, 0x0B);
+
+       /* Reenable caching on SMRAM. */
+       WRMSR(0x202, (RDMSR(0x202) & ~(0xFFULL)) | 0x06ULL);
+

        pcisave = inl(0xCF8);
        vgasave = inb(0x3D4);
        pcisave = inl(0xCF8);
        vgasave = inb(0x3D4);

-       outb(0x80, 0x1B);
-/*

        pci_unbother_all();
        pci_unbother_all();

- */
-       counter++;
-       outb(0x80, 0x2B);
-       sprintf(statstr, "NetWatch! %08x %08x", smi_status(), counter);
-       outb(0x80, 0x3B);
-       strblit(statstr, 0, 0);
-       outb(0x80, 0x4B);

        
        serial_init();
        
        serial_init();

-/*     dolog("wee!");
- */

        
        

-       /*
+       if (fb)
+               fb->getvmode(fb->priv);
+
+       counter++;
+       if (!fb || fb->curmode.text)
+       {
+               sprintf(statstr, "NetWatch! %08x %08x", smi_status(), counter);
+               strblit(statstr, 0, 0, 0);
+       }
+       

        eth_poll();
        eth_poll();

-       */

        
        if (inl(0x840) & 0x1000)
        {
        
        if (inl(0x840) & 0x1000)
        {


@@ -48,11 +51,13 @@ void smi_entry(void)
 
 
        smi_poll();
 
 
        smi_poll();

-/*     
+       

        pci_bother_all();
        pci_bother_all();

- */

        outl(0xCF8, pcisave);
        outb(0x3D4, vgasave);
        outl(0xCF8, pcisave);
        outb(0x3D4, vgasave);

+       
+       /* Disable caching on SMRAM again, to prevent the user from whacking us. */
+       WRMSR(0x202, RDMSR(0x202) & ~(0xFFULL));

 }
 
 extern void timer_handler(smi_event_t ev);
 }
 
 extern void timer_handler(smi_event_t ev);