blob: 859928f93693f5e5dc335298f3412904ea54077d [file] [log] [blame]
// Coreboot interface support.
//
// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "memmap.h" // add_e820
#include "util.h" // dprintf
#include "pci.h" // struct pir_header
#include "acpi.h" // struct rsdp_descriptor
#include "mptable.h" // MPTABLE_SIGNATURE
#include "biosvar.h" // GET_EBDA
#include "lzmadecode.h" // LzmaDecode
/****************************************************************
* BIOS table copying
****************************************************************/
static void
copy_pir(void *pos)
{
struct pir_header *p = pos;
if (p->signature != PIR_SIGNATURE)
return;
if (PirOffset)
return;
if (p->size < sizeof(*p))
return;
if (checksum(pos, p->size) != 0)
return;
bios_table_cur_addr = ALIGN(bios_table_cur_addr, 16);
if (bios_table_cur_addr + p->size > bios_table_end_addr) {
dprintf(1, "No room to copy PIR table!\n");
return;
}
dprintf(1, "Copying PIR from %p to %x\n", pos, bios_table_cur_addr);
memcpy((void*)bios_table_cur_addr, pos, p->size);
PirOffset = bios_table_cur_addr - BUILD_BIOS_ADDR;
bios_table_cur_addr += p->size;
}
static void
copy_mptable(void *pos)
{
struct mptable_floating_s *p = pos;
if (p->signature != MPTABLE_SIGNATURE)
return;
if (!p->physaddr)
return;
if (checksum(pos, sizeof(*p)) != 0)
return;
u32 length = p->length * 16;
bios_table_cur_addr = ALIGN(bios_table_cur_addr, 16);
u16 mpclength = ((struct mptable_config_s *)p->physaddr)->length;
if (bios_table_cur_addr + length + mpclength > bios_table_end_addr) {
dprintf(1, "No room to copy MPTABLE!\n");
return;
}
dprintf(1, "Copying MPTABLE from %p/%x to %x\n"
, pos, p->physaddr, bios_table_cur_addr);
memcpy((void*)bios_table_cur_addr, pos, length);
struct mptable_floating_s *newp = (void*)bios_table_cur_addr;
newp->physaddr = bios_table_cur_addr + length;
newp->checksum = 0;
newp->checksum = -checksum(newp, sizeof(*newp));
memcpy((void*)bios_table_cur_addr + length, (void*)p->physaddr, mpclength);
bios_table_cur_addr += length + mpclength;
}
static void
copy_acpi_rsdp(void *pos)
{
if (RsdpAddr)
return;
struct rsdp_descriptor *p = pos;
if (p->signature != RSDP_SIGNATURE)
return;
u32 length = 20;
if (checksum(pos, length) != 0)
return;
if (p->revision > 1) {
length = p->length;
if (checksum(pos, length) != 0)
return;
}
bios_table_cur_addr = ALIGN(bios_table_cur_addr, 16);
if (bios_table_cur_addr + length > bios_table_end_addr) {
dprintf(1, "No room to copy ACPI RSDP table!\n");
return;
}
dprintf(1, "Copying ACPI RSDP from %p to %x\n", pos, bios_table_cur_addr);
RsdpAddr = (void*)bios_table_cur_addr;
memcpy(RsdpAddr, pos, length);
bios_table_cur_addr += length;
}
// Attempt to find (and relocate) any standard bios tables found in a
// given address range.
static void
scan_tables(u32 start, u32 size)
{
void *p = (void*)ALIGN(start, 16);
void *end = (void*)start + size;
for (; p<end; p += 16) {
copy_pir(p);
copy_mptable(p);
copy_acpi_rsdp(p);
}
}
/****************************************************************
* Memory map
****************************************************************/
struct cb_header {
u32 signature;
u32 header_bytes;
u32 header_checksum;
u32 table_bytes;
u32 table_checksum;
u32 table_entries;
};
#define CB_SIGNATURE 0x4f49424C // "LBIO"
struct cb_memory_range {
u64 start;
u64 size;
u32 type;
};
#define CB_MEM_TABLE 16
struct cb_memory {
u32 tag;
u32 size;
struct cb_memory_range map[0];
};
#define CB_TAG_MEMORY 0x01
#define MEM_RANGE_COUNT(_rec) \
(((_rec)->size - sizeof(*(_rec))) / sizeof((_rec)->map[0]))
struct cb_forward {
u32 tag;
u32 size;
u64 forward;
};
#define CB_TAG_FORWARD 0x11
static u16
ipchksum(char *buf, int count)
{
u16 *p = (u16*)buf;
u32 sum = 0;
while (count > 1) {
sum += *p++;
count -= 2;
}
if (count)
sum += *(u8*)p;
sum = (sum >> 16) + (sum & 0xffff);
sum += (sum >> 16);
return ~sum;
}
// Try to locate the coreboot header in a given address range.
static struct cb_header *
find_cb_header(char *addr, int len)
{
char *end = addr + len;
for (; addr < end; addr += 16) {
struct cb_header *cbh = (struct cb_header *)addr;
if (cbh->signature != CB_SIGNATURE)
continue;
if (! cbh->table_bytes)
continue;
if (ipchksum(addr, sizeof(*cbh)) != 0)
continue;
if (ipchksum(addr + sizeof(*cbh), cbh->table_bytes)
!= cbh->table_checksum)
continue;
return cbh;
}
return NULL;
}
// Try to find the coreboot memory table in the given coreboot table.
static void *
find_cb_subtable(struct cb_header *cbh, u32 tag)
{
char *tbl = (char *)cbh + sizeof(*cbh);
int i;
for (i=0; i<cbh->table_entries; i++) {
struct cb_memory *cbm = (struct cb_memory *)tbl;
tbl += cbm->size;
if (cbm->tag == tag)
return cbm;
}
return NULL;
}
// Populate max ram and e820 map info by scanning for a coreboot table.
static void
coreboot_fill_map()
{
dprintf(3, "Attempting to find coreboot table\n");
// Init variables set in coreboot table memory scan.
PirOffset = 0;
RsdpAddr = 0;
// Find coreboot table.
struct cb_header *cbh = find_cb_header(0, 0x1000);
if (!cbh)
goto fail;
struct cb_forward *cbf = find_cb_subtable(cbh, CB_TAG_FORWARD);
if (cbf) {
dprintf(3, "Found coreboot table forwarder.\n");
cbh = find_cb_header((char *)((u32)cbf->forward), 0x100);
if (!cbh)
goto fail;
}
dprintf(3, "Now attempting to find coreboot memory map\n");
struct cb_memory *cbm = find_cb_subtable(cbh, CB_TAG_MEMORY);
if (!cbm)
goto fail;
u64 maxram = 0, maxram_over4G = 0;
int i, count = MEM_RANGE_COUNT(cbm);
for (i=0; i<count; i++) {
struct cb_memory_range *m = &cbm->map[i];
u32 type = m->type;
if (type == CB_MEM_TABLE) {
type = E820_RESERVED;
scan_tables(m->start, m->size);
} else if (type == E820_ACPI || type == E820_RAM) {
u64 end = m->start + m->size;
if (end > 0x100000000ull) {
end -= 0x100000000ull;
if (end > maxram_over4G)
maxram_over4G = end;
} else if (end > maxram)
maxram = end;
}
add_e820(m->start, m->size, type);
}
RamSize = maxram;
RamSizeOver4G = maxram_over4G;
// Ughh - coreboot likes to set a map at 0x0000-0x1000, but this
// confuses grub. So, override it.
add_e820(0, 16*1024, E820_RAM);
// XXX - just create dummy smbios table for now - should detect if
// smbios/dmi table is found from coreboot and use that instead.
smbios_init();
return;
fail:
// No table found.. Use 16Megs as a dummy value.
dprintf(1, "Unable to find coreboot table!\n");
RamSize = 16*1024*1024;
RamSizeOver4G = 0;
add_e820(0, 16*1024*1024, E820_RAM);
return;
}
/****************************************************************
* ulzma
****************************************************************/
static int
ulzma(u8 *dst, u32 maxlen, const u8 *src, u32 srclen)
{
dprintf(3, "Uncompressing data %d@%p to %d@%p\n", srclen, src, maxlen, dst);
CLzmaDecoderState state;
int ret = LzmaDecodeProperties(&state.Properties, src, LZMA_PROPERTIES_SIZE);
if (ret != LZMA_RESULT_OK) {
dprintf(1, "LzmaDecodeProperties error - %d\n", ret);
return -1;
}
u8 scratch[15980];
int need = (LzmaGetNumProbs(&state.Properties) * sizeof(CProb));
if (need > sizeof(scratch)) {
dprintf(1, "LzmaDecode need %d have %d\n", need, sizeof(scratch));
return -1;
}
state.Probs = (CProb *)scratch;
u32 dstlen = *(u32*)(src + LZMA_PROPERTIES_SIZE);
if (dstlen > maxlen) {
dprintf(1, "LzmaDecode too large (max %d need %d)\n", maxlen, dstlen);
return -1;
}
u32 inProcessed, outProcessed;
ret = LzmaDecode(&state, src + LZMA_PROPERTIES_SIZE + 8, srclen
, &inProcessed, dst, dstlen, &outProcessed);
if (ret) {
dprintf(1, "LzmaDecode returned %d\n", ret);
return -1;
}
return dstlen;
}
/****************************************************************
* Coreboot flash format
****************************************************************/
// XXX - optimize
#define ntohl(x) ((((x)&0xff)<<24) | (((x)&0xff00)<<8) | \
(((x)&0xff0000) >> 8) | (((x)&0xff000000) >> 24))
#define htonl(x) ntohl(x)
#define CBFS_HEADER_MAGIC 0x4F524243
#define CBFS_HEADPTR_ADDR 0xFFFFFFFc
#define CBFS_VERSION1 0x31313131
struct cbfs_header {
u32 magic;
u32 version;
u32 romsize;
u32 bootblocksize;
u32 align;
u32 offset;
u32 pad[2];
} PACKED;
static struct cbfs_header *CBHDR;
static void
cbfs_setup()
{
if (! CONFIG_COREBOOT_FLASH)
return;
CBHDR = *(void **)CBFS_HEADPTR_ADDR;
if (CBHDR->magic != htonl(CBFS_HEADER_MAGIC)) {
dprintf(1, "Unable to find CBFS (got %x not %x)\n"
, CBHDR->magic, htonl(CBFS_HEADER_MAGIC));
CBHDR = NULL;
return;
}
dprintf(1, "Found CBFS header at %p\n", CBHDR);
}
#define CBFS_FILE_MAGIC 0x455649484352414cLL // LARCHIVE
struct cbfs_file {
u64 magic;
u32 len;
u32 type;
u32 checksum;
u32 offset;
char filename[0];
} PACKED;
static struct cbfs_file *
cbfs_search(struct cbfs_file *file)
{
for (;;) {
if (file < (struct cbfs_file *)(0xFFFFFFFF - ntohl(CBHDR->romsize)))
return NULL;
u64 magic = file->magic;
if (magic == CBFS_FILE_MAGIC) {
dprintf(5, "Found CBFS file %s\n", file->filename);
return file;
}
if (magic == 0)
return NULL;
file = (void*)file + ntohl(CBHDR->align);
}
}
static struct cbfs_file *
cbfs_getfirst()
{
if (! CBHDR)
return NULL;
return cbfs_search((void *)(0 - ntohl(CBHDR->romsize) + ntohl(CBHDR->offset)));
}
static struct cbfs_file *
cbfs_getnext(struct cbfs_file *file)
{
file = (void*)file + ALIGN(ntohl(file->len) + ntohl(file->offset), ntohl(CBHDR->align));
return cbfs_search(file);
}
static struct cbfs_file *
cbfs_findfile(const char *fname)
{
dprintf(3, "Searching CBFS for %s\n", fname);
struct cbfs_file *file;
for (file = cbfs_getfirst(); file; file = cbfs_getnext(file)) {
if (strcmp(fname, file->filename) == 0)
return file;
}
return NULL;
}
static int
data_copy(u8 *dst, u32 maxlen, const u8 *src, u32 srclen)
{
dprintf(3, "Copying data %d@%p to %d@%p\n", srclen, src, maxlen, dst);
if (srclen > maxlen) {
dprintf(1, "File too big to copy\n");
return -1;
}
memcpy(dst, src, srclen);
return srclen;
}
// Copy a file to memory (uncompressing if necessary)
static int
cbfs_copyfile(void *dst, u32 maxlen, const char *fname)
{
dprintf(3, "Searching CBFS for data file %s\n", fname);
int fnlen = strlen(fname);
struct cbfs_file *file;
for (file = cbfs_getfirst(); file; file = cbfs_getnext(file)) {
if (memcmp(fname, file->filename, fnlen) != 0)
continue;
u32 size = ntohl(file->len);
void *src = (void*)file + ntohl(file->offset);
if (file->filename[fnlen] == '\0')
return data_copy(dst, maxlen, src, size);
if (strcmp(&file->filename[fnlen], ".lzma") == 0)
return ulzma(dst, maxlen, src, size);
}
return -1;
}
const char *
cbfs_findNprefix(const char *prefix, int n)
{
if (! CONFIG_COREBOOT_FLASH)
return NULL;
dprintf(3, "Searching CBFS for prefix %s\n", prefix);
int len = strlen(prefix);
struct cbfs_file *file;
for (file = cbfs_getfirst(); file; file = cbfs_getnext(file)) {
if (memcmp(prefix, file->filename, len) == 0) {
if (n <= 0)
return file->filename;
n--;
}
}
return NULL;
}
static char
getHex(u8 x)
{
if (x <= 9)
return '0' + x;
return 'a' + x - 10;
}
static u32
hexify4(u16 x)
{
return ((getHex(x&0xf) << 24)
| (getHex((x>>4)&0xf) << 16)
| (getHex((x>>8)&0xf) << 8)
| (getHex(x>>12)));
}
int
cbfs_copy_optionrom(void *dst, u32 maxlen, u32 vendev)
{
if (! CONFIG_COREBOOT_FLASH)
return -1;
char fname[17];
// Ughh - poor man's sprintf of "pci%04x,%04x.rom"
*(u32*)fname = 0x20696370; // "pci "
*(u32*)&fname[3] = hexify4(vendev);
fname[7] = ',';
*(u32*)&fname[8] = hexify4(vendev >> 16);
*(u32*)&fname[12] = 0x6d6f722e; // ".rom"
fname[16] = '\0';
return cbfs_copyfile(dst, maxlen, fname);
}
// Copy the next file with the given prefix - starting at pos 'last'.
struct cbfs_file *
cbfs_copyfile_prefix(void *dst, u32 maxlen, const char *prefix
, struct cbfs_file *last)
{
if (! CONFIG_COREBOOT_FLASH)
return NULL;
dprintf(3, "Searching CBFS for data file prefix %s\n", prefix);
struct cbfs_file *file;
if (! last)
file = cbfs_getfirst();
else
file = cbfs_getnext(last);
int prefixlen = strlen(prefix);
for (; file; file = cbfs_getnext(file)) {
if (memcmp(prefix, file->filename, prefixlen) != 0)
continue;
u32 size = ntohl(file->len);
void *src = (void*)file + ntohl(file->offset);
int fnamelen = strlen(file->filename);
int rv;
if (fnamelen > 5 && strcmp(&file->filename[fnamelen-5], ".lzma") == 0)
rv = ulzma(dst, maxlen, src, size);
else
rv = data_copy(dst, maxlen, src, size);
if (rv >= 0)
return file;
}
return NULL;
}
struct cbfs_payload_segment {
u32 type;
u32 compression;
u32 offset;
u64 load_addr;
u32 len;
u32 mem_len;
} PACKED;
#define PAYLOAD_SEGMENT_BSS 0x20535342
#define PAYLOAD_SEGMENT_ENTRY 0x52544E45
#define CBFS_COMPRESS_NONE 0
#define CBFS_COMPRESS_LZMA 1
struct cbfs_payload {
struct cbfs_payload_segment segments[1];
};
void
cbfs_run_payload(const char *filename)
{
if (! CONFIG_COREBOOT_FLASH)
return;
dprintf(1, "Run %s\n", filename);
struct cbfs_file *file = cbfs_findfile(filename);
if (!file)
return;
struct cbfs_payload *pay = (void*)file + ntohl(file->offset);
struct cbfs_payload_segment *seg = pay->segments;
for (;;) {
void *src = (void*)pay + ntohl(seg->offset);
void *dest = (void*)ntohl((u32)seg->load_addr);
u32 src_len = ntohl(seg->len);
u32 dest_len = ntohl(seg->mem_len);
switch (seg->type) {
case PAYLOAD_SEGMENT_BSS:
dprintf(3, "BSS segment %d@%p\n", dest_len, dest);
memset(dest, 0, dest_len);
break;
case PAYLOAD_SEGMENT_ENTRY: {
dprintf(1, "Calling addr %p\n", dest);
void (*func)() = dest;
func();
return;
}
default:
dprintf(3, "Segment %x %d@%p -> %d@%p\n"
, seg->type, src_len, src, dest_len, dest);
if (seg->compression == htonl(CBFS_COMPRESS_NONE)) {
if (src_len > dest_len)
src_len = dest_len;
memcpy(dest, src, src_len);
} else if (CONFIG_LZMA
&& seg->compression == htonl(CBFS_COMPRESS_LZMA)) {
int ret = ulzma(dest, dest_len, src, src_len);
if (ret < 0)
return;
src_len = ret;
} else {
dprintf(1, "No support for compression type %x\n"
, seg->compression);
return;
}
if (dest_len > src_len)
memset(dest + src_len, 0, dest_len - src_len);
break;
}
seg++;
}
}
void
coreboot_setup(void)
{
coreboot_fill_map();
cbfs_setup();
}