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 <pci-bother.h>
   7 #include "../net/net.h"
   8 #include "vga-overlay.h"
   9 #include "packet.h"
  10 #include "keyboard.h"
  11
  12 unsigned int counter = 0;
  13 unsigned int lastctr = 0;
  14 unsigned long pcisave;
  15 unsigned char vgasave;
  16 static int curdev = 0;  /* 0 if kbd, 1 if mouse */
  17
  18 static void cause_kbd_irq()
  19 {
  20         outl(0x844, 0x0);
  21         outl(0x848, 0x0);
  22         while (inb(0x64) & 0x1)
  23                 inb(0x60);
  24         outb(0x60, 0xee);       /* Cause an IRQ. */
  25         while (inb(0x60) != 0xEE)
  26                 ;
  27 }
  28
  29 void pci_dump() {
  30         unsigned long cts;
  31
  32         cts = inl(0x84C);
  33
  34         outl(0x840, 0x0);
  35         outl(0x848, 0x0);
  36         switch(cts&0xF0000)
  37         {
  38         case 0x20000:
  39         {
  40                 unsigned char b;
  41
  42                 switch (cts & 0xFFFF)
  43                 {
  44                 case 0x64:
  45                         /* Read the real hardware and mask in our OBF if need be. */
  46                         b = inb(0x64);
  47                         if (kbd_has_injected_scancode())
  48                         {
  49                                 dologf("OS wants to know; we have data");
  50                                 lastctr = counter;
  51                                 b |= 0x01;
  52                                 b &= ~0x20;     /* no mouse for you! */
  53                                 curdev = 0;
  54                         } else
  55                                 curdev = (b & 0x20) ? 1 : 0;
  56                         *(unsigned char*)0xAFFD0 /* EAX */ = b;
  57                         break;
  58                 case 0x60:
  59                         if (kbd_has_injected_scancode())
  60                         {
  61                                 b = kbd_get_injected_scancode();
  62                                 lastctr = counter;
  63                                 while (inb(0x64) & 0x1)
  64                                         inb(0x60);
  65                         } else
  66                                 b = inb(0x60);
  67                         if ((curdev == 0) && (b == 0x01)) {     /* Escape */
  68                                 outb(0xCF9, 0x4);       /* Reboot */
  69                                 return;
  70                         }
  71
  72                         /* If there is more nus to come, generate another IRQ. */
  73                         if (kbd_has_injected_scancode())
  74                                 cause_kbd_irq();
  75
  76                         *(unsigned char*)0xAFFD0 /* EAX */ = b;
  77                         break;
  78                 }
  79
  80                 *(unsigned char*)0xAFFD0 /* EAX */ = b;
  81                 break;
  82         }
  83         case 0x30000:
  84         {
  85                 unsigned char b;
  86
  87                 b = *(unsigned char*)0xAFFD0 /* EAX */;
  88                 dologf("WRITE: %08x (%02x)", cts, b);
  89                 outb(cts & 0xFFFF, b);
  90                 break;
  91         }
  92         default:
  93                 dolog("Unhandled PCI cycle");
  94         }
  95
  96         outl(0x840, 0x0);
  97         outl(0x844, 0x1000);
  98         outl(0x848, 0x1000);
  99 }
 100
 101 void timer_handler(smi_event_t ev)
 102 {
 103         static unsigned int ticks = 0;
 104
 105         smi_disable_event(SMI_EVENT_FAST_TIMER);
 106         smi_enable_event(SMI_EVENT_FAST_TIMER);
 107
 108         if (kbd_has_injected_scancode() && (counter > (lastctr + 2)))
 109         {
 110                 smi_disable_event(SMI_EVENT_DEVTRAP_KBC);
 111                 dolog("Kicking timer");
 112                 cause_kbd_irq();
 113                 smi_enable_event(SMI_EVENT_DEVTRAP_KBC);
 114         }
 115
 116         outb(0x80, (ticks++) & 0xFF);
 117
 118         outlog();
 119 }
 120
 121 void kbc_handler(smi_event_t ev)
 122 {
 123         pci_dump();
 124 }
 125
 126 void gbl_rls_handler(smi_event_t ev)
 127 {
 128         unsigned long ecx;
 129
 130         ecx = *(unsigned long*)0xAFFD4;
 131
 132         packet_t * packet = check_packet(ecx);
 133         if (!packet)
 134         {
 135                 dologf("WARN: bad packet at %08x", ecx);
 136                 return;
 137         }
 138
 139         dologf("Got packet: type %08x", packet->type);
 140
 141         if (packet->type == 42) {
 142                 dump_log((char *)packet->data);
 143                 *(unsigned long*)0xAFFD4 = 42;
 144         } else if (packet->type == 0xAA) {
 145                 kbd_inject_key('A');
 146         } else {
 147                 *(unsigned long*)0xAFFD4 = 0x2BADD00D;
 148         }
 149 }
 150
 151 void smi_entry(void)
 152 {
 153         char statstr[512];
 154
 155         pcisave = inl(0xCF8);
 156         vgasave = inb(0x3D4);
 157         pci_unbother_all();
 158
 159         counter++;
 160         sprintf(statstr, "15-412! %08x %08x", smi_status(), counter);
 161         strblit(statstr, 0, 0);
 162
 163         eth_poll();
 164
 165         if (inl(0x840) & 0x1000)
 166         {
 167                 pci_dump();
 168                 outl(0x840, 0x1100);
 169                 outl(0x840, 0x0100);
 170         }
 171
 172         smi_poll();
 173
 174         pci_bother_all();
 175         outl(0xCF8, pcisave);
 176         outb(0x3D4, vgasave);
 177 }
 178