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

... / ...

Commit	Line	Data
	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