blob: 7c0954b5398cfe21d83c83ffd555807349a42eeb [file] [log] [blame]
// Coreboot interface support.
//
// Copyright (C) 2008,2009 Kevin O'Connor <kevin@koconnor.net>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "block.h" // MAXDESCSIZE
#include "byteorder.h" // be32_to_cpu
#include "config.h" // CONFIG_*
#include "e820map.h" // e820_add
#include "hw/pcidevice.h" // pci_probe_devices
#include "lzmadecode.h" // LzmaDecode
#include "malloc.h" // free
#include "output.h" // dprintf
#include "paravirt.h" // PlatformRunningOn
#include "romfile.h" // romfile_findprefix
#include "stacks.h" // yield
#include "string.h" // memset
#include "util.h" // coreboot_preinit
/****************************************************************
* 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_mainboard {
u32 tag;
u32 size;
u8 vendor_idx;
u8 part_idx;
char strings[0];
};
#define CB_TAG_MAINBOARD 0x0003
struct cb_forward {
u32 tag;
u32 size;
u64 forward;
};
#define CB_TAG_FORWARD 0x11
struct cb_cbmem_ref {
u32 tag;
u32 size;
u64 cbmem_addr;
};
#define CB_TAG_CBMEM_CONSOLE 0x17
struct cbmem_console {
u32 size;
u32 cursor;
u8 body[0];
} PACKED;
#define CBMC_CURSOR_MASK ((1 << 28) - 1)
#define CBMC_OVERFLOW (1 << 31)
static struct cbmem_console *cbcon = NULL;
static u16
ipchksum(char *buf, int count)
{
u16 *p = (u16*)buf;
u32 sum = 0;
while (count > 1) {
sum += GET_FARVAR(0, *p);
p++;
count -= 2;
}
if (count)
sum += GET_FARVAR(0, *(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(u32 addr, int len)
{
u32 end = addr + len;
for (; addr < end; addr += 16) {
struct cb_header *cbh = (void*)addr;
if (GET_FARVAR(0, cbh->signature) != CB_SIGNATURE)
continue;
u32 tsize = GET_FARVAR(0, cbh->table_bytes);
if (! tsize)
continue;
if (ipchksum((void*)addr, sizeof(*cbh)) != 0)
continue;
if (ipchksum((void*)addr + sizeof(*cbh), tsize)
!= GET_FARVAR(0, cbh->table_checksum))
continue;
return cbh;
}
return NULL;
}
// Try to find the coreboot memory table in the given coreboot table.
void *
find_cb_subtable(struct cb_header *cbh, u32 tag)
{
char *tbl = (char *)cbh + sizeof(*cbh);
u32 count = GET_FARVAR(0, cbh->table_entries);
int i;
for (i=0; i<count; i++) {
struct cb_memory *cbm = (void*)tbl;
tbl += GET_FARVAR(0, cbm->size);
if (GET_FARVAR(0, cbm->tag) == tag)
return cbm;
}
return NULL;
}
struct cb_header *
find_cb_table(void)
{
struct cb_header *cbh = find_cb_header(0, 0x1000);
if (!cbh)
return NULL;
struct cb_forward *cbf = find_cb_subtable(cbh, CB_TAG_FORWARD);
if (cbf) {
dprintf(3, "Found coreboot table forwarder.\n");
cbh = find_cb_header(GET_FARVAR(0, cbf->forward), 0x100);
if (!cbh)
return NULL;
}
return cbh;
}
static struct cb_memory *CBMemTable;
const char *CBvendor = "", *CBpart = "";
// Populate max ram and e820 map info by scanning for a coreboot table.
void
coreboot_preinit(void)
{
if (!CONFIG_COREBOOT)
return;
dprintf(3, "Attempting to find coreboot table\n");
// Find coreboot table.
struct cb_header *cbh = find_cb_table();
if (!cbh)
goto fail;
dprintf(3, "Now attempting to find coreboot memory map\n");
struct cb_memory *cbm = CBMemTable = find_cb_subtable(cbh, CB_TAG_MEMORY);
if (!cbm)
goto fail;
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;
e820_add(m->start, m->size, type);
}
// Ughh - coreboot likes to set a map at 0x0000-0x1000, but this
// confuses grub. So, override it.
e820_add(0, 16*1024, E820_RAM);
struct cb_cbmem_ref *cbref = find_cb_subtable(cbh, CB_TAG_CBMEM_CONSOLE);
if (cbref) {
cbcon = (void*)(u32)cbref->cbmem_addr;
debug_banner();
dprintf(1, "Found coreboot cbmem console @ %llx\n", cbref->cbmem_addr);
}
struct cb_mainboard *cbmb = find_cb_subtable(cbh, CB_TAG_MAINBOARD);
if (cbmb) {
CBvendor = &cbmb->strings[cbmb->vendor_idx];
CBpart = &cbmb->strings[cbmb->part_idx];
dprintf(1, "Found mainboard %s %s\n", CBvendor, CBpart);
}
return;
fail:
// No table found.. Use 16Megs as a dummy value.
dprintf(1, "Unable to find coreboot table!\n");
e820_add(0, 16*1024*1024, E820_RAM);
return;
}
void coreboot_debug_putc(char c)
{
if (!CONFIG_DEBUG_COREBOOT)
return;
if (!cbcon)
return;
u32 cursor = cbcon->cursor & CBMC_CURSOR_MASK;
u32 flags = cbcon->cursor & ~CBMC_CURSOR_MASK;
if (cursor >= cbcon->size)
return; // Old coreboot version with legacy overflow mechanism.
cbcon->body[cursor++] = c;
if (cursor >= cbcon->size) {
cursor = 0;
flags |= CBMC_OVERFLOW;
}
cbcon->cursor = flags | cursor;
}
/****************************************************************
* BIOS table copying
****************************************************************/
// 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_table(p);
}
void
coreboot_platform_setup(void)
{
if (!CONFIG_COREBOOT)
return;
pci_probe_devices();
struct cb_memory *cbm = CBMemTable;
if (!cbm)
return;
dprintf(3, "Relocating coreboot bios tables\n");
// Scan CB_MEM_TABLE areas for bios tables.
int i, count = MEM_RANGE_COUNT(cbm);
for (i=0; i<count; i++) {
struct cb_memory_range *m = &cbm->map[i];
if (m->type == CB_MEM_TABLE)
scan_tables(m->start, m->size);
}
find_acpi_features();
}
/****************************************************************
* ulzma
****************************************************************/
// Uncompress data in flash to an area of memory.
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, (unsigned int)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
****************************************************************/
#define CBFS_HEADER_MAGIC 0x4F524243
#define CBFS_VERSION1 0x31313131
struct cbfs_header {
u32 magic;
u32 version;
u32 romsize;
u32 bootblocksize;
u32 align;
u32 offset;
u32 pad[2];
} PACKED;
#define CBFS_FILE_MAGIC 0x455649484352414cLL // LARCHIVE
struct cbfs_file {
u64 magic;
u32 len;
u32 type;
u32 checksum;
u32 offset;
char filename[0];
} PACKED;
struct cbfs_romfile_s {
struct romfile_s file;
struct cbfs_file *fhdr;
void *data;
u32 rawsize, flags;
};
// Copy a file to memory (uncompressing if necessary)
static int
cbfs_copyfile(struct romfile_s *file, void *dst, u32 maxlen)
{
if (!CONFIG_COREBOOT_FLASH)
return -1;
struct cbfs_romfile_s *cfile;
cfile = container_of(file, struct cbfs_romfile_s, file);
u32 size = cfile->rawsize;
void *src = cfile->data;
if (cfile->flags) {
// Compressed - copy to temp ram and uncompress it.
void *temp = malloc_tmphigh(size);
if (!temp) {
warn_noalloc();
return -1;
}
iomemcpy(temp, src, size);
int ret = ulzma(dst, maxlen, temp, size);
yield();
free(temp);
return ret;
}
// Not compressed.
dprintf(3, "Copying data %d@%p to %d@%p\n", size, src, maxlen, dst);
if (size > maxlen) {
warn_noalloc();
return -1;
}
iomemcpy(dst, src, size);
return size;
}
// Process CBFS links file. The links file is a newline separated
// file where each line has a "link name" and a "destination name"
// separated by a space character.
static void
process_links_file(void)
{
char *links = romfile_loadfile("links", NULL), *next = links;
while (next) {
// Parse out linkname and destname
char *linkname = next;
next = strchr(linkname, '\n');
if (next)
*next++ = '\0';
char *comment = strchr(linkname, '#');
if (comment)
*comment = '\0';
linkname = nullTrailingSpace(linkname);
char *destname = strchr(linkname, ' ');
if (!destname)
continue;
*destname++ = '\0';
destname = nullTrailingSpace(destname);
// Lookup destname and create new romfile entry for linkname
struct romfile_s *ufile = romfile_find(destname);
if (!ufile)
continue;
struct cbfs_romfile_s *cufile
= container_of(ufile, struct cbfs_romfile_s, file);
struct cbfs_romfile_s *cfile = malloc_tmp(sizeof(*cfile));
if (!cfile) {
warn_noalloc();
break;
}
memcpy(cfile, cufile, sizeof(*cfile));
strtcpy(cfile->file.name, linkname, sizeof(cfile->file.name));
romfile_add(&cfile->file);
}
free(links);
}
void
coreboot_cbfs_init(void)
{
if (!CONFIG_COREBOOT_FLASH)
return;
struct cbfs_header *hdr = *(void **)(CONFIG_CBFS_LOCATION - 4);
if ((u32)hdr & 0x03) {
dprintf(1, "Invalid CBFS pointer %p\n", hdr);
return;
}
if (CONFIG_CBFS_LOCATION && (u32)hdr > CONFIG_CBFS_LOCATION)
// Looks like the pointer is relative to CONFIG_CBFS_LOCATION
hdr = (void*)hdr + CONFIG_CBFS_LOCATION;
if (hdr->magic != cpu_to_be32(CBFS_HEADER_MAGIC)) {
dprintf(1, "Unable to find CBFS (ptr=%p; got %x not %x)\n"
, hdr, hdr->magic, cpu_to_be32(CBFS_HEADER_MAGIC));
return;
}
dprintf(1, "Found CBFS header at %p\n", hdr);
u32 romsize = be32_to_cpu(hdr->romsize);
u32 romstart = CONFIG_CBFS_LOCATION - romsize;
struct cbfs_file *fhdr = (void*)romstart + be32_to_cpu(hdr->offset);
for (;;) {
if ((u32)fhdr - romstart > romsize)
break;
u64 magic = fhdr->magic;
if (magic != CBFS_FILE_MAGIC)
break;
struct cbfs_romfile_s *cfile = malloc_tmp(sizeof(*cfile));
if (!cfile) {
warn_noalloc();
break;
}
memset(cfile, 0, sizeof(*cfile));
strtcpy(cfile->file.name, fhdr->filename, sizeof(cfile->file.name));
cfile->file.size = cfile->rawsize = be32_to_cpu(fhdr->len);
cfile->fhdr = fhdr;
cfile->file.copy = cbfs_copyfile;
cfile->data = (void*)fhdr + be32_to_cpu(fhdr->offset);
int len = strlen(cfile->file.name);
if (len > 5 && strcmp(&cfile->file.name[len-5], ".lzma") == 0) {
// Using compression.
cfile->flags = 1;
cfile->file.name[len-5] = '\0';
cfile->file.size = *(u32*)(cfile->data + LZMA_PROPERTIES_SIZE);
}
romfile_add(&cfile->file);
fhdr = (void*)ALIGN((u32)cfile->data + cfile->rawsize
, be32_to_cpu(hdr->align));
}
process_links_file();
}
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(struct cbfs_file *fhdr)
{
if (!CONFIG_COREBOOT_FLASH || !fhdr)
return;
dprintf(1, "Run %s\n", fhdr->filename);
struct cbfs_payload *pay = (void*)fhdr + be32_to_cpu(fhdr->offset);
struct cbfs_payload_segment *seg = pay->segments;
for (;;) {
void *src = (void*)pay + be32_to_cpu(seg->offset);
void *dest = (void*)(u32)be64_to_cpu(seg->load_addr);
u32 src_len = be32_to_cpu(seg->len);
u32 dest_len = be32_to_cpu(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)(void) = dest;
func();
return;
}
default:
dprintf(3, "Segment %x %d@%p -> %d@%p\n"
, seg->type, src_len, src, dest_len, dest);
if (seg->compression == cpu_to_be32(CBFS_COMPRESS_NONE)) {
if (src_len > dest_len)
src_len = dest_len;
memcpy(dest, src, src_len);
} else if (CONFIG_LZMA
&& seg->compression == cpu_to_be32(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++;
}
}
// Register payloads in "img/" directory with boot system.
void
cbfs_payload_setup(void)
{
if (!CONFIG_COREBOOT_FLASH)
return;
struct romfile_s *file = NULL;
for (;;) {
file = romfile_findprefix("img/", file);
if (!file)
break;
struct cbfs_romfile_s *cfile;
cfile = container_of(file, struct cbfs_romfile_s, file);
const char *filename = file->name;
char *desc = znprintf(MAXDESCSIZE, "Payload [%s]", &filename[4]);
boot_add_cbfs(cfile->fhdr, desc, bootprio_find_named_rom(filename, 0));
}
}