If the cbmem console buffer isn't zero filled before it's used, there won't be a terminator at the end. We need to put one at the cursor position manually. Change-Id: I69870c2b24b67ce3cbcd402b62f3574acb4c2a8f Signed-off-by: Gabe Black <gabeblack@google.com> Reviewed-on: https://gerrit.chromium.org/gerrit/65300 Reviewed-by: Hung-Te Lin <hungte@chromium.org> Commit-Queue: Gabe Black <gabeblack@chromium.org> Tested-by: Gabe Black <gabeblack@chromium.org> (cherry picked from commit 8ec61e52a6a27ed518d0abb5a19d6261edf9dab1) Signed-off-by: Isaac Christensen <isaac.christensen@se-eng.com> Reviewed-on: http://review.coreboot.org/6404 Tested-by: build bot (Jenkins) Reviewed-by: Paul Menzel <paulepanter@users.sourceforge.net> Reviewed-by: Edward O'Callaghan <eocallaghan@alterapraxis.com>
		
			
				
	
	
		
			970 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			970 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * This file is part of the coreboot project.
 | 
						|
 *
 | 
						|
 * Copyright 2012 Google Inc.
 | 
						|
 *
 | 
						|
 * 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 <inttypes.h>
 | 
						|
#include <stdio.h>
 | 
						|
#include <stdlib.h>
 | 
						|
#include <string.h>
 | 
						|
#include <unistd.h>
 | 
						|
#include <inttypes.h>
 | 
						|
#include <getopt.h>
 | 
						|
#include <errno.h>
 | 
						|
#include <fcntl.h>
 | 
						|
#include <ctype.h>
 | 
						|
#include <arpa/inet.h>
 | 
						|
#include <sys/types.h>
 | 
						|
#include <sys/stat.h>
 | 
						|
#include <sys/mman.h>
 | 
						|
#include <libgen.h>
 | 
						|
#include <assert.h>
 | 
						|
 | 
						|
#define ARRAY_SIZE(a) (sizeof(a) / sizeof((a)[0]))
 | 
						|
#define MAP_BYTES (1024*1024)
 | 
						|
#define IS_ENABLED(x) (defined (x) && (x))
 | 
						|
 | 
						|
#include "boot/coreboot_tables.h"
 | 
						|
 | 
						|
typedef uint16_t u16;
 | 
						|
typedef uint32_t u32;
 | 
						|
typedef uint64_t u64;
 | 
						|
 | 
						|
#include "cbmem.h"
 | 
						|
#include "timestamp.h"
 | 
						|
 | 
						|
#define CBMEM_VERSION "1.1"
 | 
						|
 | 
						|
/* verbose output? */
 | 
						|
static int verbose = 0;
 | 
						|
#define debug(x...) if(verbose) printf(x)
 | 
						|
 | 
						|
/* File handle used to access /dev/mem */
 | 
						|
static int fd;
 | 
						|
 | 
						|
/*
 | 
						|
 * calculate ip checksum (16 bit quantities) on a passed in buffer. In case
 | 
						|
 * the buffer length is odd last byte is excluded from the calculation
 | 
						|
 */
 | 
						|
