efi: Defer freeing boot services memory until after ACPI init
[linux-3.10.git] / arch / x86 / platform / efi / efi.c
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>
15  *
16  * Copied from efi_32.c to eliminate the duplicated code between EFI
17  * 32/64 support code. --ying 2007-10-26
18  *
19  * All EFI Runtime Services are not implemented yet as EFI only
20  * supports physical mode addressing on SoftSDV. This is to be fixed
21  * in a future version.  --drummond 1999-07-20
22  *
23  * Implemented EFI runtime services and virtual mode calls.  --davidm
24  *
25  * Goutham Rao: <goutham.rao@intel.com>
26  *      Skip non-WB memory and ignore empty memory ranges.
27  */
28
29 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
30
31 #include <linux/kernel.h>
32 #include <linux/init.h>
33 #include <linux/efi.h>
34 #include <linux/export.h>
35 #include <linux/bootmem.h>
36 #include <linux/memblock.h>
37 #include <linux/spinlock.h>
38 #include <linux/uaccess.h>
39 #include <linux/time.h>
40 #include <linux/io.h>
41 #include <linux/reboot.h>
42 #include <linux/bcd.h>
43
44 #include <asm/setup.h>
45 #include <asm/efi.h>
46 #include <asm/time.h>
47 #include <asm/cacheflush.h>
48 #include <asm/tlbflush.h>
49 #include <asm/x86_init.h>
50
51 #define EFI_DEBUG       1
52
53 int efi_enabled;
54 EXPORT_SYMBOL(efi_enabled);
55
56 struct efi __read_mostly efi = {
57         .mps        = EFI_INVALID_TABLE_ADDR,
58         .acpi       = EFI_INVALID_TABLE_ADDR,
59         .acpi20     = EFI_INVALID_TABLE_ADDR,
60         .smbios     = EFI_INVALID_TABLE_ADDR,
61         .sal_systab = EFI_INVALID_TABLE_ADDR,
62         .boot_info  = EFI_INVALID_TABLE_ADDR,
63         .hcdp       = EFI_INVALID_TABLE_ADDR,
64         .uga        = EFI_INVALID_TABLE_ADDR,
65         .uv_systab  = EFI_INVALID_TABLE_ADDR,
66 };
67 EXPORT_SYMBOL(efi);
68
69 struct efi_memory_map memmap;
70
71 bool efi_64bit;
72 static bool efi_native;
73
74 static struct efi efi_phys __initdata;
75 static efi_system_table_t efi_systab __initdata;
76
77 static int __init setup_noefi(char *arg)
78 {
79         efi_enabled = 0;
80         return 0;
81 }
82 early_param("noefi", setup_noefi);
83
84 int add_efi_memmap;
85 EXPORT_SYMBOL(add_efi_memmap);
86
87 static int __init setup_add_efi_memmap(char *arg)
88 {
89         add_efi_memmap = 1;
90         return 0;
91 }
92 early_param("add_efi_memmap", setup_add_efi_memmap);
93
94
95 static efi_status_t virt_efi_get_time(efi_time_t *tm, efi_time_cap_t *tc)
96 {
97         unsigned long flags;
98         efi_status_t status;
99
100         spin_lock_irqsave(&rtc_lock, flags);
101         status = efi_call_virt2(get_time, tm, tc);
102         spin_unlock_irqrestore(&rtc_lock, flags);
103         return status;
104 }
105
106 static efi_status_t virt_efi_set_time(efi_time_t *tm)
107 {
108         unsigned long flags;
109         efi_status_t status;
110
111         spin_lock_irqsave(&rtc_lock, flags);
112         status = efi_call_virt1(set_time, tm);
113         spin_unlock_irqrestore(&rtc_lock, flags);
114         return status;
115 }
116
117 static efi_status_t virt_efi_get_wakeup_time(efi_bool_t *enabled,
118                                              efi_bool_t *pending,
119                                              efi_time_t *tm)
120 {
121         unsigned long flags;
122         efi_status_t status;
123
124         spin_lock_irqsave(&rtc_lock, flags);
125         status = efi_call_virt3(get_wakeup_time,
126                                 enabled, pending, tm);
127         spin_unlock_irqrestore(&rtc_lock, flags);
128         return status;
129 }
130
131 static efi_status_t virt_efi_set_wakeup_time(efi_bool_t enabled, efi_time_t *tm)
132 {
133         unsigned long flags;
134         efi_status_t status;
135
136         spin_lock_irqsave(&rtc_lock, flags);
137         status = efi_call_virt2(set_wakeup_time,
138                                 enabled, tm);
139         spin_unlock_irqrestore(&rtc_lock, flags);
140         return status;
141 }
142
143 static efi_status_t virt_efi_get_variable(efi_char16_t *name,
144                                           efi_guid_t *vendor,
145                                           u32 *attr,
146                                           unsigned long *data_size,
147                                           void *data)
148 {
149         return efi_call_virt5(get_variable,
150                               name, vendor, attr,
151                               data_size, data);
152 }
153
154 static efi_status_t virt_efi_get_next_variable(unsigned long *name_size,
155                                                efi_char16_t *name,
156                                                efi_guid_t *vendor)
157 {
158         return efi_call_virt3(get_next_variable,
159                               name_size, name, vendor);
160 }
161
162 static efi_status_t virt_efi_set_variable(efi_char16_t *name,
163                                           efi_guid_t *vendor,
164                                           u32 attr,
165                                           unsigned long data_size,
166                                           void *data)
167 {
168         return efi_call_virt5(set_variable,
169                               name, vendor, attr,
170                               data_size, data);
171 }
172
173 static efi_status_t virt_efi_query_variable_info(u32 attr,
174                                                  u64 *storage_space,
175                                                  u64 *remaining_space,
176                                                  u64 *max_variable_size)
177 {
178         if (efi.runtime_version < EFI_2_00_SYSTEM_TABLE_REVISION)
179                 return EFI_UNSUPPORTED;
180
181         return efi_call_virt4(query_variable_info, attr, storage_space,
182                               remaining_space, max_variable_size);
183 }
184
185 static efi_status_t virt_efi_get_next_high_mono_count(u32 *count)
186 {
187         return efi_call_virt1(get_next_high_mono_count, count);
188 }
189
190 static void virt_efi_reset_system(int reset_type,
191                                   efi_status_t status,
192                                   unsigned long data_size,
193                                   efi_char16_t *data)
194 {
195         efi_call_virt4(reset_system, reset_type, status,
196                        data_size, data);
197 }
198
199 static efi_status_t virt_efi_update_capsule(efi_capsule_header_t **capsules,
200                                             unsigned long count,
201                                             unsigned long sg_list)
202 {
203         if (efi.runtime_version < EFI_2_00_SYSTEM_TABLE_REVISION)
204                 return EFI_UNSUPPORTED;
205
206         return efi_call_virt3(update_capsule, capsules, count, sg_list);
207 }
208
209 static efi_status_t virt_efi_query_capsule_caps(efi_capsule_header_t **capsules,
210                                                 unsigned long count,
211                                                 u64 *max_size,
212                                                 int *reset_type)
213 {
214         if (efi.runtime_version < EFI_2_00_SYSTEM_TABLE_REVISION)
215                 return EFI_UNSUPPORTED;
216
217         return efi_call_virt4(query_capsule_caps, capsules, count, max_size,
218                               reset_type);
219 }
220
221 static efi_status_t __init phys_efi_set_virtual_address_map(
222         unsigned long memory_map_size,
223         unsigned long descriptor_size,
224         u32 descriptor_version,
225         efi_memory_desc_t *virtual_map)
226 {
227         efi_status_t status;
228
229         efi_call_phys_prelog();
230         status = efi_call_phys4(efi_phys.set_virtual_address_map,
231                                 memory_map_size, descriptor_size,
232                                 descriptor_version, virtual_map);
233         efi_call_phys_epilog();
234         return status;
235 }
236
237 static efi_status_t __init phys_efi_get_time(efi_time_t *tm,
238                                              efi_time_cap_t *tc)
239 {
240         unsigned long flags;
241         efi_status_t status;
242
243         spin_lock_irqsave(&rtc_lock, flags);
244         efi_call_phys_prelog();
245         status = efi_call_phys2(efi_phys.get_time, virt_to_phys(tm),
246                                 virt_to_phys(tc));
247         efi_call_phys_epilog();
248         spin_unlock_irqrestore(&rtc_lock, flags);
249         return status;
250 }
251
252 int efi_set_rtc_mmss(unsigned long nowtime)
253 {
254         int real_seconds, real_minutes;
255         efi_status_t    status;
256         efi_time_t      eft;
257         efi_time_cap_t  cap;
258
259         status = efi.get_time(&eft, &cap);
260         if (status != EFI_SUCCESS) {
261                 pr_err("Oops: efitime: can't read time!\n");
262                 return -1;
263         }
264
265         real_seconds = nowtime % 60;
266         real_minutes = nowtime / 60;
267         if (((abs(real_minutes - eft.minute) + 15)/30) & 1)
268                 real_minutes += 30;
269         real_minutes %= 60;
270         eft.minute = real_minutes;
271         eft.second = real_seconds;
272
273         status = efi.set_time(&eft);
274         if (status != EFI_SUCCESS) {
275                 pr_err("Oops: efitime: can't write time!\n");
276                 return -1;
277         }
278         return 0;
279 }
280
281 unsigned long efi_get_time(void)
282 {
283         efi_status_t status;
284         efi_time_t eft;
285         efi_time_cap_t cap;
286
287         status = efi.get_time(&eft, &cap);
288         if (status != EFI_SUCCESS)
289                 pr_err("Oops: efitime: can't read time!\n");
290
291         return mktime(eft.year, eft.month, eft.day, eft.hour,
292                       eft.minute, eft.second);
293 }
294
295 /*
296  * Tell the kernel about the EFI memory map.  This might include
297  * more than the max 128 entries that can fit in the e820 legacy
298  * (zeropage) memory map.
299  */
300
301 static void __init do_add_efi_memmap(void)
302 {
303         void *p;
304
305         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
306                 efi_memory_desc_t *md = p;
307                 unsigned long long start = md->phys_addr;
308                 unsigned long long size = md->num_pages << EFI_PAGE_SHIFT;
309                 int e820_type;
310
311                 switch (md->type) {
312                 case EFI_LOADER_CODE:
313                 case EFI_LOADER_DATA:
314                 case EFI_BOOT_SERVICES_CODE:
315                 case EFI_BOOT_SERVICES_DATA:
316                 case EFI_CONVENTIONAL_MEMORY:
317                         if (md->attribute & EFI_MEMORY_WB)
318                                 e820_type = E820_RAM;
319                         else
320                                 e820_type = E820_RESERVED;
321                         break;
322                 case EFI_ACPI_RECLAIM_MEMORY:
323                         e820_type = E820_ACPI;
324                         break;
325                 case EFI_ACPI_MEMORY_NVS:
326                         e820_type = E820_NVS;
327                         break;
328                 case EFI_UNUSABLE_MEMORY:
329                         e820_type = E820_UNUSABLE;
330                         break;
331                 default:
332                         /*
333                          * EFI_RESERVED_TYPE EFI_RUNTIME_SERVICES_CODE
334                          * EFI_RUNTIME_SERVICES_DATA EFI_MEMORY_MAPPED_IO
335                          * EFI_MEMORY_MAPPED_IO_PORT_SPACE EFI_PAL_CODE
336                          */
337                         e820_type = E820_RESERVED;
338                         break;
339                 }
340                 e820_add_region(start, size, e820_type);
341         }
342         sanitize_e820_map(e820.map, ARRAY_SIZE(e820.map), &e820.nr_map);
343 }
344
345 int __init efi_memblock_x86_reserve_range(void)
346 {
347         unsigned long pmap;
348
349 #ifdef CONFIG_X86_32
350         /* Can't handle data above 4GB at this time */
351         if (boot_params.efi_info.efi_memmap_hi) {
352                 pr_err("Memory map is above 4GB, disabling EFI.\n");
353                 return -EINVAL;
354         }
355         pmap = boot_params.efi_info.efi_memmap;
356 #else
357         pmap = (boot_params.efi_info.efi_memmap |
358                 ((__u64)boot_params.efi_info.efi_memmap_hi<<32));
359 #endif
360         memmap.phys_map = (void *)pmap;
361         memmap.nr_map = boot_params.efi_info.efi_memmap_size /
362                 boot_params.efi_info.efi_memdesc_size;
363         memmap.desc_version = boot_params.efi_info.efi_memdesc_version;
364         memmap.desc_size = boot_params.efi_info.efi_memdesc_size;
365         memblock_reserve(pmap, memmap.nr_map * memmap.desc_size);
366
367         return 0;
368 }
369
370 #if EFI_DEBUG
371 static void __init print_efi_memmap(void)
372 {
373         efi_memory_desc_t *md;
374         void *p;
375         int i;
376
377         for (p = memmap.map, i = 0;
378              p < memmap.map_end;
379              p += memmap.desc_size, i++) {
380                 md = p;
381                 pr_info("mem%02u: type=%u, attr=0x%llx, "
382                         "range=[0x%016llx-0x%016llx) (%lluMB)\n",
383                         i, md->type, md->attribute, md->phys_addr,
384                         md->phys_addr + (md->num_pages << EFI_PAGE_SHIFT),
385                         (md->num_pages >> (20 - EFI_PAGE_SHIFT)));
386         }
387 }
388 #endif  /*  EFI_DEBUG  */
389
390 void __init efi_reserve_boot_services(void)
391 {
392         void *p;
393
394         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
395                 efi_memory_desc_t *md = p;
396                 u64 start = md->phys_addr;
397                 u64 size = md->num_pages << EFI_PAGE_SHIFT;
398
399                 if (md->type != EFI_BOOT_SERVICES_CODE &&
400                     md->type != EFI_BOOT_SERVICES_DATA)
401                         continue;
402                 /* Only reserve where possible:
403                  * - Not within any already allocated areas
404                  * - Not over any memory area (really needed, if above?)
405                  * - Not within any part of the kernel
406                  * - Not the bios reserved area
407                 */
408                 if ((start+size >= virt_to_phys(_text)
409                                 && start <= virt_to_phys(_end)) ||
410                         !e820_all_mapped(start, start+size, E820_RAM) ||
411                         memblock_is_region_reserved(start, size)) {
412                         /* Could not reserve, skip it */
413                         md->num_pages = 0;
414                         memblock_dbg("Could not reserve boot range "
415                                         "[0x%010llx-0x%010llx]\n",
416                                                 start, start+size-1);
417                 } else
418                         memblock_reserve(start, size);
419         }
420 }
421
422 static void __init efi_unmap_memmap(void)
423 {
424         if (memmap.map) {
425                 early_iounmap(memmap.map, memmap.nr_map * memmap.desc_size);
426                 memmap.map = NULL;
427         }
428 }
429
430 void __init efi_free_boot_services(void)
431 {
432         void *p;
433
434         if (!efi_native)
435                 return;
436
437         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
438                 efi_memory_desc_t *md = p;
439                 unsigned long long start = md->phys_addr;
440                 unsigned long long size = md->num_pages << EFI_PAGE_SHIFT;
441
442                 if (md->type != EFI_BOOT_SERVICES_CODE &&
443                     md->type != EFI_BOOT_SERVICES_DATA)
444                         continue;
445
446                 /* Could not reserve boot area */
447                 if (!size)
448                         continue;
449
450                 free_bootmem_late(start, size);
451         }
452
453         efi_unmap_memmap();
454 }
455
456 static int __init efi_systab_init(void *phys)
457 {
458         if (efi_64bit) {
459                 efi_system_table_64_t *systab64;
460                 u64 tmp = 0;
461
462                 systab64 = early_ioremap((unsigned long)phys,
463                                          sizeof(*systab64));
464                 if (systab64 == NULL) {
465                         pr_err("Couldn't map the system table!\n");
466                         return -ENOMEM;
467                 }
468
469                 efi_systab.hdr = systab64->hdr;
470                 efi_systab.fw_vendor = systab64->fw_vendor;
471                 tmp |= systab64->fw_vendor;
472                 efi_systab.fw_revision = systab64->fw_revision;
473                 efi_systab.con_in_handle = systab64->con_in_handle;
474                 tmp |= systab64->con_in_handle;
475                 efi_systab.con_in = systab64->con_in;
476                 tmp |= systab64->con_in;
477                 efi_systab.con_out_handle = systab64->con_out_handle;
478                 tmp |= systab64->con_out_handle;
479                 efi_systab.con_out = systab64->con_out;
480                 tmp |= systab64->con_out;
481                 efi_systab.stderr_handle = systab64->stderr_handle;
482                 tmp |= systab64->stderr_handle;
483                 efi_systab.stderr = systab64->stderr;
484                 tmp |= systab64->stderr;
485                 efi_systab.runtime = (void *)(unsigned long)systab64->runtime;
486                 tmp |= systab64->runtime;
487                 efi_systab.boottime = (void *)(unsigned long)systab64->boottime;
488                 tmp |= systab64->boottime;
489                 efi_systab.nr_tables = systab64->nr_tables;
490                 efi_systab.tables = systab64->tables;
491                 tmp |= systab64->tables;
492
493                 early_iounmap(systab64, sizeof(*systab64));
494 #ifdef CONFIG_X86_32
495                 if (tmp >> 32) {
496                         pr_err("EFI data located above 4GB, disabling EFI.\n");
497                         return -EINVAL;
498                 }
499 #endif
500         } else {
501                 efi_system_table_32_t *systab32;
502
503                 systab32 = early_ioremap((unsigned long)phys,
504                                          sizeof(*systab32));
505                 if (systab32 == NULL) {
506                         pr_err("Couldn't map the system table!\n");
507                         return -ENOMEM;
508                 }
509
510                 efi_systab.hdr = systab32->hdr;
511                 efi_systab.fw_vendor = systab32->fw_vendor;
512                 efi_systab.fw_revision = systab32->fw_revision;
513                 efi_systab.con_in_handle = systab32->con_in_handle;
514                 efi_systab.con_in = systab32->con_in;
515                 efi_systab.con_out_handle = systab32->con_out_handle;
516                 efi_systab.con_out = systab32->con_out;
517                 efi_systab.stderr_handle = systab32->stderr_handle;
518                 efi_systab.stderr = systab32->stderr;
519                 efi_systab.runtime = (void *)(unsigned long)systab32->runtime;
520                 efi_systab.boottime = (void *)(unsigned long)systab32->boottime;
521                 efi_systab.nr_tables = systab32->nr_tables;
522                 efi_systab.tables = systab32->tables;
523
524                 early_iounmap(systab32, sizeof(*systab32));
525         }
526
527         efi.systab = &efi_systab;
528
529         /*
530          * Verify the EFI Table
531          */
532         if (efi.systab->hdr.signature != EFI_SYSTEM_TABLE_SIGNATURE) {
533                 pr_err("System table signature incorrect!\n");
534                 return -EINVAL;
535         }
536         if ((efi.systab->hdr.revision >> 16) == 0)
537                 pr_err("Warning: System table version "
538                        "%d.%02d, expected 1.00 or greater!\n",
539                        efi.systab->hdr.revision >> 16,
540                        efi.systab->hdr.revision & 0xffff);
541
542         return 0;
543 }
544
545 static int __init efi_config_init(u64 tables, int nr_tables)
546 {
547         void *config_tables, *tablep;
548         int i, sz;
549
550         if (efi_64bit)
551                 sz = sizeof(efi_config_table_64_t);
552         else
553                 sz = sizeof(efi_config_table_32_t);
554
555         /*
556          * Let's see what config tables the firmware passed to us.
557          */
558         config_tables = early_ioremap(tables, nr_tables * sz);
559         if (config_tables == NULL) {
560                 pr_err("Could not map Configuration table!\n");
561                 return -ENOMEM;
562         }
563
564         tablep = config_tables;
565         pr_info("");
566         for (i = 0; i < efi.systab->nr_tables; i++) {
567                 efi_guid_t guid;
568                 unsigned long table;
569
570                 if (efi_64bit) {
571                         u64 table64;
572                         guid = ((efi_config_table_64_t *)tablep)->guid;
573                         table64 = ((efi_config_table_64_t *)tablep)->table;
574                         table = table64;
575 #ifdef CONFIG_X86_32
576                         if (table64 >> 32) {
577                                 pr_cont("\n");
578                                 pr_err("Table located above 4GB, disabling EFI.\n");
579                                 early_iounmap(config_tables,
580                                               efi.systab->nr_tables * sz);
581                                 return -EINVAL;
582                         }
583 #endif
584                 } else {
585                         guid = ((efi_config_table_32_t *)tablep)->guid;
586                         table = ((efi_config_table_32_t *)tablep)->table;
587                 }
588                 if (!efi_guidcmp(guid, MPS_TABLE_GUID)) {
589                         efi.mps = table;
590                         pr_cont(" MPS=0x%lx ", table);
591                 } else if (!efi_guidcmp(guid, ACPI_20_TABLE_GUID)) {
592                         efi.acpi20 = table;
593                         pr_cont(" ACPI 2.0=0x%lx ", table);
594                 } else if (!efi_guidcmp(guid, ACPI_TABLE_GUID)) {
595                         efi.acpi = table;
596                         pr_cont(" ACPI=0x%lx ", table);
597                 } else if (!efi_guidcmp(guid, SMBIOS_TABLE_GUID)) {
598                         efi.smbios = table;
599                         pr_cont(" SMBIOS=0x%lx ", table);
600 #ifdef CONFIG_X86_UV
601                 } else if (!efi_guidcmp(guid, UV_SYSTEM_TABLE_GUID)) {
602                         efi.uv_systab = table;
603                         pr_cont(" UVsystab=0x%lx ", table);
604 #endif
605                 } else if (!efi_guidcmp(guid, HCDP_TABLE_GUID)) {
606                         efi.hcdp = table;
607                         pr_cont(" HCDP=0x%lx ", table);
608                 } else if (!efi_guidcmp(guid, UGA_IO_PROTOCOL_GUID)) {
609                         efi.uga = table;
610                         pr_cont(" UGA=0x%lx ", table);
611                 }
612                 tablep += sz;
613         }
614         pr_cont("\n");
615         early_iounmap(config_tables, efi.systab->nr_tables * sz);
616         return 0;
617 }
618
619 static int __init efi_runtime_init(void)
620 {
621         efi_runtime_services_t *runtime;
622
623         /*
624          * Check out the runtime services table. We need to map
625          * the runtime services table so that we can grab the physical
626          * address of several of the EFI runtime functions, needed to
627          * set the firmware into virtual mode.
628          */
629         runtime = early_ioremap((unsigned long)efi.systab->runtime,
630                                 sizeof(efi_runtime_services_t));
631         if (!runtime) {
632                 pr_err("Could not map the runtime service table!\n");
633                 return -ENOMEM;
634         }
635         /*
636          * We will only need *early* access to the following
637          * two EFI runtime services before set_virtual_address_map
638          * is invoked.
639          */
640         efi_phys.get_time = (efi_get_time_t *)runtime->get_time;
641         efi_phys.set_virtual_address_map =
642                 (efi_set_virtual_address_map_t *)
643                 runtime->set_virtual_address_map;
644         /*
645          * Make efi_get_time can be called before entering
646          * virtual mode.
647          */
648         efi.get_time = phys_efi_get_time;
649         early_iounmap(runtime, sizeof(efi_runtime_services_t));
650
651         return 0;
652 }
653
654 static int __init efi_memmap_init(void)
655 {
656         /* Map the EFI memory map */
657         memmap.map = early_ioremap((unsigned long)memmap.phys_map,
658                                    memmap.nr_map * memmap.desc_size);
659         if (memmap.map == NULL) {
660                 pr_err("Could not map the memory map!\n");
661                 return -ENOMEM;
662         }
663         memmap.map_end = memmap.map + (memmap.nr_map * memmap.desc_size);
664
665         if (add_efi_memmap)
666                 do_add_efi_memmap();
667
668         return 0;
669 }
670
671 void __init efi_init(void)
672 {
673         efi_char16_t *c16;
674         char vendor[100] = "unknown";
675         int i = 0;
676         void *tmp;
677
678 #ifdef CONFIG_X86_32
679         if (boot_params.efi_info.efi_systab_hi ||
680             boot_params.efi_info.efi_memmap_hi) {
681                 pr_info("Table located above 4GB, disabling EFI.\n");
682                 efi_enabled = 0;
683                 return;
684         }
685         efi_phys.systab = (efi_system_table_t *)boot_params.efi_info.efi_systab;
686         efi_native = !efi_64bit;
687 #else
688         efi_phys.systab = (efi_system_table_t *)
689                           (boot_params.efi_info.efi_systab |
690                           ((__u64)boot_params.efi_info.efi_systab_hi<<32));
691         efi_native = efi_64bit;
692 #endif
693
694         if (efi_systab_init(efi_phys.systab)) {
695                 efi_enabled = 0;
696                 return;
697         }
698
699         /*
700          * Show what we know for posterity
701          */
702         c16 = tmp = early_ioremap(efi.systab->fw_vendor, 2);
703         if (c16) {
704                 for (i = 0; i < sizeof(vendor) - 1 && *c16; ++i)
705                         vendor[i] = *c16++;
706                 vendor[i] = '\0';
707         } else
708                 pr_err("Could not map the firmware vendor!\n");
709         early_iounmap(tmp, 2);
710
711         pr_info("EFI v%u.%.02u by %s\n",
712                 efi.systab->hdr.revision >> 16,
713                 efi.systab->hdr.revision & 0xffff, vendor);
714
715         if (efi_config_init(efi.systab->tables, efi.systab->nr_tables)) {
716                 efi_enabled = 0;
717                 return;
718         }
719
720         /*
721          * Note: We currently don't support runtime services on an EFI
722          * that doesn't match the kernel 32/64-bit mode.
723          */
724
725         if (!efi_native)
726                 pr_info("No EFI runtime due to 32/64-bit mismatch with kernel\n");
727         else if (efi_runtime_init()) {
728                 efi_enabled = 0;
729                 return;
730         }
731
732         if (efi_memmap_init()) {
733                 efi_enabled = 0;
734                 return;
735         }
736 #ifdef CONFIG_X86_32
737         if (efi_native) {
738                 x86_platform.get_wallclock = efi_get_time;
739                 x86_platform.set_wallclock = efi_set_rtc_mmss;
740         }
741 #endif
742
743 #if EFI_DEBUG
744         print_efi_memmap();
745 #endif
746 }
747
748 void __init efi_set_executable(efi_memory_desc_t *md, bool executable)
749 {
750         u64 addr, npages;
751
752         addr = md->virt_addr;
753         npages = md->num_pages;
754
755         memrange_efi_to_native(&addr, &npages);
756
757         if (executable)
758                 set_memory_x(addr, npages);
759         else
760                 set_memory_nx(addr, npages);
761 }
762
763 static void __init runtime_code_page_mkexec(void)
764 {
765         efi_memory_desc_t *md;
766         void *p;
767
768         /* Make EFI runtime service code area executable */
769         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
770                 md = p;
771
772                 if (md->type != EFI_RUNTIME_SERVICES_CODE)
773                         continue;
774
775                 efi_set_executable(md, true);
776         }
777 }
778
779 /*
780  * This function will switch the EFI runtime services to virtual mode.
781  * Essentially, look through the EFI memmap and map every region that
782  * has the runtime attribute bit set in its memory descriptor and update
783  * that memory descriptor with the virtual address obtained from ioremap().
784  * This enables the runtime services to be called without having to
785  * thunk back into physical mode for every invocation.
786  */
787 void __init efi_enter_virtual_mode(void)
788 {
789         efi_memory_desc_t *md, *prev_md = NULL;
790         efi_status_t status;
791         unsigned long size;
792         u64 end, systab, addr, npages, end_pfn;
793         void *p, *va, *new_memmap = NULL;
794         int count = 0;
795
796         efi.systab = NULL;
797
798         /*
799          * We don't do virtual mode, since we don't do runtime services, on
800          * non-native EFI
801          */
802
803         if (!efi_native) {
804                 efi_unmap_memmap();
805                 return;
806         }
807
808         /* Merge contiguous regions of the same type and attribute */
809         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
810                 u64 prev_size;
811                 md = p;
812
813                 if (!prev_md) {
814                         prev_md = md;
815                         continue;
816                 }
817
818                 if (prev_md->type != md->type ||
819                     prev_md->attribute != md->attribute) {
820                         prev_md = md;
821                         continue;
822                 }
823
824                 prev_size = prev_md->num_pages << EFI_PAGE_SHIFT;
825
826                 if (md->phys_addr == (prev_md->phys_addr + prev_size)) {
827                         prev_md->num_pages += md->num_pages;
828                         md->type = EFI_RESERVED_TYPE;
829                         md->attribute = 0;
830                         continue;
831                 }
832                 prev_md = md;
833         }
834
835         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
836                 md = p;
837                 if (!(md->attribute & EFI_MEMORY_RUNTIME) &&
838                     md->type != EFI_BOOT_SERVICES_CODE &&
839                     md->type != EFI_BOOT_SERVICES_DATA)
840                         continue;
841
842                 size = md->num_pages << EFI_PAGE_SHIFT;
843                 end = md->phys_addr + size;
844
845                 end_pfn = PFN_UP(end);
846                 if (end_pfn <= max_low_pfn_mapped
847                     || (end_pfn > (1UL << (32 - PAGE_SHIFT))
848                         && end_pfn <= max_pfn_mapped))
849                         va = __va(md->phys_addr);
850                 else
851                         va = efi_ioremap(md->phys_addr, size, md->type);
852
853                 md->virt_addr = (u64) (unsigned long) va;
854
855                 if (!va) {
856                         pr_err("ioremap of 0x%llX failed!\n",
857                                (unsigned long long)md->phys_addr);
858                         continue;
859                 }
860
861                 if (!(md->attribute & EFI_MEMORY_WB)) {
862                         addr = md->virt_addr;
863                         npages = md->num_pages;
864                         memrange_efi_to_native(&addr, &npages);
865                         set_memory_uc(addr, npages);
866                 }
867
868                 systab = (u64) (unsigned long) efi_phys.systab;
869                 if (md->phys_addr <= systab && systab < end) {
870                         systab += md->virt_addr - md->phys_addr;
871                         efi.systab = (efi_system_table_t *) (unsigned long) systab;
872                 }
873                 new_memmap = krealloc(new_memmap,
874                                       (count + 1) * memmap.desc_size,
875                                       GFP_KERNEL);
876                 memcpy(new_memmap + (count * memmap.desc_size), md,
877                        memmap.desc_size);
878                 count++;
879         }
880
881         BUG_ON(!efi.systab);
882
883         status = phys_efi_set_virtual_address_map(
884                 memmap.desc_size * count,
885                 memmap.desc_size,
886                 memmap.desc_version,
887                 (efi_memory_desc_t *)__pa(new_memmap));
888
889         if (status != EFI_SUCCESS) {
890                 pr_alert("Unable to switch EFI into virtual mode "
891                          "(status=%lx)!\n", status);
892                 panic("EFI call to SetVirtualAddressMap() failed!");
893         }
894
895         /*
896          * Now that EFI is in virtual mode, update the function
897          * pointers in the runtime service table to the new virtual addresses.
898          *
899          * Call EFI services through wrapper functions.
900          */
901         efi.runtime_version = efi_systab.fw_revision;
902         efi.get_time = virt_efi_get_time;
903         efi.set_time = virt_efi_set_time;
904         efi.get_wakeup_time = virt_efi_get_wakeup_time;
905         efi.set_wakeup_time = virt_efi_set_wakeup_time;
906         efi.get_variable = virt_efi_get_variable;
907         efi.get_next_variable = virt_efi_get_next_variable;
908         efi.set_variable = virt_efi_set_variable;
909         efi.get_next_high_mono_count = virt_efi_get_next_high_mono_count;
910         efi.reset_system = virt_efi_reset_system;
911         efi.set_virtual_address_map = NULL;
912         efi.query_variable_info = virt_efi_query_variable_info;
913         efi.update_capsule = virt_efi_update_capsule;
914         efi.query_capsule_caps = virt_efi_query_capsule_caps;
915         if (__supported_pte_mask & _PAGE_NX)
916                 runtime_code_page_mkexec();
917
918         kfree(new_memmap);
919 }
920
921 /*
922  * Convenience functions to obtain memory types and attributes
923  */
924 u32 efi_mem_type(unsigned long phys_addr)
925 {
926         efi_memory_desc_t *md;
927         void *p;
928
929         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
930                 md = p;
931                 if ((md->phys_addr <= phys_addr) &&
932                     (phys_addr < (md->phys_addr +
933                                   (md->num_pages << EFI_PAGE_SHIFT))))
934                         return md->type;
935         }
936         return 0;
937 }
938
939 u64 efi_mem_attributes(unsigned long phys_addr)
940 {
941         efi_memory_desc_t *md;
942         void *p;
943
944         for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
945                 md = p;
946                 if ((md->phys_addr <= phys_addr) &&
947                     (phys_addr < (md->phys_addr +
948                                   (md->num_pages << EFI_PAGE_SHIFT))))
949                         return md->attribute;
950         }
951         return 0;
952 }