diff options
author | Stefan Reinauer <stepan@openbios.org> | 2005-11-12 20:58:26 +0000 |
---|---|---|
committer | Stefan Reinauer <stepan@openbios.org> | 2005-11-12 20:58:26 +0000 |
commit | 8af7998bacc11c66381836c28b099a4407da955c (patch) | |
tree | 90c13cb5b7254d45da53eb894acba7cf0af9b132 /util/lbtdump/lbtdump.c | |
parent | 2fd467ce3ca96391f787d4e5f8c56878321da160 (diff) |
add utility to dump linuxbios table from v1
git-svn-id: svn://svn.coreboot.org/coreboot/trunk@2085 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
Diffstat (limited to 'util/lbtdump/lbtdump.c')
-rw-r--r-- | util/lbtdump/lbtdump.c | 348 |
1 files changed, 348 insertions, 0 deletions
diff --git a/util/lbtdump/lbtdump.c b/util/lbtdump/lbtdump.c new file mode 100644 index 0000000000..4b5d9dfa65 --- /dev/null +++ b/util/lbtdump/lbtdump.c @@ -0,0 +1,348 @@ +#include <stdio.h> +#include <stdint.h> +#include <stdlib.h> +#include <fcntl.h> +#include <unistd.h> +#include <sys/types.h> +#include <string.h> +#include <errno.h> +#include <sys/mman.h> +#include "../../src/include/boot/linuxbios_tables.h" + +static inline uint64_t unpack_lb64(struct lb_uint64 value) +{ + uint64_t result; + result = value.hi; + result = (result << 32) + value.lo; + return result; +} + +void print_lb_records(struct lb_record *rec, struct lb_record *last, unsigned long addr); + +unsigned long compute_checksum(void *addr, unsigned long length) +{ + uint8_t *ptr; + volatile union { + uint8_t byte[2]; + uint16_t word; + } value; + unsigned long sum; + unsigned long i; + /* In the most straight forward way possible, + * compute an ip style checksum. + */ + sum = 0; + ptr = addr; + for(i = 0; i < length; i++) { + unsigned long value; + value = ptr[i]; + if (i & 1) { + value <<= 8; + } + /* Add the new value */ + sum += value; + /* Wrap around the carry */ + if (sum > 0xFFFF) { + sum = (sum + (sum >> 16)) & 0xFFFF; + } + } + value.byte[0] = sum & 0xff; + value.byte[1] = (sum >> 8) & 0xff; + return (~value.word) & 0xFFFF; +} + +#define for_each_lbrec(head, rec) \ + for(rec = (struct lb_record *)(((char *)head) + sizeof(*head)); \ + (((char *)rec) < (((char *)head) + sizeof(*head) + head->table_bytes)) && \ + (rec->size >= 1) && \ + ((((char *)rec) + rec->size) <= (((char *)head) + sizeof(*head) + head->table_bytes)); \ + rec = (struct lb_record *)(((char *)rec) + rec->size)) + + +static int count_lb_records(struct lb_header *head) +{ + struct lb_record *rec; + int count; + count = 0; + for_each_lbrec(head, rec) { + count++; + } + return count; +} + + +struct lb_header *find_lb_table(void *base, unsigned long start, unsigned long end) +{ + unsigned long addr; + /* For now be stupid.... */ + for(addr = start; addr < end; addr += 16) { + struct lb_header *head = (struct lb_header *)(((char*)base) + addr); + struct lb_record *recs = (struct lb_record *)(((char*)base) + addr + sizeof(*head)); + if (memcmp(head->signature, "LBIO", 4) != 0) + continue; + fprintf(stdout, "Found canidate at: %08lx-%08lx\n", + addr, addr + head->table_bytes); + if (head->header_bytes != sizeof(*head)) { + fprintf(stderr, "Header bytes of %d are incorrect\n", + head->header_bytes); + continue; + } + if (count_lb_records(head) != head->table_entries) { + fprintf(stderr, "bad record count: %d\n", + head->table_entries); + continue; + } + if (compute_checksum((unsigned char *)head, sizeof(*head)) != 0) { + fprintf(stderr, "bad header checksum\n"); + continue; + } + if (compute_checksum(recs, head->table_bytes) + != head->table_checksum) { + fprintf(stderr, "bad table checksum: %04x\n", + head->table_checksum); + continue; + } + fprintf(stdout, "Found LinuxBIOS table at: %08lx\n", addr); + return head; + + }; + return 0; +} + +void nop_print(struct lb_record *rec, unsigned long addr) +{ + return; +} + +void pretty_print_number(FILE *stream, uint64_t value) +{ + if (value > 1024ULL*1024*1024*1024*1024*1024) { + value /= 1024ULL*1024*1024*1024*1024*1024; + fprintf(stream, "%ldEB", value); + } + else if (value > 1024ULL*1024*1024*1024*1024) { + value /= 1024ULL*1024*1024*1024*1024; + fprintf(stream, "%ldPB", value); + } + else if (value > 1024ULL*1024*1024*1024) { + value /= 1024ULL*1024*1024*1024; + fprintf(stream, "%ldTB", value); + } + else if (value > 1024ULL*1024*1024) { + value /= 1024ULL*1024*1024; + fprintf(stream, "%ldGB", value); + } + else if (value > 1024ULL*1024) { + value /= 1024ULL*1024; + fprintf(stream, "%ldMB", value); + } + else if (value > 1024ULL) { + value /= 1024ULL; + fprintf(stream, "%ldKB", value); + } + else { + fprintf(stream, "%ldB", value); + } +} + +void print_memory(struct lb_record *ptr, unsigned long addr) +{ + struct lb_memory *rec = (void *)ptr; + int entries; + int i; + entries = (rec->size - sizeof(*rec))/sizeof(rec->map[0]); + for(i = 0; i < entries; i++) { + char *mem_type; + uint64_t start; + uint64_t end; + start = unpack_lb64(rec->map[i].start); + end = start + unpack_lb64(rec->map[i].size); + switch(rec->map[i].type) { + case 1: mem_type = "ram"; break; + case 3: mem_type = "acpi"; break; + case 4: mem_type = "nvs"; break; + default: + case 2: mem_type = "reserved"; break; + } + printf("0x%08lx - 0x%08lx %s (", + start, end, mem_type); + pretty_print_number(stdout, start); + printf(" - "); + pretty_print_number(stdout, end); + printf(")\n"); + } +} + +void print_mainboard(struct lb_record *ptr, unsigned long addr) +{ + struct lb_mainboard *rec; + int max_size; + rec = (struct lb_mainboard *)ptr; + max_size = rec->size - sizeof(*rec); + printf("vendor: %.*s part number: %.*s\n", + max_size - rec->vendor_idx, rec->strings + rec->vendor_idx, + max_size - rec->part_number_idx, rec->strings + rec->part_number_idx); +} + +void print_string(struct lb_record *ptr, unsigned long addr) +{ + struct lb_string *rec; + int max_size; + rec = (struct lb_string *)ptr; + max_size = rec->size - sizeof(*rec); + printf("%.*s\n", max_size, rec->string); +} + +void print_option_table(struct lb_record *ptr, unsigned long addr) +{ + struct lb_record *rec, *last; + struct cmos_option_table *hdr; + hdr = (struct cmos_option_table *)ptr; + rec = (struct lb_record *)(((char *)hdr) + hdr->header_length); + last = (struct lb_record *)(((char *)hdr) + hdr->size); + printf("cmos option header record = type %d, size %d, header length %d\n", + hdr->tag, hdr->size, hdr->header_length); + print_lb_records(rec, last, addr + hdr->header_length); +#if 0 + { + unsigned char *data = (unsigned char *)ptr; + int i; + for(i = 0; i < hdr->size; i++) { + if ((i %10) == 0 ) { + fprintf(stderr, "\n\t"); + } + fprintf(stderr, "0x%02x,", data[i]); + } + } +#endif + +} + +void print_option(struct lb_record *ptr, unsigned long addr) +{ + struct cmos_entries *rec; + rec= (struct cmos_entries *)ptr; + printf("entry %d, rec len %d, start %d, length %d, conf %d, id %d, %s\n", + rec->tag, rec->size, rec->bit, rec->length, + rec->config, rec->config_id, rec->name); +} + +void print_option_enumeration(struct lb_record *ptr, unsigned long addr) +{ + struct cmos_enums *rec; + rec = (struct cmos_enums *)ptr; + printf("enumeration %d, rec len %d, id %d, value %d, %s\n", + rec->tag, rec->size, rec->config_id, rec->value, + rec->text); +} + +void print_option_checksum(struct lb_record *ptr, unsigned long addr) +{ + struct cmos_checksum *rec; + rec = (struct cmos_checksum *)ptr; + printf("checksum %d, rec len %d, range %d-%d location %d type %d\n", + rec->tag, rec->size, + rec->range_start, rec->range_end, rec->location, rec->type); +} + +struct { + uint32_t type; + char *type_name; + void (*print)(struct lb_record *rec, unsigned long addr); +} lb_types[] = { + { LB_TAG_UNUSED, "Unused", nop_print }, + { LB_TAG_MEMORY, "Memory", print_memory }, + { LB_TAG_HWRPB, "HWRPB", nop_print }, + { LB_TAG_MAINBOARD, "Mainboard", print_mainboard }, + { LB_TAG_VERSION, "Version", print_string }, + { LB_TAG_EXTRA_VERSION, "Extra Version", print_string }, + { LB_TAG_BUILD, "Build", print_string }, + { LB_TAG_COMPILE_TIME, "Compile Time", print_string }, + { LB_TAG_COMPILE_BY, "Compile By", print_string }, + { LB_TAG_COMPILE_HOST, "Compile Host", print_string }, + { LB_TAG_COMPILE_DOMAIN, "Compile Domain", print_string }, + { LB_TAG_COMPILER, "Compiler", print_string }, + { LB_TAG_LINKER, "Linker", print_string }, + { LB_TAG_ASSEMBLER, "Assembler", print_string }, + { LB_TAG_CMOS_OPTION_TABLE, "CMOS option table", print_option_table }, + { LB_TAG_OPTION, "Option", print_option }, + { LB_TAG_OPTION_ENUM, "Option Enumeration", print_option_enumeration }, + { LB_TAG_OPTION_DEFAULTS, "Option Defaults", nop_print }, + { LB_TAG_OPTION_CHECKSUM, "Option Checksum", print_option_checksum }, + { -1, "Unknown", 0 } +}; + +static struct lb_record *next_record(struct lb_record *rec) +{ + return (struct lb_record *)(((char *)rec) + rec->size); +} + +void print_lb_records(struct lb_record *rec, struct lb_record *last, + unsigned long addr) +{ + struct lb_record *next; + int i; + int count; + count = 0; + + for(next = next_record(rec); (rec < last) && (next <= last); + rec = next, addr += rec->size) { + next = next_record(rec); + count++; + for(i = 0; lb_types[i].print != 0; i++) { + if (lb_types[i].type == rec->tag) { + break; + } + } + printf("lb_record #%d type %d @ 0x%08lx %s\n", + count, rec->tag, addr, lb_types[i].type_name); + if (lb_types[i].print) { + lb_types[i].print(rec, addr); + } + } +} + +void print_lb_table(struct lb_header *head, unsigned long addr) +{ + struct lb_record *rec, *last; + + rec = (struct lb_record *)(((char *)head) + head->header_bytes); + last = (struct lb_record *)(((char *)rec) + head->table_bytes); + + printf("LinuxBIOS header(%d) checksum: %04x table(%d) checksum: %04x entries: %d\n", + head->header_bytes, head->header_checksum, + head->table_bytes, head->table_checksum, head->table_entries); + print_lb_records(rec, last, addr + head->header_bytes); +} + +int main(int argc, char **argv) +{ + unsigned char *low_1MB; + struct lb_header *lb_table; + int fd; + fd = open("/dev/mem", O_RDONLY); + if (fd < 0) { + fprintf(stderr, "Can not open /dev/mem\n"); + exit(-1); + } + low_1MB = mmap(0, 1024*1024, PROT_READ, MAP_SHARED, fd, 0x00000000); + if (low_1MB == ((void *) -1)) { + fprintf(stderr, "Can not mmap /dev/mem at %08lx errno(%d):%s\n", + 0x00000000UL, errno, strerror(errno)); + exit(-2); + } + lb_table = 0; + if (!lb_table) + lb_table = find_lb_table(low_1MB, 0x00000, 0x1000); + if (!lb_table) + lb_table = find_lb_table(low_1MB, 0xf0000, 1024*1024); + if (lb_table) { + unsigned long addr; + addr = ((char *)lb_table) - ((char *)low_1MB); + print_lb_table(lb_table, addr); + } + else { + printf("lb_table not found\n"); + } + return 0; +} |