|
|
1.1 root 1: // PCI BIOS (int 1a/b1) calls
2: //
3: // Copyright (C) 2008 Kevin O'Connor <[email protected]>
4: // Copyright (C) 2002 MandrakeSoft S.A.
5: //
6: // This file may be distributed under the terms of the GNU LGPLv3 license.
7:
8: #include "types.h" // u32
9: #include "util.h" // handle_1ab1
10: #include "pci.h" // pci_config_readl
11: #include "bregs.h" // struct bregs
12: #include "biosvar.h" // GET_EBDA
13: #include "pci_regs.h" // PCI_VENDOR_ID
14:
1.1.1.2 root 15: // romlayout.S
1.1.1.3 ! root 16: extern void entry_bios32(void);
! 17: extern void entry_pcibios32(void);
1.1.1.2 root 18:
1.1 root 19: #define RET_FUNC_NOT_SUPPORTED 0x81
20: #define RET_BAD_VENDOR_ID 0x83
21: #define RET_DEVICE_NOT_FOUND 0x86
22: #define RET_BUFFER_TOO_SMALL 0x89
23:
24: // installation check
25: static void
26: handle_1ab101(struct bregs *regs)
27: {
28: regs->al = 0x01; // Flags - "Config Mechanism #1" supported.
29: regs->bx = 0x0210; // PCI version 2.10
1.1.1.3 ! root 30: regs->cl = GET_GLOBAL(MaxPCIBus);
1.1 root 31: regs->edx = 0x20494350; // "PCI "
1.1.1.3 ! root 32: regs->edi = (u32)entry_pcibios32 + BUILD_BIOS_ADDR;
1.1 root 33: set_code_success(regs);
34: }
35:
36: // find pci device
37: static void
38: handle_1ab102(struct bregs *regs)
39: {
40: u32 id = (regs->cx << 16) | regs->dx;
41: int count = regs->si;
1.1.1.3 ! root 42: int bus = -1;
! 43: while (bus < GET_GLOBAL(MaxPCIBus)) {
! 44: bus++;
! 45: int bdf;
! 46: foreachbdf(bdf, bus) {
! 47: u32 v = pci_config_readl(bdf, PCI_VENDOR_ID);
! 48: if (v != id)
! 49: continue;
! 50: if (count--)
! 51: continue;
! 52: regs->bx = bdf;
! 53: set_code_success(regs);
! 54: return;
! 55: }
1.1 root 56: }
57: set_code_invalid(regs, RET_DEVICE_NOT_FOUND);
58: }
59:
60: // find class code
61: static void
62: handle_1ab103(struct bregs *regs)
63: {
64: int count = regs->si;
65: u32 classprog = regs->ecx;
1.1.1.3 ! root 66: int bus = -1;
! 67: while (bus < GET_GLOBAL(MaxPCIBus)) {
! 68: bus++;
! 69: int bdf;
! 70: foreachbdf(bdf, bus) {
! 71: u32 v = pci_config_readl(bdf, PCI_CLASS_REVISION);
! 72: if ((v>>8) != classprog)
! 73: continue;
! 74: if (count--)
! 75: continue;
! 76: regs->bx = bdf;
! 77: set_code_success(regs);
! 78: return;
! 79: }
1.1 root 80: }
81: set_code_invalid(regs, RET_DEVICE_NOT_FOUND);
82: }
83:
84: // read configuration byte
85: static void
86: handle_1ab108(struct bregs *regs)
87: {
88: regs->cl = pci_config_readb(regs->bx, regs->di);
89: set_code_success(regs);
90: }
91:
92: // read configuration word
93: static void
94: handle_1ab109(struct bregs *regs)
95: {
96: regs->cx = pci_config_readw(regs->bx, regs->di);
97: set_code_success(regs);
98: }
99:
100: // read configuration dword
101: static void
102: handle_1ab10a(struct bregs *regs)
103: {
104: regs->ecx = pci_config_readl(regs->bx, regs->di);
105: set_code_success(regs);
106: }
107:
108: // write configuration byte
109: static void
110: handle_1ab10b(struct bregs *regs)
111: {
112: pci_config_writeb(regs->bx, regs->di, regs->cl);
113: set_code_success(regs);
114: }
115:
116: // write configuration word
117: static void
118: handle_1ab10c(struct bregs *regs)
119: {
120: pci_config_writew(regs->bx, regs->di, regs->cx);
121: set_code_success(regs);
122: }
123:
124: // write configuration dword
125: static void
126: handle_1ab10d(struct bregs *regs)
127: {
128: pci_config_writel(regs->bx, regs->di, regs->ecx);
129: set_code_success(regs);
130: }
131:
132: // get irq routing options
133: static void
134: handle_1ab10e(struct bregs *regs)
135: {
136: struct pir_header *pirtable_g = (void*)(GET_GLOBAL(PirOffset) + 0);
137: if (! pirtable_g) {
138: set_code_invalid(regs, RET_FUNC_NOT_SUPPORTED);
139: return;
140: }
141:
142: struct param_s {
143: u16 size;
144: u16 buf_off;
145: u16 buf_seg;
146: } *param_far = (void*)(regs->di+0);
147:
148: // Validate and update size.
149: u16 bufsize = GET_FARVAR(regs->es, param_far->size);
150: u16 pirsize = GET_GLOBAL(pirtable_g->size) - sizeof(struct pir_header);
151: SET_FARVAR(regs->es, param_far->size, pirsize);
152: if (bufsize < pirsize) {
153: set_code_invalid(regs, RET_BUFFER_TOO_SMALL);
154: return;
155: }
156:
157: // Get dest buffer.
158: void *buf_far = (void*)(GET_FARVAR(regs->es, param_far->buf_off)+0);
159: u16 buf_seg = GET_FARVAR(regs->es, param_far->buf_seg);
160:
161: // Memcpy pir table slots to dest buffer.
162: memcpy_far(buf_seg, buf_far
1.1.1.2 root 163: , get_global_seg()
164: , (void*)(pirtable_g->slots) + get_global_offset()
1.1 root 165: , pirsize);
166:
167: // XXX - bochs bios sets bx to (1 << 9) | (1 << 11)
168: regs->bx = GET_GLOBAL(pirtable_g->exclusive_irqs);
169: set_code_success(regs);
170: }
171:
172: static void
173: handle_1ab1XX(struct bregs *regs)
174: {
175: set_code_unimplemented(regs, RET_FUNC_NOT_SUPPORTED);
176: }
177:
178: void
179: handle_1ab1(struct bregs *regs)
180: {
181: //debug_stub(regs);
182:
183: if (! CONFIG_PCIBIOS) {
184: set_invalid(regs);
185: return;
186: }
187:
188: switch (regs->al) {
189: case 0x01: handle_1ab101(regs); break;
190: case 0x02: handle_1ab102(regs); break;
191: case 0x03: handle_1ab103(regs); break;
192: case 0x08: handle_1ab108(regs); break;
193: case 0x09: handle_1ab109(regs); break;
194: case 0x0a: handle_1ab10a(regs); break;
195: case 0x0b: handle_1ab10b(regs); break;
196: case 0x0c: handle_1ab10c(regs); break;
197: case 0x0d: handle_1ab10d(regs); break;
198: case 0x0e: handle_1ab10e(regs); break;
199: default: handle_1ab1XX(regs); break;
200: }
201: }
1.1.1.2 root 202:
203:
204: /****************************************************************
205: * 32bit interface
206: ****************************************************************/
207:
208: // Entry point for 32bit pci bios functions.
209: void VISIBLE32SEG
210: handle_pcibios32(struct bregs *regs)
211: {
212: debug_enter(regs, DEBUG_HDL_pcibios32);
213: handle_1ab1(regs);
214: }
215:
216: struct bios32_s {
217: u32 signature;
218: u32 entry;
219: u8 version;
220: u8 length;
221: u8 checksum;
222: u8 reserved[5];
223: } PACKED;
224:
225: struct bios32_s BIOS32HEADER __aligned(16) VAR16EXPORT = {
226: .signature = 0x5f32335f, // _32_
227: .length = sizeof(BIOS32HEADER) / 16,
228: };
229:
230: void
231: bios32_setup(void)
232: {
233: dprintf(3, "init bios32\n");
234:
1.1.1.3 ! root 235: BIOS32HEADER.entry = (u32)entry_bios32;
1.1.1.2 root 236: BIOS32HEADER.checksum -= checksum(&BIOS32HEADER, sizeof(BIOS32HEADER));
237: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.