arm64/efi: refactor EFI init and runtime code for reuse by 32-bit ARM
[deliverable/linux.git] / drivers / firmware / efi / arm-runtime.c
CommitLineData
e5bc22a4
AB
1/*
2 * Extensible Firmware Interface
3 *
4 * Based on Extensible Firmware Interface Specification version 2.4
5 *
6 * Copyright (C) 2013, 2014 Linaro Ltd.
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 *
12 */
13
14#include <linux/efi.h>
f7d92489 15#include <linux/io.h>
e5bc22a4
AB
16#include <linux/memblock.h>
17#include <linux/mm_types.h>
18#include <linux/preempt.h>
19#include <linux/rbtree.h>
20#include <linux/rwsem.h>
21#include <linux/sched.h>
22#include <linux/slab.h>
23#include <linux/spinlock.h>
24
25#include <asm/cacheflush.h>
26#include <asm/efi.h>
e5bc22a4 27#include <asm/mmu.h>
f7d92489 28#include <asm/pgalloc.h>
e5bc22a4
AB
29#include <asm/pgtable.h>
30
e5bc22a4
AB
31extern u64 efi_system_table;
32
33static struct mm_struct efi_mm = {
34 .mm_rb = RB_ROOT,
e5bc22a4
AB
35 .mm_users = ATOMIC_INIT(2),
36 .mm_count = ATOMIC_INIT(1),
37 .mmap_sem = __RWSEM_INITIALIZER(efi_mm.mmap_sem),
38 .page_table_lock = __SPIN_LOCK_UNLOCKED(efi_mm.page_table_lock),
39 .mmlist = LIST_HEAD_INIT(efi_mm.mmlist),
40};
41
42static bool __init efi_virtmap_init(void)
43{
44 efi_memory_desc_t *md;
45
f7d92489 46 efi_mm.pgd = pgd_alloc(&efi_mm);
e5bc22a4
AB
47 init_new_context(NULL, &efi_mm);
48
49 for_each_efi_memory_desc(&memmap, md) {
f7d92489
AB
50 phys_addr_t phys = md->phys_addr;
51 int ret;
e5bc22a4
AB
52
53 if (!(md->attribute & EFI_MEMORY_RUNTIME))
54 continue;
55 if (md->virt_addr == 0)
56 return false;
57
f7d92489
AB
58 ret = efi_create_mapping(&efi_mm, md);
59 if (!ret) {
60 pr_info(" EFI remap %pa => %p\n",
61 &phys, (void *)(unsigned long)md->virt_addr);
62 } else {
63 pr_warn(" EFI remap %pa: failed to create mapping (%d)\n",
64 &phys, ret);
65 return false;
66 }
e5bc22a4
AB
67 }
68 return true;
69}
70
71/*
72 * Enable the UEFI Runtime Services if all prerequisites are in place, i.e.,
73 * non-early mapping of the UEFI system table and virtual mappings for all
74 * EFI_MEMORY_RUNTIME regions.
75 */
f7d92489 76static int __init arm_enable_runtime_services(void)
e5bc22a4
AB
77{
78 u64 mapsize;
79
80 if (!efi_enabled(EFI_BOOT)) {
81 pr_info("EFI services will not be available.\n");
82 return 0;
83 }
84
85 if (efi_runtime_disabled()) {
86 pr_info("EFI runtime services will be disabled.\n");
87 return 0;
88 }
89
90 pr_info("Remapping and enabling EFI services.\n");
91
92 mapsize = memmap.map_end - memmap.map;
93 memmap.map = (__force void *)ioremap_cache(memmap.phys_map,
94 mapsize);
95 if (!memmap.map) {
96 pr_err("Failed to remap EFI memory map\n");
97 return -ENOMEM;
98 }
99 memmap.map_end = memmap.map + mapsize;
100 efi.memmap = &memmap;
101
102 efi.systab = (__force void *)ioremap_cache(efi_system_table,
103 sizeof(efi_system_table_t));
104 if (!efi.systab) {
105 pr_err("Failed to remap EFI System Table\n");
106 return -ENOMEM;
107 }
108 set_bit(EFI_SYSTEM_TABLES, &efi.flags);
109
110 if (!efi_virtmap_init()) {
111 pr_err("No UEFI virtual mapping was installed -- runtime services will not be available\n");
112 return -ENOMEM;
113 }
114
115 /* Set up runtime services function pointers */
116 efi_native_runtime_setup();
117 set_bit(EFI_RUNTIME_SERVICES, &efi.flags);
118
119 efi.runtime_version = efi.systab->hdr.revision;
120
121 return 0;
122}
f7d92489 123early_initcall(arm_enable_runtime_services);
e5bc22a4
AB
124
125void efi_virtmap_load(void)
126{
127 preempt_disable();
128 efi_set_pgd(&efi_mm);
129}
130
131void efi_virtmap_unload(void)
132{
133 efi_set_pgd(current->active_mm);
134 preempt_enable();
135}
This page took 0.031518 seconds and 5 git commands to generate.