Joshua Wise's Git repositories - netwatch.git/blame_incremental

... / ...

Commit	Line	Data
	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 <serial.h>
	8	#include "../net/net.h"
	9	#include "vga-overlay.h"
	10
	11	unsigned int counter = 0;
	12	unsigned long pcisave = 0;
	13	unsigned char vgasave = 0;
	14
	15	void smi_entry(void)
	16	{
	17	char statstr[512];
	18	outb(0x80, 0x0B);
	19	pcisave = inl(0xCF8);
	20	vgasave = inb(0x3D4);
	21	outb(0x80, 0x1B);
	22	/*
	23	pci_unbother_all();
	24	*/
	25	counter++;
	26	outb(0x80, 0x2B);
	27	sprintf(statstr, "NetWatch! %08x %08x", smi_status(), counter);
	28	outb(0x80, 0x3B);
	29	strblit(statstr, 0, 0);
	30	outb(0x80, 0x4B);
	31
	32	serial_init();
	33	/* dolog("wee!");
	34	*/
	35
	36	/*
	37	eth_poll();
	38	*/
	39
	40	if (inl(0x840) & 0x1000)
	41	{
	42	/*
	43	pci_dump();
	44	*/
	45	outl(0x840, 0x1100);
	46	outl(0x840, 0x0100);
	47	}
	48
	49
	50	smi_poll();
	51	/*
	52	pci_bother_all();
	53	*/
	54	outl(0xCF8, pcisave);
	55	outb(0x3D4, vgasave);
	56	}
	57
	58	extern void timer_handler(smi_event_t ev);
	59	extern void kbc_handler(smi_event_t ev);
	60	extern void gbl_rls_handler(smi_event_t ev);
	61
	62	void __firstrun_stub() {
	63
	64	/* Try really hard to shut up USB_LEGKEY. */
	65	pci_write16(0, 31, 2, 0xC0, pci_read16(0, 31, 2, 0xC0));
	66	pci_write16(0, 31, 2, 0xC0, 0);
	67	pci_write16(0, 31, 4, 0xC0, pci_read16(0, 31, 4, 0xC0));
	68	pci_write16(0, 31, 4, 0xC0, 0);
	69
	70	/* Turn on the SMIs we want */
	71	smi_disable();
	72
	73	smi_register_handler(SMI_EVENT_FAST_TIMER, timer_handler);
	74	smi_enable_event(SMI_EVENT_FAST_TIMER);
	75
	76	smi_register_handler(SMI_EVENT_DEVTRAP_KBC, kbc_handler);
	77	smi_enable_event(SMI_EVENT_DEVTRAP_KBC);
	78
	79	smi_register_handler(SMI_EVENT_GBL_RLS, gbl_rls_handler);
	80	smi_enable_event(SMI_EVENT_GBL_RLS);
	81
	82	smi_enable();
	83	}