130 lines
3.4 KiB
C
130 lines
3.4 KiB
C
/* Adapted from Etherboot 5.1.8 */
|
|
|
|
#include "config.h"
|
|
#include "sysinclude.h"
|
|
#include "asm/types.h"
|
|
#include "asm/io.h"
|
|
#include "linuxbios.h"
|
|
#include "libopenbios/ipchecksum.h"
|
|
#include "libopenbios/sys_info.h"
|
|
|
|
#ifdef CONFIG_DEBUG_BOOT
|
|
#define debug printk
|
|
#else
|
|
#define debug(x...)
|
|
#endif
|
|
|
|
#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 void convert_memmap(struct lb_memory *lbmem, struct sys_info *info)
|
|
{
|
|
int lbcount;
|
|
int i;
|
|
|
|
lbcount = lbmem->size / sizeof(struct lb_memory_range);
|
|
info->memrange = malloc(lbcount * sizeof(struct memrange));
|
|
info->n_memranges = 0;
|
|
for (i = 0; i < lbcount; i++) {
|
|
debug("%#016llx %#016llx %d\n",
|
|
(long long)lbmem->map[i].start, (long long)lbmem->map[i].size,
|
|
(int) lbmem->map[i].type);
|
|
if (lbmem->map[i].type != LB_MEM_RAM)
|
|
continue;
|
|
info->memrange[info->n_memranges].base = lbmem->map[i].start;
|
|
info->memrange[info->n_memranges].size = lbmem->map[i].size;
|
|
info->n_memranges++;
|
|
}
|
|
}
|
|
|
|
static int read_lbtable(struct lb_header *head, struct sys_info *info)
|
|
{
|
|
int retval = 0;
|
|
|
|
/* Read linuxbios tables... */
|
|
struct lb_record *rec;
|
|
|
|
for_each_lbrec(head, rec) {
|
|
switch(rec->tag) {
|
|
case LB_TAG_MEMORY:
|
|
convert_memmap((struct lb_memory *) rec, info);
|
|
retval = 1;
|
|
break;
|
|
};
|
|
}
|
|
return retval;
|
|
}
|
|
|
|
static unsigned long count_lb_records(void *start, unsigned long length)
|
|
{
|
|
struct lb_record *rec;
|
|
void *end;
|
|
unsigned long count;
|
|
count = 0;
|
|
end = ((char *)start) + length;
|
|
for(rec = start; ((void *)rec < end) &&
|
|
((signed long)rec->size <=
|
|
((signed long)end - (signed long)rec));
|
|
rec = (void *)(((char *)rec) + rec->size)) {
|
|
count++;
|
|
}
|
|
return count;
|
|
}
|
|
|
|
static int find_lb_table(void *start, void *end, struct lb_header **result)
|
|
{
|
|
unsigned char *ptr;
|
|
/* For now be stupid.... */
|
|
for(ptr = start; (void *)ptr < end; ptr += 16) {
|
|
struct lb_header *head = (struct lb_header *)ptr;
|
|
if ( (head->signature[0] != 'L') ||
|
|
(head->signature[1] != 'B') ||
|
|
(head->signature[2] != 'I') ||
|
|
(head->signature[3] != 'O')) {
|
|
continue;
|
|
}
|
|
if (head->header_bytes != sizeof(*head))
|
|
continue;
|
|
debug("Found canidate at: %p\n", head);
|
|
if (ipchksum((uint16_t *)head, sizeof(*head)) != 0)
|
|
continue;
|
|
debug("header checksum o.k.\n");
|
|
if (ipchksum((uint16_t *)(ptr + sizeof(*head)), head->table_bytes) !=
|
|
head->table_checksum) {
|
|
continue;
|
|
}
|
|
debug("table checksum o.k.\n");
|
|
if (count_lb_records(ptr + sizeof(*head), head->table_bytes) !=
|
|
head->table_entries) {
|
|
continue;
|
|
}
|
|
debug("record count o.k.\n");
|
|
*result = head;
|
|
return 1;
|
|
};
|
|
return 0;
|
|
}
|
|
|
|
void collect_linuxbios_info(struct sys_info *info)
|
|
{
|
|
struct lb_header *lb_table;
|
|
int found;
|
|
debug("Searching for LinuxBIOS tables...\n");
|
|
found = 0;
|
|
if (!found) {
|
|
found = find_lb_table(phys_to_virt(0x00000), phys_to_virt(0x01000), &lb_table);
|
|
}
|
|
if (!found) {
|
|
found = find_lb_table(phys_to_virt(0xf0000), phys_to_virt(0x100000), &lb_table);
|
|
}
|
|
if (!found)
|
|
return;
|
|
|
|
debug("Found LinuxBIOS table at: %p\n", lb_table);
|
|
info->firmware = "LinuxBIOS";
|
|
read_lbtable(lb_table, info);
|
|
}
|