// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
// Copyright (C) 2002 MandrakeSoft S.A.
//
-// This file may be distributed under the terms of the GNU GPLv3 license.
+// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "types.h" // u32
#include "util.h" // handle_1ab1
#include "pci.h" // pci_config_readl
#include "bregs.h" // struct bregs
#include "biosvar.h" // GET_EBDA
+#include "pci_regs.h" // PCI_VENDOR_ID
+
+// romlayout.S
+extern void entry_bios32(void);
+extern void entry_pcibios32(void);
#define RET_FUNC_NOT_SUPPORTED 0x81
#define RET_BAD_VENDOR_ID 0x83
{
regs->al = 0x01; // Flags - "Config Mechanism #1" supported.
regs->bx = 0x0210; // PCI version 2.10
- regs->cl = pci_bdf_to_bus(GET_VAR(CS, MaxBDF) - 1);
+ regs->cl = GET_GLOBAL(MaxPCIBus);
regs->edx = 0x20494350; // "PCI "
- // XXX - bochs bios code sets edi to point to 32bit code - but no
- // reference to this in spec.
+ regs->edi = (u32)entry_pcibios32 + BUILD_BIOS_ADDR;
set_code_success(regs);
}
static void
handle_1ab102(struct bregs *regs)
{
- int bdf = -1;
+ u32 id = (regs->cx << 16) | regs->dx;
int count = regs->si;
- do {
- bdf = pci_find_device(regs->dx, regs->cx, bdf+1);
- if (bdf < 0) {
- set_code_fail(regs, RET_DEVICE_NOT_FOUND);
+ int bus = -1;
+ while (bus < GET_GLOBAL(MaxPCIBus)) {
+ bus++;
+ int bdf;
+ foreachbdf(bdf, bus) {
+ u32 v = pci_config_readl(bdf, PCI_VENDOR_ID);
+ if (v != id)
+ continue;
+ if (count--)
+ continue;
+ regs->bx = bdf;
+ set_code_success(regs);
return;
}
- } while (count--);
-
- regs->bx = bdf;
- set_code_success(regs);
+ }
+ set_code_invalid(regs, RET_DEVICE_NOT_FOUND);
}
// find class code
static void
handle_1ab103(struct bregs *regs)
{
- int bdf = -1;
int count = regs->si;
- do {
- bdf = pci_find_classprog(regs->ecx, bdf+1);
- if (bdf < 0) {
- set_code_fail(regs, RET_DEVICE_NOT_FOUND);
+ u32 classprog = regs->ecx;
+ int bus = -1;
+ while (bus < GET_GLOBAL(MaxPCIBus)) {
+ bus++;
+ int bdf;
+ foreachbdf(bdf, bus) {
+ u32 v = pci_config_readl(bdf, PCI_CLASS_REVISION);
+ if ((v>>8) != classprog)
+ continue;
+ if (count--)
+ continue;
+ regs->bx = bdf;
+ set_code_success(regs);
return;
}
- } while (count--);
-
- regs->bx = bdf;
- set_code_success(regs);
+ }
+ set_code_invalid(regs, RET_DEVICE_NOT_FOUND);
}
// read configuration byte
static void
handle_1ab10e(struct bregs *regs)
{
- struct pir_header *pirtable_far = GET_EBDA(pir_loc);
- if (! pirtable_far) {
- set_code_fail(regs, RET_FUNC_NOT_SUPPORTED);
+ struct pir_header *pirtable_g = (void*)(GET_GLOBAL(PirOffset) + 0);
+ if (! pirtable_g) {
+ set_code_invalid(regs, RET_FUNC_NOT_SUPPORTED);
return;
}
+ struct param_s {
+ u16 size;
+ u16 buf_off;
+ u16 buf_seg;
+ } *param_far = (void*)(regs->di+0);
+
// Validate and update size.
- u16 size = GET_FARVAR(regs->es, *(u16*)(regs->di+0));
- u16 pirsize = (GET_FARPTR(pirtable_far->size)
- - sizeof(struct pir_header));
- SET_FARVAR(regs->es, *(u16*)(regs->di+0), pirsize);
- if (size < pirsize) {
- set_code_fail(regs, RET_BUFFER_TOO_SMALL);
+ u16 bufsize = GET_FARVAR(regs->es, param_far->size);
+ u16 pirsize = GET_GLOBAL(pirtable_g->size) - sizeof(struct pir_header);
+ SET_FARVAR(regs->es, param_far->size, pirsize);
+ if (bufsize < pirsize) {
+ set_code_invalid(regs, RET_BUFFER_TOO_SMALL);
return;
}
// Get dest buffer.
- u16 d = (GET_FARVAR(regs->es, *(u16*)(regs->di+2)) + 0);
- u16 destseg = GET_FARVAR(regs->es, *(u16*)(regs->di+4));
+ void *buf_far = (void*)(GET_FARVAR(regs->es, param_far->buf_off)+0);
+ u16 buf_seg = GET_FARVAR(regs->es, param_far->buf_seg);
// Memcpy pir table slots to dest buffer.
- memcpy_far(MAKE_FARPTR(destseg, d), pirtable_far, pirsize);
+ memcpy_far(buf_seg, buf_far
+ , get_global_seg()
+ , (void*)(pirtable_g->slots) + get_global_offset()
+ , pirsize);
// XXX - bochs bios sets bx to (1 << 9) | (1 << 11)
- regs->bx = GET_FARPTR(pirtable_far->exclusive_irqs);
+ regs->bx = GET_GLOBAL(pirtable_g->exclusive_irqs);
set_code_success(regs);
}
static void
handle_1ab1XX(struct bregs *regs)
{
- set_code_fail(regs, RET_FUNC_NOT_SUPPORTED);
+ set_code_unimplemented(regs, RET_FUNC_NOT_SUPPORTED);
}
void
//debug_stub(regs);
if (! CONFIG_PCIBIOS) {
- set_fail(regs);
+ set_invalid(regs);
return;
}
default: handle_1ab1XX(regs); break;
}
}
+
+
+/****************************************************************
+ * 32bit interface
+ ****************************************************************/
+
+// Entry point for 32bit pci bios functions.
+void VISIBLE32SEG
+handle_pcibios32(struct bregs *regs)
+{
+ debug_enter(regs, DEBUG_HDL_pcibios32);
+ handle_1ab1(regs);
+}
+
+struct bios32_s {
+ u32 signature;
+ u32 entry;
+ u8 version;
+ u8 length;
+ u8 checksum;
+ u8 reserved[5];
+} PACKED;
+
+struct bios32_s BIOS32HEADER __aligned(16) VAR16EXPORT = {
+ .signature = 0x5f32335f, // _32_
+ .length = sizeof(BIOS32HEADER) / 16,
+};
+
+void
+bios32_setup(void)
+{
+ dprintf(3, "init bios32\n");
+
+ BIOS32HEADER.entry = (u32)entry_bios32;
+ BIOS32HEADER.checksum -= checksum(&BIOS32HEADER, sizeof(BIOS32HEADER));
+}