static u16 ipchcksum(const void *addr, unsigned size)
 | 
						|
{
 | 
						|
	const u16 *p = addr;
 | 
						|
	unsigned i, n = size / 2; /* don't expect odd sized blocks */
 | 
						|
	u32 sum = 0;
 | 
						|
 | 
						|
	for (i = 0; i < n; i++)
 | 
						|
		sum += p[i];
 | 
						|
 | 
						|
	sum = (sum >> 16) + (sum & 0xffff);
 | 
						|
	sum += (sum >> 16);
 | 
						|
	sum = ~sum & 0xffff;
 | 
						|
	return (u16) sum;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * Functions to map / unmap physical memory into virtual address space. These
 | 
						|
 * functions always maps 1MB at a time and can only map one area at once.
 | 
						|
 */
 | 
						|
static void *mapped_virtual;
 | 
						|
static size_t mapped_size;
 | 
						|
 | 
						|
static inline size_t size_to_mib(size_t sz)
 | 
						|
{
 | 
						|
	return sz >> 20;
 | 
						|
}
 | 
						|
 | 
						|
static void unmap_memory(void)
 | 
						|
{
 | 
						|
	if (mapped_virtual == NULL) {
 | 
						|
		fprintf(stderr, "Error unmapping memory\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	debug("Unmapping %zuMB of virtual memory at %p.\n",
 | 
						|
	      size_to_mib(mapped_size), mapped_virtual);
 | 
						|
	munmap(mapped_virtual, mapped_size);
 | 
						|
	mapped_virtual = NULL;
 | 
						|
	mapped_size = 0;
 | 
						|
}
 | 
						|
 | 
						|
static void *map_memory_size(u64 physical, size_t size)
 | 
						|
{
 | 
						|
	void *v;
 | 
						|
	off_t p;
 | 
						|
	u64 page = getpagesize();
 | 
						|
	size_t padding;
 | 
						|
 | 
						|
	if (mapped_virtual != NULL)
 | 
						|
		unmap_memory();
 | 
						|
 | 
						|
	/* Mapped memory must be aligned to page size */
 | 
						|
	p = physical & ~(page - 1);
 | 
						|
	padding = physical & (page-1);
 | 
						|
	size += padding;
 | 
						|
 | 
						|
	debug("Mapping %zuMB of physical memory at 0x%jx.\n",
 | 
						|
	      size_to_mib(size), (intmax_t)p);
 | 
						|
 | 
						|
	v = mmap(NULL, size, PROT_READ, MAP_SHARED, fd, p);
 | 
						|
 | 
						|
	if (v == MAP_FAILED) {
 | 
						|
		fprintf(stderr, "Failed to mmap /dev/mem: %s\n",
 | 
						|
			strerror(errno));
 | 
						|
		exit(1);
 | 
						|
	}
 | 
						|
 | 
						|
	/* Remember what we actually mapped ... */
 | 
						|
	mapped_virtual = v;
 | 
						|
	mapped_size = size;
 | 
						|
 | 
						|
	/* ... but return address to the physical memory that was requested */
 | 
						|
	if (padding)
 | 
						|
		debug("  ... padding virtual address with 0x%zx bytes.\n",
 | 
						|
			padding);
 | 
						|
	v += padding;
 | 
						|
 | 
						|
	return v;
 | 
						|
}
 | 
						|
 | 
						|
static void *map_memory(u64 physical)
 | 
						|
{
 | 
						|
	return map_memory_size(physical, MAP_BYTES);
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * Try finding the timestamp table and coreboot cbmem console starting from the
 | 
						|
 * passed in memory offset.  Could be called recursively in case a forwarding
 | 
						|
 * entry is found.
 | 
						|
 *
 | 
						|
 * Returns pointer to a memory buffer containg the timestamp table or zero if
 | 
						|
 * none found.
 | 
						|
 */
 | 
						|
 | 
						|
static struct lb_cbmem_ref timestamps;
 | 
						|
static struct lb_cbmem_ref console;
 | 
						|
static struct lb_memory_range cbmem;
 | 
						|
 | 
						|
/* This is a work-around for a nasty problem introduced by initially having
 | 
						|
 * pointer sized entries in the lb_cbmem_ref structures. This caused problems
 | 
						|
 * on 64bit x86 systems because coreboot is 32bit on those systems.
 | 
						|
 * When the problem was found, it was corrected, but there are a lot of
 | 
						|
 * systems out there with a firmware that does not produce the right
 | 
						|
 * lb_cbmem_ref structure. Hence we try to autocorrect this issue here.
 | 
						|
 */
 | 
						|
static struct lb_cbmem_ref parse_cbmem_ref(struct lb_cbmem_ref *cbmem_ref)
 | 
						|
{
 | 
						|
	struct lb_cbmem_ref ret;
 | 
						|
 | 
						|
	ret = *cbmem_ref;
 | 
						|
 | 
						|
	if (cbmem_ref->size < sizeof(*cbmem_ref))
 | 
						|
		ret.cbmem_addr = (uint32_t)ret.cbmem_addr;
 | 
						|
 | 
						|
	debug("      cbmem_addr = %" PRIx64 "\n", ret.cbmem_addr);
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
static int parse_cbtable(u64 address)
 | 
						|
{
 | 
						|
	int i, found = 0;
 | 
						|
	void *buf;
 | 
						|
 | 
						|
	debug("Looking for coreboot table at %" PRIx64 "\n", address);
 | 
						|
	buf = map_memory(address);
 | 
						|
 | 
						|
	/* look at every 16 bytes within 4K of the base */
 | 
						|
 | 
						|
	for (i = 0; i < 0x1000; i += 0x10) {
 | 
						|
		struct lb_header *lbh;
 | 
						|
		struct lb_record* lbr_p;
 | 
						|
		void *lbtable;
 | 
						|
		int j;
 | 
						|
 | 
						|
		lbh = (struct lb_header *)(buf + i);
 | 
						|
		if (memcmp(lbh->signature, "LBIO", sizeof(lbh->signature)) ||
 | 
						|
		    !lbh->header_bytes ||
 | 
						|
		    ipchcksum(lbh, sizeof(*lbh))) {
 | 
						|
			continue;
 | 
						|
		}
 | 
						|
		lbtable = buf + i + lbh->header_bytes;
 | 
						|
 | 
						|
		if (ipchcksum(lbtable, lbh->table_bytes) !=
 | 
						|
		    lbh->table_checksum) {
 | 
						|
			debug("Signature found, but wrong checksum.\n");
 | 
						|
			continue;
 | 
						|
		}
 | 
						|
 | 
						|
		found = 1;
 | 
						|
		debug("Found!\n");
 | 
						|
 | 
						|
		for (j = 0; j < lbh->table_bytes; j += lbr_p->size) {
 | 
						|
			/* look for the timestamp table */
 | 
						|
			lbr_p = (struct lb_record*) ((char *)lbtable + j);
 | 
						|
			debug("  coreboot table entry 0x%02x\n", lbr_p->tag);
 | 
						|
			switch (lbr_p->tag) {
 | 
						|
			case LB_TAG_MEMORY: {
 | 
						|
				int i = 0;
 | 
						|
				debug("    Found memory map.\n");
 | 
						|
				struct lb_memory *memory =
 | 
						|
						(struct lb_memory *)lbr_p;
 | 
						|
				while ((char *)&memory->map[i] < ((char *)lbtable
 | 
						|
							    + lbr_p->size)) {
 | 
						|
					if (memory->map[i].type == LB_MEM_TABLE) {
 | 
						|
						debug("      LB_MEM_TABLE found.\n");
 | 
						|
						/* The last one found is CBMEM */
 | 
						|
						cbmem = memory->map[i];
 | 
						|
					}
 | 
						|
					i++;
 | 
						|
				}
 | 
						|
				continue;
 | 
						|
			}
 | 
						|
			case LB_TAG_TIMESTAMPS: {
 | 
						|
				debug("    Found timestamp table.\n");
 | 
						|
				timestamps = parse_cbmem_ref((struct lb_cbmem_ref *) lbr_p);
 | 
						|
				continue;
 | 
						|
			}
 | 
						|
			case LB_TAG_CBMEM_CONSOLE: {
 | 
						|
				debug("    Found cbmem console.\n");
 | 
						|
				console = parse_cbmem_ref((struct lb_cbmem_ref *) lbr_p);
 | 
						|
				continue;
 | 
						|
			}
 | 
						|
			case LB_TAG_FORWARD: {
 | 
						|
				/*
 | 
						|
				 * This is a forwarding entry - repeat the
 | 
						|
				 * search at the new address.
 | 
						|
				 */
 | 
						|
				struct lb_forward lbf_p =
 | 
						|
					*(struct lb_forward *) lbr_p;
 | 
						|
				debug("    Found forwarding entry.\n");
 | 
						|
				unmap_memory();
 | 
						|
				return parse_cbtable(lbf_p.forward);
 | 
						|
			}
 | 
						|
			default:
 | 
						|
				break;
 | 
						|
			}
 | 
						|
 | 
						|
		}
 | 
						|
	}
 | 
						|
	unmap_memory();
 | 
						|
 | 
						|
	return found;
 | 
						|
}
 | 
						|
 | 
						|
#if defined(__i386__) || defined(__x86_64__)
 | 
						|
/*
 | 
						|
 * read CPU frequency from a sysfs file, return an frequency in Kilohertz as
 | 
						|
 * an int or exit on any error.
 | 
						|
 */
 | 
						|
static u64 get_cpu_freq_KHz(void)
 | 
						|
{
 | 
						|
	FILE *cpuf;
 | 
						|
	char freqs[100];
 | 
						|
	int  size;
 | 
						|
	char *endp;
 | 
						|
	u64 rv;
 | 
						|
 | 
						|
	const char* freq_file =
 | 
						|
		"/sys/devices/system/cpu/cpu0/cpufreq/cpuinfo_max_freq";
 | 
						|
 | 
						|
	cpuf = fopen(freq_file, "r");
 | 
						|
	if (!cpuf) {
 | 
						|
		fprintf(stderr, "Could not open %s: %s\n",
 | 
						|
			freq_file, strerror(errno));
 | 
						|
		exit(1);
 | 
						|
	}
 | 
						|
 | 
						|
	memset(freqs, 0, sizeof(freqs));
 | 
						|
	size = fread(freqs, 1, sizeof(freqs), cpuf);
 | 
						|
	if (!size || (size == sizeof(freqs))) {
 | 
						|
		fprintf(stderr, "Wrong number of bytes(%d) read from %s\n",
 | 
						|
			size, freq_file);
 | 
						|
		exit(1);
 | 
						|
	}
 | 
						|
	fclose(cpuf);
 | 
						|
	rv = strtoull(freqs, &endp, 10);
 | 
						|
 | 
						|
	if (*endp == '\0' || *endp == '\n')
 | 
						|
		return rv;
 | 
						|
	fprintf(stderr, "Wrong formatted value ^%s^ read from %s\n",
 | 
						|
		freqs, freq_file);
 | 
						|
	exit(1);
 | 
						|
}
 | 
						|
 | 
						|
/* On x86 platforms timestamps are stored
 | 
						|
 * in CPU cycles (from rdtsc). Hence the
 | 
						|
 * timestamp divider is the CPU frequency
 | 
						|
 * in MHz.
 | 
						|
 */
 | 
						|
u64 arch_convert_raw_ts_entry(u64 ts)
 | 
						|
{
 | 
						|
	static u64 cpu_freq_mhz = 0;
 | 
						|
 | 
						|
	if (!cpu_freq_mhz)
 | 
						|
		cpu_freq_mhz = get_cpu_freq_KHz() / 1000;
 | 
						|
 | 
						|
	return ts / cpu_freq_mhz;
 | 
						|
}
 | 
						|
 | 
						|
#else
 | 
						|
 | 
						|
/* On non-x86 platforms the timestamp entries
 | 
						|
 * are not in clock cycles but in usecs
 | 
						|
 */
 | 
						|
u64 arch_convert_raw_ts_entry(u64 ts)
 | 
						|
{
 | 
						|
	return ts;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 * Print an integer in 'normalized' form - with commas separating every three
 | 
						|
 * decimal orders. The 'comma' parameter indicates if a comma is needed after
 | 
						|
 * the value is printed.
 | 
						|
 */
 | 
						|
static void print_norm(u64 v, int comma)
 | 
						|
{
 | 
						|
	int first_triple = 1;
 | 
						|
 | 
						|
	if (v > 1000) {
 | 
						|
		/* print the higher order sections first */
 | 
						|
		print_norm(v / 1000, 1);
 | 
						|
		first_triple = 0;
 | 
						|
	}
 | 
						|
	if (first_triple)
 | 
						|
		printf("%d", (u32)(v % 1000));
 | 
						|
	else
 | 
						|
		printf("%3.3d", (u32)(v % 1000));
 | 
						|
	if (comma)
 | 
						|
		printf(",");
 | 
						|
}
 | 
						|
 | 
						|
enum additional_timestamp_id {
 | 
						|
	// Depthcharge entry IDs start at 1000.
 | 
						|
	TS_DC_START = 1000,
 | 
						|
 | 
						|
	TS_RO_PARAMS_INIT = 1001,
 | 
						|
	TS_RO_VB_INIT = 1002,
 | 
						|
	TS_RO_VB_SELECT_FIRMWARE = 1003,
 | 
						|
	TS_RO_VB_SELECT_AND_LOAD_KERNEL = 1004,
 | 
						|
 | 
						|
	TS_RW_VB_SELECT_AND_LOAD_KERNEL = 1010,
 | 
						|
 | 
						|
	TS_VB_SELECT_AND_LOAD_KERNEL = 1020,
 | 
						|
 | 
						|
	TS_CROSSYSTEM_DATA = 1100,
 | 
						|
	TS_START_KERNEL = 1101
 | 
						|
};
 | 
						|
 | 
						|
static const struct timestamp_id_to_name {
 | 
						|
	u32 id;
 | 
						|
	const char *name;
 | 
						|
} timestamp_ids[] = {
 | 
						|
	{ TS_START_ROMSTAGE,	"start of rom stage" },
 | 
						|
	{ TS_BEFORE_INITRAM,	"before ram initialization" },
 | 
						|
	{ TS_AFTER_INITRAM,	"after ram initialization" },
 | 
						|
	{ TS_END_ROMSTAGE,	"end of romstage" },
 | 
						|
	{ TS_START_VBOOT,	"start of verified boot" },
 | 
						|
	{ TS_END_VBOOT,		"end of verified boot" },
 | 
						|
	{ TS_START_COPYRAM,	"start of copying ram stage" },
 | 
						|
	{ TS_END_COPYRAM,	"end of copying ram stage" },
 | 
						|
	{ TS_START_RAMSTAGE,	"start of ramstage" },
 | 
						|
	{ TS_DEVICE_ENUMERATE,	"device enumeration" },
 | 
						|
	{ TS_DEVICE_CONFIGURE,	"device configuration" },
 | 
						|
	{ TS_DEVICE_ENABLE,	"device enable" },
 | 
						|
	{ TS_DEVICE_INITIALIZE,	"device initialization" },
 | 
						|
	{ TS_DEVICE_DONE,	"device setup done" },
 | 
						|
	{ TS_CBMEM_POST,	"cbmem post" },
 | 
						|
	{ TS_WRITE_TABLES,	"write tables" },
 | 
						|
	{ TS_LOAD_PAYLOAD,	"load payload" },
 | 
						|
	{ TS_ACPI_WAKE_JUMP,	"ACPI wake jump" },
 | 
						|
	{ TS_SELFBOOT_JUMP,	"selfboot jump" },
 | 
						|
	{ TS_DC_START,		"depthcharge start" },
 | 
						|
	{ TS_RO_PARAMS_INIT,	"RO parameter init" },
 | 
						|
	{ TS_RO_VB_INIT,	"RO vboot init" },
 | 
						|
	{ TS_RO_VB_SELECT_FIRMWARE,		"RO vboot select firmware" },
 | 
						|
	{ TS_RO_VB_SELECT_AND_LOAD_KERNEL,	"RO vboot select&load kernel" },
 | 
						|
	{ TS_RW_VB_SELECT_AND_LOAD_KERNEL,	"RW vboot select&load kernel" },
 | 
						|
	{ TS_VB_SELECT_AND_LOAD_KERNEL,		"vboot select&load kernel" },
 | 
						|
	{ TS_CROSSYSTEM_DATA,	"crossystem data" },
 | 
						|
	{ TS_START_KERNEL,	"start kernel" }
 | 
						|
};
 | 
						|
 | 
						|
void timestamp_print_entry(uint32_t id, uint64_t stamp, uint64_t prev_stamp)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	const char *name;
 | 
						|
 | 
						|
	name = "<unknown>";
 | 
						|
	for (i = 0; i < ARRAY_SIZE(timestamp_ids); i++) {
 | 
						|
		if (timestamp_ids[i].id == id) {
 | 
						|
			name = timestamp_ids[i].name;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	printf("%4d:", id);
 | 
						|
	printf("%-30s", name);
 | 
						|
	print_norm(arch_convert_raw_ts_entry(stamp), 0);
 | 
						|
	if (prev_stamp) {
 | 
						|
		printf(" (");
 | 
						|
		print_norm(arch_convert_raw_ts_entry(stamp
 | 
						|
				- prev_stamp), 0);
 | 
						|
		printf(")");
 | 
						|
	}
 | 
						|
	printf("\n");
 | 
						|
}
 | 
						|
 | 
						|
/* dump the timestamp table */
 | 
						|
static void dump_timestamps(void)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	struct timestamp_table *tst_p;
 | 
						|
 | 
						|
	if (timestamps.tag != LB_TAG_TIMESTAMPS) {
 | 
						|
		fprintf(stderr, "No timestamps found in coreboot table.\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	tst_p = (struct timestamp_table *)
 | 
						|
			map_memory((unsigned long)timestamps.cbmem_addr);
 | 
						|
 | 
						|
	printf("%d entries total:\n\n", tst_p->num_entries);
 | 
						|
	for (i = 0; i < tst_p->num_entries; i++) {
 | 
						|
		const struct timestamp_entry *tse_p = tst_p->entries + i;
 | 
						|
		timestamp_print_entry(tse_p->entry_id, tse_p->entry_stamp,
 | 
						|
			i ? tse_p[-1].entry_stamp : 0);
 | 
						|
	}
 | 
						|
 | 
						|
	unmap_memory();
 | 
						|
}
 | 
						|
 | 
						|
/* dump the cbmem console */
 | 
						|
static void dump_console(void)
 | 
						|
{
 | 
						|
	void *console_p;
 | 
						|
	char *console_c;
 | 
						|
	uint32_t size;
 | 
						|
	uint32_t cursor;
 | 
						|
 | 
						|
	if (console.tag != LB_TAG_CBMEM_CONSOLE) {
 | 
						|
		fprintf(stderr, "No console found in coreboot table.\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	console_p = map_memory((unsigned long)console.cbmem_addr);
 | 
						|
	/* The in-memory format of the console area is:
 | 
						|
	 *  u32  size
 | 
						|
	 *  u32  cursor
 | 
						|
	 *  char console[size]
 | 
						|
	 * Hence we have to add 8 to get to the actual console string.
 | 
						|
	 */
 | 
						|
	size = ((uint32_t *)console_p)[0];
 | 
						|
	cursor = ((uint32_t *)console_p)[1];
 | 
						|
	/* Cursor continues to go on even after no more data fits in
 | 
						|
	 * the buffer but the data is dropped in this case.
 | 
						|
	 */
 | 
						|
	if (size > cursor)
 | 
						|
		size = cursor;
 | 
						|
	console_c = malloc(size + 1);
 | 
						|
	if (!console_c) {
 | 
						|
		fprintf(stderr, "Not enough memory for console.\n");
 | 
						|
		exit(1);
 | 
						|
	}
 | 
						|
 | 
						|
	console_p = map_memory_size((unsigned long)console.cbmem_addr,
 | 
						|
	                            size + sizeof(size) + sizeof(cursor));
 | 
						|
	memcpy(console_c, console_p + 8, size);
 | 
						|
	console_c[size] = 0;
 | 
						|
	console_c[cursor] = 0;
 | 
						|
 | 
						|
	printf("%s\n", console_c);
 | 
						|
	if (size < cursor)
 | 
						|
		printf("%d %s lost\n", cursor - size,
 | 
						|
			(cursor - size) == 1 ? "byte":"bytes");
 | 
						|
 | 
						|
	free(console_c);
 | 
						|
 | 
						|
	unmap_memory();
 | 
						|
}
 | 
						|
 | 
						|
static void hexdump(unsigned long memory, int length)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	uint8_t *m;
 | 
						|
	int all_zero = 0;
 | 
						|
 | 
						|
	m = map_memory((intptr_t)memory);
 | 
						|
 | 
						|
	if (length > MAP_BYTES) {
 | 
						|
		printf("Truncating hex dump from %d to %d bytes\n\n",
 | 
						|
			length, MAP_BYTES);
 | 
						|
		length = MAP_BYTES;
 | 
						|
	}
 | 
						|
 | 
						|
	for (i = 0; i < length; i += 16) {
 | 
						|
		int j;
 | 
						|
 | 
						|
		all_zero++;
 | 
						|
		for (j = 0; j < 16; j++) {
 | 
						|
			if(m[i+j] != 0) {
 | 
						|
				all_zero = 0;
 | 
						|
				break;
 | 
						|
			}
 | 
						|
		}
 | 
						|
 | 
						|
		if (all_zero < 2) {
 | 
						|
			printf("%08lx:", memory + i);
 | 
						|
			for (j = 0; j < 16; j++)
 | 
						|
				printf(" %02x", m[i+j]);
 | 
						|
			printf("  ");
 | 
						|
			for (j = 0; j < 16; j++)
 | 
						|
				printf("%c", isprint(m[i+j]) ? m[i+j] : '.');
 | 
						|
			printf("\n");
 | 
						|
		} else if (all_zero == 2) {
 | 
						|
			printf("...\n");
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	unmap_memory();
 | 
						|
}
 | 
						|
 | 
						|
static void dump_cbmem_hex(void)
 | 
						|
{
 | 
						|
	if (cbmem.type != LB_MEM_TABLE) {
 | 
						|
		fprintf(stderr, "No coreboot CBMEM area found!\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	hexdump(unpack_lb64(cbmem.start), unpack_lb64(cbmem.size));
 | 
						|
}
 | 
						|
 | 
						|
/* The root region is at least DYN_CBMEM_ALIGN_SIZE . */
 | 
						|
#define DYN_CBMEM_ALIGN_SIZE (4096)
 | 
						|
#define ROOT_MIN_SIZE DYN_CBMEM_ALIGN_SIZE
 | 
						|
#define CBMEM_POINTER_MAGIC 0xc0389479
 | 
						|
#define CBMEM_ENTRY_MAGIC ~(CBMEM_POINTER_MAGIC)
 | 
						|
 | 
						|
struct cbmem_root_pointer {
 | 
						|
	uint32_t magic;
 | 
						|
	uint32_t root;
 | 
						|
} __attribute__((packed));
 | 
						|
 | 
						|
struct dynamic_cbmem_entry {
 | 
						|
	uint32_t magic;
 | 
						|
	uint32_t start;
 | 
						|
	uint32_t size;
 | 
						|
	uint32_t id;
 | 
						|
} __attribute__((packed));
 | 
						|
 | 
						|
struct cbmem_root {
 | 
						|
	uint32_t max_entries;
 | 
						|
	uint32_t num_entries;
 | 
						|
	uint32_t locked;
 | 
						|
	uint32_t size;
 | 
						|
	struct dynamic_cbmem_entry entries[0];
 | 
						|
} __attribute__((packed));
 | 
						|
 | 
						|
#define CBMEM_MAGIC 0x434f5245
 | 
						|
#define MAX_CBMEM_ENTRIES 16
 | 
						|
 | 
						|
struct cbmem_entry {
 | 
						|
	uint32_t magic;
 | 
						|
	uint32_t id;
 | 
						|
	uint64_t base;
 | 
						|
	uint64_t size;
 | 
						|
} __attribute__((packed));
 | 
						|
 | 
						|
static const struct cbmem_id_to_name {
 | 
						|
	u32 id;
 | 
						|
	const char *name;
 | 
						|
} cbmem_ids[] = {
 | 
						|
	{ CBMEM_ID_FREESPACE,		"FREE SPACE " },
 | 
						|
	{ CBMEM_ID_GDT,			"GDT        " },
 | 
						|
	{ CBMEM_ID_ACPI,		"ACPI       " },
 | 
						|
	{ CBMEM_ID_CBTABLE,		"COREBOOT   " },
 | 
						|
	{ CBMEM_ID_PIRQ,		"IRQ TABLE  " },
 | 
						|
	{ CBMEM_ID_MPTABLE,		"SMP TABLE  " },
 | 
						|
	{ CBMEM_ID_RESUME,		"ACPI RESUME" },
 | 
						|
	{ CBMEM_ID_RESUME_SCRATCH,	"ACPISCRATCH" },
 | 
						|
	{ CBMEM_ID_ACPI_GNVS,		"ACPI GNVS  " },
 | 
						|
	{ CBMEM_ID_ACPI_GNVS_PTR,	"GNVS PTR   " },
 | 
						|
	{ CBMEM_ID_SMBIOS,		"SMBIOS     " },
 | 
						|
	{ CBMEM_ID_TIMESTAMP,		"TIME STAMP " },
 | 
						|
	{ CBMEM_ID_MRCDATA,		"MRC DATA   " },
 | 
						|
	{ CBMEM_ID_CONSOLE,		"CONSOLE    " },
 | 
						|
	{ CBMEM_ID_ELOG,		"ELOG       " },
 | 
						|
	{ CBMEM_ID_COVERAGE,		"COVERAGE   " },
 | 
						|
	{ CBMEM_ID_ROMSTAGE_INFO,	"ROMSTAGE   " },
 | 
						|
	{ CBMEM_ID_ROMSTAGE_RAM_STACK,	"ROMSTG STCK" },
 | 
						|
	{ CBMEM_ID_RAMSTAGE,		"RAMSTAGE   " },
 | 
						|
	{ CBMEM_ID_RAMSTAGE_CACHE,	"RAMSTAGE $ " },
 | 
						|
	{ CBMEM_ID_ROOT,		"CBMEM ROOT " },
 | 
						|
	{ CBMEM_ID_VBOOT_HANDOFF,	"VBOOT      " },
 | 
						|
	{ CBMEM_ID_CAR_GLOBALS,		"CAR GLOBALS" },
 | 
						|
};
 | 
						|
 | 
						|
void cbmem_print_entry(int n, uint32_t id, uint64_t base, uint64_t size)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	const char *name;
 | 
						|
 | 
						|
	name = NULL;
 | 
						|
	for (i = 0; i < ARRAY_SIZE(cbmem_ids); i++) {
 | 
						|
		if (cbmem_ids[i].id == id) {
 | 
						|
			name = cbmem_ids[i].name;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	printf("%2d. ", n);
 | 
						|
	if (name == NULL)
 | 
						|
		printf("%08x ", id);
 | 
						|
	else
 | 
						|
		printf("%s", name);
 | 
						|
	printf("  %08" PRIx64 " ", base);
 | 
						|
	printf("  %08" PRIx64 "\n", size);
 | 
						|
}
 | 
						|
 | 
						|
static void dump_static_cbmem_toc(struct cbmem_entry *entries)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	printf("CBMEM table of contents:\n");
 | 
						|
	printf("    ID           START      LENGTH\n");
 | 
						|
 | 
						|
	for (i=0; i<MAX_CBMEM_ENTRIES; i++) {
 | 
						|
		if (entries[i].magic != CBMEM_MAGIC)
 | 
						|
			break;
 | 
						|
		cbmem_print_entry(i, entries[i].id,
 | 
						|
				entries[i].base, entries[i].size);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void dump_dynamic_cbmem_toc(struct cbmem_root *root)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	debug("CBMEM: max_entries=%d num_entries=%d locked=0x%x, size=%d\n\n",
 | 
						|
		root->max_entries, root->num_entries, root->locked, root->size);
 | 
						|
 | 
						|
	printf("CBMEM table of contents:\n");
 | 
						|
	printf("    ID           START      LENGTH\n");
 | 
						|
 | 
						|
	for (i = 0; i < root->num_entries; i++) {
 | 
						|
		if(root->entries[i].magic != CBMEM_ENTRY_MAGIC)
 | 
						|
			break;
 | 
						|
		cbmem_print_entry(i, root->entries[i].id,
 | 
						|
			root->entries[i].start, root->entries[i].size);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void dump_cbmem_toc(void)
 | 
						|
{
 | 
						|
	uint64_t start;
 | 
						|
	void *cbmem_area;
 | 
						|
	struct cbmem_entry *entries;
 | 
						|
 | 
						|
	if (cbmem.type != LB_MEM_TABLE) {
 | 
						|
		fprintf(stderr, "No coreboot CBMEM area found!\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	start = unpack_lb64(cbmem.start);
 | 
						|
 | 
						|
	cbmem_area = map_memory(start);
 | 
						|
	entries = (struct cbmem_entry *)cbmem_area;
 | 
						|
 | 
						|
	if (entries[0].magic == CBMEM_MAGIC) {
 | 
						|
		dump_static_cbmem_toc(entries);
 | 
						|
	} else {
 | 
						|
		uint64_t rootptr;
 | 
						|
 | 
						|
		rootptr = unpack_lb64(cbmem.start) + unpack_lb64(cbmem.size);
 | 
						|
		rootptr &= ~(DYN_CBMEM_ALIGN_SIZE - 1);
 | 
						|
		rootptr -= sizeof(struct cbmem_root_pointer);
 | 
						|
		unmap_memory();
 | 
						|
		struct cbmem_root_pointer *r =
 | 
						|
			(struct cbmem_root_pointer *)map_memory(rootptr);
 | 
						|
		if (r->magic == CBMEM_POINTER_MAGIC) {
 | 
						|
			struct cbmem_root *root;
 | 
						|
			uint64_t rootaddr = r->root;
 | 
						|
			unmap_memory();
 | 
						|
			/* Note that this only works because our default mmap
 | 
						|
			 * size is 1MiB which happens to be larger than the
 | 
						|
			 * root entry size which is default to be 4KiB.
 | 
						|
			 */
 | 
						|
			root = (struct cbmem_root *)map_memory(rootaddr);
 | 
						|
			dump_dynamic_cbmem_toc(root);
 | 
						|
		} else
 | 
						|
			fprintf(stderr, "No valid coreboot CBMEM root pointer found.\n");
 | 
						|
	}
 | 
						|
 | 
						|
	unmap_memory();
 | 
						|
}
 | 
						|
 | 
						|
#define COVERAGE_MAGIC 0x584d4153
 | 
						|
struct file {
 | 
						|
	uint32_t magic;
 | 
						|
	uint32_t next;
 | 
						|
	uint32_t filename;
 | 
						|
	uint32_t data;
 | 
						|
	int offset;
 | 
						|
	int len;
 | 
						|
};
 | 
						|
 | 
						|
static int mkpath(char *path, mode_t mode)
 | 
						|
{
 | 
						|
	assert (path && *path);
 | 
						|
	char *p;
 | 
						|
	for (p = strchr(path+1, '/'); p; p = strchr(p + 1, '/')) {
 | 
						|
		*p = '\0';
 | 
						|
		if (mkdir(path, mode) == -1) {
 | 
						|
			if (errno != EEXIST) {
 | 
						|
				*p = '/';
 | 
						|
				return -1;
 | 
						|
			}
 | 
						|
		}
 | 
						|
		*p = '/';
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void dump_coverage(void)
 | 
						|
{
 | 
						|
	int i, found = 0;
 | 
						|
	uint64_t start;
 | 
						|
	struct cbmem_entry *entries;
 | 
						|
	void *coverage;
 | 
						|
	unsigned long phys_offset;
 | 
						|
#define phys_to_virt(x) ((void *)(unsigned long)(x) + phys_offset)
 | 
						|
 | 
						|
	if (cbmem.type != LB_MEM_TABLE) {
 | 
						|
		fprintf(stderr, "No coreboot table area found!\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	start = unpack_lb64(cbmem.start);
 | 
						|
 | 
						|
	entries = (struct cbmem_entry *)map_memory(start);
 | 
						|
 | 
						|
	for (i=0; i<MAX_CBMEM_ENTRIES; i++) {
 | 
						|
		if (entries[i].magic != CBMEM_MAGIC)
 | 
						|
			break;
 | 
						|
		if (entries[i].id == CBMEM_ID_COVERAGE) {
 | 
						|
			found = 1;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	if (!found) {
 | 
						|
		unmap_memory();
 | 
						|
		fprintf(stderr, "No coverage information found in"
 | 
						|
			" CBMEM area.\n");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	start = entries[i].base;
 | 
						|
	unmap_memory();
 | 
						|
	/* Map coverage area */
 | 
						|
	coverage = map_memory(start);
 | 
						|
	phys_offset = (unsigned long)coverage - (unsigned long)start;
 | 
						|
 | 
						|
	printf("Dumping coverage data...\n");
 | 
						|
 | 
						|
	struct file *file = (struct file *)coverage;
 | 
						|
	while (file && file->magic == COVERAGE_MAGIC) {
 | 
						|
		FILE *f;
 | 
						|
		char *filename;
 | 
						|
 | 
						|
		debug(" -> %s\n", (char *)phys_to_virt(file->filename));
 | 
						|
		filename = strdup((char *)phys_to_virt(file->filename));
 | 
						|
		if (mkpath(filename, 0755) == -1) {
 | 
						|
			perror("Directory for coverage data could "
 | 
						|
				"not be created");
 | 
						|
			exit(1);
 | 
						|
		}
 | 
						|
		f = fopen(filename, "wb");
 | 
						|
		if (!f) {
 | 
						|
			printf("Could not open %s: %s\n",
 | 
						|
				filename, strerror(errno));
 | 
						|
			exit(1);
 | 
						|
		}
 | 
						|
		if (fwrite((void *)phys_to_virt(file->data),
 | 
						|
						file->len, 1, f) != 1) {
 | 
						|
			printf("Could not write to %s: %s\n",
 | 
						|
				filename, strerror(errno));
 | 
						|
			exit(1);
 | 
						|
		}
 | 
						|
		fclose(f);
 | 
						|
		free(filename);
 | 
						|
 | 
						|
		if (file->next)
 | 
						|
			file = (struct file *)phys_to_virt(file->next);
 | 
						|
		else
 | 
						|
			file = NULL;
 | 
						|
	}
 | 
						|
	unmap_memory();
 | 
						|
}
 | 
						|
 | 
						|
static void print_version(void)
 | 
						|
{
 | 
						|
	printf("cbmem v%s -- ", CBMEM_VERSION);
 | 
						|
	printf("Copyright (C) 2012 The ChromiumOS Authors.  All rights reserved.\n\n");
 | 
						|
	printf(
 | 
						|
    "This program is free software: you can redistribute it and/or modify\n"
 | 
						|
    "it under the terms of the GNU General Public License as published by\n"
 | 
						|
    "the Free Software Foundation, version 2 of the License.\n\n"
 | 
						|
    "This program is distributed in the hope that it will be useful,\n"
 | 
						|
    "but WITHOUT ANY WARRANTY; without even the implied warranty of\n"
 | 
						|
    "MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\n"
 | 
						|
    "GNU General Public License for more details.\n\n"
 | 
						|
    "You should have received a copy of the GNU General Public License\n"
 | 
						|
    "along with this program.  If not, see <http://www.gnu.org/licenses/>.\n\n");
 | 
						|
}
 | 
						|
 | 
						|
static void print_usage(const char *name)
 | 
						|
{
 | 
						|
	printf("usage: %s [-cCltxVvh?]\n", name);
 | 
						|
	printf("\n"
 | 
						|
	     "   -c | --console:                   print cbmem console\n"
 | 
						|
	     "   -C | --coverage:                  dump coverage information\n"
 | 
						|
	     "   -l | --list:                      print cbmem table of contents\n"
 | 
						|
	     "   -x | --hexdump:                   print hexdump of cbmem area\n"
 | 
						|
	     "   -t | --timestamps:                print timestamp information\n"
 | 
						|
	     "   -V | --verbose:                   verbose (debugging) output\n"
 | 
						|
	     "   -v | --version:                   print the version\n"
 | 
						|
	     "   -h | --help:                      print this help\n"
 | 
						|
	     "\n");
 | 
						|
	exit(1);
 | 
						|
}
 | 
						|
 | 
						|
int main(int argc, char** argv)
 | 
						|
{
 | 
						|
	int print_defaults = 1;
 | 
						|
	int print_console = 0;
 | 
						|
	int print_coverage = 0;
 | 
						|
	int print_list = 0;
 | 
						|
	int print_hexdump = 0;
 | 
						|
	int print_timestamps = 0;
 | 
						|
 | 
						|
	int opt, option_index = 0;
 | 
						|
	static struct option long_options[] = {
 | 
						|
		{"console", 0, 0, 'c'},
 | 
						|
		{"coverage", 0, 0, 'C'},
 | 
						|
		{"list", 0, 0, 'l'},
 | 
						|
		{"timestamps", 0, 0, 't'},
 | 
						|
		{"hexdump", 0, 0, 'x'},
 | 
						|
		{"verbose", 0, 0, 'V'},
 | 
						|
		{"version", 0, 0, 'v'},
 | 
						|
		{"help", 0, 0, 'h'},
 | 
						|
		{0, 0, 0, 0}
 | 
						|
	};
 | 
						|
	while ((opt = getopt_long(argc, argv, "cCltxVvh?",
 | 
						|
				  long_options, &option_index)) != EOF) {
 | 
						|
		switch (opt) {
 | 
						|
		case 'c':
 | 
						|
			print_console = 1;
 | 
						|
			print_defaults = 0;
 | 
						|
			break;
 | 
						|
		case 'C':
 | 
						|
			print_coverage = 1;
 | 
						|
			print_defaults = 0;
 | 
						|
			break;
 | 
						|
		case 'l':
 | 
						|
			print_list = 1;
 | 
						|
			print_defaults = 0;
 | 
						|
			break;
 | 
						|
		case 'x':
 | 
						|
			print_hexdump = 1;
 | 
						|
			print_defaults = 0;
 | 
						|
			break;
 | 
						|
		case 't':
 | 
						|
			print_timestamps = 1;
 | 
						|
			print_defaults = 0;
 | 
						|
			break;
 | 
						|
		case 'V':
 | 
						|
			verbose = 1;
 | 
						|
			break;
 | 
						|
		case 'v':
 | 
						|
			print_version();
 | 
						|
			exit(0);
 | 
						|
			break;
 | 
						|
		case 'h':
 | 
						|
		case '?':
 | 
						|
		default:
 | 
						|
			print_usage(argv[0]);
 | 
						|
			exit(0);
 | 
						|
			break;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	fd = open("/dev/mem", O_RDONLY, 0);
 | 
						|
	if (fd < 0) {
 | 
						|
		fprintf(stderr, "Failed to gain memory access: %s\n",
 | 
						|
			strerror(errno));
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
 | 
						|
#ifdef __arm__
 | 
						|
	int dt_fd;
 | 
						|
	uint32_t cbtable_base;
 | 
						|
 | 
						|
	dt_fd = open("/proc/device-tree/firmware/coreboot/coreboot-table",
 | 
						|
			O_RDONLY, 0);
 | 
						|
	if (dt_fd < 0) {
 | 
						|
		fprintf(stderr, "Failed to open device tree node: %s\n",
 | 
						|
			strerror(errno));
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
 | 
						|
	if (read(dt_fd, &cbtable_base, 4) != 4) {
 | 
						|
		fprintf(stderr, "Failed to read device tree node: %s\n",
 | 
						|
			strerror(errno));
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
	close(dt_fd);
 | 
						|
 | 
						|
	parse_cbtable(ntohl(cbtable_base));
 | 
						|
#else
 | 
						|
	int j;
 | 
						|
	static const int possible_base_addresses[] = { 0, 0xf0000 };
 | 
						|
 | 
						|
	/* Find and parse coreboot table */
 | 
						|
	for (j = 0; j < ARRAY_SIZE(possible_base_addresses); j++) {
 | 
						|
		if (parse_cbtable(possible_base_addresses[j]))
 | 
						|
			break;
 | 
						|
	}
 | 
						|
#endif
 | 
						|
 | 
						|
	if (print_console)
 | 
						|
		dump_console();
 | 
						|
 | 
						|
	if (print_coverage)
 | 
						|
		dump_coverage();
 | 
						|
 | 
						|
	if (print_list)
 | 
						|
		dump_cbmem_toc();
 | 
						|
 | 
						|
	if (print_hexdump)
 | 
						|
		dump_cbmem_hex();
 | 
						|
 | 
						|
	if (print_defaults || print_timestamps)
 | 
						|
		dump_timestamps();
 | 
						|
 | 
						|
	close(fd);
 | 
						|
	return 0;
 | 
						|
}
 |