294 lines
6.7 KiB
C
294 lines
6.7 KiB
C
/*
|
|
* This file is part of the coreboot project.
|
|
*
|
|
* Copyright (C) 2009 coresystems GmbH
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* This program 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA, 02110-1301 USA
|
|
*/
|
|
|
|
#include <types.h>
|
|
#include <string.h>
|
|
#include <bootmem.h>
|
|
#include <bootstate.h>
|
|
#include <cbmem.h>
|
|
#include <console/console.h>
|
|
#include <console/cbmem_console.h>
|
|
#include <arch/early_variables.h>
|
|
#if CONFIG_HAVE_ACPI_RESUME && !defined(__PRE_RAM__)
|
|
#include <arch/acpi.h>
|
|
#endif
|
|
|
|
// The CBMEM TOC reserves 512 bytes to keep
|
|
// the other entries somewhat aligned.
|
|
// Increase if MAX_CBMEM_ENTRIES exceeds 21
|
|
#define CBMEM_TOC_RESERVED 512
|
|
#define MAX_CBMEM_ENTRIES 16
|
|
#define CBMEM_MAGIC 0x434f5245
|
|
|
|
struct cbmem_entry {
|
|
u32 magic;
|
|
u32 id;
|
|
u64 base;
|
|
u64 size;
|
|
} __attribute__((packed));
|
|
|
|
#ifndef __PRE_RAM__
|
|
static uint64_t cbmem_base = 0;
|
|
static uint64_t cbmem_size = 0;
|
|
#endif
|
|
|
|
static void cbmem_trace_location(uint64_t base, uint64_t size, const char *s)
|
|
{
|
|
if (base && size && s) {
|
|
printk(BIOS_DEBUG, "CBMEM region %llx-%llx (%s)\n",
|
|
base, base + size - 1, s);
|
|
}
|
|
}
|
|
|
|
static void cbmem_locate_table(uint64_t *base, uint64_t *size)
|
|
{
|
|
#ifdef __PRE_RAM__
|
|
get_cbmem_table(base, size);
|
|
#else
|
|
if (!(cbmem_base && cbmem_size)) {
|
|
get_cbmem_table(&cbmem_base, &cbmem_size);
|
|
cbmem_trace_location(cbmem_base, cbmem_size, __FUNCTION__);
|
|
}
|
|
*base = cbmem_base;
|
|
*size = cbmem_size;
|
|
#endif
|
|
}
|
|
|
|
struct cbmem_entry *get_cbmem_toc(void)
|
|
{
|
|
uint64_t base, size;
|
|
cbmem_locate_table(&base, &size);
|
|
return (struct cbmem_entry *)(unsigned long)base;
|
|
}
|
|
|
|
#if !defined(__PRE_RAM__)
|
|
void cbmem_late_set_table(uint64_t base, uint64_t size)
|
|
{
|
|
cbmem_trace_location(base, size, __FUNCTION__);
|
|
cbmem_base = base;
|
|
cbmem_size = size;
|
|
}
|
|
#endif
|
|
|
|
/**
|
|
* cbmem is a simple mechanism to do some kind of book keeping of the coreboot
|
|
* high tables memory. This is a small amount of memory which is "stolen" from
|
|
* the system memory for coreboot purposes. Usually this memory is used for
|
|
* - the coreboot table
|
|
* - legacy tables (PIRQ, MP table)
|
|
* - ACPI tables
|
|
* - suspend/resume backup memory
|
|
*/
|
|
|
|
static void cbmem_initialize_empty(void)
|
|
{
|
|
uint64_t baseaddr, size;
|
|
struct cbmem_entry *cbmem_toc;
|
|
|
|
cbmem_locate_table(&baseaddr, &size);
|
|
cbmem_trace_location(baseaddr, size, __FUNCTION__);
|
|
|
|
if (!(baseaddr && size)) {
|
|
printk(BIOS_CRIT, "Unable to set location for CBMEM.\n");
|
|
return;
|
|
}
|
|
|
|
cbmem_toc = (struct cbmem_entry *)(unsigned long)baseaddr;
|
|
memset(cbmem_toc, 0, CBMEM_TOC_RESERVED);
|
|
|
|
cbmem_toc[0] = (struct cbmem_entry) {
|
|
.magic = CBMEM_MAGIC,
|
|
.id = CBMEM_ID_FREESPACE,
|
|
.base = baseaddr + CBMEM_TOC_RESERVED,
|
|
.size = size - CBMEM_TOC_RESERVED
|
|
};
|
|
}
|
|
|
|
static int cbmem_check_toc(void)
|
|
{
|
|
uint64_t baseaddr, size;
|
|
struct cbmem_entry *cbmem_toc;
|
|
|
|
cbmem_locate_table(&baseaddr, &size);
|
|
cbmem_trace_location(baseaddr, size, __FUNCTION__);
|
|
|
|
cbmem_toc = (struct cbmem_entry *)(unsigned long)baseaddr;
|
|
|
|
return (cbmem_toc[0].magic == CBMEM_MAGIC);
|
|
}
|
|
|
|
void *cbmem_add(u32 id, u64 size)
|
|
{
|
|
struct cbmem_entry *cbmem_toc;
|
|
int i;
|
|
void *p;
|
|
|
|
/*
|
|
* This could be a restart, check if the section is there already. It
|
|
* is remotely possible that the dram contents persisted over the
|
|
* bootloader upgrade AND the same section now needs more room, but
|
|
* this is quite a remote possibility and it is ignored here.
|
|
*/
|
|
p = cbmem_find(id);
|
|
if (p) {
|
|
printk(BIOS_NOTICE,
|
|
"CBMEM section %x: using existing location at %p.\n",
|
|
id, p);
|
|
return p;
|
|
}
|
|
|
|
cbmem_toc = get_cbmem_toc();
|
|
|
|
if (cbmem_toc == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
if (cbmem_toc[0].magic != CBMEM_MAGIC) {
|
|
printk(BIOS_ERR, "ERROR: CBMEM was not initialized yet.\n");
|
|
return NULL;
|
|
}
|
|
|
|
/* Will the entry fit at all? */
|
|
if (size > cbmem_toc[0].size) {
|
|
printk(BIOS_ERR, "ERROR: Not enough memory for table %x\n", id);
|
|
return NULL;
|
|
}
|
|
|
|
/* Align size to 512 byte blocks */
|
|
|
|
size = ALIGN(size, 512) < cbmem_toc[0].size ?
|
|
ALIGN(size, 512) : cbmem_toc[0].size;
|
|
|
|
/* Now look for the first free/usable TOC entry */
|
|
for (i = 0; i < MAX_CBMEM_ENTRIES; i++) {
|
|
if (cbmem_toc[i].id == CBMEM_ID_NONE)
|
|
break;
|
|
}
|
|
|
|
if (i >= MAX_CBMEM_ENTRIES) {
|
|
printk(BIOS_ERR, "ERROR: No more CBMEM entries available.\n");
|
|
return NULL;
|
|
}
|
|
|
|
printk(BIOS_DEBUG, "Adding CBMEM entry as no. %d\n", i);
|
|
|
|
cbmem_toc[i] = (struct cbmem_entry) {
|
|
.magic = CBMEM_MAGIC,
|
|
.id = id,
|
|
.base = cbmem_toc[0].base,
|
|
.size = size
|
|
};
|
|
|
|
cbmem_toc[0].base += size;
|
|
cbmem_toc[0].size -= size;
|
|
|
|
return (void *)(uintptr_t)cbmem_toc[i].base;
|
|
}
|
|
|
|
void *cbmem_find(u32 id)
|
|
{
|
|
struct cbmem_entry *cbmem_toc;
|
|
int i;
|
|
cbmem_toc = get_cbmem_toc();
|
|
|
|
if (cbmem_toc == NULL)
|
|
return NULL;
|
|
|
|
for (i = 0; i < MAX_CBMEM_ENTRIES; i++) {
|
|
if (cbmem_toc[i].id == id)
|
|
return (void *)(unsigned long)cbmem_toc[i].base;
|
|
}
|
|
|
|
return (void *)NULL;
|
|
}
|
|
|
|
/* Returns True if it was not initialized before. */
|
|
int cbmem_recovery(int is_wakeup)
|
|
{
|
|
int found = cbmem_check_toc();
|
|
int wipe = 0;
|
|
|
|
/* CBMEM TOC is wiped clean when we are not waking up from S3
|
|
* suspend. Boards with EARLY_CBMEM_INIT do this in romstage,
|
|
* boards without EARLY_CBMEM_INIT do this in ramstage.
|
|
*/
|
|
#if defined(__PRE_RAM__) && CONFIG_EARLY_CBMEM_INIT
|
|
wipe = 1;
|
|
#endif
|
|
#if !defined(__PRE_RAM__) && !CONFIG_EARLY_CBMEM_INIT
|
|
wipe = 1;
|
|
#endif
|
|
|
|
if (!is_wakeup && wipe)
|
|
cbmem_initialize_empty();
|
|
|
|
if (is_wakeup && !found) {
|
|
cbmem_initialize_empty();
|
|
cbmem_fail_resume();
|
|
}
|
|
|
|
cbmem_arch_init();
|
|
car_migrate_variables();
|
|
return !found;
|
|
}
|
|
|
|
#ifndef __PRE_RAM__
|
|
static void init_cbmem_post_device(void *unused)
|
|
{
|
|
#if CONFIG_HAVE_ACPI_RESUME
|
|
cbmem_recovery(acpi_is_wakeup());
|
|
#else
|
|
cbmem_recovery(0);
|
|
#endif
|
|
#if CONFIG_CONSOLE_CBMEM
|
|
cbmemc_reinit();
|
|
#endif
|
|
}
|
|
|
|
BOOT_STATE_INIT_ENTRIES(cbmem_bscb) = {
|
|
BOOT_STATE_INIT_ENTRY(BS_POST_DEVICE, BS_ON_ENTRY,
|
|
init_cbmem_post_device, NULL),
|
|
};
|
|
|
|
void cbmem_add_bootmem(void)
|
|
{
|
|
bootmem_add_range(cbmem_base, cbmem_size, LB_MEM_TABLE);
|
|
}
|
|
|
|
void cbmem_list(void)
|
|
{
|
|
struct cbmem_entry *cbmem_toc;
|
|
int i;
|
|
cbmem_toc = get_cbmem_toc();
|
|
|
|
if (cbmem_toc == NULL)
|
|
return;
|
|
|
|
for (i = 0; i < MAX_CBMEM_ENTRIES; i++) {
|
|
|
|
if (cbmem_toc[i].magic != CBMEM_MAGIC)
|
|
continue;
|
|
cbmem_print_entry(i, cbmem_toc[i].id, cbmem_toc[i].base,
|
|
cbmem_toc[i].size);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|