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