aseg/counter.c

   1 #include <io.h>
   2 #include <smram.h>
   3 #include <video_defines.h>
   4 #include <minilib.h>
   5 #include <smi.h>
   6 #include "vga-overlay.h"
   7
   8 unsigned int counter = 0;
   9 unsigned long pcisave;
  10 unsigned char vgasave;
  11
  12 void pci_dump() {
  13         unsigned long cts;
  14         static int curdev = 0;  /* 0 if kbd, 1 if mouse */
  15
  16         cts = inl(0x84C);
  17
  18         outl(0x848, 0x0);
  19         outl(0x840, 0x0);
  20         switch(cts&0xF0000)
  21         {
  22         case 0x20000:
  23         {
  24                 unsigned char b;
  25                 b = inb(cts & 0xFFFF);
  26                 dologf("READ: %08x (%02x)", cts, b);
  27                 if ((cts & 0xFFFF) == 0x64)
  28                         curdev = (b & 0x20) ? 1 : 0;
  29                 if ((curdev == 0) && ((cts & 0xFFFF) == 0x60) && (b == 0x01))
  30                         outb(0xCF9, 0x4);
  31                 *(unsigned char*)0xAFFD0 /* EAX */ = b;
  32                 break;
  33         }
  34         case 0x30000:
  35         {
  36                 unsigned char b;
  37
  38                 b = *(unsigned char*)0xAFFD0 /* EAX */;
  39                 dologf("WRITE: %08x (%02x)", cts, b);
  40                 outb(cts & 0xFFFF, b);
  41                 break;
  42         }
  43         default:
  44                 dolog("Unhandled PCI cycle");
  45         }
  46
  47         outl(0x848, 0x1000);
  48         outl(0x840, 0x0100);
  49 }
  50
  51 void timer_handler(smi_event_t ev)
  52 {
  53         static unsigned int ticks = 0;
  54
  55         smi_disable_event(SMI_EVENT_FAST_TIMER);
  56         smi_enable_event(SMI_EVENT_FAST_TIMER);
  57
  58         outb(0x80, (ticks++) & 0xFF);
  59
  60         outlog();
  61 }
  62
  63 void smi_entry(void)
  64 {
  65         char statstr[512];
  66
  67         pcisave = inl(0xCF8);
  68         vgasave = inb(0x3D4);
  69
  70         counter++;
  71         sprintf(statstr, "15-412! %08x %08x", smi_status(), counter);
  72         strblit(statstr, 0, 0);
  73
  74         if (inl(0x834) & 0x1000)
  75         {
  76                 if (inl(0x844) & 0x1000)        /* devact_sts */
  77                 {
  78                         pci_dump();
  79                         outl(0x844, 0x1000);    /* ack it */
  80                 }
  81         }
  82         if (inl(0x840) & 0x1000)
  83         {
  84                 pci_dump();
  85                 outl(0x840, 0x1100);
  86                 outl(0x840, 0x0100);
  87         }
  88
  89         smi_poll();
  90
  91         outl(0xCF8, pcisave);
  92         outb(0x3D4, vgasave);
  93 }
  94