]>
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 | void smi_init() { | |
17 | smram_state_t smram; | |
18 | ||
19 | smram = smram_save_state(); | |
20 | smram_tseg_set_state(SMRAM_TSEG_OPEN); | |
21 | ||
22 | outputf("NetWatch running"); | |
23 | ||
24 | /* Try really hard to shut up USB_LEGKEY. */ | |
25 | pci_write16(0, 31, 2, 0xC0, pci_read16(0, 31, 2, 0xC0)); | |
26 | pci_write16(0, 31, 2, 0xC0, 0); | |
27 | pci_write16(0, 31, 4, 0xC0, pci_read16(0, 31, 4, 0xC0)); | |
28 | pci_write16(0, 31, 4, 0xC0, 0); | |
29 | ||
30 | /* Turn on the SMIs we want */ | |
31 | smi_disable(); | |
32 | ||
33 | eth_init(); | |
34 | ||
35 | smi_register_handler(SMI_EVENT_FAST_TIMER, timer_handler); | |
36 | smi_enable_event(SMI_EVENT_FAST_TIMER); | |
37 | ||
38 | smi_register_handler(SMI_EVENT_DEVTRAP_KBC, kbc_handler); | |
39 | smi_enable_event(SMI_EVENT_DEVTRAP_KBC); | |
40 | ||
41 | smi_register_handler(SMI_EVENT_GBL_RLS, gbl_rls_handler); | |
42 | smi_enable_event(SMI_EVENT_GBL_RLS); | |
43 | ||
44 | smi_enable(); | |
45 | ||
46 | vga_flush_imm(1); | |
47 | ||
48 | smram_restore_state(smram); | |
49 | } | |
50 |