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
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
|
// Support for building memory maps suitable for int 15 e820 calls.
//
// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "memmap.h" // struct e820entry
#include "util.h" // dprintf.h
#include "biosvar.h" // SET_EBDA
// Remove an entry from the e820_list.
static void
remove_e820(int i)
{
e820_count--;
memmove(&e820_list[i], &e820_list[i+1]
, sizeof(e820_list[0]) * (e820_count - i));
}
// Insert an entry in the e820_list at the given position.
static void
insert_e820(int i, u64 start, u64 size, u32 type)
{
if (e820_count >= CONFIG_MAX_E820) {
dprintf(1, "Overflowed e820 list!\n");
return;
}
memmove(&e820_list[i+1], &e820_list[i]
, sizeof(e820_list[0]) * (e820_count - i));
e820_count++;
struct e820entry *e = &e820_list[i];
e->start = start;
e->size = size;
e->type = type;
}
// Show the current e820_list.
static void
dump_map()
{
dprintf(1, "e820 map has %d items:\n", e820_count);
int i;
for (i=0; i<e820_count; i++) {
struct e820entry *e = &e820_list[i];
u64 e_end = e->start + e->size;
dprintf(1, " %d: %x%x - %x%x = %d\n", i
, (u32)(e->start >> 32), (u32)e->start
, (u32)(e_end >> 32), (u32)e_end
, e->type);
}
}
// Add a new entry to the list. This scans for overlaps and keeps the
// list sorted.
void
add_e820(u64 start, u64 size, u32 type)
{
dprintf(8, "Add to e820 map: %x %x %d\n", (u32)start, (u32)size, type);
if (! size)
// Huh? Nothing to do.
return;
u64 end = start + size;
int i;
for (i=0; i<e820_count; i++) {
struct e820entry *e = &e820_list[i];
if (end < e->start)
// Simple insertion point.
break;
u64 e_end = e->start + e->size;
if (start > e_end)
// No overlap.
continue;
// New item overlaps (or borders) an existing one.
if (start > e->start) {
e->size = start - e->start;
i++;
if (end < e_end)
// Need to split existing item
insert_e820(i, end, e_end - end, e->type);
if (type == e->type) {
// Same type - merge them.
size += start - e->start;
start = e->start;
i--;
remove_e820(i);
}
}
if (type != E820_HOLE) {
insert_e820(i, start, size, type);
i++;
}
// Remove all existing items that are completely overlapped.
while (i<e820_count) {
e = &e820_list[i];
if (end < e->start)
// No overlap - done.
break;
e_end = e->start + e->size;
if (end >= e_end) {
// Existing item completely overlapped - remove it.
remove_e820(i);
continue;
}
// Not completely overlapped - adjust its start.
e->start = end;
e->size = e_end - e->start;
if (type == e->type) {
// Same type - merge them.
(e-1)->size += e->size;
remove_e820(i);
}
break;
}
//dump_map();
return;
}
// Just insert item.
insert_e820(i, start, size, type);
//dump_map();
}
// Symbols defined in romlayout.S
extern char freespace2_start, freespace2_end;
u32 bios_table_cur_addr, bios_table_end_addr;
// Prep for memmap stuff - init bios table locations.
void
memmap_setup()
{
bios_table_cur_addr = (u32)&freespace2_start;
bios_table_end_addr = (u32)&freespace2_end;
dprintf(1, "bios_table_addr: 0x%08x end=0x%08x\n",
bios_table_cur_addr, bios_table_end_addr);
bios_table_cur_addr = ALIGN(bios_table_cur_addr, 4);
u32 msize = CONFIG_MAX_E820 * sizeof(e820_list[0]);
if (bios_table_cur_addr + msize > bios_table_end_addr) {
dprintf(1, "No room for e820 map!\n");
return;
}
e820_count = 0;
e820_list = (void*)bios_table_cur_addr;
bios_table_cur_addr += msize;
}
// Report on final memory locations.
void
memmap_finalize()
{
dump_map();
dprintf(1, "final bios_table_addr: 0x%08x (used %d%%)\n"
, bios_table_cur_addr
, (100 * (bios_table_cur_addr - (u32)&freespace2_start)
/ ((u32)&freespace2_end - (u32)&freespace2_start)));
if (bios_table_cur_addr > bios_table_end_addr)
BX_PANIC("bios_table_end_addr overflow!\n");
}
|
