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
|
/*
* sfi.c - driver for parsing sfi mmap table and build e820 table
*
* Copyright (c) 2009, Intel Corporation.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License,
* version 2, as published by the Free Software Foundation.
*
* This program is distributed in the hope it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
* more details.
*
* You should have received a copy of the GNU General Public License along with
* this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
*/
#include "types.h"
#include "bootparam.h"
#include "bootstub.h"
#include "spi-uart.h"
#include "sfi.h"
#define SFI_BASE_ADDR 0x000E0000
#define SFI_LENGTH 0x00020000
#define SFI_TABLE_LENGTH 16
static int sfi_table_check(struct sfi_table_header *sbh)
{
char chksum = 0;
char *pos = (char *)sbh;
int i;
if (sbh->length < SFI_TABLE_LENGTH)
return -1;
if (sbh->length > SFI_LENGTH)
return -1;
for (i = 0; i < sbh->length; i++)
chksum += *pos++;
if (chksum)
bs_printk("sfi: Invalid checksum\n");
/* checksum is ok if zero */
return chksum;
}
static unsigned long sfi_search_mmap(void)
{
u32 i = 0;
u32 *pos = (u32 *)SFI_BASE_ADDR;
u32 *end = (u32 *)(SFI_BASE_ADDR + SFI_LENGTH);
struct sfi_table_header *sbh;
struct sfi_table *sb;
u32 sys_entry_cnt = 0;
/* Find SYST table */
for (; pos < end; pos += 4) {
if (*pos == SFI_SYST_MAGIC) {
if (!sfi_table_check((struct sfi_table_header *)pos))
break;
}
}
if (pos >= end) {
bs_printk("Bootstub: failed to locate SFI SYST table\n");
return 0;
}
/* map table pointers */
sb = (struct sfi_table *)pos;
sbh = (struct sfi_table_header *)sb;
sys_entry_cnt = (sbh->length - sizeof(struct sfi_table_header)) >> 3;
/* Search through each SYST entry for MMAP table */
for (i = 0; i < sys_entry_cnt; i++) {
sbh = (struct sfi_table_header *)sb->entry[i].low;
if (*(u32 *)sbh->signature == SFI_MMAP_MAGIC) {
if (!sfi_table_check((struct sfi_table_header *)sbh))
return (unsigned long) sbh;
}
}
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();
if (!sb) {
bs_printk("Bootstub: failed to locate SFI MMAP table\n");
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_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;
}
|
