]>
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 |