netwatch/smi.c

   1 /* smi.c
   2  * First-run SMI C entry point
   3  * NetWatch system management mode administration console
   4  *
   5  * Copyright (c) 2008 Jacob Potter and Joshua Wise.  All rights reserved.
   6  * This program is free software; you can redistribute and/or modify it under
   7  * the terms found in the file LICENSE in the root of this source tree.
   8  *
   9  */
  10
  11 #include <io.h>
  12 #include <smram.h>
  13 #include <video_defines.h>
  14 #include <minilib.h>
  15 #include <smi.h>
  16 #include <pci-bother.h>
  17 #include <serial.h>
  18 #include <fb.h>
  19 #include <output.h>
  20 #include <msr.h>
  21 #include "../net/net.h"
  22 #include "vga-overlay.h"
  23
  24 unsigned int counter = 0;
  25 unsigned long pcisave = 0;
  26 unsigned char vgasave = 0;
  27
  28 void smi_entry(void)
  29 {
  30         char statstr[512];
  31
  32         /* Reenable caching on SMRAM. */
  33         WRMSR(0x202, (RDMSR(0x202) & ~(0xFFULL)) | 0x06ULL);
  34
  35         pcisave = inl(0xCF8);
  36         vgasave = inb(0x3D4);
  37         pci_unbother_all();
  38
  39         serial_init();
  40
  41         if (fb)
  42                 fb->getvmode(fb->priv);
  43
  44         counter++;
  45         if (!fb || fb->curmode.text)
  46         {
  47                 sprintf(statstr, "NetWatch! %08x %08x", smi_status(), counter);
  48                 strblit(statstr, 0, 0, 0);
  49         }
  50
  51         eth_poll();
  52
  53         if (inl(0x840) & 0x1000)
  54         {
  55         /*
  56                 pci_dump();
  57         */
  58                 outl(0x840, 0x1100);
  59                 outl(0x840, 0x0100);
  60         }
  61
  62
  63         smi_poll();
  64
  65         pci_bother_all();
  66         outl(0xCF8, pcisave);
  67         outb(0x3D4, vgasave);
  68
  69         /* Disable caching on SMRAM again, to prevent the user from whacking us. */
  70         WRMSR(0x202, RDMSR(0x202) & ~(0xFFULL));
  71 }
  72
  73 extern void timer_handler(smi_event_t ev);
  74 extern void kbc_handler(smi_event_t ev);
  75 extern void gbl_rls_handler(smi_event_t ev);
  76
  77 void __firstrun_stub() {
  78
  79         /* Try really hard to shut up USB_LEGKEY. */
  80         pci_write16(0, 31, 2, 0xC0, pci_read16(0, 31, 2, 0xC0));
  81         pci_write16(0, 31, 2, 0xC0, 0);
  82         pci_write16(0, 31, 4, 0xC0, pci_read16(0, 31, 4, 0xC0));
  83         pci_write16(0, 31, 4, 0xC0, 0);
  84
  85         /* Turn on the SMIs we want */
  86         smi_disable();
  87
  88         smi_register_handler(SMI_EVENT_FAST_TIMER, timer_handler);
  89         smi_enable_event(SMI_EVENT_FAST_TIMER);
  90
  91         smi_register_handler(SMI_EVENT_DEVTRAP_KBC, kbc_handler);
  92         smi_enable_event(SMI_EVENT_DEVTRAP_KBC);
  93
  94         smi_register_handler(SMI_EVENT_GBL_RLS, gbl_rls_handler);
  95         smi_enable_event(SMI_EVENT_GBL_RLS);
  96
  97         smi_enable();
  98 }