blob: 001360f21bfc9f48191cb454b381327f14269519 (
plain)
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
|
#include "types.h"
#include "bootparam.h"
#include "bootstub.h"
#include "spi-uart.h"
#include "sfi.h"
#define bs_printk(x) { if (!*(int *)SPI_UART_SUPPRESSION) bs_spi_printk(x); }
#define SFI_BASE_ADDR 0x000E0000
#define SFI_LENGTH 0x00020000
static unsigned long sfi_search_mmap(unsigned long start, int len)
{
unsigned long i = 0;
char *pchar = (char *)start;
for (i = 0; i < len; i += 4, pchar += 4) {
if (pchar[0] == 'M'
&& pchar[1] == 'M'
&& pchar[2] == 'A'
&& pchar[3] == 'P')
return start + i;
}
return 0;
}
void sfi_setup_e820(struct boot_params *bp)
{
struct sfi_table *sb;
struct sfi_mem_entry *mentry;
unsigned long long start, end, size;
int i, num, type, total;
bp->e820_entries = 0;
total = 0;
/* search for sfi mmap table */
sb = (struct sfi_table *)sfi_search_mmap(SFI_BASE_ADDR, SFI_LENGTH);
if (!sb)
return;
bs_printk("Bootstub: will use sfi mmap table for e820 table\n");
num = SFI_GET_ENTRY_NUM(sb, sfi_mem_entry);
mentry = (struct sfi_mem_entry *)sb->pentry;
for (i = 0; i < num; i++) {
start = mentry->phy_start;
size = mentry->pages << 12;
end = start + size;
if (start > end)
continue;
/* translate SFI mmap type to E820 map type */
switch (mentry->type) {
case SFI_MEM_CONV:
type = E820_RAM;
break;
case SFI_MEM_MMIO:
case SFI_MEM_UNUSABLE:
case SFI_RUNTIME_SERVICE_DATA:
mentry++;
continue;
default:
type = E820_RESERVED;
}
if (total == E820MAX)
break;
bp->e820_map[total].addr = start;
bp->e820_map[total].size = size;
bp->e820_map[total++].type = type;
mentry++;
}
bp->e820_entries = total;
}
|
