]> git.proxmox.com Git - mirror_ubuntu-hirsute-kernel.git/blame - arch/x86/platform/efi/efi.c
ACPICA: Fix for ill-formed GUID strings for NFIT tables.
[mirror_ubuntu-hirsute-kernel.git] / arch / x86 / platform / efi / efi.c
CommitLineData
5b83683f
HY
1/*
2 * Common EFI (Extensible Firmware Interface) support functions
3 * Based on Extensible Firmware Interface Specification version 1.0
4 *
5 * Copyright (C) 1999 VA Linux Systems
6 * Copyright (C) 1999 Walt Drummond <drummond@valinux.com>
7 * Copyright (C) 1999-2002 Hewlett-Packard Co.
8 * David Mosberger-Tang <davidm@hpl.hp.com>
9 * Stephane Eranian <eranian@hpl.hp.com>
10 * Copyright (C) 2005-2008 Intel Co.
11 * Fenghua Yu <fenghua.yu@intel.com>
12 * Bibo Mao <bibo.mao@intel.com>
13 * Chandramouli Narayanan <mouli@linux.intel.com>
14 * Huang Ying <ying.huang@intel.com>
d2f7cbe7
BP
15 * Copyright (C) 2013 SuSE Labs
16 * Borislav Petkov <bp@suse.de> - runtime services VA mapping
5b83683f
HY
17 *
18 * Copied from efi_32.c to eliminate the duplicated code between EFI
19 * 32/64 support code. --ying 2007-10-26
20 *
21 * All EFI Runtime Services are not implemented yet as EFI only
22 * supports physical mode addressing on SoftSDV. This is to be fixed
23 * in a future version. --drummond 1999-07-20
24 *
25 * Implemented EFI runtime services and virtual mode calls. --davidm
26 *
27 * Goutham Rao: <goutham.rao@intel.com>
28 * Skip non-WB memory and ignore empty memory ranges.
29 */
30
e3cb3f5a
OJ
31#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
32
5b83683f
HY
33#include <linux/kernel.h>
34#include <linux/init.h>
35#include <linux/efi.h>
2223af38 36#include <linux/efi-bgrt.h>
69c60c88 37#include <linux/export.h>
5b83683f 38#include <linux/bootmem.h>
0d01ff25 39#include <linux/slab.h>
a9ce6bc1 40#include <linux/memblock.h>
5b83683f
HY
41#include <linux/spinlock.h>
42#include <linux/uaccess.h>
43#include <linux/time.h>
44#include <linux/io.h>
45#include <linux/reboot.h>
46#include <linux/bcd.h>
47
48#include <asm/setup.h>
49#include <asm/efi.h>
50#include <asm/time.h>
a2172e25
HY
51#include <asm/cacheflush.h>
52#include <asm/tlbflush.h>
7bd867df 53#include <asm/x86_init.h>
3195ef59 54#include <asm/rtc.h>
a5d90c92 55#include <asm/uv/uv.h>
5b83683f 56
f4fccac0 57#define EFI_DEBUG
5b83683f 58
5b83683f
HY
59struct efi_memory_map memmap;
60
ecaea42e 61static struct efi efi_phys __initdata;
5b83683f
HY
62static efi_system_table_t efi_systab __initdata;
63
9b7d2049 64static efi_config_table_type_t arch_tables[] __initdata = {
272686bf
LL
65#ifdef CONFIG_X86_UV
66 {UV_SYSTEM_TABLE_GUID, "UVsystab", &efi.uv_systab},
67#endif
722da9d2 68 {NULL_GUID, NULL, NULL},
272686bf
LL
69};
70
1fec0533 71u64 efi_setup; /* efi setup_data physical address */
926172d4 72
60920685 73static int add_efi_memmap __initdata;
200001eb
PJ
74static int __init setup_add_efi_memmap(char *arg)
75{
76 add_efi_memmap = 1;
77 return 0;
78}
79early_param("add_efi_memmap", setup_add_efi_memmap);
80
5b83683f
HY
81static efi_status_t __init phys_efi_set_virtual_address_map(
82 unsigned long memory_map_size,
83 unsigned long descriptor_size,
84 u32 descriptor_version,
85 efi_memory_desc_t *virtual_map)
86{
87 efi_status_t status;
23a0d4e8 88 unsigned long flags;
744937b0 89 pgd_t *save_pgd;
5b83683f 90
744937b0 91 save_pgd = efi_call_phys_prolog();
23a0d4e8
IM
92
93 /* Disable interrupts around EFI calls: */
94 local_irq_save(flags);
62fa6e69
MF
95 status = efi_call_phys(efi_phys.set_virtual_address_map,
96 memory_map_size, descriptor_size,
97 descriptor_version, virtual_map);
23a0d4e8
IM
98 local_irq_restore(flags);
99
744937b0 100 efi_call_phys_epilog(save_pgd);
23a0d4e8 101
5b83683f
HY
102 return status;
103}
104
3565184e 105void efi_get_time(struct timespec *now)
5b83683f
HY
106{
107 efi_status_t status;
108 efi_time_t eft;
109 efi_time_cap_t cap;
110
111 status = efi.get_time(&eft, &cap);
112 if (status != EFI_SUCCESS)
e3cb3f5a 113 pr_err("Oops: efitime: can't read time!\n");
5b83683f 114
3565184e
DV
115 now->tv_sec = mktime(eft.year, eft.month, eft.day, eft.hour,
116 eft.minute, eft.second);
117 now->tv_nsec = 0;
5b83683f
HY
118}
119
69c91893
PJ
120/*
121 * Tell the kernel about the EFI memory map. This might include
122 * more than the max 128 entries that can fit in the e820 legacy
123 * (zeropage) memory map.
124 */
125
200001eb 126static void __init do_add_efi_memmap(void)
69c91893
PJ
127{
128 void *p;
129
130 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
131 efi_memory_desc_t *md = p;
132 unsigned long long start = md->phys_addr;
133 unsigned long long size = md->num_pages << EFI_PAGE_SHIFT;
134 int e820_type;
135
e2a71476
CW
136 switch (md->type) {
137 case EFI_LOADER_CODE:
138 case EFI_LOADER_DATA:
139 case EFI_BOOT_SERVICES_CODE:
140 case EFI_BOOT_SERVICES_DATA:
141 case EFI_CONVENTIONAL_MEMORY:
142 if (md->attribute & EFI_MEMORY_WB)
143 e820_type = E820_RAM;
144 else
145 e820_type = E820_RESERVED;
146 break;
147 case EFI_ACPI_RECLAIM_MEMORY:
148 e820_type = E820_ACPI;
149 break;
150 case EFI_ACPI_MEMORY_NVS:
151 e820_type = E820_NVS;
152 break;
153 case EFI_UNUSABLE_MEMORY:
154 e820_type = E820_UNUSABLE;
155 break;
156 default:
157 /*
158 * EFI_RESERVED_TYPE EFI_RUNTIME_SERVICES_CODE
159 * EFI_RUNTIME_SERVICES_DATA EFI_MEMORY_MAPPED_IO
160 * EFI_MEMORY_MAPPED_IO_PORT_SPACE EFI_PAL_CODE
161 */
69c91893 162 e820_type = E820_RESERVED;
e2a71476
CW
163 break;
164 }
d0be6bde 165 e820_add_region(start, size, e820_type);
69c91893
PJ
166 }
167 sanitize_e820_map(e820.map, ARRAY_SIZE(e820.map), &e820.nr_map);
168}
169
1adbfa35 170int __init efi_memblock_x86_reserve_range(void)
ecacf09f 171{
15b9c359 172 struct efi_info *e = &boot_params.efi_info;
ecacf09f
HY
173 unsigned long pmap;
174
9f27bc54
DK
175 if (efi_enabled(EFI_PARAVIRT))
176 return 0;
177
05486fa7 178#ifdef CONFIG_X86_32
1adbfa35 179 /* Can't handle data above 4GB at this time */
15b9c359 180 if (e->efi_memmap_hi) {
1adbfa35
OJ
181 pr_err("Memory map is above 4GB, disabling EFI.\n");
182 return -EINVAL;
183 }
15b9c359 184 pmap = e->efi_memmap;
05486fa7 185#else
15b9c359 186 pmap = (e->efi_memmap | ((__u64)e->efi_memmap_hi << 32));
ecacf09f 187#endif
15b9c359
BP
188 memmap.phys_map = (void *)pmap;
189 memmap.nr_map = e->efi_memmap_size /
190 e->efi_memdesc_size;
191 memmap.desc_size = e->efi_memdesc_size;
192 memmap.desc_version = e->efi_memdesc_version;
193
24aa0788 194 memblock_reserve(pmap, memmap.nr_map * memmap.desc_size);
1adbfa35 195
258f6fd7
LL
196 efi.memmap = &memmap;
197
1adbfa35 198 return 0;
ecacf09f
HY
199}
200
5b83683f
HY
201static void __init print_efi_memmap(void)
202{
f4fccac0 203#ifdef EFI_DEBUG
5b83683f
HY
204 efi_memory_desc_t *md;
205 void *p;
206 int i;
207
208 for (p = memmap.map, i = 0;
209 p < memmap.map_end;
210 p += memmap.desc_size, i++) {
ace1d121
LE
211 char buf[64];
212
5b83683f 213 md = p;
ace1d121
LE
214 pr_info("mem%02u: %s range=[0x%016llx-0x%016llx) (%lluMB)\n",
215 i, efi_md_typeattr_format(buf, sizeof(buf), md),
216 md->phys_addr,
5b83683f
HY
217 md->phys_addr + (md->num_pages << EFI_PAGE_SHIFT),
218 (md->num_pages >> (20 - EFI_PAGE_SHIFT)));
219 }
5b83683f 220#endif /* EFI_DEBUG */
f4fccac0 221}
5b83683f 222
5189c2a7 223void __init efi_unmap_memmap(void)
78510792 224{
3e909599 225 clear_bit(EFI_MEMMAP, &efi.flags);
78510792 226 if (memmap.map) {
abc93f8e 227 early_memunmap(memmap.map, memmap.nr_map * memmap.desc_size);
78510792
JT
228 memmap.map = NULL;
229 }
230}
231
140bf275 232static int __init efi_systab_init(void *phys)
5b83683f 233{
83e68189 234 if (efi_enabled(EFI_64BIT)) {
1adbfa35 235 efi_system_table_64_t *systab64;
1fec0533 236 struct efi_setup_data *data = NULL;
1adbfa35
OJ
237 u64 tmp = 0;
238
1fec0533
DY
239 if (efi_setup) {
240 data = early_memremap(efi_setup, sizeof(*data));
241 if (!data)
242 return -ENOMEM;
243 }
abc93f8e 244 systab64 = early_memremap((unsigned long)phys,
1adbfa35
OJ
245 sizeof(*systab64));
246 if (systab64 == NULL) {
247 pr_err("Couldn't map the system table!\n");
1fec0533 248 if (data)
abc93f8e 249 early_memunmap(data, sizeof(*data));
1adbfa35
OJ
250 return -ENOMEM;
251 }
252
253 efi_systab.hdr = systab64->hdr;
1fec0533
DY
254 efi_systab.fw_vendor = data ? (unsigned long)data->fw_vendor :
255 systab64->fw_vendor;
256 tmp |= data ? data->fw_vendor : systab64->fw_vendor;
1adbfa35
OJ
257 efi_systab.fw_revision = systab64->fw_revision;
258 efi_systab.con_in_handle = systab64->con_in_handle;
259 tmp |= systab64->con_in_handle;
260 efi_systab.con_in = systab64->con_in;
261 tmp |= systab64->con_in;
262 efi_systab.con_out_handle = systab64->con_out_handle;
263 tmp |= systab64->con_out_handle;
264 efi_systab.con_out = systab64->con_out;
265 tmp |= systab64->con_out;
266 efi_systab.stderr_handle = systab64->stderr_handle;
267 tmp |= systab64->stderr_handle;
268 efi_systab.stderr = systab64->stderr;
269 tmp |= systab64->stderr;
1fec0533
DY
270 efi_systab.runtime = data ?
271 (void *)(unsigned long)data->runtime :
272 (void *)(unsigned long)systab64->runtime;
273 tmp |= data ? data->runtime : systab64->runtime;
1adbfa35
OJ
274 efi_systab.boottime = (void *)(unsigned long)systab64->boottime;
275 tmp |= systab64->boottime;
276 efi_systab.nr_tables = systab64->nr_tables;
1fec0533
DY
277 efi_systab.tables = data ? (unsigned long)data->tables :
278 systab64->tables;
279 tmp |= data ? data->tables : systab64->tables;
1adbfa35 280
abc93f8e 281 early_memunmap(systab64, sizeof(*systab64));
1fec0533 282 if (data)
abc93f8e 283 early_memunmap(data, sizeof(*data));
1adbfa35
OJ
284#ifdef CONFIG_X86_32
285 if (tmp >> 32) {
286 pr_err("EFI data located above 4GB, disabling EFI.\n");
287 return -EINVAL;
288 }
289#endif
290 } else {
291 efi_system_table_32_t *systab32;
292
abc93f8e 293 systab32 = early_memremap((unsigned long)phys,
1adbfa35
OJ
294 sizeof(*systab32));
295 if (systab32 == NULL) {
296 pr_err("Couldn't map the system table!\n");
297 return -ENOMEM;
298 }
299
300 efi_systab.hdr = systab32->hdr;
301 efi_systab.fw_vendor = systab32->fw_vendor;
302 efi_systab.fw_revision = systab32->fw_revision;
303 efi_systab.con_in_handle = systab32->con_in_handle;
304 efi_systab.con_in = systab32->con_in;
305 efi_systab.con_out_handle = systab32->con_out_handle;
306 efi_systab.con_out = systab32->con_out;
307 efi_systab.stderr_handle = systab32->stderr_handle;
308 efi_systab.stderr = systab32->stderr;
309 efi_systab.runtime = (void *)(unsigned long)systab32->runtime;
310 efi_systab.boottime = (void *)(unsigned long)systab32->boottime;
311 efi_systab.nr_tables = systab32->nr_tables;
312 efi_systab.tables = systab32->tables;
313
abc93f8e 314 early_memunmap(systab32, sizeof(*systab32));
140bf275 315 }
1adbfa35 316
5b83683f
HY
317 efi.systab = &efi_systab;
318
319 /*
320 * Verify the EFI Table
321 */
140bf275 322 if (efi.systab->hdr.signature != EFI_SYSTEM_TABLE_SIGNATURE) {
e3cb3f5a 323 pr_err("System table signature incorrect!\n");
140bf275
OJ
324 return -EINVAL;
325 }
5b83683f 326 if ((efi.systab->hdr.revision >> 16) == 0)
9b7d2049 327 pr_err("Warning: System table version %d.%02d, expected 1.00 or greater!\n",
5b83683f
HY
328 efi.systab->hdr.revision >> 16,
329 efi.systab->hdr.revision & 0xffff);
140bf275 330
0f8093a9
MF
331 set_bit(EFI_SYSTEM_TABLES, &efi.flags);
332
140bf275 333 return 0;
83e7ee66 334}
5b83683f 335
4f9dbcfc 336static int __init efi_runtime_init32(void)
83e7ee66 337{
4f9dbcfc
MF
338 efi_runtime_services_32_t *runtime;
339
abc93f8e 340 runtime = early_memremap((unsigned long)efi.systab->runtime,
4f9dbcfc
MF
341 sizeof(efi_runtime_services_32_t));
342 if (!runtime) {
343 pr_err("Could not map the runtime service table!\n");
344 return -ENOMEM;
345 }
5b83683f
HY
346
347 /*
0ce4605c
MK
348 * We will only need *early* access to the SetVirtualAddressMap
349 * EFI runtime service. All other runtime services will be called
350 * via the virtual mapping.
5b83683f 351 */
4f9dbcfc
MF
352 efi_phys.set_virtual_address_map =
353 (efi_set_virtual_address_map_t *)
354 (unsigned long)runtime->set_virtual_address_map;
abc93f8e 355 early_memunmap(runtime, sizeof(efi_runtime_services_32_t));
4f9dbcfc
MF
356
357 return 0;
358}
359
360static int __init efi_runtime_init64(void)
361{
362 efi_runtime_services_64_t *runtime;
363
abc93f8e 364 runtime = early_memremap((unsigned long)efi.systab->runtime,
4f9dbcfc 365 sizeof(efi_runtime_services_64_t));
140bf275 366 if (!runtime) {
e3cb3f5a 367 pr_err("Could not map the runtime service table!\n");
140bf275
OJ
368 return -ENOMEM;
369 }
4f9dbcfc 370
140bf275 371 /*
0ce4605c
MK
372 * We will only need *early* access to the SetVirtualAddressMap
373 * EFI runtime service. All other runtime services will be called
374 * via the virtual mapping.
140bf275 375 */
140bf275 376 efi_phys.set_virtual_address_map =
4f9dbcfc
MF
377 (efi_set_virtual_address_map_t *)
378 (unsigned long)runtime->set_virtual_address_map;
abc93f8e 379 early_memunmap(runtime, sizeof(efi_runtime_services_64_t));
4f9dbcfc
MF
380
381 return 0;
382}
383
384static int __init efi_runtime_init(void)
385{
386 int rv;
387
388 /*
389 * Check out the runtime services table. We need to map
390 * the runtime services table so that we can grab the physical
391 * address of several of the EFI runtime functions, needed to
392 * set the firmware into virtual mode.
9f27bc54
DK
393 *
394 * When EFI_PARAVIRT is in force then we could not map runtime
395 * service memory region because we do not have direct access to it.
396 * However, runtime services are available through proxy functions
397 * (e.g. in case of Xen dom0 EFI implementation they call special
398 * hypercall which executes relevant EFI functions) and that is why
399 * they are always enabled.
4f9dbcfc 400 */
4f9dbcfc 401
9f27bc54
DK
402 if (!efi_enabled(EFI_PARAVIRT)) {
403 if (efi_enabled(EFI_64BIT))
404 rv = efi_runtime_init64();
405 else
406 rv = efi_runtime_init32();
407
408 if (rv)
409 return rv;
410 }
140bf275 411
0f8093a9
MF
412 set_bit(EFI_RUNTIME_SERVICES, &efi.flags);
413
140bf275 414 return 0;
83e7ee66 415}
5b83683f 416
140bf275 417static int __init efi_memmap_init(void)
83e7ee66 418{
9f27bc54
DK
419 if (efi_enabled(EFI_PARAVIRT))
420 return 0;
421
5b83683f 422 /* Map the EFI memory map */
abc93f8e 423 memmap.map = early_memremap((unsigned long)memmap.phys_map,
beacfaac 424 memmap.nr_map * memmap.desc_size);
140bf275 425 if (memmap.map == NULL) {
e3cb3f5a 426 pr_err("Could not map the memory map!\n");
140bf275
OJ
427 return -ENOMEM;
428 }
5b83683f 429 memmap.map_end = memmap.map + (memmap.nr_map * memmap.desc_size);
175e438f 430
200001eb
PJ
431 if (add_efi_memmap)
432 do_add_efi_memmap();
140bf275 433
0f8093a9
MF
434 set_bit(EFI_MEMMAP, &efi.flags);
435
140bf275 436 return 0;
83e7ee66
OJ
437}
438
439void __init efi_init(void)
440{
441 efi_char16_t *c16;
442 char vendor[100] = "unknown";
443 int i = 0;
444 void *tmp;
445
446#ifdef CONFIG_X86_32
1adbfa35
OJ
447 if (boot_params.efi_info.efi_systab_hi ||
448 boot_params.efi_info.efi_memmap_hi) {
449 pr_info("Table located above 4GB, disabling EFI.\n");
1adbfa35
OJ
450 return;
451 }
83e7ee66
OJ
452 efi_phys.systab = (efi_system_table_t *)boot_params.efi_info.efi_systab;
453#else
454 efi_phys.systab = (efi_system_table_t *)
1adbfa35
OJ
455 (boot_params.efi_info.efi_systab |
456 ((__u64)boot_params.efi_info.efi_systab_hi<<32));
83e7ee66
OJ
457#endif
458
83e68189 459 if (efi_systab_init(efi_phys.systab))
140bf275 460 return;
83e68189 461
a0998eb1
DY
462 efi.config_table = (unsigned long)efi.systab->tables;
463 efi.fw_vendor = (unsigned long)efi.systab->fw_vendor;
464 efi.runtime = (unsigned long)efi.systab->runtime;
465
83e7ee66
OJ
466 /*
467 * Show what we know for posterity
468 */
abc93f8e 469 c16 = tmp = early_memremap(efi.systab->fw_vendor, 2);
83e7ee66
OJ
470 if (c16) {
471 for (i = 0; i < sizeof(vendor) - 1 && *c16; ++i)
472 vendor[i] = *c16++;
473 vendor[i] = '\0';
474 } else
e3cb3f5a 475 pr_err("Could not map the firmware vendor!\n");
abc93f8e 476 early_memunmap(tmp, 2);
83e7ee66 477
e3cb3f5a
OJ
478 pr_info("EFI v%u.%.02u by %s\n",
479 efi.systab->hdr.revision >> 16,
480 efi.systab->hdr.revision & 0xffff, vendor);
83e7ee66 481
1fec0533
DY
482 if (efi_reuse_config(efi.systab->tables, efi.systab->nr_tables))
483 return;
484
272686bf 485 if (efi_config_init(arch_tables))
140bf275 486 return;
83e68189 487
1adbfa35
OJ
488 /*
489 * Note: We currently don't support runtime services on an EFI
490 * that doesn't match the kernel 32/64-bit mode.
491 */
492
7d453eee 493 if (!efi_runtime_supported())
1adbfa35 494 pr_info("No EFI runtime due to 32/64-bit mismatch with kernel\n");
83e68189 495 else {
b2e0a54a 496 if (efi_runtime_disabled() || efi_runtime_init())
83e68189 497 return;
140bf275 498 }
83e68189 499 if (efi_memmap_init())
140bf275 500 return;
83e68189 501
fed6cefe
BP
502 if (efi_enabled(EFI_DBG))
503 print_efi_memmap();
5b83683f
HY
504}
505
2223af38
JT
506void __init efi_late_init(void)
507{
508 efi_bgrt_init();
509}
510
9cd2b07c
MG
511void __init efi_set_executable(efi_memory_desc_t *md, bool executable)
512{
513 u64 addr, npages;
514
515 addr = md->virt_addr;
516 npages = md->num_pages;
517
518 memrange_efi_to_native(&addr, &npages);
519
520 if (executable)
521 set_memory_x(addr, npages);
522 else
523 set_memory_nx(addr, npages);
524}
525
c55d016f 526void __init runtime_code_page_mkexec(void)
a2172e25
HY
527{
528 efi_memory_desc_t *md;
a2172e25
HY
529 void *p;
530
a2172e25
HY
531 /* Make EFI runtime service code area executable */
532 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
533 md = p;
1c083eb2
HY
534
535 if (md->type != EFI_RUNTIME_SERVICES_CODE)
536 continue;
537
9cd2b07c 538 efi_set_executable(md, true);
a2172e25 539 }
a2172e25 540}
a2172e25 541
4e78eb05 542void __init efi_memory_uc(u64 addr, unsigned long size)
3e8fa263
MF
543{
544 unsigned long page_shift = 1UL << EFI_PAGE_SHIFT;
545 u64 npages;
546
547 npages = round_up(size, page_shift) / page_shift;
548 memrange_efi_to_native(&addr, &npages);
549 set_memory_uc(addr, npages);
550}
551
d2f7cbe7
BP
552void __init old_map_region(efi_memory_desc_t *md)
553{
554 u64 start_pfn, end_pfn, end;
555 unsigned long size;
556 void *va;
557
558 start_pfn = PFN_DOWN(md->phys_addr);
559 size = md->num_pages << PAGE_SHIFT;
560 end = md->phys_addr + size;
561 end_pfn = PFN_UP(end);
562
563 if (pfn_range_is_mapped(start_pfn, end_pfn)) {
564 va = __va(md->phys_addr);
565
566 if (!(md->attribute & EFI_MEMORY_WB))
567 efi_memory_uc((u64)(unsigned long)va, size);
568 } else
569 va = efi_ioremap(md->phys_addr, size,
570 md->type, md->attribute);
571
572 md->virt_addr = (u64) (unsigned long) va;
573 if (!va)
574 pr_err("ioremap of 0x%llX failed!\n",
575 (unsigned long long)md->phys_addr);
576}
577
481f75c0
DY
578/* Merge contiguous regions of the same type and attribute */
579static void __init efi_merge_regions(void)
5b83683f 580{
481f75c0 581 void *p;
202f9d0a 582 efi_memory_desc_t *md, *prev_md = NULL;
202f9d0a 583
202f9d0a
MG
584 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
585 u64 prev_size;
586 md = p;
587
588 if (!prev_md) {
589 prev_md = md;
590 continue;
591 }
592
593 if (prev_md->type != md->type ||
594 prev_md->attribute != md->attribute) {
595 prev_md = md;
596 continue;
597 }
598
599 prev_size = prev_md->num_pages << EFI_PAGE_SHIFT;
600
601 if (md->phys_addr == (prev_md->phys_addr + prev_size)) {
602 prev_md->num_pages += md->num_pages;
603 md->type = EFI_RESERVED_TYPE;
604 md->attribute = 0;
605 continue;
606 }
607 prev_md = md;
481f75c0
DY
608 }
609}
610
611static void __init get_systab_virt_addr(efi_memory_desc_t *md)
612{
613 unsigned long size;
614 u64 end, systab;
d2f7cbe7 615
481f75c0
DY
616 size = md->num_pages << EFI_PAGE_SHIFT;
617 end = md->phys_addr + size;
618 systab = (u64)(unsigned long)efi_phys.systab;
619 if (md->phys_addr <= systab && systab < end) {
620 systab += md->virt_addr - md->phys_addr;
621 efi.systab = (efi_system_table_t *)(unsigned long)systab;
202f9d0a 622 }
481f75c0
DY
623}
624
fabb37c7 625static void __init save_runtime_map(void)
926172d4 626{
fabb37c7 627#ifdef CONFIG_KEXEC
926172d4
DY
628 efi_memory_desc_t *md;
629 void *tmp, *p, *q = NULL;
630 int count = 0;
631
a3530e8f
DY
632 if (efi_enabled(EFI_OLD_MEMMAP))
633 return;
634
926172d4
DY
635 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
636 md = p;
637
638 if (!(md->attribute & EFI_MEMORY_RUNTIME) ||
639 (md->type == EFI_BOOT_SERVICES_CODE) ||
640 (md->type == EFI_BOOT_SERVICES_DATA))
641 continue;
642 tmp = krealloc(q, (count + 1) * memmap.desc_size, GFP_KERNEL);
643 if (!tmp)
644 goto out;
645 q = tmp;
646
647 memcpy(q + count * memmap.desc_size, md, memmap.desc_size);
648 count++;
649 }
650
518548ab 651 efi_runtime_map_setup(q, count, memmap.desc_size);
fabb37c7 652 return;
926172d4 653
926172d4
DY
654out:
655 kfree(q);
fabb37c7
BP
656 pr_err("Error saving runtime map, efi runtime on kexec non-functional!!\n");
657#endif
1fec0533
DY
658}
659
b7b898ae
BP
660static void *realloc_pages(void *old_memmap, int old_shift)
661{
662 void *ret;
663
664 ret = (void *)__get_free_pages(GFP_KERNEL, old_shift + 1);
665 if (!ret)
666 goto out;
667
668 /*
669 * A first-time allocation doesn't have anything to copy.
670 */
671 if (!old_memmap)
672 return ret;
673
674 memcpy(ret, old_memmap, PAGE_SIZE << old_shift);
675
676out:
677 free_pages((unsigned long)old_memmap, old_shift);
678 return ret;
679}
680
481f75c0 681/*
b7b898ae
BP
682 * Map the efi memory ranges of the runtime services and update new_mmap with
683 * virtual addresses.
481f75c0 684 */
b7b898ae 685static void * __init efi_map_regions(int *count, int *pg_shift)
481f75c0 686{
b7b898ae
BP
687 void *p, *new_memmap = NULL;
688 unsigned long left = 0;
481f75c0 689 efi_memory_desc_t *md;
202f9d0a 690
5b83683f
HY
691 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
692 md = p;
70087011
JB
693 if (!(md->attribute & EFI_MEMORY_RUNTIME)) {
694#ifdef CONFIG_X86_64
695 if (md->type != EFI_BOOT_SERVICES_CODE &&
696 md->type != EFI_BOOT_SERVICES_DATA)
697#endif
698 continue;
699 }
1c083eb2 700
d2f7cbe7 701 efi_map_region(md);
481f75c0
DY
702 get_systab_virt_addr(md);
703
b7b898ae
BP
704 if (left < memmap.desc_size) {
705 new_memmap = realloc_pages(new_memmap, *pg_shift);
706 if (!new_memmap)
707 return NULL;
708
709 left += PAGE_SIZE << *pg_shift;
710 (*pg_shift)++;
711 }
712
481f75c0
DY
713 memcpy(new_memmap + (*count * memmap.desc_size), md,
714 memmap.desc_size);
b7b898ae
BP
715
716 left -= memmap.desc_size;
481f75c0
DY
717 (*count)++;
718 }
d2f7cbe7 719
481f75c0 720 return new_memmap;
481f75c0
DY
721}
722
fabb37c7
BP
723static void __init kexec_enter_virtual_mode(void)
724{
725#ifdef CONFIG_KEXEC
726 efi_memory_desc_t *md;
727 void *p;
728
729 efi.systab = NULL;
730
731 /*
732 * We don't do virtual mode, since we don't do runtime services, on
733 * non-native EFI
734 */
735 if (!efi_is_native()) {
736 efi_unmap_memmap();
a5a750a9 737 clear_bit(EFI_RUNTIME_SERVICES, &efi.flags);
fabb37c7
BP
738 return;
739 }
740
741 /*
742 * Map efi regions which were passed via setup_data. The virt_addr is a
743 * fixed addr which was used in first kernel of a kexec boot.
744 */
745 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
746 md = p;
747 efi_map_region_fixed(md); /* FIXME: add error handling */
748 get_systab_virt_addr(md);
749 }
750
751 save_runtime_map();
752
753 BUG_ON(!efi.systab);
754
755 efi_sync_low_kernel_mappings();
756
757 /*
758 * Now that EFI is in virtual mode, update the function
759 * pointers in the runtime service table to the new virtual addresses.
760 *
761 * Call EFI services through wrapper functions.
762 */
763 efi.runtime_version = efi_systab.hdr.revision;
994448f1 764
022ee6c5 765 efi_native_runtime_setup();
994448f1 766
fabb37c7 767 efi.set_virtual_address_map = NULL;
fabb37c7
BP
768
769 if (efi_enabled(EFI_OLD_MEMMAP) && (__supported_pte_mask & _PAGE_NX))
770 runtime_code_page_mkexec();
771
772 /* clean DUMMY object */
eeb9db09 773 efi_delete_dummy_variable();
fabb37c7
BP
774#endif
775}
776
481f75c0
DY
777/*
778 * This function will switch the EFI runtime services to virtual mode.
779 * Essentially, we look through the EFI memmap and map every region that
780 * has the runtime attribute bit set in its memory descriptor into the
781 * ->trampoline_pgd page table using a top-down VA allocation scheme.
782 *
783 * The old method which used to update that memory descriptor with the
784 * virtual address obtained from ioremap() is still supported when the
785 * kernel is booted with efi=old_map on its command line. Same old
786 * method enabled the runtime services to be called without having to
787 * thunk back into physical mode for every invocation.
788 *
789 * The new method does a pagetable switch in a preemption-safe manner
790 * so that we're in a different address space when calling a runtime
791 * function. For function arguments passing we do copy the PGDs of the
792 * kernel page table into ->trampoline_pgd prior to each call.
1fec0533
DY
793 *
794 * Specially for kexec boot, efi runtime maps in previous kernel should
795 * be passed in via setup_data. In that case runtime ranges will be mapped
fabb37c7
BP
796 * to the same virtual addresses as the first kernel, see
797 * kexec_enter_virtual_mode().
481f75c0 798 */
fabb37c7 799static void __init __efi_enter_virtual_mode(void)
481f75c0 800{
fabb37c7 801 int count = 0, pg_shift = 0;
481f75c0 802 void *new_memmap = NULL;
b7b898ae 803 efi_status_t status;
1c083eb2 804
481f75c0 805 efi.systab = NULL;
d2f7cbe7 806
fabb37c7
BP
807 efi_merge_regions();
808 new_memmap = efi_map_regions(&count, &pg_shift);
809 if (!new_memmap) {
810 pr_err("Error reallocating memory, EFI runtime non-functional!\n");
a5a750a9 811 clear_bit(EFI_RUNTIME_SERVICES, &efi.flags);
fabb37c7 812 return;
b7b898ae 813 }
926172d4 814
fabb37c7
BP
815 save_runtime_map();
816
5b83683f
HY
817 BUG_ON(!efi.systab);
818
a5a750a9
DY
819 if (efi_setup_page_tables(__pa(new_memmap), 1 << pg_shift)) {
820 clear_bit(EFI_RUNTIME_SERVICES, &efi.flags);
fabb37c7 821 return;
a5a750a9 822 }
b7b898ae 823
d2f7cbe7 824 efi_sync_low_kernel_mappings();
11cc8512 825 efi_dump_pagetable();
d2f7cbe7 826
994448f1
MF
827 if (efi_is_native()) {
828 status = phys_efi_set_virtual_address_map(
829 memmap.desc_size * count,
830 memmap.desc_size,
831 memmap.desc_version,
832 (efi_memory_desc_t *)__pa(new_memmap));
833 } else {
834 status = efi_thunk_set_virtual_address_map(
835 efi_phys.set_virtual_address_map,
836 memmap.desc_size * count,
837 memmap.desc_size,
838 memmap.desc_version,
839 (efi_memory_desc_t *)__pa(new_memmap));
840 }
1fec0533 841
fabb37c7
BP
842 if (status != EFI_SUCCESS) {
843 pr_alert("Unable to switch EFI into virtual mode (status=%lx)!\n",
844 status);
845 panic("EFI call to SetVirtualAddressMap() failed!");
5b83683f
HY
846 }
847
848 /*
849 * Now that EFI is in virtual mode, update the function
850 * pointers in the runtime service table to the new virtual addresses.
851 *
852 * Call EFI services through wrapper functions.
853 */
712ba9e9 854 efi.runtime_version = efi_systab.hdr.revision;
4f9dbcfc
MF
855
856 if (efi_is_native())
022ee6c5 857 efi_native_runtime_setup();
4f9dbcfc
MF
858 else
859 efi_thunk_runtime_setup();
860
2b5e8ef3 861 efi.set_virtual_address_map = NULL;
d2f7cbe7 862
c55d016f 863 efi_runtime_mkexec();
1adbfa35 864
b7b898ae
BP
865 /*
866 * We mapped the descriptor array into the EFI pagetable above but we're
867 * not unmapping it here. Here's why:
868 *
869 * We're copying select PGDs from the kernel page table to the EFI page
870 * table and when we do so and make changes to those PGDs like unmapping
871 * stuff from them, those changes appear in the kernel page table and we
872 * go boom.
873 *
874 * From setup_real_mode():
875 *
876 * ...
877 * trampoline_pgd[0] = init_level4_pgt[pgd_index(__PAGE_OFFSET)].pgd;
878 *
879 * In this particular case, our allocation is in PGD 0 of the EFI page
880 * table but we've copied that PGD from PGD[272] of the EFI page table:
881 *
882 * pgd_index(__PAGE_OFFSET = 0xffff880000000000) = 272
883 *
884 * where the direct memory mapping in kernel space is.
885 *
886 * new_memmap's VA comes from that direct mapping and thus clearing it,
887 * it would get cleared in the kernel page table too.
888 *
889 * efi_cleanup_page_tables(__pa(new_memmap), 1 << pg_shift);
890 */
fabb37c7 891 free_pages((unsigned long)new_memmap, pg_shift);
f8b84043
MG
892
893 /* clean DUMMY object */
eeb9db09 894 efi_delete_dummy_variable();
5b83683f
HY
895}
896
fabb37c7
BP
897void __init efi_enter_virtual_mode(void)
898{
9f27bc54
DK
899 if (efi_enabled(EFI_PARAVIRT))
900 return;
901
fabb37c7
BP
902 if (efi_setup)
903 kexec_enter_virtual_mode();
904 else
905 __efi_enter_virtual_mode();
906}
907
5b83683f
HY
908/*
909 * Convenience functions to obtain memory types and attributes
910 */
911u32 efi_mem_type(unsigned long phys_addr)
912{
913 efi_memory_desc_t *md;
914 void *p;
915
83e68189
MF
916 if (!efi_enabled(EFI_MEMMAP))
917 return 0;
918
5b83683f
HY
919 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
920 md = p;
921 if ((md->phys_addr <= phys_addr) &&
922 (phys_addr < (md->phys_addr +
923 (md->num_pages << EFI_PAGE_SHIFT))))
924 return md->type;
925 }
926 return 0;
927}
928
929u64 efi_mem_attributes(unsigned long phys_addr)
930{
931 efi_memory_desc_t *md;
932 void *p;
933
67a9b9c5
DK
934 if (!efi_enabled(EFI_MEMMAP))
935 return 0;
936
5b83683f
HY
937 for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
938 md = p;
939 if ((md->phys_addr <= phys_addr) &&
940 (phys_addr < (md->phys_addr +
941 (md->num_pages << EFI_PAGE_SHIFT))))
942 return md->attribute;
943 }
944 return 0;
945}
a6e4d5a0 946
5ae3683c 947static int __init arch_parse_efi_cmdline(char *str)
d2f7cbe7 948{
6ccc72b8
DY
949 if (parse_option_str(str, "old_map"))
950 set_bit(EFI_OLD_MEMMAP, &efi.flags);
fed6cefe
BP
951 if (parse_option_str(str, "debug"))
952 set_bit(EFI_DBG, &efi.flags);
d2f7cbe7
BP
953
954 return 0;
955}
5ae3683c 956early_param("efi", arch_parse_efi_cmdline);