1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
|
/* 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);
}
|
