1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2e71de54aSFelipe Balbi /*
3e71de54aSFelipe Balbi * Copyright (c) 2017 Intel Corporation
4e71de54aSFelipe Balbi */
5e71de54aSFelipe Balbi
6e71de54aSFelipe Balbi #include <common.h>
7e71de54aSFelipe Balbi #include <asm/e820.h>
8e71de54aSFelipe Balbi #include <asm/global_data.h>
9e71de54aSFelipe Balbi #include <asm/sfi.h>
10e71de54aSFelipe Balbi
11e71de54aSFelipe Balbi DECLARE_GLOBAL_DATA_PTR;
12e71de54aSFelipe Balbi
13e71de54aSFelipe Balbi /*
14e71de54aSFelipe Balbi * SFI tables are part of the first stage bootloader.
15e71de54aSFelipe Balbi *
16e71de54aSFelipe Balbi * U-Boot finds the System Table by searching 16-byte boundaries between
17e71de54aSFelipe Balbi * physical address 0x000E0000 and 0x000FFFFF. U-Boot shall search this region
18e71de54aSFelipe Balbi * starting at the low address and shall stop searching when the 1st valid SFI
19e71de54aSFelipe Balbi * System Table is found.
20e71de54aSFelipe Balbi */
21e71de54aSFelipe Balbi #define SFI_BASE_ADDR 0x000E0000
22e71de54aSFelipe Balbi #define SFI_LENGTH 0x00020000
23e71de54aSFelipe Balbi #define SFI_TABLE_LENGTH 16
24e71de54aSFelipe Balbi
sfi_table_check(struct sfi_table_header * sbh)25e71de54aSFelipe Balbi static int sfi_table_check(struct sfi_table_header *sbh)
26e71de54aSFelipe Balbi {
27e71de54aSFelipe Balbi char chksum = 0;
28e71de54aSFelipe Balbi char *pos = (char *)sbh;
29e71de54aSFelipe Balbi u32 i;
30e71de54aSFelipe Balbi
31e71de54aSFelipe Balbi if (sbh->len < SFI_TABLE_LENGTH)
32e71de54aSFelipe Balbi return -ENXIO;
33e71de54aSFelipe Balbi
34e71de54aSFelipe Balbi if (sbh->len > SFI_LENGTH)
35e71de54aSFelipe Balbi return -ENXIO;
36e71de54aSFelipe Balbi
37e71de54aSFelipe Balbi for (i = 0; i < sbh->len; i++)
38e71de54aSFelipe Balbi chksum += *pos++;
39e71de54aSFelipe Balbi
40e71de54aSFelipe Balbi if (chksum)
419b643e31SMasahiro Yamada pr_err("sfi: Invalid checksum\n");
42e71de54aSFelipe Balbi
43e71de54aSFelipe Balbi /* Checksum is OK if zero */
44e71de54aSFelipe Balbi return chksum ? -EILSEQ : 0;
45e71de54aSFelipe Balbi }
46e71de54aSFelipe Balbi
sfi_table_is_type(struct sfi_table_header * sbh,const char * signature)47e71de54aSFelipe Balbi static int sfi_table_is_type(struct sfi_table_header *sbh, const char *signature)
48e71de54aSFelipe Balbi {
49e71de54aSFelipe Balbi return !strncmp(sbh->sig, signature, SFI_SIGNATURE_SIZE) &&
50e71de54aSFelipe Balbi !sfi_table_check(sbh);
51e71de54aSFelipe Balbi }
52e71de54aSFelipe Balbi
sfi_get_table_by_sig(unsigned long addr,const char * signature)53e71de54aSFelipe Balbi static struct sfi_table_simple *sfi_get_table_by_sig(unsigned long addr,
54e71de54aSFelipe Balbi const char *signature)
55e71de54aSFelipe Balbi {
56e71de54aSFelipe Balbi struct sfi_table_simple *sb;
57e71de54aSFelipe Balbi u32 i;
58e71de54aSFelipe Balbi
59e71de54aSFelipe Balbi for (i = 0; i < SFI_LENGTH; i += SFI_TABLE_LENGTH) {
60e71de54aSFelipe Balbi sb = (struct sfi_table_simple *)(addr + i);
61e71de54aSFelipe Balbi if (sfi_table_is_type(&sb->header, signature))
62e71de54aSFelipe Balbi return sb;
63e71de54aSFelipe Balbi }
64e71de54aSFelipe Balbi
65e71de54aSFelipe Balbi return NULL;
66e71de54aSFelipe Balbi }
67e71de54aSFelipe Balbi
sfi_search_mmap(void)68e71de54aSFelipe Balbi static struct sfi_table_simple *sfi_search_mmap(void)
69e71de54aSFelipe Balbi {
70e71de54aSFelipe Balbi struct sfi_table_header *sbh;
71e71de54aSFelipe Balbi struct sfi_table_simple *sb;
72e71de54aSFelipe Balbi u32 sys_entry_cnt;
73e71de54aSFelipe Balbi u32 i;
74e71de54aSFelipe Balbi
75e71de54aSFelipe Balbi /* Find SYST table */
76e71de54aSFelipe Balbi sb = sfi_get_table_by_sig(SFI_BASE_ADDR, SFI_SIG_SYST);
77e71de54aSFelipe Balbi if (!sb) {
789b643e31SMasahiro Yamada pr_err("sfi: failed to locate SYST table\n");
79e71de54aSFelipe Balbi return NULL;
80e71de54aSFelipe Balbi }
81e71de54aSFelipe Balbi
82e71de54aSFelipe Balbi sys_entry_cnt = (sb->header.len - sizeof(*sbh)) / 8;
83e71de54aSFelipe Balbi
84e71de54aSFelipe Balbi /* Search through each SYST entry for MMAP table */
85e71de54aSFelipe Balbi for (i = 0; i < sys_entry_cnt; i++) {
86e71de54aSFelipe Balbi sbh = (struct sfi_table_header *)(unsigned long)sb->pentry[i];
87e71de54aSFelipe Balbi
88e71de54aSFelipe Balbi if (sfi_table_is_type(sbh, SFI_SIG_MMAP))
89e71de54aSFelipe Balbi return (struct sfi_table_simple *)sbh;
90e71de54aSFelipe Balbi }
91e71de54aSFelipe Balbi
929b643e31SMasahiro Yamada pr_err("sfi: failed to locate SFI MMAP table\n");
93e71de54aSFelipe Balbi return NULL;
94e71de54aSFelipe Balbi }
95e71de54aSFelipe Balbi
96e71de54aSFelipe Balbi #define sfi_for_each_mentry(i, sb, mentry) \
97e71de54aSFelipe Balbi for (i = 0, mentry = (struct sfi_mem_entry *)sb->pentry; \
98e71de54aSFelipe Balbi i < SFI_GET_NUM_ENTRIES(sb, struct sfi_mem_entry); \
99e71de54aSFelipe Balbi i++, mentry++) \
100e71de54aSFelipe Balbi
sfi_setup_e820(unsigned int max_entries,struct e820_entry * entries)10187af71c2SBin Meng static unsigned int sfi_setup_e820(unsigned int max_entries,
10245519924SBin Meng struct e820_entry *entries)
103e71de54aSFelipe Balbi {
104e71de54aSFelipe Balbi struct sfi_table_simple *sb;
105e71de54aSFelipe Balbi struct sfi_mem_entry *mentry;
106e71de54aSFelipe Balbi unsigned long long start, end, size;
107e71de54aSFelipe Balbi int type, total = 0;
108e71de54aSFelipe Balbi u32 i;
109e71de54aSFelipe Balbi
110e71de54aSFelipe Balbi sb = sfi_search_mmap();
111e71de54aSFelipe Balbi if (!sb)
112e71de54aSFelipe Balbi return 0;
113e71de54aSFelipe Balbi
114e71de54aSFelipe Balbi sfi_for_each_mentry(i, sb, mentry) {
115e71de54aSFelipe Balbi start = mentry->phys_start;
116e71de54aSFelipe Balbi size = mentry->pages << 12;
117e71de54aSFelipe Balbi end = start + size;
118e71de54aSFelipe Balbi
119e71de54aSFelipe Balbi if (start > end)
120e71de54aSFelipe Balbi continue;
121e71de54aSFelipe Balbi
122e71de54aSFelipe Balbi /* translate SFI mmap type to E820 map type */
123e71de54aSFelipe Balbi switch (mentry->type) {
124e71de54aSFelipe Balbi case SFI_MEM_CONV:
125e71de54aSFelipe Balbi type = E820_RAM;
126e71de54aSFelipe Balbi break;
127e71de54aSFelipe Balbi case SFI_MEM_UNUSABLE:
128e71de54aSFelipe Balbi case SFI_RUNTIME_SERVICE_DATA:
129e71de54aSFelipe Balbi continue;
130e71de54aSFelipe Balbi default:
131e71de54aSFelipe Balbi type = E820_RESERVED;
132e71de54aSFelipe Balbi }
133e71de54aSFelipe Balbi
134e71de54aSFelipe Balbi if (total == E820MAX)
135e71de54aSFelipe Balbi break;
136e71de54aSFelipe Balbi entries[total].addr = start;
137e71de54aSFelipe Balbi entries[total].size = size;
138e71de54aSFelipe Balbi entries[total].type = type;
139e71de54aSFelipe Balbi
140e71de54aSFelipe Balbi total++;
141e71de54aSFelipe Balbi }
142e71de54aSFelipe Balbi
143e71de54aSFelipe Balbi return total;
144e71de54aSFelipe Balbi }
145e71de54aSFelipe Balbi
sfi_get_bank_size(void)146e71de54aSFelipe Balbi static int sfi_get_bank_size(void)
147e71de54aSFelipe Balbi {
148e71de54aSFelipe Balbi struct sfi_table_simple *sb;
149e71de54aSFelipe Balbi struct sfi_mem_entry *mentry;
150e71de54aSFelipe Balbi int bank = 0;
151e71de54aSFelipe Balbi u32 i;
152e71de54aSFelipe Balbi
153e71de54aSFelipe Balbi sb = sfi_search_mmap();
154e71de54aSFelipe Balbi if (!sb)
155e71de54aSFelipe Balbi return 0;
156e71de54aSFelipe Balbi
157e71de54aSFelipe Balbi sfi_for_each_mentry(i, sb, mentry) {
158e71de54aSFelipe Balbi if (mentry->type != SFI_MEM_CONV)
159e71de54aSFelipe Balbi continue;
160e71de54aSFelipe Balbi
161e71de54aSFelipe Balbi gd->bd->bi_dram[bank].start = mentry->phys_start;
162e71de54aSFelipe Balbi gd->bd->bi_dram[bank].size = mentry->pages << 12;
163e71de54aSFelipe Balbi bank++;
164e71de54aSFelipe Balbi }
165e71de54aSFelipe Balbi
166e71de54aSFelipe Balbi return bank;
167e71de54aSFelipe Balbi }
168e71de54aSFelipe Balbi
sfi_get_ram_size(void)169e71de54aSFelipe Balbi static phys_size_t sfi_get_ram_size(void)
170e71de54aSFelipe Balbi {
171e71de54aSFelipe Balbi struct sfi_table_simple *sb;
172e71de54aSFelipe Balbi struct sfi_mem_entry *mentry;
173e71de54aSFelipe Balbi phys_size_t ram = 0;
174e71de54aSFelipe Balbi u32 i;
175e71de54aSFelipe Balbi
176e71de54aSFelipe Balbi sb = sfi_search_mmap();
177e71de54aSFelipe Balbi if (!sb)
178e71de54aSFelipe Balbi return 0;
179e71de54aSFelipe Balbi
180e71de54aSFelipe Balbi sfi_for_each_mentry(i, sb, mentry) {
181e71de54aSFelipe Balbi if (mentry->type != SFI_MEM_CONV)
182e71de54aSFelipe Balbi continue;
183e71de54aSFelipe Balbi
184e71de54aSFelipe Balbi ram += mentry->pages << 12;
185e71de54aSFelipe Balbi }
186e71de54aSFelipe Balbi
187e71de54aSFelipe Balbi debug("sfi: RAM size %llu\n", ram);
188e71de54aSFelipe Balbi return ram;
189e71de54aSFelipe Balbi }
190e71de54aSFelipe Balbi
install_e820_map(unsigned int max_entries,struct e820_entry * entries)19187af71c2SBin Meng unsigned int install_e820_map(unsigned int max_entries,
19245519924SBin Meng struct e820_entry *entries)
193e71de54aSFelipe Balbi {
194e71de54aSFelipe Balbi return sfi_setup_e820(max_entries, entries);
195e71de54aSFelipe Balbi }
196e71de54aSFelipe Balbi
dram_init_banksize(void)197e71de54aSFelipe Balbi int dram_init_banksize(void)
198e71de54aSFelipe Balbi {
199e71de54aSFelipe Balbi sfi_get_bank_size();
200e71de54aSFelipe Balbi return 0;
201e71de54aSFelipe Balbi }
202e71de54aSFelipe Balbi
dram_init(void)203e71de54aSFelipe Balbi int dram_init(void)
204e71de54aSFelipe Balbi {
205e71de54aSFelipe Balbi gd->ram_size = sfi_get_ram_size();
206e71de54aSFelipe Balbi return 0;
207e71de54aSFelipe Balbi }
208