2006-09-28 23:01:04 +04:00
|
|
|
/////////////////////////////////////////////////////////////////////////
|
2007-12-09 18:38:41 +03:00
|
|
|
// $Id: rombios32.c,v 1.17 2007-12-09 15:37:27 vruppert Exp $
|
2006-09-28 23:01:04 +04:00
|
|
|
/////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
|
|
|
// 32 bit Bochs BIOS init code
|
|
|
|
// Copyright (C) 2006 Fabrice Bellard
|
|
|
|
//
|
|
|
|
// This library is free software; you can redistribute it and/or
|
|
|
|
// modify it under the terms of the GNU Lesser General Public
|
|
|
|
// License as published by the Free Software Foundation; either
|
|
|
|
// version 2 of the License, or (at your option) any later version.
|
|
|
|
//
|
|
|
|
// This library is distributed in the hope that it will be useful,
|
|
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
// Lesser General Public License for more details.
|
|
|
|
//
|
|
|
|
// You should have received a copy of the GNU Lesser General Public
|
|
|
|
// License along with this library; if not, write to the Free Software
|
|
|
|
// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
|
|
#include <stdarg.h>
|
|
|
|
#include <stddef.h>
|
|
|
|
|
2006-09-30 15:23:49 +04:00
|
|
|
#include "rombios.h"
|
|
|
|
|
2006-09-28 23:01:04 +04:00
|
|
|
typedef signed char int8_t;
|
|
|
|
typedef short int16_t;
|
|
|
|
typedef int int32_t;
|
|
|
|
typedef long long int64_t;
|
|
|
|
typedef unsigned char uint8_t;
|
|
|
|
typedef unsigned short uint16_t;
|
|
|
|
typedef unsigned int uint32_t;
|
|
|
|
typedef unsigned long long uint64_t;
|
|
|
|
|
|
|
|
/* if true, put the MP float table and ACPI RSDT in EBDA and the MP
|
|
|
|
table in RAM. Unfortunately, Linux has bugs with that, so we prefer
|
|
|
|
to modify the BIOS in shadow RAM */
|
|
|
|
//#define BX_USE_EBDA_TABLES
|
|
|
|
|
|
|
|
/* define it if the (emulated) hardware supports SMM mode */
|
|
|
|
#define BX_USE_SMM
|
|
|
|
|
|
|
|
#define cpuid(index, eax, ebx, ecx, edx) \
|
|
|
|
asm volatile ("cpuid" \
|
|
|
|
: "=a" (eax), "=b" (ebx), "=c" (ecx), "=d" (edx) \
|
|
|
|
: "0" (index))
|
|
|
|
|
2006-10-04 00:30:09 +04:00
|
|
|
#define wbinvd() asm volatile("wbinvd")
|
|
|
|
|
2006-09-28 23:01:04 +04:00
|
|
|
#define CPUID_APIC (1 << 9)
|
|
|
|
|
|
|
|
#define APIC_BASE ((uint8_t *)0xfee00000)
|
|
|
|
#define APIC_ICR_LOW 0x300
|
|
|
|
#define APIC_SVR 0x0F0
|
|
|
|
#define APIC_ID 0x020
|
|
|
|
#define APIC_LVT3 0x370
|
|
|
|
|
|
|
|
#define APIC_ENABLED 0x0100
|
|
|
|
|
|
|
|
#define AP_BOOT_ADDR 0x10000
|
|
|
|
|
|
|
|
#define MPTABLE_MAX_SIZE 0x00002000
|
|
|
|
#define SMI_CMD_IO_ADDR 0xb2
|
|
|
|
|
|
|
|
#define BIOS_TMP_STORAGE 0x00030000 /* 64 KB used to copy the BIOS to shadow RAM */
|
|
|
|
|
|
|
|
static inline void outl(int addr, int val)
|
|
|
|
{
|
|
|
|
asm volatile ("outl %1, %w0" : : "d" (addr), "a" (val));
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void outw(int addr, int val)
|
|
|
|
{
|
|
|
|
asm volatile ("outw %w1, %w0" : : "d" (addr), "a" (val));
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void outb(int addr, int val)
|
|
|
|
{
|
|
|
|
asm volatile ("outb %b1, %w0" : : "d" (addr), "a" (val));
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint32_t inl(int addr)
|
|
|
|
{
|
|
|
|
uint32_t val;
|
|
|
|
asm volatile ("inl %w1, %0" : "=a" (val) : "d" (addr));
|
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint16_t inw(int addr)
|
|
|
|
{
|
|
|
|
uint16_t val;
|
|
|
|
asm volatile ("inw %w1, %w0" : "=a" (val) : "d" (addr));
|
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint8_t inb(int addr)
|
|
|
|
{
|
|
|
|
uint8_t val;
|
|
|
|
asm volatile ("inb %w1, %b0" : "=a" (val) : "d" (addr));
|
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void writel(void *addr, uint32_t val)
|
|
|
|
{
|
|
|
|
*(volatile uint32_t *)addr = val;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void writew(void *addr, uint16_t val)
|
|
|
|
{
|
|
|
|
*(volatile uint16_t *)addr = val;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void writeb(void *addr, uint8_t val)
|
|
|
|
{
|
|
|
|
*(volatile uint8_t *)addr = val;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint32_t readl(const void *addr)
|
|
|
|
{
|
|
|
|
return *(volatile const uint32_t *)addr;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint16_t readw(const void *addr)
|
|
|
|
{
|
|
|
|
return *(volatile const uint16_t *)addr;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint8_t readb(const void *addr)
|
|
|
|
{
|
|
|
|
return *(volatile const uint8_t *)addr;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void putc(int c)
|
|
|
|
{
|
|
|
|
outb(INFO_PORT, c);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int isdigit(int c)
|
|
|
|
{
|
|
|
|
return c >= '0' && c <= '9';
|
|
|
|
}
|
|
|
|
|
|
|
|
void *memset(void *d1, int val, size_t len)
|
|
|
|
{
|
|
|
|
uint8_t *d = d1;
|
|
|
|
|
|
|
|
while (len--) {
|
|
|
|
*d++ = val;
|
|
|
|
}
|
|
|
|
return d1;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *memcpy(void *d1, const void *s1, size_t len)
|
|
|
|
{
|
|
|
|
uint8_t *d = d1;
|
|
|
|
const uint8_t *s = s1;
|
|
|
|
|
|
|
|
while (len--) {
|
|
|
|
*d++ = *s++;
|
|
|
|
}
|
|
|
|
return d1;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *memmove(void *d1, const void *s1, size_t len)
|
|
|
|
{
|
|
|
|
uint8_t *d = d1;
|
|
|
|
const uint8_t *s = s1;
|
|
|
|
|
|
|
|
if (d <= s) {
|
|
|
|
while (len--) {
|
|
|
|
*d++ = *s++;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
d += len;
|
|
|
|
s += len;
|
|
|
|
while (len--) {
|
|
|
|
*--d = *--s;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return d1;
|
|
|
|
}
|
|
|
|
|
|
|
|
size_t strlen(const char *s)
|
|
|
|
{
|
|
|
|
const char *s1;
|
|
|
|
for(s1 = s; *s1 != '\0'; s1++);
|
|
|
|
return s1 - s;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* from BSD ppp sources */
|
|
|
|
int vsnprintf(char *buf, int buflen, const char *fmt, va_list args)
|
|
|
|
{
|
|
|
|
int c, i, n;
|
|
|
|
int width, prec, fillch;
|
|
|
|
int base, len, neg;
|
|
|
|
unsigned long val = 0;
|
|
|
|
const char *f;
|
|
|
|
char *str, *buf0;
|
|
|
|
char num[32];
|
|
|
|
static const char hexchars[] = "0123456789abcdef";
|
|
|
|
|
|
|
|
buf0 = buf;
|
|
|
|
--buflen;
|
|
|
|
while (buflen > 0) {
|
|
|
|
for (f = fmt; *f != '%' && *f != 0; ++f)
|
|
|
|
;
|
|
|
|
if (f > fmt) {
|
|
|
|
len = f - fmt;
|
|
|
|
if (len > buflen)
|
|
|
|
len = buflen;
|
|
|
|
memcpy(buf, fmt, len);
|
|
|
|
buf += len;
|
|
|
|
buflen -= len;
|
|
|
|
fmt = f;
|
|
|
|
}
|
|
|
|
if (*fmt == 0)
|
|
|
|
break;
|
|
|
|
c = *++fmt;
|
|
|
|
width = prec = 0;
|
|
|
|
fillch = ' ';
|
|
|
|
if (c == '0') {
|
|
|
|
fillch = '0';
|
|
|
|
c = *++fmt;
|
|
|
|
}
|
|
|
|
if (c == '*') {
|
|
|
|
width = va_arg(args, int);
|
|
|
|
c = *++fmt;
|
|
|
|
} else {
|
|
|
|
while (isdigit(c)) {
|
|
|
|
width = width * 10 + c - '0';
|
|
|
|
c = *++fmt;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (c == '.') {
|
|
|
|
c = *++fmt;
|
|
|
|
if (c == '*') {
|
|
|
|
prec = va_arg(args, int);
|
|
|
|
c = *++fmt;
|
|
|
|
} else {
|
|
|
|
while (isdigit(c)) {
|
|
|
|
prec = prec * 10 + c - '0';
|
|
|
|
c = *++fmt;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/* modifiers */
|
|
|
|
switch(c) {
|
|
|
|
case 'l':
|
|
|
|
c = *++fmt;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
str = 0;
|
|
|
|
base = 0;
|
|
|
|
neg = 0;
|
|
|
|
++fmt;
|
|
|
|
switch (c) {
|
|
|
|
case 'd':
|
|
|
|
i = va_arg(args, int);
|
|
|
|
if (i < 0) {
|
|
|
|
neg = 1;
|
|
|
|
val = -i;
|
|
|
|
} else
|
|
|
|
val = i;
|
|
|
|
base = 10;
|
|
|
|
break;
|
|
|
|
case 'o':
|
|
|
|
val = va_arg(args, unsigned int);
|
|
|
|
base = 8;
|
|
|
|
break;
|
|
|
|
case 'x':
|
|
|
|
case 'X':
|
|
|
|
val = va_arg(args, unsigned int);
|
|
|
|
base = 16;
|
|
|
|
break;
|
|
|
|
case 'p':
|
|
|
|
val = (unsigned long) va_arg(args, void *);
|
|
|
|
base = 16;
|
|
|
|
neg = 2;
|
|
|
|
break;
|
|
|
|
case 's':
|
|
|
|
str = va_arg(args, char *);
|
|
|
|
break;
|
|
|
|
case 'c':
|
|
|
|
num[0] = va_arg(args, int);
|
|
|
|
num[1] = 0;
|
|
|
|
str = num;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
*buf++ = '%';
|
|
|
|
if (c != '%')
|
|
|
|
--fmt; /* so %z outputs %z etc. */
|
|
|
|
--buflen;
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (base != 0) {
|
|
|
|
str = num + sizeof(num);
|
|
|
|
*--str = 0;
|
|
|
|
while (str > num + neg) {
|
|
|
|
*--str = hexchars[val % base];
|
|
|
|
val = val / base;
|
|
|
|
if (--prec <= 0 && val == 0)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
switch (neg) {
|
|
|
|
case 1:
|
|
|
|
*--str = '-';
|
|
|
|
break;
|
|
|
|
case 2:
|
|
|
|
*--str = 'x';
|
|
|
|
*--str = '0';
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
len = num + sizeof(num) - 1 - str;
|
|
|
|
} else {
|
|
|
|
len = strlen(str);
|
|
|
|
if (prec > 0 && len > prec)
|
|
|
|
len = prec;
|
|
|
|
}
|
|
|
|
if (width > 0) {
|
|
|
|
if (width > buflen)
|
|
|
|
width = buflen;
|
|
|
|
if ((n = width - len) > 0) {
|
|
|
|
buflen -= n;
|
|
|
|
for (; n > 0; --n)
|
|
|
|
*buf++ = fillch;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (len > buflen)
|
|
|
|
len = buflen;
|
|
|
|
memcpy(buf, str, len);
|
|
|
|
buf += len;
|
|
|
|
buflen -= len;
|
|
|
|
}
|
|
|
|
*buf = 0;
|
|
|
|
return buf - buf0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void bios_printf(int flags, const char *fmt, ...)
|
|
|
|
{
|
|
|
|
va_list ap;
|
|
|
|
char buf[1024];
|
|
|
|
const char *s;
|
|
|
|
|
|
|
|
va_start(ap, fmt);
|
|
|
|
vsnprintf(buf, sizeof(buf), fmt, ap);
|
|
|
|
s = buf;
|
|
|
|
while (*s)
|
|
|
|
putc(*s++);
|
|
|
|
va_end(ap);
|
|
|
|
}
|
|
|
|
|
|
|
|
void delay_ms(int n)
|
|
|
|
{
|
2006-10-01 20:40:30 +04:00
|
|
|
int i, j;
|
2006-09-28 23:01:04 +04:00
|
|
|
for(i = 0; i < n; i++) {
|
2006-10-01 20:40:30 +04:00
|
|
|
#ifdef BX_QEMU
|
2006-09-30 15:23:49 +04:00
|
|
|
/* approximative ! */
|
2006-09-28 23:01:04 +04:00
|
|
|
for(j = 0; j < 1000000; j++);
|
2006-09-29 16:24:05 +04:00
|
|
|
#else
|
2006-10-01 20:40:30 +04:00
|
|
|
{
|
|
|
|
int r1, r2;
|
|
|
|
j = 66;
|
|
|
|
r1 = inb(0x61) & 0x10;
|
|
|
|
do {
|
2006-09-29 16:24:05 +04:00
|
|
|
r2 = inb(0x61) & 0x10;
|
|
|
|
if (r1 != r2) {
|
2006-10-01 20:40:30 +04:00
|
|
|
j--;
|
|
|
|
r1 = r2;
|
2006-09-29 16:24:05 +04:00
|
|
|
}
|
2006-10-01 20:40:30 +04:00
|
|
|
} while (j > 0);
|
|
|
|
}
|
2006-09-29 16:24:05 +04:00
|
|
|
#endif
|
2006-09-28 23:01:04 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
int smp_cpus;
|
|
|
|
uint32_t cpuid_features;
|
|
|
|
uint32_t cpuid_ext_features;
|
|
|
|
unsigned long ram_size;
|
|
|
|
#ifdef BX_USE_EBDA_TABLES
|
|
|
|
unsigned long ebda_cur_addr;
|
|
|
|
#endif
|
|
|
|
int acpi_enabled;
|
2007-02-20 12:39:06 +03:00
|
|
|
uint32_t pm_io_base, smb_io_base;
|
2006-09-28 23:01:04 +04:00
|
|
|
int pm_sci_int;
|
|
|
|
unsigned long bios_table_cur_addr;
|
|
|
|
unsigned long bios_table_end_addr;
|
|
|
|
|
|
|
|
void cpu_probe(void)
|
|
|
|
{
|
|
|
|
uint32_t eax, ebx, ecx, edx;
|
|
|
|
cpuid(1, eax, ebx, ecx, edx);
|
|
|
|
cpuid_features = edx;
|
|
|
|
cpuid_ext_features = ecx;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int cmos_readb(int addr)
|
|
|
|
{
|
|
|
|
outb(0x70, addr);
|
|
|
|
return inb(0x71);
|
|
|
|
}
|
|
|
|
|
|
|
|
void ram_probe(void)
|
|
|
|
{
|
2007-09-15 11:24:37 +04:00
|
|
|
if (cmos_readb(0x34) | cmos_readb(0x35))
|
2006-09-28 23:01:04 +04:00
|
|
|
ram_size = (cmos_readb(0x34) | (cmos_readb(0x35) << 8)) * 65536 +
|
|
|
|
16 * 1024 * 1024;
|
2007-09-15 11:24:37 +04:00
|
|
|
else
|
|
|
|
ram_size = (cmos_readb(0x17) | (cmos_readb(0x18) << 8)) * 1024;
|
2006-09-28 23:01:04 +04:00
|
|
|
#ifdef BX_USE_EBDA_TABLES
|
|
|
|
ebda_cur_addr = ((*(uint16_t *)(0x40e)) << 4) + 0x380;
|
|
|
|
#endif
|
2007-09-10 19:10:39 +04:00
|
|
|
BX_INFO("ram_size=0x%08lx\n", ram_size);
|
2006-09-28 23:01:04 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************/
|
|
|
|
/* SMP probe */
|
|
|
|
|
|
|
|
extern uint8_t smp_ap_boot_code_start;
|
|
|
|
extern uint8_t smp_ap_boot_code_end;
|
|
|
|
|
|
|
|
/* find the number of CPUs by launching a SIPI to them */
|
|
|
|
void smp_probe(void)
|
|
|
|
{
|
|
|
|
uint32_t val, sipi_vector;
|
|
|
|
|
|
|
|
smp_cpus = 1;
|
|
|
|
if (cpuid_features & CPUID_APIC) {
|
|
|
|
|
|
|
|
/* enable local APIC */
|
|
|
|
val = readl(APIC_BASE + APIC_SVR);
|
|
|
|
val |= APIC_ENABLED;
|
|
|
|
writel(APIC_BASE + APIC_SVR, val);
|
|
|
|
|
|
|
|
writew((void *)CPU_COUNT_ADDR, 1);
|
|
|
|
/* copy AP boot code */
|
|
|
|
memcpy((void *)AP_BOOT_ADDR, &smp_ap_boot_code_start,
|
|
|
|
&smp_ap_boot_code_end - &smp_ap_boot_code_start);
|
|
|
|
|
|
|
|
/* broadcast SIPI */
|
|
|
|
writel(APIC_BASE + APIC_ICR_LOW, 0x000C4500);
|
|
|
|
sipi_vector = AP_BOOT_ADDR >> 12;
|
|
|
|
writel(APIC_BASE + APIC_ICR_LOW, 0x000C4600 | sipi_vector);
|
|
|
|
|
|
|
|
delay_ms(10);
|
|
|
|
|
|
|
|
smp_cpus = readw((void *)CPU_COUNT_ADDR);
|
|
|
|
}
|
2006-09-29 16:24:05 +04:00
|
|
|
BX_INFO("Found %d cpu(s)\n", smp_cpus);
|
2006-09-28 23:01:04 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************/
|
|
|
|
/* PCI init */
|
|
|
|
|
|
|
|
#define PCI_ADDRESS_SPACE_MEM 0x00
|
|
|
|
#define PCI_ADDRESS_SPACE_IO 0x01
|
|
|
|
#define PCI_ADDRESS_SPACE_MEM_PREFETCH 0x08
|
|
|
|
|
|
|
|
#define PCI_ROM_SLOT 6
|
|
|
|
#define PCI_NUM_REGIONS 7
|
|
|
|
|
|
|
|
#define PCI_DEVICES_MAX 64
|
|
|
|
|
|
|
|
#define PCI_VENDOR_ID 0x00 /* 16 bits */
|
|
|
|
#define PCI_DEVICE_ID 0x02 /* 16 bits */
|
|
|
|
#define PCI_COMMAND 0x04 /* 16 bits */
|
|
|
|
#define PCI_COMMAND_IO 0x1 /* Enable response in I/O space */
|
|
|
|
#define PCI_COMMAND_MEMORY 0x2 /* Enable response in Memory space */
|
|
|
|
#define PCI_CLASS_DEVICE 0x0a /* Device class */
|
|
|
|
#define PCI_INTERRUPT_LINE 0x3c /* 8 bits */
|
|
|
|
#define PCI_INTERRUPT_PIN 0x3d /* 8 bits */
|
|
|
|
#define PCI_MIN_GNT 0x3e /* 8 bits */
|
|
|
|
#define PCI_MAX_LAT 0x3f /* 8 bits */
|
|
|
|
|
|
|
|
typedef struct PCIDevice {
|
|
|
|
int bus;
|
|
|
|
int devfn;
|
|
|
|
} PCIDevice;
|
|
|
|
|
|
|
|
static uint32_t pci_bios_io_addr;
|
|
|
|
static uint32_t pci_bios_mem_addr;
|
2007-06-17 11:37:11 +04:00
|
|
|
static uint32_t pci_bios_bigmem_addr;
|
2006-09-28 23:01:04 +04:00
|
|
|
/* host irqs corresponding to PCI irqs A-D */
|
|
|
|
static uint8_t pci_irqs[4] = { 11, 9, 11, 9 };
|
|
|
|
static PCIDevice i440_pcidev;
|
|
|
|
|
|
|
|
static void pci_config_writel(PCIDevice *d, uint32_t addr, uint32_t val)
|
|
|
|
{
|
|
|
|
outl(0xcf8, 0x80000000 | (d->bus << 16) | (d->devfn << 8) | (addr & 0xfc));
|
|
|
|
outl(0xcfc, val);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pci_config_writew(PCIDevice *d, uint32_t addr, uint32_t val)
|
|
|
|
{
|
|
|
|
outl(0xcf8, 0x80000000 | (d->bus << 16) | (d->devfn << 8) | (addr & 0xfc));
|
|
|
|
outw(0xcfc + (addr & 2), val);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pci_config_writeb(PCIDevice *d, uint32_t addr, uint32_t val)
|
|
|
|
{
|
|
|
|
outl(0xcf8, 0x80000000 | (d->bus << 16) | (d->devfn << 8) | (addr & 0xfc));
|
|
|
|
outb(0xcfc + (addr & 3), val);
|
|
|
|
}
|
|
|
|
|
|
|
|
static uint32_t pci_config_readl(PCIDevice *d, uint32_t addr)
|
|
|
|
{
|
|
|
|
outl(0xcf8, 0x80000000 | (d->bus << 16) | (d->devfn << 8) | (addr & 0xfc));
|
|
|
|
return inl(0xcfc);
|
|
|
|
}
|
|
|
|
|
|
|
|
static uint32_t pci_config_readw(PCIDevice *d, uint32_t addr)
|
|
|
|
{
|
|
|
|
outl(0xcf8, 0x80000000 | (d->bus << 16) | (d->devfn << 8) | (addr & 0xfc));
|
|
|
|
return inw(0xcfc + (addr & 2));
|
|
|
|
}
|
|
|
|
|
|
|
|
static uint32_t pci_config_readb(PCIDevice *d, uint32_t addr)
|
|
|
|
{
|
|
|
|
outl(0xcf8, 0x80000000 | (d->bus << 16) | (d->devfn << 8) | (addr & 0xfc));
|
|
|
|
return inb(0xcfc + (addr & 3));
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pci_set_io_region_addr(PCIDevice *d, int region_num, uint32_t addr)
|
|
|
|
{
|
|
|
|
uint16_t cmd;
|
|
|
|
uint32_t ofs, old_addr;
|
|
|
|
|
|
|
|
if ( region_num == PCI_ROM_SLOT ) {
|
|
|
|
ofs = 0x30;
|
|
|
|
}else{
|
|
|
|
ofs = 0x10 + region_num * 4;
|
|
|
|
}
|
|
|
|
|
|
|
|
old_addr = pci_config_readl(d, ofs);
|
|
|
|
|
|
|
|
pci_config_writel(d, ofs, addr);
|
|
|
|
BX_INFO("region %d: 0x%08x\n", region_num, addr);
|
|
|
|
|
|
|
|
/* enable memory mappings */
|
|
|
|
cmd = pci_config_readw(d, PCI_COMMAND);
|
|
|
|
if ( region_num == PCI_ROM_SLOT )
|
|
|
|
cmd |= 2;
|
|
|
|
else if (old_addr & PCI_ADDRESS_SPACE_IO)
|
|
|
|
cmd |= 1;
|
|
|
|
else
|
|
|
|
cmd |= 2;
|
|
|
|
pci_config_writew(d, PCI_COMMAND, cmd);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* return the global irq number corresponding to a given device irq
|
|
|
|
pin. We could also use the bus number to have a more precise
|
|
|
|
mapping. */
|
|
|
|
static int pci_slot_get_pirq(PCIDevice *pci_dev, int irq_num)
|
|
|
|
{
|
|
|
|
int slot_addend;
|
|
|
|
slot_addend = (pci_dev->devfn >> 3) - 1;
|
|
|
|
return (irq_num + slot_addend) & 3;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int find_bios_table_area(void)
|
|
|
|
{
|
|
|
|
unsigned long addr;
|
|
|
|
for(addr = 0xf0000; addr < 0x100000; addr += 16) {
|
|
|
|
if (*(uint32_t *)addr == 0xaafb4442) {
|
|
|
|
bios_table_cur_addr = addr + 8;
|
|
|
|
bios_table_end_addr = bios_table_cur_addr + *(uint32_t *)(addr + 4);
|
|
|
|
BX_INFO("bios_table_addr: 0x%08lx end=0x%08lx\n",
|
|
|
|
bios_table_cur_addr, bios_table_end_addr);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void bios_shadow_init(PCIDevice *d)
|
|
|
|
{
|
|
|
|
int v;
|
|
|
|
|
|
|
|
if (find_bios_table_area() < 0)
|
|
|
|
return;
|
|
|
|
|
|
|
|
/* remap the BIOS to shadow RAM an keep it read/write while we
|
|
|
|
are writing tables */
|
|
|
|
v = pci_config_readb(d, 0x59);
|
2007-12-01 22:27:28 +03:00
|
|
|
v &= 0xcf;
|
|
|
|
pci_config_writeb(d, 0x59, v);
|
|
|
|
memcpy((void *)BIOS_TMP_STORAGE, (void *)0x000f0000, 0x10000);
|
|
|
|
v |= 0x30;
|
2006-09-28 23:01:04 +04:00
|
|
|
pci_config_writeb(d, 0x59, v);
|
|
|
|
memcpy((void *)0x000f0000, (void *)BIOS_TMP_STORAGE, 0x10000);
|
|
|
|
|
|
|
|
i440_pcidev = *d;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void bios_lock_shadow_ram(void)
|
|
|
|
{
|
|
|
|
PCIDevice *d = &i440_pcidev;
|
|
|
|
int v;
|
|
|
|
|
2006-10-04 00:30:09 +04:00
|
|
|
wbinvd();
|
2006-09-28 23:01:04 +04:00
|
|
|
v = pci_config_readb(d, 0x59);
|
|
|
|
v = (v & 0x0f) | (0x10);
|
|
|
|
pci_config_writeb(d, 0x59, v);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pci_bios_init_bridges(PCIDevice *d)
|
|
|
|
{
|
|
|
|
uint16_t vendor_id, device_id;
|
|
|
|
|
|
|
|
vendor_id = pci_config_readw(d, PCI_VENDOR_ID);
|
|
|
|
device_id = pci_config_readw(d, PCI_DEVICE_ID);
|
|
|
|
|
|
|
|
if (vendor_id == 0x8086 && device_id == 0x7000) {
|
|
|
|
int i, irq;
|
|
|
|
uint8_t elcr[2];
|
|
|
|
|
|
|
|
/* PIIX3 bridge */
|
|
|
|
|
|
|
|
elcr[0] = 0x00;
|
|
|
|
elcr[1] = 0x00;
|
|
|
|
for(i = 0; i < 4; i++) {
|
|
|
|
irq = pci_irqs[i];
|
|
|
|
/* set to trigger level */
|
|
|
|
elcr[irq >> 3] |= (1 << (irq & 7));
|
|
|
|
/* activate irq remapping in PIIX */
|
|
|
|
pci_config_writeb(d, 0x60 + i, irq);
|
|
|
|
}
|
|
|
|
outb(0x4d0, elcr[0]);
|
|
|
|
outb(0x4d1, elcr[1]);
|
|
|
|
BX_INFO("PIIX3 init: elcr=%02x %02x\n",
|
|
|
|
elcr[0], elcr[1]);
|
|
|
|
} else if (vendor_id == 0x8086 && device_id == 0x1237) {
|
|
|
|
/* i440 PCI bridge */
|
|
|
|
bios_shadow_init(d);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
extern uint8_t smm_relocation_start, smm_relocation_end;
|
|
|
|
extern uint8_t smm_code_start, smm_code_end;
|
|
|
|
|
|
|
|
#ifdef BX_USE_SMM
|
2006-10-02 10:30:36 +04:00
|
|
|
static void smm_init(PCIDevice *d)
|
2006-09-28 23:01:04 +04:00
|
|
|
{
|
2007-12-09 18:38:41 +03:00
|
|
|
uint32_t value;
|
2006-10-02 10:30:36 +04:00
|
|
|
|
2007-12-09 18:38:41 +03:00
|
|
|
/* check if SMM init is already done */
|
|
|
|
value = pci_config_readl(d, 0x58);
|
|
|
|
if ((value & (1 << 25)) == 0) {
|
2006-10-02 10:30:36 +04:00
|
|
|
|
2007-12-09 18:38:41 +03:00
|
|
|
/* copy the SMM relocation code */
|
|
|
|
memcpy((void *)0x38000, &smm_relocation_start,
|
|
|
|
&smm_relocation_end - &smm_relocation_start);
|
2006-10-02 10:30:36 +04:00
|
|
|
|
2007-12-09 18:38:41 +03:00
|
|
|
/* enable SMI generation when writing to the APMC register */
|
|
|
|
pci_config_writel(d, 0x58, value | (1 << 25));
|
2006-10-02 10:30:36 +04:00
|
|
|
|
2007-12-09 18:38:41 +03:00
|
|
|
/* init APM status port */
|
|
|
|
outb(0xb3, 0x01);
|
2006-09-28 23:01:04 +04:00
|
|
|
|
2007-12-09 18:38:41 +03:00
|
|
|
/* raise an SMI interrupt */
|
|
|
|
outb(0xb2, 0x00);
|
2006-09-28 23:01:04 +04:00
|
|
|
|
2007-12-09 18:38:41 +03:00
|
|
|
/* wait until SMM code executed */
|
|
|
|
while (inb(0xb3) != 0x00);
|
|
|
|
|
|
|
|
/* enable the SMM memory window */
|
|
|
|
pci_config_writeb(&i440_pcidev, 0x72, 0x02 | 0x48);
|
|
|
|
|
|
|
|
/* copy the SMM code */
|
|
|
|
memcpy((void *)0xa8000, &smm_code_start,
|
|
|
|
&smm_code_end - &smm_code_start);
|
|
|
|
wbinvd();
|
|
|
|
|
|
|
|
/* close the SMM memory window and enable normal SMM */
|
|
|
|
pci_config_writeb(&i440_pcidev, 0x72, 0x02 | 0x08);
|
|
|
|
}
|
2006-09-28 23:01:04 +04:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static void pci_bios_init_device(PCIDevice *d)
|
|
|
|
{
|
|
|
|
int class;
|
|
|
|
uint32_t *paddr;
|
|
|
|
int i, pin, pic_irq, vendor_id, device_id;
|
|
|
|
|
|
|
|
class = pci_config_readw(d, PCI_CLASS_DEVICE);
|
|
|
|
vendor_id = pci_config_readw(d, PCI_VENDOR_ID);
|
|
|
|
device_id = pci_config_readw(d, PCI_DEVICE_ID);
|
|
|
|
BX_INFO("PCI: bus=%d devfn=0x%02x: vendor_id=0x%04x device_id=0x%04x\n",
|
|
|
|
d->bus, d->devfn, vendor_id, device_id);
|
|
|
|
switch(class) {
|
|
|
|
case 0x0101:
|
|
|
|
if (vendor_id == 0x8086 && device_id == 0x7010) {
|
|
|
|
/* PIIX3 IDE */
|
|
|
|
pci_config_writew(d, 0x40, 0x8000); // enable IDE0
|
|
|
|
pci_config_writew(d, 0x42, 0x8000); // enable IDE1
|
|
|
|
goto default_map;
|
|
|
|
} else {
|
|
|
|
/* IDE: we map it as in ISA mode */
|
|
|
|
pci_set_io_region_addr(d, 0, 0x1f0);
|
|
|
|
pci_set_io_region_addr(d, 1, 0x3f4);
|
|
|
|
pci_set_io_region_addr(d, 2, 0x170);
|
|
|
|
pci_set_io_region_addr(d, 3, 0x374);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0x0300:
|
|
|
|
if (vendor_id != 0x1234)
|
|
|
|
goto default_map;
|
|
|
|
/* VGA: map frame buffer to default Bochs VBE address */
|
|
|
|
pci_set_io_region_addr(d, 0, 0xE0000000);
|
|
|
|
break;
|
|
|
|
case 0x0800:
|
|
|
|
/* PIC */
|
|
|
|
if (vendor_id == 0x1014) {
|
|
|
|
/* IBM */
|
|
|
|
if (device_id == 0x0046 || device_id == 0xFFFF) {
|
|
|
|
/* MPIC & MPIC2 */
|
|
|
|
pci_set_io_region_addr(d, 0, 0x80800000 + 0x00040000);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 0xff00:
|
|
|
|
if (vendor_id == 0x0106b &&
|
|
|
|
(device_id == 0x0017 || device_id == 0x0022)) {
|
|
|
|
/* macio bridge */
|
|
|
|
pci_set_io_region_addr(d, 0, 0x80800000);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
default_map:
|
|
|
|
/* default memory mappings */
|
|
|
|
for(i = 0; i < PCI_NUM_REGIONS; i++) {
|
|
|
|
int ofs;
|
|
|
|
uint32_t val, size ;
|
|
|
|
|
|
|
|
if (i == PCI_ROM_SLOT)
|
|
|
|
ofs = 0x30;
|
|
|
|
else
|
|
|
|
ofs = 0x10 + i * 4;
|
|
|
|
pci_config_writel(d, ofs, 0xffffffff);
|
|
|
|
val = pci_config_readl(d, ofs);
|
|
|
|
if (val != 0) {
|
|
|
|
size = (~(val & ~0xf)) + 1;
|
|
|
|
if (val & PCI_ADDRESS_SPACE_IO)
|
|
|
|
paddr = &pci_bios_io_addr;
|
2007-06-17 11:37:11 +04:00
|
|
|
else if (size >= 0x04000000)
|
|
|
|
paddr = &pci_bios_bigmem_addr;
|
2006-09-28 23:01:04 +04:00
|
|
|
else
|
|
|
|
paddr = &pci_bios_mem_addr;
|
|
|
|
*paddr = (*paddr + size - 1) & ~(size - 1);
|
|
|
|
pci_set_io_region_addr(d, i, *paddr);
|
|
|
|
*paddr += size;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* map the interrupt */
|
|
|
|
pin = pci_config_readb(d, PCI_INTERRUPT_PIN);
|
|
|
|
if (pin != 0) {
|
|
|
|
pin = pci_slot_get_pirq(d, pin - 1);
|
|
|
|
pic_irq = pci_irqs[pin];
|
|
|
|
pci_config_writeb(d, PCI_INTERRUPT_LINE, pic_irq);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (vendor_id == 0x8086 && device_id == 0x7113) {
|
|
|
|
/* PIIX4 Power Management device (for ACPI) */
|
|
|
|
pm_io_base = PM_IO_BASE;
|
|
|
|
pci_config_writel(d, 0x40, pm_io_base | 1);
|
|
|
|
pci_config_writeb(d, 0x80, 0x01); /* enable PM io space */
|
2007-02-20 12:39:06 +03:00
|
|
|
smb_io_base = SMB_IO_BASE;
|
|
|
|
pci_config_writel(d, 0x90, smb_io_base | 1);
|
|
|
|
pci_config_writeb(d, 0xd2, 0x09); /* enable SMBus io space */
|
2006-09-28 23:01:04 +04:00
|
|
|
pm_sci_int = pci_config_readb(d, PCI_INTERRUPT_LINE);
|
|
|
|
#ifdef BX_USE_SMM
|
2006-10-02 10:30:36 +04:00
|
|
|
smm_init(d);
|
2006-09-28 23:01:04 +04:00
|
|
|
#endif
|
|
|
|
acpi_enabled = 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void pci_for_each_device(void (*init_func)(PCIDevice *d))
|
|
|
|
{
|
|
|
|
PCIDevice d1, *d = &d1;
|
|
|
|
int bus, devfn;
|
|
|
|
uint16_t vendor_id, device_id;
|
|
|
|
|
|
|
|
for(bus = 0; bus < 1; bus++) {
|
|
|
|
for(devfn = 0; devfn < 256; devfn++) {
|
|
|
|
d->bus = bus;
|
|
|
|
d->devfn = devfn;
|
|
|
|
vendor_id = pci_config_readw(d, PCI_VENDOR_ID);
|
|
|
|
device_id = pci_config_readw(d, PCI_DEVICE_ID);
|
|
|
|
if (vendor_id != 0xffff || device_id != 0xffff) {
|
|
|
|
init_func(d);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void pci_bios_init(void)
|
|
|
|
{
|
|
|
|
pci_bios_io_addr = 0xc000;
|
|
|
|
pci_bios_mem_addr = 0xf0000000;
|
2007-06-17 11:37:11 +04:00
|
|
|
pci_bios_bigmem_addr = ram_size;
|
|
|
|
if (pci_bios_bigmem_addr < 0x90000000)
|
|
|
|
pci_bios_bigmem_addr = 0x90000000;
|
2006-09-28 23:01:04 +04:00
|
|
|
|
|
|
|
pci_for_each_device(pci_bios_init_bridges);
|
|
|
|
|
|
|
|
pci_for_each_device(pci_bios_init_device);
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************/
|
|
|
|
/* Multi Processor table init */
|
|
|
|
|
|
|
|
static void putb(uint8_t **pp, int val)
|
|
|
|
{
|
|
|
|
uint8_t *q;
|
|
|
|
q = *pp;
|
|
|
|
*q++ = val;
|
|
|
|
*pp = q;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void putstr(uint8_t **pp, const char *str)
|
|
|
|
{
|
|
|
|
uint8_t *q;
|
|
|
|
q = *pp;
|
|
|
|
while (*str)
|
|
|
|
*q++ = *str++;
|
|
|
|
*pp = q;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void putle16(uint8_t **pp, int val)
|
|
|
|
{
|
|
|
|
uint8_t *q;
|
|
|
|
q = *pp;
|
|
|
|
*q++ = val;
|
|
|
|
*q++ = val >> 8;
|
|
|
|
*pp = q;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void putle32(uint8_t **pp, int val)
|
|
|
|
{
|
|
|
|
uint8_t *q;
|
|
|
|
q = *pp;
|
|
|
|
*q++ = val;
|
|
|
|
*q++ = val >> 8;
|
|
|
|
*q++ = val >> 16;
|
|
|
|
*q++ = val >> 24;
|
|
|
|
*pp = q;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mpf_checksum(const uint8_t *data, int len)
|
|
|
|
{
|
|
|
|
int sum, i;
|
|
|
|
sum = 0;
|
|
|
|
for(i = 0; i < len; i++)
|
|
|
|
sum += data[i];
|
|
|
|
return sum & 0xff;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned long align(unsigned long addr, unsigned long v)
|
|
|
|
{
|
|
|
|
return (addr + v - 1) & ~(v - 1);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void mptable_init(void)
|
|
|
|
{
|
|
|
|
uint8_t *mp_config_table, *q, *float_pointer_struct;
|
|
|
|
int ioapic_id, i, len;
|
|
|
|
int mp_config_table_size;
|
|
|
|
|
|
|
|
#ifdef BX_USE_EBDA_TABLES
|
|
|
|
mp_config_table = (uint8_t *)(ram_size - ACPI_DATA_SIZE - MPTABLE_MAX_SIZE);
|
|
|
|
#else
|
|
|
|
bios_table_cur_addr = align(bios_table_cur_addr, 16);
|
|
|
|
mp_config_table = (uint8_t *)bios_table_cur_addr;
|
|
|
|
#endif
|
|
|
|
q = mp_config_table;
|
|
|
|
putstr(&q, "PCMP"); /* "PCMP signature */
|
|
|
|
putle16(&q, 0); /* table length (patched later) */
|
|
|
|
putb(&q, 4); /* spec rev */
|
|
|
|
putb(&q, 0); /* checksum (patched later) */
|
|
|
|
#ifdef BX_QEMU
|
|
|
|
putstr(&q, "QEMUCPU "); /* OEM id */
|
|
|
|
#else
|
|
|
|
putstr(&q, "BOCHSCPU");
|
|
|
|
#endif
|
|
|
|
putstr(&q, "0.1 "); /* vendor id */
|
|
|
|
putle32(&q, 0); /* OEM table ptr */
|
|
|
|
putle16(&q, 0); /* OEM table size */
|
2006-09-30 15:23:49 +04:00
|
|
|
putle16(&q, smp_cpus + 18); /* entry count */
|
2006-09-28 23:01:04 +04:00
|
|
|
putle32(&q, 0xfee00000); /* local APIC addr */
|
|
|
|
putle16(&q, 0); /* ext table length */
|
|
|
|
putb(&q, 0); /* ext table checksum */
|
|
|
|
putb(&q, 0); /* reserved */
|
|
|
|
|
|
|
|
for(i = 0; i < smp_cpus; i++) {
|
|
|
|
putb(&q, 0); /* entry type = processor */
|
|
|
|
putb(&q, i); /* APIC id */
|
|
|
|
putb(&q, 0x11); /* local APIC version number */
|
|
|
|
if (i == 0)
|
|
|
|
putb(&q, 3); /* cpu flags: enabled, bootstrap cpu */
|
|
|
|
else
|
|
|
|
putb(&q, 1); /* cpu flags: enabled */
|
|
|
|
putb(&q, 0); /* cpu signature */
|
|
|
|
putb(&q, 6);
|
|
|
|
putb(&q, 0);
|
|
|
|
putb(&q, 0);
|
|
|
|
putle16(&q, 0x201); /* feature flags */
|
|
|
|
putle16(&q, 0);
|
|
|
|
|
|
|
|
putle16(&q, 0); /* reserved */
|
|
|
|
putle16(&q, 0);
|
|
|
|
putle16(&q, 0);
|
|
|
|
putle16(&q, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* isa bus */
|
|
|
|
putb(&q, 1); /* entry type = bus */
|
|
|
|
putb(&q, 0); /* bus ID */
|
|
|
|
putstr(&q, "ISA ");
|
|
|
|
|
|
|
|
/* ioapic */
|
|
|
|
ioapic_id = smp_cpus;
|
|
|
|
putb(&q, 2); /* entry type = I/O APIC */
|
|
|
|
putb(&q, ioapic_id); /* apic ID */
|
|
|
|
putb(&q, 0x11); /* I/O APIC version number */
|
|
|
|
putb(&q, 1); /* enable */
|
|
|
|
putle32(&q, 0xfec00000); /* I/O APIC addr */
|
|
|
|
|
|
|
|
/* irqs */
|
|
|
|
for(i = 0; i < 16; i++) {
|
|
|
|
putb(&q, 3); /* entry type = I/O interrupt */
|
|
|
|
putb(&q, 0); /* interrupt type = vectored interrupt */
|
|
|
|
putb(&q, 0); /* flags: po=0, el=0 */
|
|
|
|
putb(&q, 0);
|
|
|
|
putb(&q, 0); /* source bus ID = ISA */
|
|
|
|
putb(&q, i); /* source bus IRQ */
|
|
|
|
putb(&q, ioapic_id); /* dest I/O APIC ID */
|
|
|
|
putb(&q, i); /* dest I/O APIC interrupt in */
|
|
|
|
}
|
|
|
|
/* patch length */
|
|
|
|
len = q - mp_config_table;
|
|
|
|
mp_config_table[4] = len;
|
|
|
|
mp_config_table[5] = len >> 8;
|
|
|
|
|
|
|
|
mp_config_table[7] = -mpf_checksum(mp_config_table, q - mp_config_table);
|
|
|
|
|
|
|
|
mp_config_table_size = q - mp_config_table;
|
|
|
|
|
|
|
|
#ifndef BX_USE_EBDA_TABLES
|
|
|
|
bios_table_cur_addr += mp_config_table_size;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* floating pointer structure */
|
|
|
|
#ifdef BX_USE_EBDA_TABLES
|
|
|
|
ebda_cur_addr = align(ebda_cur_addr, 16);
|
|
|
|
float_pointer_struct = (uint8_t *)ebda_cur_addr;
|
|
|
|
#else
|
|
|
|
bios_table_cur_addr = align(bios_table_cur_addr, 16);
|
|
|
|
float_pointer_struct = (uint8_t *)bios_table_cur_addr;
|
|
|
|
#endif
|
|
|
|
q = float_pointer_struct;
|
|
|
|
putstr(&q, "_MP_");
|
|
|
|
/* pointer to MP config table */
|
|
|
|
putle32(&q, (unsigned long)mp_config_table);
|
|
|
|
|
|
|
|
putb(&q, 1); /* length in 16 byte units */
|
|
|
|
putb(&q, 4); /* MP spec revision */
|
|
|
|
putb(&q, 0); /* checksum (patched later) */
|
|
|
|
putb(&q, 0); /* MP feature byte 1 */
|
|
|
|
|
|
|
|
putb(&q, 0);
|
|
|
|
putb(&q, 0);
|
|
|
|
putb(&q, 0);
|
|
|
|
putb(&q, 0);
|
|
|
|
float_pointer_struct[10] =
|
|
|
|
-mpf_checksum(float_pointer_struct, q - float_pointer_struct);
|
|
|
|
#ifdef BX_USE_EBDA_TABLES
|
|
|
|
ebda_cur_addr += (q - float_pointer_struct);
|
|
|
|
#else
|
|
|
|
bios_table_cur_addr += (q - float_pointer_struct);
|
|
|
|
#endif
|
|
|
|
BX_INFO("MP table addr=0x%08lx MPC table addr=0x%08lx size=0x%x\n",
|
|
|
|
(unsigned long)float_pointer_struct,
|
|
|
|
(unsigned long)mp_config_table,
|
|
|
|
mp_config_table_size);
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************/
|
|
|
|
/* ACPI tables init */
|
|
|
|
|
|
|
|
/* Table structure from Linux kernel (the ACPI tables are under the
|
|
|
|
BSD license) */
|
|
|
|
|
|
|
|
#define ACPI_TABLE_HEADER_DEF /* ACPI common table header */ \
|
|
|
|
uint8_t signature [4]; /* ACPI signature (4 ASCII characters) */\
|
|
|
|
uint32_t length; /* Length of table, in bytes, including header */\
|
|
|
|
uint8_t revision; /* ACPI Specification minor version # */\
|
|
|
|
uint8_t checksum; /* To make sum of entire table == 0 */\
|
|
|
|
uint8_t oem_id [6]; /* OEM identification */\
|
|
|
|
uint8_t oem_table_id [8]; /* OEM table identification */\
|
|
|
|
uint32_t oem_revision; /* OEM revision number */\
|
|
|
|
uint8_t asl_compiler_id [4]; /* ASL compiler vendor ID */\
|
|
|
|
uint32_t asl_compiler_revision; /* ASL compiler revision number */
|
|
|
|
|
|
|
|
|
|
|
|
struct acpi_table_header /* ACPI common table header */
|
|
|
|
{
|
|
|
|
ACPI_TABLE_HEADER_DEF
|
|
|
|
};
|
|
|
|
|
|
|
|
struct rsdp_descriptor /* Root System Descriptor Pointer */
|
|
|
|
{
|
|
|
|
uint8_t signature [8]; /* ACPI signature, contains "RSD PTR " */
|
|
|
|
uint8_t checksum; /* To make sum of struct == 0 */
|
|
|
|
uint8_t oem_id [6]; /* OEM identification */
|
|
|
|
uint8_t revision; /* Must be 0 for 1.0, 2 for 2.0 */
|
|
|
|
uint32_t rsdt_physical_address; /* 32-bit physical address of RSDT */
|
|
|
|
uint32_t length; /* XSDT Length in bytes including hdr */
|
|
|
|
uint64_t xsdt_physical_address; /* 64-bit physical address of XSDT */
|
|
|
|
uint8_t extended_checksum; /* Checksum of entire table */
|
|
|
|
uint8_t reserved [3]; /* Reserved field must be 0 */
|
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* ACPI 1.0 Root System Description Table (RSDT)
|
|
|
|
*/
|
|
|
|
struct rsdt_descriptor_rev1
|
|
|
|
{
|
|
|
|
ACPI_TABLE_HEADER_DEF /* ACPI common table header */
|
|
|
|
uint32_t table_offset_entry [2]; /* Array of pointers to other */
|
|
|
|
/* ACPI tables */
|
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* ACPI 1.0 Firmware ACPI Control Structure (FACS)
|
|
|
|
*/
|
|
|
|
struct facs_descriptor_rev1
|
|
|
|
{
|
|
|
|
uint8_t signature[4]; /* ACPI Signature */
|
|
|
|
uint32_t length; /* Length of structure, in bytes */
|
|
|
|
uint32_t hardware_signature; /* Hardware configuration signature */
|
|
|
|
uint32_t firmware_waking_vector; /* ACPI OS waking vector */
|
|
|
|
uint32_t global_lock; /* Global Lock */
|
|
|
|
uint32_t S4bios_f : 1; /* Indicates if S4BIOS support is present */
|
|
|
|
uint32_t reserved1 : 31; /* Must be 0 */
|
|
|
|
uint8_t resverved3 [40]; /* Reserved - must be zero */
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* ACPI 1.0 Fixed ACPI Description Table (FADT)
|
|
|
|
*/
|
|
|
|
struct fadt_descriptor_rev1
|
|
|
|
{
|
|
|
|
ACPI_TABLE_HEADER_DEF /* ACPI common table header */
|
|
|
|
uint32_t firmware_ctrl; /* Physical address of FACS */
|
|
|
|
uint32_t dsdt; /* Physical address of DSDT */
|
|
|
|
uint8_t model; /* System Interrupt Model */
|
|
|
|
uint8_t reserved1; /* Reserved */
|
|
|
|
uint16_t sci_int; /* System vector of SCI interrupt */
|
|
|
|
uint32_t smi_cmd; /* Port address of SMI command port */
|
|
|
|
uint8_t acpi_enable; /* Value to write to smi_cmd to enable ACPI */
|
|
|
|
uint8_t acpi_disable; /* Value to write to smi_cmd to disable ACPI */
|
|
|
|
uint8_t S4bios_req; /* Value to write to SMI CMD to enter S4BIOS state */
|
|
|
|
uint8_t reserved2; /* Reserved - must be zero */
|
|
|
|
uint32_t pm1a_evt_blk; /* Port address of Power Mgt 1a acpi_event Reg Blk */
|
|
|
|
uint32_t pm1b_evt_blk; /* Port address of Power Mgt 1b acpi_event Reg Blk */
|
|
|
|
uint32_t pm1a_cnt_blk; /* Port address of Power Mgt 1a Control Reg Blk */
|
|
|
|
uint32_t pm1b_cnt_blk; /* Port address of Power Mgt 1b Control Reg Blk */
|
|
|
|
uint32_t pm2_cnt_blk; /* Port address of Power Mgt 2 Control Reg Blk */
|
|
|
|
uint32_t pm_tmr_blk; /* Port address of Power Mgt Timer Ctrl Reg Blk */
|
|
|
|
uint32_t gpe0_blk; /* Port addr of General Purpose acpi_event 0 Reg Blk */
|
|
|
|
uint32_t gpe1_blk; /* Port addr of General Purpose acpi_event 1 Reg Blk */
|
|
|
|
uint8_t pm1_evt_len; /* Byte length of ports at pm1_x_evt_blk */
|
|
|
|
uint8_t pm1_cnt_len; /* Byte length of ports at pm1_x_cnt_blk */
|
|
|
|
uint8_t pm2_cnt_len; /* Byte Length of ports at pm2_cnt_blk */
|
|
|
|
uint8_t pm_tmr_len; /* Byte Length of ports at pm_tm_blk */
|
|
|
|
uint8_t gpe0_blk_len; /* Byte Length of ports at gpe0_blk */
|
|
|
|
uint8_t gpe1_blk_len; /* Byte Length of ports at gpe1_blk */
|
|
|
|
uint8_t gpe1_base; /* Offset in gpe model where gpe1 events start */
|
|
|
|
uint8_t reserved3; /* Reserved */
|
|
|
|
uint16_t plvl2_lat; /* Worst case HW latency to enter/exit C2 state */
|
|
|
|
uint16_t plvl3_lat; /* Worst case HW latency to enter/exit C3 state */
|
|
|
|
uint16_t flush_size; /* Size of area read to flush caches */
|
|
|
|
uint16_t flush_stride; /* Stride used in flushing caches */
|
|
|
|
uint8_t duty_offset; /* Bit location of duty cycle field in p_cnt reg */
|
|
|
|
uint8_t duty_width; /* Bit width of duty cycle field in p_cnt reg */
|
|
|
|
uint8_t day_alrm; /* Index to day-of-month alarm in RTC CMOS RAM */
|
|
|
|
uint8_t mon_alrm; /* Index to month-of-year alarm in RTC CMOS RAM */
|
|
|
|
uint8_t century; /* Index to century in RTC CMOS RAM */
|
|
|
|
uint8_t reserved4; /* Reserved */
|
|
|
|
uint8_t reserved4a; /* Reserved */
|
|
|
|
uint8_t reserved4b; /* Reserved */
|
|
|
|
#if 0
|
|
|
|
uint32_t wb_invd : 1; /* The wbinvd instruction works properly */
|
|
|
|
uint32_t wb_invd_flush : 1; /* The wbinvd flushes but does not invalidate */
|
|
|
|
uint32_t proc_c1 : 1; /* All processors support C1 state */
|
|
|
|
uint32_t plvl2_up : 1; /* C2 state works on MP system */
|
|
|
|
uint32_t pwr_button : 1; /* Power button is handled as a generic feature */
|
|
|
|
uint32_t sleep_button : 1; /* Sleep button is handled as a generic feature, or not present */
|
|
|
|
uint32_t fixed_rTC : 1; /* RTC wakeup stat not in fixed register space */
|
|
|
|
uint32_t rtcs4 : 1; /* RTC wakeup stat not possible from S4 */
|
|
|
|
uint32_t tmr_val_ext : 1; /* The tmr_val width is 32 bits (0 = 24 bits) */
|
|
|
|
uint32_t reserved5 : 23; /* Reserved - must be zero */
|
|
|
|
#else
|
|
|
|
uint32_t flags;
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* MADT values and structures
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* Values for MADT PCATCompat */
|
|
|
|
|
|
|
|
#define DUAL_PIC 0
|
|
|
|
#define MULTIPLE_APIC 1
|
|
|
|
|
|
|
|
|
|
|
|
/* Master MADT */
|
|
|
|
|
|
|
|
struct multiple_apic_table
|
|
|
|
{
|
|
|
|
ACPI_TABLE_HEADER_DEF /* ACPI common table header */
|
|
|
|
uint32_t local_apic_address; /* Physical address of local APIC */
|
|
|
|
#if 0
|
|
|
|
uint32_t PCATcompat : 1; /* A one indicates system also has dual 8259s */
|
|
|
|
uint32_t reserved1 : 31;
|
|
|
|
#else
|
|
|
|
uint32_t flags;
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/* Values for Type in APIC_HEADER_DEF */
|
|
|
|
|
|
|
|
#define APIC_PROCESSOR 0
|
|
|
|
#define APIC_IO 1
|
|
|
|
#define APIC_XRUPT_OVERRIDE 2
|
|
|
|
#define APIC_NMI 3
|
|
|
|
#define APIC_LOCAL_NMI 4
|
|
|
|
#define APIC_ADDRESS_OVERRIDE 5
|
|
|
|
#define APIC_IO_SAPIC 6
|
|
|
|
#define APIC_LOCAL_SAPIC 7
|
|
|
|
#define APIC_XRUPT_SOURCE 8
|
|
|
|
#define APIC_RESERVED 9 /* 9 and greater are reserved */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* MADT sub-structures (Follow MULTIPLE_APIC_DESCRIPTION_TABLE)
|
|
|
|
*/
|
|
|
|
#define APIC_HEADER_DEF /* Common APIC sub-structure header */\
|
|
|
|
uint8_t type; \
|
|
|
|
uint8_t length;
|
|
|
|
|
|
|
|
/* Sub-structures for MADT */
|
|
|
|
|
|
|
|
struct madt_processor_apic
|
|
|
|
{
|
|
|
|
APIC_HEADER_DEF
|
|
|
|
uint8_t processor_id; /* ACPI processor id */
|
|
|
|
uint8_t local_apic_id; /* Processor's local APIC id */
|
|
|
|
#if 0
|
|
|
|
uint32_t processor_enabled: 1; /* Processor is usable if set */
|
|
|
|
uint32_t reserved2 : 31; /* Reserved, must be zero */
|
|
|
|
#else
|
|
|
|
uint32_t flags;
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
|
|
|
|
struct madt_io_apic
|
|
|
|
{
|
|
|
|
APIC_HEADER_DEF
|
|
|
|
uint8_t io_apic_id; /* I/O APIC ID */
|
|
|
|
uint8_t reserved; /* Reserved - must be zero */
|
|
|
|
uint32_t address; /* APIC physical address */
|
|
|
|
uint32_t interrupt; /* Global system interrupt where INTI
|
|
|
|
* lines start */
|
|
|
|
};
|
|
|
|
|
|
|
|
#include "acpi-dsdt.hex"
|
|
|
|
|
|
|
|
static inline uint16_t cpu_to_le16(uint16_t x)
|
|
|
|
{
|
|
|
|
return x;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint32_t cpu_to_le32(uint32_t x)
|
|
|
|
{
|
|
|
|
return x;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int acpi_checksum(const uint8_t *data, int len)
|
|
|
|
{
|
|
|
|
int sum, i;
|
|
|
|
sum = 0;
|
|
|
|
for(i = 0; i < len; i++)
|
|
|
|
sum += data[i];
|
|
|
|
return (-sum) & 0xff;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void acpi_build_table_header(struct acpi_table_header *h,
|
2007-08-31 01:05:22 +04:00
|
|
|
char *sig, int len, uint8_t rev)
|
2006-09-28 23:01:04 +04:00
|
|
|
{
|
|
|
|
memcpy(h->signature, sig, 4);
|
|
|
|
h->length = cpu_to_le32(len);
|
2007-08-31 01:05:22 +04:00
|
|
|
h->revision = rev;
|
2006-09-28 23:01:04 +04:00
|
|
|
#ifdef BX_QEMU
|
|
|
|
memcpy(h->oem_id, "QEMU ", 6);
|
|
|
|
memcpy(h->oem_table_id, "QEMU", 4);
|
|
|
|
#else
|
|
|
|
memcpy(h->oem_id, "BOCHS ", 6);
|
|
|
|
memcpy(h->oem_table_id, "BXPC", 4);
|
|
|
|
#endif
|
|
|
|
memcpy(h->oem_table_id + 4, sig, 4);
|
|
|
|
h->oem_revision = cpu_to_le32(1);
|
|
|
|
#ifdef BX_QEMU
|
|
|
|
memcpy(h->asl_compiler_id, "QEMU", 4);
|
|
|
|
#else
|
|
|
|
memcpy(h->asl_compiler_id, "BXPC", 4);
|
|
|
|
#endif
|
|
|
|
h->asl_compiler_revision = cpu_to_le32(1);
|
|
|
|
h->checksum = acpi_checksum((void *)h, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* base_addr must be a multiple of 4KB */
|
|
|
|
void acpi_bios_init(void)
|
|
|
|
{
|
|
|
|
struct rsdp_descriptor *rsdp;
|
|
|
|
struct rsdt_descriptor_rev1 *rsdt;
|
|
|
|
struct fadt_descriptor_rev1 *fadt;
|
|
|
|
struct facs_descriptor_rev1 *facs;
|
|
|
|
struct multiple_apic_table *madt;
|
|
|
|
uint8_t *dsdt;
|
|
|
|
uint32_t base_addr, rsdt_addr, fadt_addr, addr, facs_addr, dsdt_addr;
|
|
|
|
uint32_t acpi_tables_size, madt_addr, madt_size;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* reserve memory space for tables */
|
|
|
|
#ifdef BX_USE_EBDA_TABLES
|
|
|
|
ebda_cur_addr = align(ebda_cur_addr, 16);
|
|
|
|
rsdp = (void *)(ebda_cur_addr);
|
|
|
|
ebda_cur_addr += sizeof(*rsdp);
|
|
|
|
#else
|
|
|
|
bios_table_cur_addr = align(bios_table_cur_addr, 16);
|
|
|
|
rsdp = (void *)(bios_table_cur_addr);
|
|
|
|
bios_table_cur_addr += sizeof(*rsdp);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
addr = base_addr = ram_size - ACPI_DATA_SIZE;
|
|
|
|
rsdt_addr = addr;
|
|
|
|
rsdt = (void *)(addr);
|
|
|
|
addr += sizeof(*rsdt);
|
|
|
|
|
|
|
|
fadt_addr = addr;
|
|
|
|
fadt = (void *)(addr);
|
|
|
|
addr += sizeof(*fadt);
|
|
|
|
|
|
|
|
/* XXX: FACS should be in RAM */
|
|
|
|
addr = (addr + 63) & ~63; /* 64 byte alignment for FACS */
|
|
|
|
facs_addr = addr;
|
|
|
|
facs = (void *)(addr);
|
|
|
|
addr += sizeof(*facs);
|
|
|
|
|
|
|
|
dsdt_addr = addr;
|
|
|
|
dsdt = (void *)(addr);
|
|
|
|
addr += sizeof(AmlCode);
|
|
|
|
|
|
|
|
addr = (addr + 7) & ~7;
|
|
|
|
madt_addr = addr;
|
|
|
|
madt_size = sizeof(*madt) +
|
|
|
|
sizeof(struct madt_processor_apic) * smp_cpus +
|
|
|
|
sizeof(struct madt_io_apic);
|
|
|
|
madt = (void *)(addr);
|
|
|
|
addr += madt_size;
|
|
|
|
|
|
|
|
acpi_tables_size = addr - base_addr;
|
|
|
|
|
|
|
|
BX_INFO("ACPI tables: RSDP addr=0x%08lx ACPI DATA addr=0x%08lx size=0x%x\n",
|
|
|
|
(unsigned long)rsdp,
|
|
|
|
(unsigned long)rsdt, acpi_tables_size);
|
|
|
|
|
|
|
|
/* RSDP */
|
|
|
|
memset(rsdp, 0, sizeof(*rsdp));
|
|
|
|
memcpy(rsdp->signature, "RSD PTR ", 8);
|
|
|
|
#ifdef BX_QEMU
|
|
|
|
memcpy(rsdp->oem_id, "QEMU ", 6);
|
|
|
|
#else
|
|
|
|
memcpy(rsdp->oem_id, "BOCHS ", 6);
|
|
|
|
#endif
|
|
|
|
rsdp->rsdt_physical_address = cpu_to_le32(rsdt_addr);
|
|
|
|
rsdp->checksum = acpi_checksum((void *)rsdp, 20);
|
|
|
|
|
|
|
|
/* RSDT */
|
2007-08-19 11:51:31 +04:00
|
|
|
memset(rsdt, 0, sizeof(*rsdt));
|
2006-09-28 23:01:04 +04:00
|
|
|
rsdt->table_offset_entry[0] = cpu_to_le32(fadt_addr);
|
|
|
|
rsdt->table_offset_entry[1] = cpu_to_le32(madt_addr);
|
|
|
|
acpi_build_table_header((struct acpi_table_header *)rsdt,
|
2007-08-31 01:05:22 +04:00
|
|
|
"RSDT", sizeof(*rsdt), 1);
|
2006-09-28 23:01:04 +04:00
|
|
|
|
|
|
|
/* FADT */
|
|
|
|
memset(fadt, 0, sizeof(*fadt));
|
|
|
|
fadt->firmware_ctrl = cpu_to_le32(facs_addr);
|
|
|
|
fadt->dsdt = cpu_to_le32(dsdt_addr);
|
|
|
|
fadt->model = 1;
|
|
|
|
fadt->reserved1 = 0;
|
|
|
|
fadt->sci_int = cpu_to_le16(pm_sci_int);
|
|
|
|
fadt->smi_cmd = cpu_to_le32(SMI_CMD_IO_ADDR);
|
|
|
|
fadt->acpi_enable = 0xf1;
|
|
|
|
fadt->acpi_disable = 0xf0;
|
|
|
|
fadt->pm1a_evt_blk = cpu_to_le32(pm_io_base);
|
|
|
|
fadt->pm1a_cnt_blk = cpu_to_le32(pm_io_base + 0x04);
|
|
|
|
fadt->pm_tmr_blk = cpu_to_le32(pm_io_base + 0x08);
|
|
|
|
fadt->pm1_evt_len = 4;
|
|
|
|
fadt->pm1_cnt_len = 2;
|
|
|
|
fadt->pm_tmr_len = 4;
|
|
|
|
fadt->plvl2_lat = cpu_to_le16(50);
|
|
|
|
fadt->plvl3_lat = cpu_to_le16(50);
|
|
|
|
fadt->plvl3_lat = cpu_to_le16(50);
|
|
|
|
/* WBINVD + PROC_C1 + PWR_BUTTON + SLP_BUTTON + FIX_RTC */
|
|
|
|
fadt->flags = cpu_to_le32((1 << 0) | (1 << 2) | (1 << 4) | (1 << 5) | (1 << 6));
|
|
|
|
acpi_build_table_header((struct acpi_table_header *)fadt, "FACP",
|
2007-08-31 01:05:22 +04:00
|
|
|
sizeof(*fadt), 1);
|
2006-09-28 23:01:04 +04:00
|
|
|
|
|
|
|
/* FACS */
|
|
|
|
memset(facs, 0, sizeof(*facs));
|
|
|
|
memcpy(facs->signature, "FACS", 4);
|
|
|
|
facs->length = cpu_to_le32(sizeof(*facs));
|
|
|
|
|
|
|
|
/* DSDT */
|
|
|
|
memcpy(dsdt, AmlCode, sizeof(AmlCode));
|
|
|
|
|
|
|
|
/* MADT */
|
|
|
|
{
|
|
|
|
struct madt_processor_apic *apic;
|
|
|
|
struct madt_io_apic *io_apic;
|
|
|
|
|
|
|
|
memset(madt, 0, madt_size);
|
|
|
|
madt->local_apic_address = cpu_to_le32(0xfee00000);
|
|
|
|
madt->flags = cpu_to_le32(1);
|
|
|
|
apic = (void *)(madt + 1);
|
|
|
|
for(i=0;i<smp_cpus;i++) {
|
|
|
|
apic->type = APIC_PROCESSOR;
|
|
|
|
apic->length = sizeof(*apic);
|
|
|
|
apic->processor_id = i;
|
|
|
|
apic->local_apic_id = i;
|
|
|
|
apic->flags = cpu_to_le32(1);
|
|
|
|
apic++;
|
|
|
|
}
|
|
|
|
io_apic = (void *)apic;
|
|
|
|
io_apic->type = APIC_IO;
|
|
|
|
io_apic->length = sizeof(*io_apic);
|
|
|
|
io_apic->io_apic_id = smp_cpus;
|
|
|
|
io_apic->address = cpu_to_le32(0xfec00000);
|
|
|
|
io_apic->interrupt = cpu_to_le32(0);
|
|
|
|
|
|
|
|
acpi_build_table_header((struct acpi_table_header *)madt,
|
2007-08-31 01:05:22 +04:00
|
|
|
"APIC", madt_size, 1);
|
2006-09-28 23:01:04 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void rombios32_init(void)
|
|
|
|
{
|
|
|
|
BX_INFO("Starting rombios32\n");
|
|
|
|
|
|
|
|
ram_probe();
|
|
|
|
|
|
|
|
cpu_probe();
|
|
|
|
|
|
|
|
smp_probe();
|
|
|
|
|
|
|
|
pci_bios_init();
|
|
|
|
|
|
|
|
if (bios_table_cur_addr != 0) {
|
|
|
|
|
|
|
|
mptable_init();
|
|
|
|
|
|
|
|
if (acpi_enabled)
|
|
|
|
acpi_bios_init();
|
|
|
|
|
|
|
|
bios_lock_shadow_ram();
|
|
|
|
}
|
|
|
|
}
|