1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
#include "bios.h"
#include "ioport.h"
#include "pci.h"
#include "string.h"
// NOTE: this runs from ROM at 0xFFFF0000, so it is not possible to use any
// static data.
#define PIIX_ISA_PIRQA_ROUT 0x60
#define PIIX_PMBASE 0x40
#define PIIX_PMREGMISC 0x80
#define PIIX_SMBHSTBASE 0x90
#define PIIX_SMBHSTCFG 0xd2
static void setup_piix(void)
{
const int bdf = (1 << 3);
pci_config_writeb(bdf, PIIX_ISA_PIRQA_ROUT, 10);
pci_config_writeb(bdf, PIIX_ISA_PIRQA_ROUT+1, 10);
pci_config_writeb(bdf, PIIX_ISA_PIRQA_ROUT+2, 11);
pci_config_writeb(bdf, PIIX_ISA_PIRQA_ROUT+3, 11);
}
static void setup_piix_pm(void)
{
const int bdf = (1 << 3) | 3;
pci_config_writel(bdf, PIIX_PMBASE, 0x601);
pci_config_writeb(bdf, PIIX_PMREGMISC, 0x01);
pci_config_writel(bdf, PIIX_SMBHSTBASE, 0x701);
pci_config_writeb(bdf, PIIX_SMBHSTCFG, 0x09);
}
#define ICH9_LPC_PIRQA_ROUT 0x60
#define ICH9_LPC_PIRQE_ROUT 0x68
#define ICH9_LPC_PMBASE 0x40
#define ICH9_LPC_ACPI_CTRL 0x44
static void setup_ich9(void)
{
const int bdf = 0x1f << 3;
pci_config_writeb(bdf, ICH9_LPC_PIRQA_ROUT, 10);
pci_config_writeb(bdf, ICH9_LPC_PIRQA_ROUT+1, 10);
pci_config_writeb(bdf, ICH9_LPC_PIRQA_ROUT+2, 11);
pci_config_writeb(bdf, ICH9_LPC_PIRQA_ROUT+3, 11);
pci_config_writeb(bdf, ICH9_LPC_PIRQE_ROUT, 10);
pci_config_writeb(bdf, ICH9_LPC_PIRQE_ROUT+1, 10);
pci_config_writeb(bdf, ICH9_LPC_PIRQE_ROUT+2, 11);
pci_config_writeb(bdf, ICH9_LPC_PIRQE_ROUT+3, 11);
}
static void setup_ich9_pm(void)
{
const int bdf = 0x1f << 3;
pci_config_writel(bdf, ICH9_LPC_PMBASE, 0x601);
pci_config_writeb(bdf, ICH9_LPC_ACPI_CTRL, 0x80);
}
#define I440FX_PAM0 0x59
#define Q35_HOST_BRIDGE_PAM0 0x90
static void setup_pic(void)
{
/* Send ICW1 (select OCW1 + will send ICW4) */
outb(0x20, 0x11);
outb(0xa0, 0x11);
/* Send ICW2 (base irqs: 0x08-0x0f for irq0-7, 0x70-0x77 for irq8-15) */
outb(0x21, 8);
outb(0xa1, 0x70);
/* Send ICW3 (cascaded pic ids) */
outb(0x21, 0x04);
outb(0xa1, 0x02);
/* Send ICW4 (enable 8086 mode) */
outb(0x21, 0x01);
outb(0xa1, 0x01);
/* Mask all irqs (except cascaded PIC2 irq) */
outb(0x21, ~(1 << 2));
outb(0xa1, ~0);
/* Set ELCR to IRQs 10 and 11 */
outb(0x4d0, 0);
outb(0x4d1, 0x0c);
}
void setup_pam(int bdf, int pambase)
{
int i;
for (i=0; i<6; i++) {
int pam = pambase + 1 + i;
pci_config_writeb(bdf, pam, 0x33);
}
// Make ram from 0xf0000-0x100000 read-write
pci_config_writeb(bdf, pambase, 0x30);
}
void setup_hw(void)
{
const int bdf = 0;
const uint8_t *bios_start = &stext + 0xfff00000;
const uint8_t *init_start = &sinit + 0xfff00000;
volatile uint8_t *rom_check = &stext;
int rom_check_value;
int pambase;
uint32_t id = pci_config_readl(bdf, 0);
if (id == (PCI_VENDOR_ID_INTEL | (PCI_DEVICE_ID_INTEL_82441 << 16))) {
setup_piix();
setup_piix_pm();
pambase = I440FX_PAM0;
} else if (id == (PCI_VENDOR_ID_INTEL | (PCI_DEVICE_ID_INTEL_Q35_MCH << 16))) {
setup_ich9();
setup_ich9_pm();
pambase = Q35_HOST_BRIDGE_PAM0;
} else
panic();
// Make ram from 0xc0000-0xf0000 read-write
rom_check_value = *rom_check;
*rom_check = rom_check_value + 1;
if (*rom_check == rom_check_value)
setup_pam(bdf, pambase);
// Shadow BIOS; we're still running from 0xffff0000
memcpy(&stext, bios_start, &edata - &stext);
memcpy(&sinit, init_start, &einit - &sinit);
setup_pic();
}
|
