aseg-paging/firstrun.c

   1 #include <io.h>
   2 #include <smi.h>
   3 #include <pci.h>
   4 #include <reg-82801b.h>
   5 #include <output.h>
   6 #include "vga-overlay.h"
   7 #include <smram.h>
   8 #include "../net/net.h"
   9
  10 extern int _bss, _bssend;
  11
  12 extern void timer_handler(smi_event_t ev);
  13 extern void kbc_handler(smi_event_t ev);
  14 extern void gbl_rls_handler(smi_event_t ev);
  15
  16 extern pci_driver_t *drivers[];
  17
  18 void smi_init() {
  19         smram_state_t smram;
  20         pci_driver_t **driver;
  21
  22         smram = smram_save_state();
  23         smram_tseg_set_state(SMRAM_TSEG_OPEN);
  24
  25         outputf("NetWatch running");
  26
  27         /* Try really hard to shut up USB_LEGKEY. */
  28         pci_write16(0, 31, 2, 0xC0, pci_read16(0, 31, 2, 0xC0));
  29         pci_write16(0, 31, 2, 0xC0, 0);
  30         pci_write16(0, 31, 4, 0xC0, pci_read16(0, 31, 4, 0xC0));
  31         pci_write16(0, 31, 4, 0xC0, 0);
  32
  33         /* Turn on the SMIs we want */
  34         smi_disable();
  35
  36         eth_init();
  37
  38         /* After everything is initialized, load drivers. */
  39         for (driver = drivers; *driver; driver++)
  40         {
  41                 outputf("Probing driver: %s", (*driver)->name);
  42                 if (pci_probe_driver(*driver))
  43                         output("Found a card");
  44         }
  45         outputf("Driver probe complete");
  46
  47         smi_register_handler(SMI_EVENT_FAST_TIMER, timer_handler);
  48         smi_enable_event(SMI_EVENT_FAST_TIMER);
  49
  50         smi_register_handler(SMI_EVENT_DEVTRAP_KBC, kbc_handler);
  51         smi_enable_event(SMI_EVENT_DEVTRAP_KBC);
  52
  53         smi_register_handler(SMI_EVENT_GBL_RLS, gbl_rls_handler);
  54         smi_enable_event(SMI_EVENT_GBL_RLS);
  55
  56         smi_enable();
  57
  58         vga_flush_imm(1);
  59
  60         smram_restore_state(smram);
  61 }
  62