blob: 971bd5ffa3e96f19beef17e2bb758dadfb197250 [file] [log] [blame]
Tom Rini70df9d62018-05-07 17:02:21 -04001// SPDX-License-Identifier: GPL-2.0+
Alexander Grafc15d9212016-03-04 01:09:59 +01002/*
3 * EFI application boot time services
4 *
5 * Copyright (c) 2016 Alexander Graf
Alexander Grafc15d9212016-03-04 01:09:59 +01006 */
7
Alexander Grafc15d9212016-03-04 01:09:59 +01008#include <common.h>
Heinrich Schuchardt368ca642017-10-05 16:14:14 +02009#include <div64.h>
Alexander Grafc15d9212016-03-04 01:09:59 +010010#include <efi_loader.h>
Rob Clark15f3d742017-09-13 18:05:37 -040011#include <environment.h>
Alexander Grafc15d9212016-03-04 01:09:59 +010012#include <malloc.h>
Masahiro Yamada75f82d02018-03-05 01:20:11 +090013#include <linux/libfdt_env.h>
Alexander Grafc15d9212016-03-04 01:09:59 +010014#include <u-boot/crc.h>
15#include <bootm.h>
Heinrich Schuchardt37587522019-05-01 20:07:04 +020016#include <pe.h>
Alexander Grafc15d9212016-03-04 01:09:59 +010017#include <watchdog.h>
18
19DECLARE_GLOBAL_DATA_PTR;
20
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +020021/* Task priority level */
Heinrich Schuchardtf8d4ec32017-11-06 21:17:47 +010022static efi_uintn_t efi_tpl = TPL_APPLICATION;
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +020023
Alexander Grafc15d9212016-03-04 01:09:59 +010024/* This list contains all the EFI objects our payload has access to */
25LIST_HEAD(efi_obj_list);
26
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +010027/* List of all events */
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +010028LIST_HEAD(efi_events);
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +010029
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +020030/* List of all events registered by RegisterProtocolNotify() */
31LIST_HEAD(efi_register_notify_events);
32
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +010033/* Handle of the currently executing image */
34static efi_handle_t current_image;
35
Alexander Graffa5246b2018-11-15 21:23:47 +010036/*
37 * If we're running on nasty systems (32bit ARM booting into non-EFI Linux)
38 * we need to do trickery with caches. Since we don't want to break the EFI
39 * aware boot path, only apply hacks when loading exiting directly (breaking
40 * direct Linux EFI booting along the way - oh well).
41 */
42static bool efi_is_direct_boot = true;
43
Simon Glasscdfe6962016-09-25 15:27:35 -060044#ifdef CONFIG_ARM
Alexander Grafc15d9212016-03-04 01:09:59 +010045/*
46 * The "gd" pointer lives in a register on ARM and AArch64 that we declare
47 * fixed when compiling U-Boot. However, the payload does not know about that
48 * restriction so we need to manually swap its and our view of that register on
49 * EFI callback entry/exit.
50 */
51static volatile void *efi_gd, *app_gd;
Simon Glasscdfe6962016-09-25 15:27:35 -060052#endif
Alexander Grafc15d9212016-03-04 01:09:59 +010053
Heinrich Schuchardt72506232019-02-09 14:10:39 +010054/* 1 if inside U-Boot code, 0 if inside EFI payload code */
55static int entry_count = 1;
Rob Clarke7896c32017-07-27 08:04:19 -040056static int nesting_level;
Heinrich Schuchardt44ab21b2018-03-03 15:29:03 +010057/* GUID of the device tree table */
58const efi_guid_t efi_guid_fdt = EFI_FDT_GUID;
Heinrich Schuchardt760255f2018-01-11 08:16:02 +010059/* GUID of the EFI_DRIVER_BINDING_PROTOCOL */
60const efi_guid_t efi_guid_driver_binding_protocol =
61 EFI_DRIVER_BINDING_PROTOCOL_GUID;
Rob Clark86789d52017-07-27 08:04:18 -040062
Heinrich Schuchardt672d99e2018-02-18 15:17:51 +010063/* event group ExitBootServices() invoked */
64const efi_guid_t efi_guid_event_group_exit_boot_services =
65 EFI_EVENT_GROUP_EXIT_BOOT_SERVICES;
66/* event group SetVirtualAddressMap() invoked */
67const efi_guid_t efi_guid_event_group_virtual_address_change =
68 EFI_EVENT_GROUP_VIRTUAL_ADDRESS_CHANGE;
69/* event group memory map changed */
70const efi_guid_t efi_guid_event_group_memory_map_change =
71 EFI_EVENT_GROUP_MEMORY_MAP_CHANGE;
72/* event group boot manager about to boot */
73const efi_guid_t efi_guid_event_group_ready_to_boot =
74 EFI_EVENT_GROUP_READY_TO_BOOT;
75/* event group ResetSystem() invoked (before ExitBootServices) */
76const efi_guid_t efi_guid_event_group_reset_system =
77 EFI_EVENT_GROUP_RESET_SYSTEM;
78
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +010079static efi_status_t EFIAPI efi_disconnect_controller(
80 efi_handle_t controller_handle,
81 efi_handle_t driver_image_handle,
82 efi_handle_t child_handle);
Heinrich Schuchardte9943282018-01-11 08:16:04 +010083
Rob Clark86789d52017-07-27 08:04:18 -040084/* Called on every callback entry */
85int __efi_entry_check(void)
86{
87 int ret = entry_count++ == 0;
88#ifdef CONFIG_ARM
89 assert(efi_gd);
90 app_gd = gd;
91 gd = efi_gd;
92#endif
93 return ret;
94}
95
96/* Called on every callback exit */
97int __efi_exit_check(void)
98{
99 int ret = --entry_count == 0;
100#ifdef CONFIG_ARM
101 gd = app_gd;
102#endif
103 return ret;
104}
105
Alexander Grafc15d9212016-03-04 01:09:59 +0100106/* Called from do_bootefi_exec() */
107void efi_save_gd(void)
108{
Simon Glasscdfe6962016-09-25 15:27:35 -0600109#ifdef CONFIG_ARM
Alexander Grafc15d9212016-03-04 01:09:59 +0100110 efi_gd = gd;
Simon Glasscdfe6962016-09-25 15:27:35 -0600111#endif
Alexander Grafc15d9212016-03-04 01:09:59 +0100112}
113
Rob Clark86789d52017-07-27 08:04:18 -0400114/*
Mario Six8fac2912018-07-10 08:40:17 +0200115 * Special case handler for error/abort that just forces things back to u-boot
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +0200116 * world so we can dump out an abort message, without any care about returning
117 * back to UEFI world.
Rob Clark86789d52017-07-27 08:04:18 -0400118 */
Alexander Grafc15d9212016-03-04 01:09:59 +0100119void efi_restore_gd(void)
120{
Simon Glasscdfe6962016-09-25 15:27:35 -0600121#ifdef CONFIG_ARM
Alexander Grafc15d9212016-03-04 01:09:59 +0100122 /* Only restore if we're already in EFI context */
123 if (!efi_gd)
124 return;
Alexander Grafc15d9212016-03-04 01:09:59 +0100125 gd = efi_gd;
Simon Glasscdfe6962016-09-25 15:27:35 -0600126#endif
Alexander Grafc15d9212016-03-04 01:09:59 +0100127}
128
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200129/**
Mario Six8fac2912018-07-10 08:40:17 +0200130 * indent_string() - returns a string for indenting with two spaces per level
131 * @level: indent level
Heinrich Schuchardt091cf432018-01-24 19:21:36 +0100132 *
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200133 * A maximum of ten indent levels is supported. Higher indent levels will be
134 * truncated.
135 *
Mario Six8fac2912018-07-10 08:40:17 +0200136 * Return: A string for indenting with two spaces per level is
137 * returned.
Rob Clarke7896c32017-07-27 08:04:19 -0400138 */
139static const char *indent_string(int level)
140{
141 const char *indent = " ";
142 const int max = strlen(indent);
Heinrich Schuchardt91064592018-02-18 15:17:49 +0100143
Rob Clarke7896c32017-07-27 08:04:19 -0400144 level = min(max, level * 2);
145 return &indent[max - level];
146}
147
Heinrich Schuchardt4d664892017-08-18 17:45:16 +0200148const char *__efi_nesting(void)
149{
150 return indent_string(nesting_level);
151}
152
Rob Clarke7896c32017-07-27 08:04:19 -0400153const char *__efi_nesting_inc(void)
154{
155 return indent_string(nesting_level++);
156}
157
158const char *__efi_nesting_dec(void)
159{
160 return indent_string(--nesting_level);
161}
162
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200163/**
Mario Six8fac2912018-07-10 08:40:17 +0200164 * efi_queue_event() - queue an EFI event
165 * @event: event to signal
166 * @check_tpl: check the TPL level
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200167 *
168 * This function queues the notification function of the event for future
169 * execution.
170 *
Mario Six8fac2912018-07-10 08:40:17 +0200171 * The notification function is called if the task priority level of the event
172 * is higher than the current task priority level.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200173 *
174 * For the SignalEvent service see efi_signal_event_ext.
175 *
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200176 */
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100177static void efi_queue_event(struct efi_event *event, bool check_tpl)
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200178{
Heinrich Schuchardt8b11a8a2017-09-15 10:06:13 +0200179 if (event->notify_function) {
Heinrich Schuchardt1bbee392017-10-04 15:03:24 +0200180 event->is_queued = true;
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200181 /* Check TPL */
Heinrich Schuchardtd8b878a2018-01-19 20:24:51 +0100182 if (check_tpl && efi_tpl >= event->notify_tpl)
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200183 return;
Heinrich Schuchardtad559972019-05-11 21:44:59 +0200184 event->is_queued = false;
Heinrich Schuchardt91e5b8a2017-09-15 10:06:10 +0200185 EFI_CALL_VOID(event->notify_function(event,
186 event->notify_context));
Heinrich Schuchardtad559972019-05-11 21:44:59 +0200187 } else {
188 event->is_queued = false;
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200189 }
190}
191
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200192/**
Heinrich Schuchardt7f0f0052018-07-02 12:53:52 +0200193 * is_valid_tpl() - check if the task priority level is valid
194 *
195 * @tpl: TPL level to check
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +0200196 * Return: status code
Heinrich Schuchardt7f0f0052018-07-02 12:53:52 +0200197 */
198efi_status_t is_valid_tpl(efi_uintn_t tpl)
199{
200 switch (tpl) {
201 case TPL_APPLICATION:
202 case TPL_CALLBACK:
203 case TPL_NOTIFY:
204 case TPL_HIGH_LEVEL:
205 return EFI_SUCCESS;
206 default:
207 return EFI_INVALID_PARAMETER;
208 }
209}
210
211/**
Mario Six8fac2912018-07-10 08:40:17 +0200212 * efi_signal_event() - signal an EFI event
213 * @event: event to signal
214 * @check_tpl: check the TPL level
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100215 *
Mario Six8fac2912018-07-10 08:40:17 +0200216 * This function signals an event. If the event belongs to an event group all
217 * events of the group are signaled. If they are of type EVT_NOTIFY_SIGNAL
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100218 * their notification function is queued.
219 *
220 * For the SignalEvent service see efi_signal_event_ext.
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100221 */
222void efi_signal_event(struct efi_event *event, bool check_tpl)
223{
224 if (event->group) {
225 struct efi_event *evt;
226
227 /*
228 * The signaled state has to set before executing any
229 * notification function
230 */
231 list_for_each_entry(evt, &efi_events, link) {
232 if (!evt->group || guidcmp(evt->group, event->group))
233 continue;
234 if (evt->is_signaled)
235 continue;
236 evt->is_signaled = true;
237 if (evt->type & EVT_NOTIFY_SIGNAL &&
238 evt->notify_function)
239 evt->is_queued = true;
240 }
241 list_for_each_entry(evt, &efi_events, link) {
242 if (!evt->group || guidcmp(evt->group, event->group))
243 continue;
244 if (evt->is_queued)
245 efi_queue_event(evt, check_tpl);
246 }
Heinrich Schuchardt66ddc2e2019-05-05 00:07:34 +0200247 } else {
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100248 event->is_signaled = true;
249 if (event->type & EVT_NOTIFY_SIGNAL)
250 efi_queue_event(event, check_tpl);
251 }
252}
253
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200254/**
Mario Six8fac2912018-07-10 08:40:17 +0200255 * efi_raise_tpl() - raise the task priority level
256 * @new_tpl: new value of the task priority level
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200257 *
258 * This function implements the RaiseTpl service.
Mario Six8fac2912018-07-10 08:40:17 +0200259 *
260 * See the Unified Extensible Firmware Interface (UEFI) specification for
261 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200262 *
Mario Six8fac2912018-07-10 08:40:17 +0200263 * Return: old value of the task priority level
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200264 */
Heinrich Schuchardtf8d4ec32017-11-06 21:17:47 +0100265static unsigned long EFIAPI efi_raise_tpl(efi_uintn_t new_tpl)
Alexander Grafc15d9212016-03-04 01:09:59 +0100266{
Heinrich Schuchardtf8d4ec32017-11-06 21:17:47 +0100267 efi_uintn_t old_tpl = efi_tpl;
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200268
xypron.glpk@gmx.de48df2092017-07-18 20:17:19 +0200269 EFI_ENTRY("0x%zx", new_tpl);
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200270
271 if (new_tpl < efi_tpl)
Heinrich Schuchardt952e2062019-05-05 11:56:23 +0200272 EFI_PRINT("WARNING: new_tpl < current_tpl in %s\n", __func__);
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200273 efi_tpl = new_tpl;
274 if (efi_tpl > TPL_HIGH_LEVEL)
275 efi_tpl = TPL_HIGH_LEVEL;
276
277 EFI_EXIT(EFI_SUCCESS);
278 return old_tpl;
Alexander Grafc15d9212016-03-04 01:09:59 +0100279}
280
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200281/**
Mario Six8fac2912018-07-10 08:40:17 +0200282 * efi_restore_tpl() - lower the task priority level
283 * @old_tpl: value of the task priority level to be restored
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200284 *
285 * This function implements the RestoreTpl service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200286 *
Mario Six8fac2912018-07-10 08:40:17 +0200287 * See the Unified Extensible Firmware Interface (UEFI) specification for
288 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200289 */
Heinrich Schuchardtf8d4ec32017-11-06 21:17:47 +0100290static void EFIAPI efi_restore_tpl(efi_uintn_t old_tpl)
Alexander Grafc15d9212016-03-04 01:09:59 +0100291{
xypron.glpk@gmx.de48df2092017-07-18 20:17:19 +0200292 EFI_ENTRY("0x%zx", old_tpl);
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200293
294 if (old_tpl > efi_tpl)
Heinrich Schuchardt952e2062019-05-05 11:56:23 +0200295 EFI_PRINT("WARNING: old_tpl > current_tpl in %s\n", __func__);
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200296 efi_tpl = old_tpl;
297 if (efi_tpl > TPL_HIGH_LEVEL)
298 efi_tpl = TPL_HIGH_LEVEL;
299
Heinrich Schuchardt59b20952018-03-24 18:40:21 +0100300 /*
301 * Lowering the TPL may have made queued events eligible for execution.
302 */
303 efi_timer_check();
304
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200305 EFI_EXIT(EFI_SUCCESS);
Alexander Grafc15d9212016-03-04 01:09:59 +0100306}
307
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200308/**
Mario Six8fac2912018-07-10 08:40:17 +0200309 * efi_allocate_pages_ext() - allocate memory pages
310 * @type: type of allocation to be performed
311 * @memory_type: usage type of the allocated memory
312 * @pages: number of pages to be allocated
313 * @memory: allocated memory
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200314 *
315 * This function implements the AllocatePages service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200316 *
Mario Six8fac2912018-07-10 08:40:17 +0200317 * See the Unified Extensible Firmware Interface (UEFI) specification for
318 * details.
319 *
320 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200321 */
Masahiro Yamadab2a05c12017-06-22 17:49:03 +0900322static efi_status_t EFIAPI efi_allocate_pages_ext(int type, int memory_type,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100323 efi_uintn_t pages,
Masahiro Yamadab2a05c12017-06-22 17:49:03 +0900324 uint64_t *memory)
Alexander Grafc15d9212016-03-04 01:09:59 +0100325{
326 efi_status_t r;
327
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100328 EFI_ENTRY("%d, %d, 0x%zx, %p", type, memory_type, pages, memory);
Alexander Grafc15d9212016-03-04 01:09:59 +0100329 r = efi_allocate_pages(type, memory_type, pages, memory);
330 return EFI_EXIT(r);
331}
332
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200333/**
Mario Six8fac2912018-07-10 08:40:17 +0200334 * efi_free_pages_ext() - Free memory pages.
335 * @memory: start of the memory area to be freed
336 * @pages: number of pages to be freed
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200337 *
338 * This function implements the FreePages service.
Mario Six8fac2912018-07-10 08:40:17 +0200339 *
340 * See the Unified Extensible Firmware Interface (UEFI) specification for
341 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200342 *
Mario Six8fac2912018-07-10 08:40:17 +0200343 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200344 */
Masahiro Yamadab2a05c12017-06-22 17:49:03 +0900345static efi_status_t EFIAPI efi_free_pages_ext(uint64_t memory,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100346 efi_uintn_t pages)
Alexander Grafc15d9212016-03-04 01:09:59 +0100347{
348 efi_status_t r;
349
Masahiro Yamadac7570a32018-08-06 20:47:40 +0900350 EFI_ENTRY("%llx, 0x%zx", memory, pages);
Alexander Grafc15d9212016-03-04 01:09:59 +0100351 r = efi_free_pages(memory, pages);
352 return EFI_EXIT(r);
353}
354
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200355/**
Mario Six8fac2912018-07-10 08:40:17 +0200356 * efi_get_memory_map_ext() - get map describing memory usage
357 * @memory_map_size: on entry the size, in bytes, of the memory map buffer,
358 * on exit the size of the copied memory map
359 * @memory_map: buffer to which the memory map is written
360 * @map_key: key for the memory map
361 * @descriptor_size: size of an individual memory descriptor
362 * @descriptor_version: version number of the memory descriptor structure
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200363 *
364 * This function implements the GetMemoryMap service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200365 *
Mario Six8fac2912018-07-10 08:40:17 +0200366 * See the Unified Extensible Firmware Interface (UEFI) specification for
367 * details.
368 *
369 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200370 */
Masahiro Yamadab2a05c12017-06-22 17:49:03 +0900371static efi_status_t EFIAPI efi_get_memory_map_ext(
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100372 efi_uintn_t *memory_map_size,
Masahiro Yamadab2a05c12017-06-22 17:49:03 +0900373 struct efi_mem_desc *memory_map,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100374 efi_uintn_t *map_key,
375 efi_uintn_t *descriptor_size,
Masahiro Yamadab2a05c12017-06-22 17:49:03 +0900376 uint32_t *descriptor_version)
Alexander Grafc15d9212016-03-04 01:09:59 +0100377{
378 efi_status_t r;
379
380 EFI_ENTRY("%p, %p, %p, %p, %p", memory_map_size, memory_map,
381 map_key, descriptor_size, descriptor_version);
382 r = efi_get_memory_map(memory_map_size, memory_map, map_key,
383 descriptor_size, descriptor_version);
384 return EFI_EXIT(r);
385}
386
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200387/**
Mario Six8fac2912018-07-10 08:40:17 +0200388 * efi_allocate_pool_ext() - allocate memory from pool
389 * @pool_type: type of the pool from which memory is to be allocated
390 * @size: number of bytes to be allocated
391 * @buffer: allocated memory
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200392 *
393 * This function implements the AllocatePool service.
Mario Six8fac2912018-07-10 08:40:17 +0200394 *
395 * See the Unified Extensible Firmware Interface (UEFI) specification for
396 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200397 *
Mario Six8fac2912018-07-10 08:40:17 +0200398 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200399 */
Stefan Brüns5a09aef2016-10-09 22:17:18 +0200400static efi_status_t EFIAPI efi_allocate_pool_ext(int pool_type,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100401 efi_uintn_t size,
Stefan Brüns5a09aef2016-10-09 22:17:18 +0200402 void **buffer)
Alexander Grafc15d9212016-03-04 01:09:59 +0100403{
Alexander Graf1c34fa82016-03-24 01:37:37 +0100404 efi_status_t r;
405
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100406 EFI_ENTRY("%d, %zd, %p", pool_type, size, buffer);
Stefan Brüns5a09aef2016-10-09 22:17:18 +0200407 r = efi_allocate_pool(pool_type, size, buffer);
Alexander Graf1c34fa82016-03-24 01:37:37 +0100408 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +0100409}
410
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200411/**
Mario Six8fac2912018-07-10 08:40:17 +0200412 * efi_free_pool_ext() - free memory from pool
413 * @buffer: start of memory to be freed
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200414 *
415 * This function implements the FreePool service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200416 *
Mario Six8fac2912018-07-10 08:40:17 +0200417 * See the Unified Extensible Firmware Interface (UEFI) specification for
418 * details.
419 *
420 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200421 */
Stefan Brüns67b67d92016-10-09 22:17:26 +0200422static efi_status_t EFIAPI efi_free_pool_ext(void *buffer)
Alexander Grafc15d9212016-03-04 01:09:59 +0100423{
Alexander Graf1c34fa82016-03-24 01:37:37 +0100424 efi_status_t r;
425
426 EFI_ENTRY("%p", buffer);
Stefan Brüns67b67d92016-10-09 22:17:26 +0200427 r = efi_free_pool(buffer);
Alexander Graf1c34fa82016-03-24 01:37:37 +0100428 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +0100429}
430
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200431/**
Heinrich Schuchardt30cd0462019-05-01 09:42:39 +0200432 * efi_add_handle() - add a new handle to the object list
433 *
434 * @handle: handle to be added
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +0100435 *
Heinrich Schuchardt30cd0462019-05-01 09:42:39 +0200436 * The protocols list is initialized. The handle is added to the list of known
437 * UEFI objects.
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +0100438 */
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200439void efi_add_handle(efi_handle_t handle)
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +0100440{
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200441 if (!handle)
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +0100442 return;
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200443 INIT_LIST_HEAD(&handle->protocols);
444 list_add_tail(&handle->link, &efi_obj_list);
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +0100445}
446
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200447/**
Mario Six8fac2912018-07-10 08:40:17 +0200448 * efi_create_handle() - create handle
449 * @handle: new handle
Heinrich Schuchardteb6106e2017-10-26 19:25:49 +0200450 *
Mario Six8fac2912018-07-10 08:40:17 +0200451 * Return: status code
Heinrich Schuchardteb6106e2017-10-26 19:25:49 +0200452 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +0100453efi_status_t efi_create_handle(efi_handle_t *handle)
Heinrich Schuchardtcd522cb2017-08-27 00:51:09 +0200454{
455 struct efi_object *obj;
Heinrich Schuchardtcd522cb2017-08-27 00:51:09 +0200456
Heinrich Schuchardtae1d2062018-05-27 16:47:21 +0200457 obj = calloc(1, sizeof(struct efi_object));
458 if (!obj)
459 return EFI_OUT_OF_RESOURCES;
460
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +0100461 efi_add_handle(obj);
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200462 *handle = obj;
Heinrich Schuchardtae1d2062018-05-27 16:47:21 +0200463
464 return EFI_SUCCESS;
Heinrich Schuchardtcd522cb2017-08-27 00:51:09 +0200465}
466
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200467/**
Mario Six8fac2912018-07-10 08:40:17 +0200468 * efi_search_protocol() - find a protocol on a handle.
469 * @handle: handle
470 * @protocol_guid: GUID of the protocol
471 * @handler: reference to the protocol
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100472 *
Mario Six8fac2912018-07-10 08:40:17 +0200473 * Return: status code
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100474 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +0100475efi_status_t efi_search_protocol(const efi_handle_t handle,
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100476 const efi_guid_t *protocol_guid,
477 struct efi_handler **handler)
478{
479 struct efi_object *efiobj;
480 struct list_head *lhandle;
481
482 if (!handle || !protocol_guid)
483 return EFI_INVALID_PARAMETER;
484 efiobj = efi_search_obj(handle);
485 if (!efiobj)
486 return EFI_INVALID_PARAMETER;
487 list_for_each(lhandle, &efiobj->protocols) {
488 struct efi_handler *protocol;
489
490 protocol = list_entry(lhandle, struct efi_handler, link);
491 if (!guidcmp(protocol->guid, protocol_guid)) {
492 if (handler)
493 *handler = protocol;
494 return EFI_SUCCESS;
495 }
496 }
497 return EFI_NOT_FOUND;
498}
499
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200500/**
Mario Six8fac2912018-07-10 08:40:17 +0200501 * efi_remove_protocol() - delete protocol from a handle
502 * @handle: handle from which the protocol shall be deleted
503 * @protocol: GUID of the protocol to be deleted
504 * @protocol_interface: interface of the protocol implementation
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100505 *
Mario Six8fac2912018-07-10 08:40:17 +0200506 * Return: status code
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100507 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +0100508efi_status_t efi_remove_protocol(const efi_handle_t handle,
509 const efi_guid_t *protocol,
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100510 void *protocol_interface)
511{
512 struct efi_handler *handler;
513 efi_status_t ret;
514
515 ret = efi_search_protocol(handle, protocol, &handler);
516 if (ret != EFI_SUCCESS)
517 return ret;
Heinrich Schuchardtb27594d2018-05-11 12:09:21 +0200518 if (handler->protocol_interface != protocol_interface)
Heinrich Schuchardtfdeb1f02019-05-10 20:06:48 +0200519 return EFI_NOT_FOUND;
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100520 list_del(&handler->link);
521 free(handler);
522 return EFI_SUCCESS;
523}
524
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200525/**
Mario Six8fac2912018-07-10 08:40:17 +0200526 * efi_remove_all_protocols() - delete all protocols from a handle
527 * @handle: handle from which the protocols shall be deleted
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100528 *
Mario Six8fac2912018-07-10 08:40:17 +0200529 * Return: status code
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100530 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +0100531efi_status_t efi_remove_all_protocols(const efi_handle_t handle)
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100532{
533 struct efi_object *efiobj;
Heinrich Schuchardta84731d2018-01-11 08:15:55 +0100534 struct efi_handler *protocol;
535 struct efi_handler *pos;
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100536
537 efiobj = efi_search_obj(handle);
538 if (!efiobj)
539 return EFI_INVALID_PARAMETER;
Heinrich Schuchardta84731d2018-01-11 08:15:55 +0100540 list_for_each_entry_safe(protocol, pos, &efiobj->protocols, link) {
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100541 efi_status_t ret;
542
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100543 ret = efi_remove_protocol(handle, protocol->guid,
544 protocol->protocol_interface);
545 if (ret != EFI_SUCCESS)
546 return ret;
547 }
548 return EFI_SUCCESS;
549}
550
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200551/**
Mario Six8fac2912018-07-10 08:40:17 +0200552 * efi_delete_handle() - delete handle
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100553 *
Mario Six8fac2912018-07-10 08:40:17 +0200554 * @obj: handle to delete
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100555 */
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200556void efi_delete_handle(efi_handle_t handle)
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100557{
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200558 if (!handle)
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100559 return;
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200560 efi_remove_all_protocols(handle);
561 list_del(&handle->link);
562 free(handle);
Heinrich Schuchardt7d135462017-12-04 18:03:02 +0100563}
564
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200565/**
Mario Six8fac2912018-07-10 08:40:17 +0200566 * efi_is_event() - check if a pointer is a valid event
567 * @event: pointer to check
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100568 *
Mario Six8fac2912018-07-10 08:40:17 +0200569 * Return: status code
Alexander Grafc15d9212016-03-04 01:09:59 +0100570 */
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100571static efi_status_t efi_is_event(const struct efi_event *event)
572{
573 const struct efi_event *evt;
574
575 if (!event)
576 return EFI_INVALID_PARAMETER;
577 list_for_each_entry(evt, &efi_events, link) {
578 if (evt == event)
579 return EFI_SUCCESS;
580 }
581 return EFI_INVALID_PARAMETER;
582}
Alexander Grafc15d9212016-03-04 01:09:59 +0100583
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200584/**
Mario Six8fac2912018-07-10 08:40:17 +0200585 * efi_create_event() - create an event
586 * @type: type of the event to create
587 * @notify_tpl: task priority level of the event
588 * @notify_function: notification function of the event
589 * @notify_context: pointer passed to the notification function
590 * @group: event group
591 * @event: created event
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200592 *
593 * This function is used inside U-Boot code to create an event.
594 *
595 * For the API function implementing the CreateEvent service see
596 * efi_create_event_ext.
597 *
Mario Six8fac2912018-07-10 08:40:17 +0200598 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200599 */
Heinrich Schuchardtf8d4ec32017-11-06 21:17:47 +0100600efi_status_t efi_create_event(uint32_t type, efi_uintn_t notify_tpl,
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200601 void (EFIAPI *notify_function) (
xypron.glpk@gmx.decdbf3ac2017-07-18 20:17:17 +0200602 struct efi_event *event,
603 void *context),
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100604 void *notify_context, efi_guid_t *group,
605 struct efi_event **event)
Alexander Grafc15d9212016-03-04 01:09:59 +0100606{
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100607 struct efi_event *evt;
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200608
Jonathan Gray7758b212017-03-12 19:26:07 +1100609 if (event == NULL)
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200610 return EFI_INVALID_PARAMETER;
Jonathan Gray7758b212017-03-12 19:26:07 +1100611
Heinrich Schuchardt7f0f0052018-07-02 12:53:52 +0200612 switch (type) {
613 case 0:
614 case EVT_TIMER:
615 case EVT_NOTIFY_SIGNAL:
616 case EVT_TIMER | EVT_NOTIFY_SIGNAL:
617 case EVT_NOTIFY_WAIT:
618 case EVT_TIMER | EVT_NOTIFY_WAIT:
619 case EVT_SIGNAL_EXIT_BOOT_SERVICES:
620 case EVT_SIGNAL_VIRTUAL_ADDRESS_CHANGE:
621 break;
622 default:
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200623 return EFI_INVALID_PARAMETER;
Heinrich Schuchardt7f0f0052018-07-02 12:53:52 +0200624 }
Jonathan Gray7758b212017-03-12 19:26:07 +1100625
AKASHI Takahiro3f3835d2018-08-10 15:36:32 +0900626 if ((type & (EVT_NOTIFY_WAIT | EVT_NOTIFY_SIGNAL)) &&
Heinrich Schuchardtad7a2152019-04-25 07:30:41 +0200627 (!notify_function || is_valid_tpl(notify_tpl) != EFI_SUCCESS))
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200628 return EFI_INVALID_PARAMETER;
Jonathan Gray7758b212017-03-12 19:26:07 +1100629
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100630 evt = calloc(1, sizeof(struct efi_event));
631 if (!evt)
632 return EFI_OUT_OF_RESOURCES;
633 evt->type = type;
634 evt->notify_tpl = notify_tpl;
635 evt->notify_function = notify_function;
636 evt->notify_context = notify_context;
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100637 evt->group = group;
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +0200638 /* Disable timers on boot up */
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100639 evt->trigger_next = -1ULL;
640 evt->is_queued = false;
641 evt->is_signaled = false;
642 list_add_tail(&evt->link, &efi_events);
643 *event = evt;
644 return EFI_SUCCESS;
Alexander Grafc15d9212016-03-04 01:09:59 +0100645}
646
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200647/*
Mario Six8fac2912018-07-10 08:40:17 +0200648 * efi_create_event_ex() - create an event in a group
649 * @type: type of the event to create
650 * @notify_tpl: task priority level of the event
651 * @notify_function: notification function of the event
652 * @notify_context: pointer passed to the notification function
653 * @event: created event
654 * @event_group: event group
Heinrich Schuchardt717c4582018-02-04 23:05:13 +0100655 *
656 * This function implements the CreateEventEx service.
Heinrich Schuchardt717c4582018-02-04 23:05:13 +0100657 *
Mario Six8fac2912018-07-10 08:40:17 +0200658 * See the Unified Extensible Firmware Interface (UEFI) specification for
659 * details.
660 *
661 * Return: status code
Heinrich Schuchardt717c4582018-02-04 23:05:13 +0100662 */
663efi_status_t EFIAPI efi_create_event_ex(uint32_t type, efi_uintn_t notify_tpl,
664 void (EFIAPI *notify_function) (
665 struct efi_event *event,
666 void *context),
667 void *notify_context,
668 efi_guid_t *event_group,
669 struct efi_event **event)
670{
Heinrich Schuchardtce664992019-05-04 10:12:50 +0200671 efi_status_t ret;
672
Heinrich Schuchardt717c4582018-02-04 23:05:13 +0100673 EFI_ENTRY("%d, 0x%zx, %p, %p, %pUl", type, notify_tpl, notify_function,
674 notify_context, event_group);
Heinrich Schuchardtce664992019-05-04 10:12:50 +0200675
676 /*
677 * The allowable input parameters are the same as in CreateEvent()
678 * except for the following two disallowed event types.
679 */
680 switch (type) {
681 case EVT_SIGNAL_EXIT_BOOT_SERVICES:
682 case EVT_SIGNAL_VIRTUAL_ADDRESS_CHANGE:
683 ret = EFI_INVALID_PARAMETER;
684 goto out;
685 }
686
687 ret = efi_create_event(type, notify_tpl, notify_function,
688 notify_context, event_group, event);
689out:
690 return EFI_EXIT(ret);
Heinrich Schuchardt717c4582018-02-04 23:05:13 +0100691}
692
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200693/**
Mario Six8fac2912018-07-10 08:40:17 +0200694 * efi_create_event_ext() - create an event
695 * @type: type of the event to create
696 * @notify_tpl: task priority level of the event
697 * @notify_function: notification function of the event
698 * @notify_context: pointer passed to the notification function
699 * @event: created event
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200700 *
701 * This function implements the CreateEvent service.
Mario Six8fac2912018-07-10 08:40:17 +0200702 *
703 * See the Unified Extensible Firmware Interface (UEFI) specification for
704 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200705 *
Mario Six8fac2912018-07-10 08:40:17 +0200706 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200707 */
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200708static efi_status_t EFIAPI efi_create_event_ext(
Heinrich Schuchardtf8d4ec32017-11-06 21:17:47 +0100709 uint32_t type, efi_uintn_t notify_tpl,
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200710 void (EFIAPI *notify_function) (
711 struct efi_event *event,
712 void *context),
713 void *notify_context, struct efi_event **event)
714{
715 EFI_ENTRY("%d, 0x%zx, %p, %p", type, notify_tpl, notify_function,
716 notify_context);
717 return EFI_EXIT(efi_create_event(type, notify_tpl, notify_function,
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100718 notify_context, NULL, event));
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +0200719}
720
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200721/**
Mario Six8fac2912018-07-10 08:40:17 +0200722 * efi_timer_check() - check if a timer event has occurred
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200723 *
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200724 * Check if a timer event has occurred or a queued notification function should
725 * be called.
726 *
Alexander Grafc15d9212016-03-04 01:09:59 +0100727 * Our timers have to work without interrupts, so we check whenever keyboard
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200728 * input or disk accesses happen if enough time elapsed for them to fire.
Alexander Grafc15d9212016-03-04 01:09:59 +0100729 */
730void efi_timer_check(void)
731{
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100732 struct efi_event *evt;
Alexander Grafc15d9212016-03-04 01:09:59 +0100733 u64 now = timer_get_us();
734
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100735 list_for_each_entry(evt, &efi_events, link) {
736 if (evt->is_queued)
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100737 efi_queue_event(evt, true);
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100738 if (!(evt->type & EVT_TIMER) || now < evt->trigger_next)
Heinrich Schuchardt8b11a8a2017-09-15 10:06:13 +0200739 continue;
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100740 switch (evt->trigger_type) {
Heinrich Schuchardt8b11a8a2017-09-15 10:06:13 +0200741 case EFI_TIMER_RELATIVE:
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100742 evt->trigger_type = EFI_TIMER_STOP;
Heinrich Schuchardt8b11a8a2017-09-15 10:06:13 +0200743 break;
744 case EFI_TIMER_PERIODIC:
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100745 evt->trigger_next += evt->trigger_time;
Heinrich Schuchardt8b11a8a2017-09-15 10:06:13 +0200746 break;
747 default:
748 continue;
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200749 }
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100750 evt->is_signaled = false;
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100751 efi_signal_event(evt, true);
Alexander Grafc15d9212016-03-04 01:09:59 +0100752 }
Alexander Grafc15d9212016-03-04 01:09:59 +0100753 WATCHDOG_RESET();
754}
755
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200756/**
Mario Six8fac2912018-07-10 08:40:17 +0200757 * efi_set_timer() - set the trigger time for a timer event or stop the event
758 * @event: event for which the timer is set
759 * @type: type of the timer
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +0200760 * @trigger_time: trigger period in multiples of 100 ns
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200761 *
762 * This is the function for internal usage in U-Boot. For the API function
763 * implementing the SetTimer service see efi_set_timer_ext.
764 *
Mario Six8fac2912018-07-10 08:40:17 +0200765 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200766 */
xypron.glpk@gmx.de3ecc6bd2017-07-19 19:22:34 +0200767efi_status_t efi_set_timer(struct efi_event *event, enum efi_timer_delay type,
xypron.glpk@gmx.dea587fd12017-07-18 20:17:21 +0200768 uint64_t trigger_time)
Alexander Grafc15d9212016-03-04 01:09:59 +0100769{
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100770 /* Check that the event is valid */
771 if (efi_is_event(event) != EFI_SUCCESS || !(event->type & EVT_TIMER))
772 return EFI_INVALID_PARAMETER;
Alexander Grafc15d9212016-03-04 01:09:59 +0100773
xypron.glpk@gmx.de44c4be02017-07-18 20:17:23 +0200774 /*
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +0200775 * The parameter defines a multiple of 100 ns.
776 * We use multiples of 1000 ns. So divide by 10.
xypron.glpk@gmx.de44c4be02017-07-18 20:17:23 +0200777 */
Heinrich Schuchardt368ca642017-10-05 16:14:14 +0200778 do_div(trigger_time, 10);
Alexander Grafc15d9212016-03-04 01:09:59 +0100779
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100780 switch (type) {
781 case EFI_TIMER_STOP:
782 event->trigger_next = -1ULL;
783 break;
784 case EFI_TIMER_PERIODIC:
785 case EFI_TIMER_RELATIVE:
786 event->trigger_next = timer_get_us() + trigger_time;
787 break;
788 default:
789 return EFI_INVALID_PARAMETER;
Alexander Grafc15d9212016-03-04 01:09:59 +0100790 }
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100791 event->trigger_type = type;
792 event->trigger_time = trigger_time;
793 event->is_signaled = false;
794 return EFI_SUCCESS;
Alexander Grafc15d9212016-03-04 01:09:59 +0100795}
796
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200797/**
Mario Six8fac2912018-07-10 08:40:17 +0200798 * efi_set_timer_ext() - Set the trigger time for a timer event or stop the
799 * event
800 * @event: event for which the timer is set
801 * @type: type of the timer
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +0200802 * @trigger_time: trigger period in multiples of 100 ns
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200803 *
804 * This function implements the SetTimer service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200805 *
Mario Six8fac2912018-07-10 08:40:17 +0200806 * See the Unified Extensible Firmware Interface (UEFI) specification for
807 * details.
808 *
809 *
810 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200811 */
xypron.glpk@gmx.de3ecc6bd2017-07-19 19:22:34 +0200812static efi_status_t EFIAPI efi_set_timer_ext(struct efi_event *event,
813 enum efi_timer_delay type,
814 uint64_t trigger_time)
xypron.glpk@gmx.dea587fd12017-07-18 20:17:21 +0200815{
Masahiro Yamadac7570a32018-08-06 20:47:40 +0900816 EFI_ENTRY("%p, %d, %llx", event, type, trigger_time);
xypron.glpk@gmx.dea587fd12017-07-18 20:17:21 +0200817 return EFI_EXIT(efi_set_timer(event, type, trigger_time));
818}
819
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200820/**
Mario Six8fac2912018-07-10 08:40:17 +0200821 * efi_wait_for_event() - wait for events to be signaled
822 * @num_events: number of events to be waited for
823 * @event: events to be waited for
824 * @index: index of the event that was signaled
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200825 *
826 * This function implements the WaitForEvent service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200827 *
Mario Six8fac2912018-07-10 08:40:17 +0200828 * See the Unified Extensible Firmware Interface (UEFI) specification for
829 * details.
830 *
831 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200832 */
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100833static efi_status_t EFIAPI efi_wait_for_event(efi_uintn_t num_events,
xypron.glpk@gmx.decdbf3ac2017-07-18 20:17:17 +0200834 struct efi_event **event,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100835 efi_uintn_t *index)
Alexander Grafc15d9212016-03-04 01:09:59 +0100836{
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100837 int i;
Alexander Grafc15d9212016-03-04 01:09:59 +0100838
Heinrich Schuchardt798a4412017-11-06 21:17:48 +0100839 EFI_ENTRY("%zd, %p, %p", num_events, event, index);
Alexander Grafc15d9212016-03-04 01:09:59 +0100840
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200841 /* Check parameters */
842 if (!num_events || !event)
843 return EFI_EXIT(EFI_INVALID_PARAMETER);
Heinrich Schuchardt0c150ca2017-09-15 10:06:16 +0200844 /* Check TPL */
845 if (efi_tpl != TPL_APPLICATION)
846 return EFI_EXIT(EFI_UNSUPPORTED);
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200847 for (i = 0; i < num_events; ++i) {
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100848 if (efi_is_event(event[i]) != EFI_SUCCESS)
849 return EFI_EXIT(EFI_INVALID_PARAMETER);
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200850 if (!event[i]->type || event[i]->type & EVT_NOTIFY_SIGNAL)
851 return EFI_EXIT(EFI_INVALID_PARAMETER);
Heinrich Schuchardt1bbee392017-10-04 15:03:24 +0200852 if (!event[i]->is_signaled)
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100853 efi_queue_event(event[i], true);
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200854 }
855
856 /* Wait for signal */
857 for (;;) {
858 for (i = 0; i < num_events; ++i) {
Heinrich Schuchardt1bbee392017-10-04 15:03:24 +0200859 if (event[i]->is_signaled)
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200860 goto out;
861 }
862 /* Allow events to occur. */
863 efi_timer_check();
864 }
865
866out:
867 /*
868 * Reset the signal which is passed to the caller to allow periodic
869 * events to occur.
870 */
Heinrich Schuchardt1bbee392017-10-04 15:03:24 +0200871 event[i]->is_signaled = false;
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200872 if (index)
873 *index = i;
Alexander Grafc15d9212016-03-04 01:09:59 +0100874
875 return EFI_EXIT(EFI_SUCCESS);
876}
877
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200878/**
Mario Six8fac2912018-07-10 08:40:17 +0200879 * efi_signal_event_ext() - signal an EFI event
880 * @event: event to signal
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200881 *
882 * This function implements the SignalEvent service.
Mario Six8fac2912018-07-10 08:40:17 +0200883 *
884 * See the Unified Extensible Firmware Interface (UEFI) specification for
885 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200886 *
887 * This functions sets the signaled state of the event and queues the
888 * notification function for execution.
889 *
Mario Six8fac2912018-07-10 08:40:17 +0200890 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200891 */
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200892static efi_status_t EFIAPI efi_signal_event_ext(struct efi_event *event)
Alexander Grafc15d9212016-03-04 01:09:59 +0100893{
894 EFI_ENTRY("%p", event);
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100895 if (efi_is_event(event) != EFI_SUCCESS)
896 return EFI_EXIT(EFI_INVALID_PARAMETER);
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100897 efi_signal_event(event, true);
Alexander Grafc15d9212016-03-04 01:09:59 +0100898 return EFI_EXIT(EFI_SUCCESS);
899}
900
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200901/**
Mario Six8fac2912018-07-10 08:40:17 +0200902 * efi_close_event() - close an EFI event
903 * @event: event to close
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200904 *
905 * This function implements the CloseEvent service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200906 *
Mario Six8fac2912018-07-10 08:40:17 +0200907 * See the Unified Extensible Firmware Interface (UEFI) specification for
908 * details.
909 *
910 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200911 */
xypron.glpk@gmx.decdbf3ac2017-07-18 20:17:17 +0200912static efi_status_t EFIAPI efi_close_event(struct efi_event *event)
Alexander Grafc15d9212016-03-04 01:09:59 +0100913{
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +0200914 struct efi_register_notify_event *item, *next;
915
Alexander Grafc15d9212016-03-04 01:09:59 +0100916 EFI_ENTRY("%p", event);
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100917 if (efi_is_event(event) != EFI_SUCCESS)
918 return EFI_EXIT(EFI_INVALID_PARAMETER);
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +0200919
920 /* Remove protocol notify registrations for the event */
921 list_for_each_entry_safe(item, next, &efi_register_notify_events,
922 link) {
923 if (event == item->event) {
924 list_del(&item->link);
925 free(item);
926 }
927 }
928
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100929 list_del(&event->link);
930 free(event);
931 return EFI_EXIT(EFI_SUCCESS);
Alexander Grafc15d9212016-03-04 01:09:59 +0100932}
933
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200934/**
Mario Six8fac2912018-07-10 08:40:17 +0200935 * efi_check_event() - check if an event is signaled
936 * @event: event to check
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200937 *
938 * This function implements the CheckEvent service.
Mario Six8fac2912018-07-10 08:40:17 +0200939 *
940 * See the Unified Extensible Firmware Interface (UEFI) specification for
941 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200942 *
Mario Six8fac2912018-07-10 08:40:17 +0200943 * If an event is not signaled yet, the notification function is queued. The
944 * signaled state is cleared.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200945 *
Mario Six8fac2912018-07-10 08:40:17 +0200946 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +0200947 */
xypron.glpk@gmx.decdbf3ac2017-07-18 20:17:17 +0200948static efi_status_t EFIAPI efi_check_event(struct efi_event *event)
Alexander Grafc15d9212016-03-04 01:09:59 +0100949{
950 EFI_ENTRY("%p", event);
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200951 efi_timer_check();
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100952 if (efi_is_event(event) != EFI_SUCCESS ||
953 event->type & EVT_NOTIFY_SIGNAL)
954 return EFI_EXIT(EFI_INVALID_PARAMETER);
955 if (!event->is_signaled)
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +0100956 efi_queue_event(event, true);
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100957 if (event->is_signaled) {
958 event->is_signaled = false;
959 return EFI_EXIT(EFI_SUCCESS);
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +0200960 }
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +0100961 return EFI_EXIT(EFI_NOT_READY);
Alexander Grafc15d9212016-03-04 01:09:59 +0100962}
963
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200964/**
Mario Six8fac2912018-07-10 08:40:17 +0200965 * efi_search_obj() - find the internal EFI object for a handle
966 * @handle: handle to find
Heinrich Schuchardt37ebcba2017-10-18 18:13:03 +0200967 *
Mario Six8fac2912018-07-10 08:40:17 +0200968 * Return: EFI object
Heinrich Schuchardt37ebcba2017-10-18 18:13:03 +0200969 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +0100970struct efi_object *efi_search_obj(const efi_handle_t handle)
Heinrich Schuchardt37ebcba2017-10-18 18:13:03 +0200971{
Heinrich Schuchardt274cc872017-11-06 21:17:50 +0100972 struct efi_object *efiobj;
Heinrich Schuchardt37ebcba2017-10-18 18:13:03 +0200973
Heinrich Schuchardt5d8231b2019-05-05 10:37:51 +0200974 if (!handle)
975 return NULL;
976
Heinrich Schuchardt274cc872017-11-06 21:17:50 +0100977 list_for_each_entry(efiobj, &efi_obj_list, link) {
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +0200978 if (efiobj == handle)
Heinrich Schuchardt37ebcba2017-10-18 18:13:03 +0200979 return efiobj;
980 }
Heinrich Schuchardt37ebcba2017-10-18 18:13:03 +0200981 return NULL;
982}
983
Heinrich Schuchardt59999172018-05-11 18:15:41 +0200984/**
Mario Six8fac2912018-07-10 08:40:17 +0200985 * efi_open_protocol_info_entry() - create open protocol info entry and add it
986 * to a protocol
987 * @handler: handler of a protocol
Heinrich Schuchardta277d3a2018-01-11 08:15:57 +0100988 *
Mario Six8fac2912018-07-10 08:40:17 +0200989 * Return: open protocol info entry
Heinrich Schuchardta277d3a2018-01-11 08:15:57 +0100990 */
991static struct efi_open_protocol_info_entry *efi_create_open_info(
992 struct efi_handler *handler)
993{
994 struct efi_open_protocol_info_item *item;
995
996 item = calloc(1, sizeof(struct efi_open_protocol_info_item));
997 if (!item)
998 return NULL;
999 /* Append the item to the open protocol info list. */
1000 list_add_tail(&item->link, &handler->open_infos);
1001
1002 return &item->info;
1003}
1004
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001005/**
Mario Six8fac2912018-07-10 08:40:17 +02001006 * efi_delete_open_info() - remove an open protocol info entry from a protocol
1007 * @item: open protocol info entry to delete
Heinrich Schuchardta277d3a2018-01-11 08:15:57 +01001008 *
Mario Six8fac2912018-07-10 08:40:17 +02001009 * Return: status code
Heinrich Schuchardta277d3a2018-01-11 08:15:57 +01001010 */
1011static efi_status_t efi_delete_open_info(
1012 struct efi_open_protocol_info_item *item)
1013{
1014 list_del(&item->link);
1015 free(item);
1016 return EFI_SUCCESS;
1017}
1018
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001019/**
Mario Six8fac2912018-07-10 08:40:17 +02001020 * efi_add_protocol() - install new protocol on a handle
1021 * @handle: handle on which the protocol shall be installed
1022 * @protocol: GUID of the protocol to be installed
1023 * @protocol_interface: interface of the protocol implementation
Heinrich Schuchardt5aef61d2017-10-26 19:25:53 +02001024 *
Mario Six8fac2912018-07-10 08:40:17 +02001025 * Return: status code
Heinrich Schuchardt5aef61d2017-10-26 19:25:53 +02001026 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01001027efi_status_t efi_add_protocol(const efi_handle_t handle,
1028 const efi_guid_t *protocol,
Heinrich Schuchardt5aef61d2017-10-26 19:25:53 +02001029 void *protocol_interface)
1030{
1031 struct efi_object *efiobj;
1032 struct efi_handler *handler;
1033 efi_status_t ret;
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001034 struct efi_register_notify_event *event;
Heinrich Schuchardt5aef61d2017-10-26 19:25:53 +02001035
1036 efiobj = efi_search_obj(handle);
1037 if (!efiobj)
1038 return EFI_INVALID_PARAMETER;
1039 ret = efi_search_protocol(handle, protocol, NULL);
1040 if (ret != EFI_NOT_FOUND)
1041 return EFI_INVALID_PARAMETER;
1042 handler = calloc(1, sizeof(struct efi_handler));
1043 if (!handler)
1044 return EFI_OUT_OF_RESOURCES;
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01001045 handler->guid = protocol;
1046 handler->protocol_interface = protocol_interface;
Heinrich Schuchardta277d3a2018-01-11 08:15:57 +01001047 INIT_LIST_HEAD(&handler->open_infos);
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01001048 list_add_tail(&handler->link, &efiobj->protocols);
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001049
1050 /* Notify registered events */
1051 list_for_each_entry(event, &efi_register_notify_events, link) {
1052 if (!guidcmp(protocol, &event->protocol))
1053 efi_signal_event(event->event, true);
1054 }
1055
Heinrich Schuchardt3d2abc32018-01-11 08:16:01 +01001056 if (!guidcmp(&efi_guid_device_path, protocol))
1057 EFI_PRINT("installed device path '%pD'\n", protocol_interface);
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01001058 return EFI_SUCCESS;
Heinrich Schuchardt5aef61d2017-10-26 19:25:53 +02001059}
1060
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001061/**
Mario Six8fac2912018-07-10 08:40:17 +02001062 * efi_install_protocol_interface() - install protocol interface
1063 * @handle: handle on which the protocol shall be installed
1064 * @protocol: GUID of the protocol to be installed
1065 * @protocol_interface_type: type of the interface to be installed,
1066 * always EFI_NATIVE_INTERFACE
1067 * @protocol_interface: interface of the protocol implementation
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001068 *
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01001069 * This function implements the InstallProtocolInterface service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001070 *
Mario Six8fac2912018-07-10 08:40:17 +02001071 * See the Unified Extensible Firmware Interface (UEFI) specification for
1072 * details.
1073 *
1074 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001075 */
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01001076static efi_status_t EFIAPI efi_install_protocol_interface(
Heinrich Schuchardt4f94ec52018-09-26 05:27:54 +02001077 efi_handle_t *handle, const efi_guid_t *protocol,
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01001078 int protocol_interface_type, void *protocol_interface)
Alexander Grafc15d9212016-03-04 01:09:59 +01001079{
xypron.glpk@gmx.de0581fa82017-07-11 22:06:16 +02001080 efi_status_t r;
1081
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01001082 EFI_ENTRY("%p, %pUl, %d, %p", handle, protocol, protocol_interface_type,
1083 protocol_interface);
1084
xypron.glpk@gmx.de0581fa82017-07-11 22:06:16 +02001085 if (!handle || !protocol ||
1086 protocol_interface_type != EFI_NATIVE_INTERFACE) {
1087 r = EFI_INVALID_PARAMETER;
1088 goto out;
1089 }
1090
1091 /* Create new handle if requested. */
1092 if (!*handle) {
Heinrich Schuchardtcd522cb2017-08-27 00:51:09 +02001093 r = efi_create_handle(handle);
1094 if (r != EFI_SUCCESS)
1095 goto out;
Heinrich Schuchardt952e2062019-05-05 11:56:23 +02001096 EFI_PRINT("new handle %p\n", *handle);
Heinrich Schuchardt50f02102017-10-26 19:25:43 +02001097 } else {
Heinrich Schuchardt952e2062019-05-05 11:56:23 +02001098 EFI_PRINT("handle %p\n", *handle);
xypron.glpk@gmx.de0581fa82017-07-11 22:06:16 +02001099 }
Heinrich Schuchardt865d5f32017-10-26 19:25:54 +02001100 /* Add new protocol */
1101 r = efi_add_protocol(*handle, protocol, protocol_interface);
xypron.glpk@gmx.de0581fa82017-07-11 22:06:16 +02001102out:
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01001103 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +01001104}
xypron.glpk@gmx.de0581fa82017-07-11 22:06:16 +02001105
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001106/**
Mario Six8fac2912018-07-10 08:40:17 +02001107 * efi_get_drivers() - get all drivers associated to a controller
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001108 * @handle: handle of the controller
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02001109 * @protocol: protocol GUID (optional)
Mario Six8fac2912018-07-10 08:40:17 +02001110 * @number_of_drivers: number of child controllers
1111 * @driver_handle_buffer: handles of the the drivers
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001112 *
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001113 * The allocated buffer has to be freed with free().
1114 *
Mario Six8fac2912018-07-10 08:40:17 +02001115 * Return: status code
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001116 */
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001117static efi_status_t efi_get_drivers(efi_handle_t handle,
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001118 const efi_guid_t *protocol,
1119 efi_uintn_t *number_of_drivers,
1120 efi_handle_t **driver_handle_buffer)
1121{
1122 struct efi_handler *handler;
1123 struct efi_open_protocol_info_item *item;
1124 efi_uintn_t count = 0, i;
1125 bool duplicate;
1126
1127 /* Count all driver associations */
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001128 list_for_each_entry(handler, &handle->protocols, link) {
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001129 if (protocol && guidcmp(handler->guid, protocol))
1130 continue;
1131 list_for_each_entry(item, &handler->open_infos, link) {
1132 if (item->info.attributes &
1133 EFI_OPEN_PROTOCOL_BY_DRIVER)
1134 ++count;
1135 }
1136 }
1137 /*
1138 * Create buffer. In case of duplicate driver assignments the buffer
1139 * will be too large. But that does not harm.
1140 */
1141 *number_of_drivers = 0;
1142 *driver_handle_buffer = calloc(count, sizeof(efi_handle_t));
1143 if (!*driver_handle_buffer)
1144 return EFI_OUT_OF_RESOURCES;
1145 /* Collect unique driver handles */
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001146 list_for_each_entry(handler, &handle->protocols, link) {
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001147 if (protocol && guidcmp(handler->guid, protocol))
1148 continue;
1149 list_for_each_entry(item, &handler->open_infos, link) {
1150 if (item->info.attributes &
1151 EFI_OPEN_PROTOCOL_BY_DRIVER) {
1152 /* Check this is a new driver */
1153 duplicate = false;
1154 for (i = 0; i < *number_of_drivers; ++i) {
1155 if ((*driver_handle_buffer)[i] ==
1156 item->info.agent_handle)
1157 duplicate = true;
1158 }
1159 /* Copy handle to buffer */
1160 if (!duplicate) {
1161 i = (*number_of_drivers)++;
1162 (*driver_handle_buffer)[i] =
1163 item->info.agent_handle;
1164 }
1165 }
1166 }
1167 }
1168 return EFI_SUCCESS;
1169}
1170
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001171/**
Mario Six8fac2912018-07-10 08:40:17 +02001172 * efi_disconnect_all_drivers() - disconnect all drivers from a controller
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001173 * @handle: handle of the controller
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02001174 * @protocol: protocol GUID (optional)
Mario Six8fac2912018-07-10 08:40:17 +02001175 * @child_handle: handle of the child to destroy
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001176 *
1177 * This function implements the DisconnectController service.
Mario Six8fac2912018-07-10 08:40:17 +02001178 *
1179 * See the Unified Extensible Firmware Interface (UEFI) specification for
1180 * details.
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001181 *
Mario Six8fac2912018-07-10 08:40:17 +02001182 * Return: status code
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001183 */
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001184static efi_status_t efi_disconnect_all_drivers
1185 (efi_handle_t handle,
1186 const efi_guid_t *protocol,
1187 efi_handle_t child_handle)
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001188{
1189 efi_uintn_t number_of_drivers;
1190 efi_handle_t *driver_handle_buffer;
1191 efi_status_t r, ret;
1192
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001193 ret = efi_get_drivers(handle, protocol, &number_of_drivers,
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001194 &driver_handle_buffer);
1195 if (ret != EFI_SUCCESS)
1196 return ret;
1197
1198 ret = EFI_NOT_FOUND;
1199 while (number_of_drivers) {
1200 r = EFI_CALL(efi_disconnect_controller(
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001201 handle,
Heinrich Schuchardte9943282018-01-11 08:16:04 +01001202 driver_handle_buffer[--number_of_drivers],
1203 child_handle));
1204 if (r == EFI_SUCCESS)
1205 ret = r;
1206 }
1207 free(driver_handle_buffer);
1208 return ret;
1209}
1210
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001211/**
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02001212 * efi_uninstall_protocol() - uninstall protocol interface
1213 *
Mario Six8fac2912018-07-10 08:40:17 +02001214 * @handle: handle from which the protocol shall be removed
1215 * @protocol: GUID of the protocol to be removed
1216 * @protocol_interface: interface to be removed
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001217 *
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02001218 * This function DOES NOT delete a handle without installed protocol.
Mario Six8fac2912018-07-10 08:40:17 +02001219 *
1220 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001221 */
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02001222static efi_status_t efi_uninstall_protocol
1223 (efi_handle_t handle, const efi_guid_t *protocol,
1224 void *protocol_interface)
Alexander Grafc15d9212016-03-04 01:09:59 +01001225{
Heinrich Schuchardt86637f32018-01-11 08:16:05 +01001226 struct efi_object *efiobj;
Heinrich Schuchardt7538c272017-10-26 19:25:56 +02001227 struct efi_handler *handler;
Heinrich Schuchardt86637f32018-01-11 08:16:05 +01001228 struct efi_open_protocol_info_item *item;
1229 struct efi_open_protocol_info_item *pos;
Heinrich Schuchardt7538c272017-10-26 19:25:56 +02001230 efi_status_t r;
xypron.glpk@gmx.de2cfad482017-07-11 22:06:17 +02001231
Heinrich Schuchardt86637f32018-01-11 08:16:05 +01001232 /* Check handle */
1233 efiobj = efi_search_obj(handle);
1234 if (!efiobj) {
xypron.glpk@gmx.de2cfad482017-07-11 22:06:17 +02001235 r = EFI_INVALID_PARAMETER;
1236 goto out;
1237 }
Heinrich Schuchardt7538c272017-10-26 19:25:56 +02001238 /* Find the protocol on the handle */
1239 r = efi_search_protocol(handle, protocol, &handler);
1240 if (r != EFI_SUCCESS)
1241 goto out;
Heinrich Schuchardt86637f32018-01-11 08:16:05 +01001242 /* Disconnect controllers */
1243 efi_disconnect_all_drivers(efiobj, protocol, NULL);
1244 if (!list_empty(&handler->open_infos)) {
1245 r = EFI_ACCESS_DENIED;
1246 goto out;
1247 }
1248 /* Close protocol */
1249 list_for_each_entry_safe(item, pos, &handler->open_infos, link) {
1250 if (item->info.attributes ==
1251 EFI_OPEN_PROTOCOL_BY_HANDLE_PROTOCOL ||
1252 item->info.attributes == EFI_OPEN_PROTOCOL_GET_PROTOCOL ||
1253 item->info.attributes == EFI_OPEN_PROTOCOL_TEST_PROTOCOL)
1254 list_del(&item->link);
1255 }
1256 if (!list_empty(&handler->open_infos)) {
Heinrich Schuchardt7538c272017-10-26 19:25:56 +02001257 r = EFI_ACCESS_DENIED;
Heinrich Schuchardt86637f32018-01-11 08:16:05 +01001258 goto out;
xypron.glpk@gmx.de2cfad482017-07-11 22:06:17 +02001259 }
Heinrich Schuchardt86637f32018-01-11 08:16:05 +01001260 r = efi_remove_protocol(handle, protocol, protocol_interface);
xypron.glpk@gmx.de2cfad482017-07-11 22:06:17 +02001261out:
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02001262 return r;
Alexander Grafc15d9212016-03-04 01:09:59 +01001263}
1264
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001265/**
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02001266 * efi_uninstall_protocol_interface() - uninstall protocol interface
1267 * @handle: handle from which the protocol shall be removed
1268 * @protocol: GUID of the protocol to be removed
1269 * @protocol_interface: interface to be removed
1270 *
1271 * This function implements the UninstallProtocolInterface service.
1272 *
1273 * See the Unified Extensible Firmware Interface (UEFI) specification for
1274 * details.
1275 *
1276 * Return: status code
1277 */
1278static efi_status_t EFIAPI efi_uninstall_protocol_interface
1279 (efi_handle_t handle, const efi_guid_t *protocol,
1280 void *protocol_interface)
1281{
1282 efi_status_t ret;
1283
1284 EFI_ENTRY("%p, %pUl, %p", handle, protocol, protocol_interface);
1285
1286 ret = efi_uninstall_protocol(handle, protocol, protocol_interface);
1287 if (ret != EFI_SUCCESS)
1288 goto out;
1289
1290 /* If the last protocol has been removed, delete the handle. */
1291 if (list_empty(&handle->protocols)) {
1292 list_del(&handle->link);
1293 free(handle);
1294 }
1295out:
1296 return EFI_EXIT(ret);
1297}
1298
1299/**
Mario Six8fac2912018-07-10 08:40:17 +02001300 * efi_register_protocol_notify() - register an event for notification when a
1301 * protocol is installed.
1302 * @protocol: GUID of the protocol whose installation shall be notified
1303 * @event: event to be signaled upon installation of the protocol
1304 * @registration: key for retrieving the registration information
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001305 *
1306 * This function implements the RegisterProtocolNotify service.
1307 * See the Unified Extensible Firmware Interface (UEFI) specification
1308 * for details.
1309 *
Mario Six8fac2912018-07-10 08:40:17 +02001310 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001311 */
Heinrich Schuchardte547c662017-10-05 16:35:53 +02001312static efi_status_t EFIAPI efi_register_protocol_notify(
1313 const efi_guid_t *protocol,
1314 struct efi_event *event,
1315 void **registration)
Alexander Grafc15d9212016-03-04 01:09:59 +01001316{
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001317 struct efi_register_notify_event *item;
1318 efi_status_t ret = EFI_SUCCESS;
1319
Rob Clark238f88c2017-09-13 18:05:41 -04001320 EFI_ENTRY("%pUl, %p, %p", protocol, event, registration);
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001321
1322 if (!protocol || !event || !registration) {
1323 ret = EFI_INVALID_PARAMETER;
1324 goto out;
1325 }
1326
1327 item = calloc(1, sizeof(struct efi_register_notify_event));
1328 if (!item) {
1329 ret = EFI_OUT_OF_RESOURCES;
1330 goto out;
1331 }
1332
1333 item->event = event;
1334 memcpy(&item->protocol, protocol, sizeof(efi_guid_t));
1335
1336 list_add_tail(&item->link, &efi_register_notify_events);
1337
1338 *registration = item;
1339out:
1340 return EFI_EXIT(ret);
Alexander Grafc15d9212016-03-04 01:09:59 +01001341}
1342
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001343/**
Mario Six8fac2912018-07-10 08:40:17 +02001344 * efi_search() - determine if an EFI handle implements a protocol
1345 * @search_type: selection criterion
1346 * @protocol: GUID of the protocol
1347 * @search_key: registration key
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001348 * @handle: handle
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001349 *
1350 * See the documentation of the LocateHandle service in the UEFI specification.
1351 *
Mario Six8fac2912018-07-10 08:40:17 +02001352 * Return: 0 if the handle implements the protocol
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001353 */
Alexander Grafc15d9212016-03-04 01:09:59 +01001354static int efi_search(enum efi_locate_search_type search_type,
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001355 const efi_guid_t *protocol, efi_handle_t handle)
Alexander Grafc15d9212016-03-04 01:09:59 +01001356{
Heinrich Schuchardt6a430752017-10-26 19:25:55 +02001357 efi_status_t ret;
Alexander Grafc15d9212016-03-04 01:09:59 +01001358
1359 switch (search_type) {
Heinrich Schuchardt68845f02017-11-06 21:17:42 +01001360 case ALL_HANDLES:
Alexander Grafc15d9212016-03-04 01:09:59 +01001361 return 0;
Heinrich Schuchardt68845f02017-11-06 21:17:42 +01001362 case BY_REGISTER_NOTIFY:
Heinrich Schuchardt68845f02017-11-06 21:17:42 +01001363 case BY_PROTOCOL:
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001364 ret = efi_search_protocol(handle, protocol, NULL);
Heinrich Schuchardt6a430752017-10-26 19:25:55 +02001365 return (ret != EFI_SUCCESS);
1366 default:
1367 /* Invalid search type */
Alexander Grafc15d9212016-03-04 01:09:59 +01001368 return -1;
1369 }
Alexander Grafc15d9212016-03-04 01:09:59 +01001370}
1371
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001372/**
Mario Six8fac2912018-07-10 08:40:17 +02001373 * efi_locate_handle() - locate handles implementing a protocol
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001374 *
1375 * @search_type: selection criterion
1376 * @protocol: GUID of the protocol
1377 * @search_key: registration key
1378 * @buffer_size: size of the buffer to receive the handles in bytes
1379 * @buffer: buffer to receive the relevant handles
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001380 *
1381 * This function is meant for U-Boot internal calls. For the API implementation
1382 * of the LocateHandle service see efi_locate_handle_ext.
1383 *
Mario Six8fac2912018-07-10 08:40:17 +02001384 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001385 */
xypron.glpk@gmx.decab4dd52017-08-09 20:55:00 +02001386static efi_status_t efi_locate_handle(
Alexander Grafc15d9212016-03-04 01:09:59 +01001387 enum efi_locate_search_type search_type,
Heinrich Schuchardte547c662017-10-05 16:35:53 +02001388 const efi_guid_t *protocol, void *search_key,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01001389 efi_uintn_t *buffer_size, efi_handle_t *buffer)
Alexander Grafc15d9212016-03-04 01:09:59 +01001390{
Heinrich Schuchardtec66fc82017-11-06 21:17:49 +01001391 struct efi_object *efiobj;
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01001392 efi_uintn_t size = 0;
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001393 struct efi_register_notify_event *item, *event = NULL;
Alexander Grafc15d9212016-03-04 01:09:59 +01001394
Heinrich Schuchardtec66fc82017-11-06 21:17:49 +01001395 /* Check parameters */
1396 switch (search_type) {
1397 case ALL_HANDLES:
1398 break;
1399 case BY_REGISTER_NOTIFY:
1400 if (!search_key)
1401 return EFI_INVALID_PARAMETER;
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001402 /* Check that the registration key is valid */
1403 list_for_each_entry(item, &efi_register_notify_events, link) {
1404 if (item ==
1405 (struct efi_register_notify_event *)search_key) {
1406 event = item;
1407 break;
1408 }
1409 }
1410 if (!event)
1411 return EFI_INVALID_PARAMETER;
1412
1413 protocol = &event->protocol;
1414 break;
Heinrich Schuchardtec66fc82017-11-06 21:17:49 +01001415 case BY_PROTOCOL:
1416 if (!protocol)
1417 return EFI_INVALID_PARAMETER;
1418 break;
1419 default:
1420 return EFI_INVALID_PARAMETER;
1421 }
1422
Alexander Grafc15d9212016-03-04 01:09:59 +01001423 /* Count how much space we need */
Heinrich Schuchardtec66fc82017-11-06 21:17:49 +01001424 list_for_each_entry(efiobj, &efi_obj_list, link) {
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001425 if (!efi_search(search_type, protocol, efiobj))
Heinrich Schuchardt91064592018-02-18 15:17:49 +01001426 size += sizeof(void *);
Alexander Grafc15d9212016-03-04 01:09:59 +01001427 }
1428
Heinrich Schuchardtc0ee5f32019-05-04 17:37:32 +02001429 if (size == 0)
1430 return EFI_NOT_FOUND;
1431
1432 if (!buffer_size)
1433 return EFI_INVALID_PARAMETER;
1434
Alexander Grafc15d9212016-03-04 01:09:59 +01001435 if (*buffer_size < size) {
1436 *buffer_size = size;
xypron.glpk@gmx.de69f94032017-07-11 22:06:21 +02001437 return EFI_BUFFER_TOO_SMALL;
Alexander Grafc15d9212016-03-04 01:09:59 +01001438 }
1439
Rob Clarkcdee3372017-08-06 14:10:07 -04001440 *buffer_size = size;
Heinrich Schuchardtc0ee5f32019-05-04 17:37:32 +02001441
Heinrich Schuchardtc97f9472019-05-10 19:03:49 +02001442 /* The buffer size is sufficient but there is no buffer */
Heinrich Schuchardtc0ee5f32019-05-04 17:37:32 +02001443 if (!buffer)
1444 return EFI_INVALID_PARAMETER;
Rob Clarkcdee3372017-08-06 14:10:07 -04001445
Alexander Grafc15d9212016-03-04 01:09:59 +01001446 /* Then fill the array */
Heinrich Schuchardtec66fc82017-11-06 21:17:49 +01001447 list_for_each_entry(efiobj, &efi_obj_list, link) {
Heinrich Schuchardt6eec42d2019-05-04 17:27:54 +02001448 if (!efi_search(search_type, protocol, efiobj))
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02001449 *buffer++ = efiobj;
Alexander Grafc15d9212016-03-04 01:09:59 +01001450 }
1451
xypron.glpk@gmx.de69f94032017-07-11 22:06:21 +02001452 return EFI_SUCCESS;
1453}
1454
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001455/**
Mario Six8fac2912018-07-10 08:40:17 +02001456 * efi_locate_handle_ext() - locate handles implementing a protocol.
1457 * @search_type: selection criterion
1458 * @protocol: GUID of the protocol
1459 * @search_key: registration key
1460 * @buffer_size: size of the buffer to receive the handles in bytes
1461 * @buffer: buffer to receive the relevant handles
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001462 *
1463 * This function implements the LocateHandle service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001464 *
Mario Six8fac2912018-07-10 08:40:17 +02001465 * See the Unified Extensible Firmware Interface (UEFI) specification for
1466 * details.
1467 *
1468 * Return: 0 if the handle implements the protocol
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001469 */
xypron.glpk@gmx.de69f94032017-07-11 22:06:21 +02001470static efi_status_t EFIAPI efi_locate_handle_ext(
1471 enum efi_locate_search_type search_type,
Heinrich Schuchardte547c662017-10-05 16:35:53 +02001472 const efi_guid_t *protocol, void *search_key,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01001473 efi_uintn_t *buffer_size, efi_handle_t *buffer)
xypron.glpk@gmx.de69f94032017-07-11 22:06:21 +02001474{
Rob Clark238f88c2017-09-13 18:05:41 -04001475 EFI_ENTRY("%d, %pUl, %p, %p, %p", search_type, protocol, search_key,
xypron.glpk@gmx.de69f94032017-07-11 22:06:21 +02001476 buffer_size, buffer);
1477
1478 return EFI_EXIT(efi_locate_handle(search_type, protocol, search_key,
1479 buffer_size, buffer));
Alexander Grafc15d9212016-03-04 01:09:59 +01001480}
1481
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001482/**
Mario Six8fac2912018-07-10 08:40:17 +02001483 * efi_remove_configuration_table() - collapses configuration table entries,
1484 * removing index i
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001485 *
Mario Six8fac2912018-07-10 08:40:17 +02001486 * @i: index of the table entry to be removed
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001487 */
Alexander Graffe3366f2017-07-26 13:41:04 +02001488static void efi_remove_configuration_table(int i)
1489{
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02001490 struct efi_configuration_table *this = &systab.tables[i];
1491 struct efi_configuration_table *next = &systab.tables[i + 1];
1492 struct efi_configuration_table *end = &systab.tables[systab.nr_tables];
Alexander Graffe3366f2017-07-26 13:41:04 +02001493
1494 memmove(this, next, (ulong)end - (ulong)next);
1495 systab.nr_tables--;
1496}
1497
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001498/**
Mario Six8fac2912018-07-10 08:40:17 +02001499 * efi_install_configuration_table() - adds, updates, or removes a
1500 * configuration table
1501 * @guid: GUID of the installed table
1502 * @table: table to be installed
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001503 *
1504 * This function is used for internal calls. For the API implementation of the
1505 * InstallConfigurationTable service see efi_install_configuration_table_ext.
1506 *
Mario Six8fac2912018-07-10 08:40:17 +02001507 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001508 */
Heinrich Schuchardt91064592018-02-18 15:17:49 +01001509efi_status_t efi_install_configuration_table(const efi_guid_t *guid,
1510 void *table)
Alexander Grafc15d9212016-03-04 01:09:59 +01001511{
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +01001512 struct efi_event *evt;
Alexander Grafc15d9212016-03-04 01:09:59 +01001513 int i;
1514
Heinrich Schuchardt754ce102018-02-18 00:08:00 +01001515 if (!guid)
1516 return EFI_INVALID_PARAMETER;
1517
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02001518 /* Check for GUID override */
Alexander Grafc15d9212016-03-04 01:09:59 +01001519 for (i = 0; i < systab.nr_tables; i++) {
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02001520 if (!guidcmp(guid, &systab.tables[i].guid)) {
Alexander Graffe3366f2017-07-26 13:41:04 +02001521 if (table)
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02001522 systab.tables[i].table = table;
Alexander Graffe3366f2017-07-26 13:41:04 +02001523 else
1524 efi_remove_configuration_table(i);
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +01001525 goto out;
Alexander Grafc15d9212016-03-04 01:09:59 +01001526 }
1527 }
1528
Alexander Graffe3366f2017-07-26 13:41:04 +02001529 if (!table)
1530 return EFI_NOT_FOUND;
1531
Alexander Grafc15d9212016-03-04 01:09:59 +01001532 /* No override, check for overflow */
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02001533 if (i >= EFI_MAX_CONFIGURATION_TABLES)
Alexander Grafc5c11632016-08-19 01:23:24 +02001534 return EFI_OUT_OF_RESOURCES;
Alexander Grafc15d9212016-03-04 01:09:59 +01001535
1536 /* Add a new entry */
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02001537 memcpy(&systab.tables[i].guid, guid, sizeof(*guid));
1538 systab.tables[i].table = table;
Alexander Graf9982e672016-08-19 01:23:30 +02001539 systab.nr_tables = i + 1;
Alexander Grafc15d9212016-03-04 01:09:59 +01001540
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +01001541out:
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02001542 /* systab.nr_tables may have changed. So we need to update the CRC32 */
Heinrich Schuchardtac2d4da2018-07-07 15:36:05 +02001543 efi_update_table_header_crc32(&systab.hdr);
1544
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +01001545 /* Notify that the configuration table was changed */
1546 list_for_each_entry(evt, &efi_events, link) {
1547 if (evt->group && !guidcmp(evt->group, guid)) {
1548 efi_signal_event(evt, false);
1549 break;
1550 }
1551 }
1552
Alexander Grafc5c11632016-08-19 01:23:24 +02001553 return EFI_SUCCESS;
Alexander Grafc15d9212016-03-04 01:09:59 +01001554}
1555
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001556/**
Mario Six8fac2912018-07-10 08:40:17 +02001557 * efi_install_configuration_table_ex() - Adds, updates, or removes a
1558 * configuration table.
1559 * @guid: GUID of the installed table
1560 * @table: table to be installed
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001561 *
1562 * This function implements the InstallConfigurationTable service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001563 *
Mario Six8fac2912018-07-10 08:40:17 +02001564 * See the Unified Extensible Firmware Interface (UEFI) specification for
1565 * details.
1566 *
1567 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001568 */
Alexander Grafc5c11632016-08-19 01:23:24 +02001569static efi_status_t EFIAPI efi_install_configuration_table_ext(efi_guid_t *guid,
1570 void *table)
1571{
Rob Clark238f88c2017-09-13 18:05:41 -04001572 EFI_ENTRY("%pUl, %p", guid, table);
Alexander Grafc5c11632016-08-19 01:23:24 +02001573 return EFI_EXIT(efi_install_configuration_table(guid, table));
1574}
1575
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001576/**
Mario Six8fac2912018-07-10 08:40:17 +02001577 * efi_setup_loaded_image() - initialize a loaded image
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001578 *
1579 * Initialize a loaded_image_info and loaded_image_info object with correct
Rob Clarkf8db9222017-09-13 18:05:33 -04001580 * protocols, boot-device, etc.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001581 *
Heinrich Schuchardt6346a902019-02-06 19:41:29 +01001582 * In case of an error *handle_ptr and *info_ptr are set to NULL and an error
1583 * code is returned.
1584 *
1585 * @device_path: device path of the loaded image
1586 * @file_path: file path of the loaded image
1587 * @handle_ptr: handle of the loaded image
1588 * @info_ptr: loaded image protocol
1589 * Return: status code
Rob Clarkf8db9222017-09-13 18:05:33 -04001590 */
Heinrich Schuchardt3c3a7352018-09-23 17:21:51 +02001591efi_status_t efi_setup_loaded_image(struct efi_device_path *device_path,
1592 struct efi_device_path *file_path,
1593 struct efi_loaded_image_obj **handle_ptr,
1594 struct efi_loaded_image **info_ptr)
Rob Clarkf8db9222017-09-13 18:05:33 -04001595{
Heinrich Schuchardt24d3a662017-10-26 19:25:58 +02001596 efi_status_t ret;
Heinrich Schuchardt6346a902019-02-06 19:41:29 +01001597 struct efi_loaded_image *info = NULL;
1598 struct efi_loaded_image_obj *obj = NULL;
AKASHI Takahirobbe13da2019-03-27 13:40:32 +09001599 struct efi_device_path *dp;
Heinrich Schuchardt6346a902019-02-06 19:41:29 +01001600
1601 /* In case of EFI_OUT_OF_RESOURCES avoid illegal free by caller. */
1602 *handle_ptr = NULL;
1603 *info_ptr = NULL;
Heinrich Schuchardt3c3a7352018-09-23 17:21:51 +02001604
1605 info = calloc(1, sizeof(*info));
1606 if (!info)
1607 return EFI_OUT_OF_RESOURCES;
1608 obj = calloc(1, sizeof(*obj));
1609 if (!obj) {
1610 free(info);
1611 return EFI_OUT_OF_RESOURCES;
1612 }
Heinrich Schuchardtb27ced42019-05-01 14:20:18 +02001613 obj->header.type = EFI_OBJECT_TYPE_LOADED_IMAGE;
Heinrich Schuchardt24d3a662017-10-26 19:25:58 +02001614
Heinrich Schuchardt967d7de2017-11-26 14:05:23 +01001615 /* Add internal object to object list */
Heinrich Schuchardt72928722018-09-26 05:27:56 +02001616 efi_add_handle(&obj->header);
Heinrich Schuchardt3c3a7352018-09-23 17:21:51 +02001617
Heinrich Schuchardtc47f8702018-07-05 08:17:58 +02001618 info->revision = EFI_LOADED_IMAGE_PROTOCOL_REVISION;
Heinrich Schuchardt24d3a662017-10-26 19:25:58 +02001619 info->file_path = file_path;
Heinrich Schuchardt8a7e09d2018-08-26 15:31:52 +02001620 info->system_table = &systab;
Heinrich Schuchardt24d3a662017-10-26 19:25:58 +02001621
Heinrich Schuchardtf3996be2018-01-26 06:50:54 +01001622 if (device_path) {
1623 info->device_handle = efi_dp_find_obj(device_path, NULL);
AKASHI Takahirobbe13da2019-03-27 13:40:32 +09001624
1625 dp = efi_dp_append(device_path, file_path);
1626 if (!dp) {
1627 ret = EFI_OUT_OF_RESOURCES;
Heinrich Schuchardtf3996be2018-01-26 06:50:54 +01001628 goto failure;
AKASHI Takahirobbe13da2019-03-27 13:40:32 +09001629 }
1630 } else {
1631 dp = NULL;
Heinrich Schuchardtf3996be2018-01-26 06:50:54 +01001632 }
AKASHI Takahirobbe13da2019-03-27 13:40:32 +09001633 ret = efi_add_protocol(&obj->header,
1634 &efi_guid_loaded_image_device_path, dp);
1635 if (ret != EFI_SUCCESS)
1636 goto failure;
Rob Clarkf8db9222017-09-13 18:05:33 -04001637
1638 /*
1639 * When asking for the loaded_image interface, just
1640 * return handle which points to loaded_image_info
1641 */
Heinrich Schuchardt72928722018-09-26 05:27:56 +02001642 ret = efi_add_protocol(&obj->header,
Heinrich Schuchardt3c3a7352018-09-23 17:21:51 +02001643 &efi_guid_loaded_image, info);
Heinrich Schuchardt24d3a662017-10-26 19:25:58 +02001644 if (ret != EFI_SUCCESS)
1645 goto failure;
Rob Clarkf8db9222017-09-13 18:05:33 -04001646
Heinrich Schuchardtd20f5122019-03-19 18:58:58 +01001647 *info_ptr = info;
1648 *handle_ptr = obj;
Heinrich Schuchardt6346a902019-02-06 19:41:29 +01001649
Heinrich Schuchardt7db9f892017-12-04 18:03:01 +01001650 return ret;
Heinrich Schuchardt24d3a662017-10-26 19:25:58 +02001651failure:
1652 printf("ERROR: Failure to install protocols for loaded image\n");
Heinrich Schuchardt6346a902019-02-06 19:41:29 +01001653 efi_delete_handle(&obj->header);
1654 free(info);
Heinrich Schuchardt7db9f892017-12-04 18:03:01 +01001655 return ret;
Rob Clarkf8db9222017-09-13 18:05:33 -04001656}
1657
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001658/**
Mario Six8fac2912018-07-10 08:40:17 +02001659 * efi_load_image_from_path() - load an image using a file path
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001660 *
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001661 * Read a file into a buffer allocated as EFI_BOOT_SERVICES_DATA. It is the
1662 * callers obligation to update the memory type as needed.
1663 *
1664 * @file_path: the path of the image to load
1665 * @buffer: buffer containing the loaded image
1666 * @size: size of the loaded image
1667 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001668 */
AKASHI Takahiro14ff23b2019-04-19 12:22:35 +09001669static
Rob Clarkc84c1102017-09-13 18:05:38 -04001670efi_status_t efi_load_image_from_path(struct efi_device_path *file_path,
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001671 void **buffer, efi_uintn_t *size)
Rob Clark857a1222017-09-13 18:05:35 -04001672{
1673 struct efi_file_info *info = NULL;
1674 struct efi_file_handle *f;
1675 static efi_status_t ret;
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001676 u64 addr;
Heinrich Schuchardt6b06e0d2018-04-03 22:37:11 +02001677 efi_uintn_t bs;
Rob Clark857a1222017-09-13 18:05:35 -04001678
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001679 /* In case of failure nothing is returned */
1680 *buffer = NULL;
1681 *size = 0;
1682
1683 /* Open file */
Rob Clark857a1222017-09-13 18:05:35 -04001684 f = efi_file_from_path(file_path);
1685 if (!f)
1686 return EFI_DEVICE_ERROR;
1687
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001688 /* Get file size */
Rob Clark857a1222017-09-13 18:05:35 -04001689 bs = 0;
1690 EFI_CALL(ret = f->getinfo(f, (efi_guid_t *)&efi_file_info_guid,
1691 &bs, info));
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001692 if (ret != EFI_BUFFER_TOO_SMALL) {
1693 ret = EFI_DEVICE_ERROR;
Rob Clark857a1222017-09-13 18:05:35 -04001694 goto error;
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001695 }
Rob Clark857a1222017-09-13 18:05:35 -04001696
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001697 info = malloc(bs);
1698 EFI_CALL(ret = f->getinfo(f, (efi_guid_t *)&efi_file_info_guid, &bs,
1699 info));
1700 if (ret != EFI_SUCCESS)
Rob Clark857a1222017-09-13 18:05:35 -04001701 goto error;
1702
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001703 /*
1704 * When reading the file we do not yet know if it contains an
1705 * application, a boottime driver, or a runtime driver. So here we
1706 * allocate a buffer as EFI_BOOT_SERVICES_DATA. The caller has to
1707 * update the reservation according to the image type.
1708 */
Heinrich Schuchardt6b06e0d2018-04-03 22:37:11 +02001709 bs = info->file_size;
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001710 ret = efi_allocate_pages(EFI_ALLOCATE_ANY_PAGES,
1711 EFI_BOOT_SERVICES_DATA,
1712 efi_size_in_pages(bs), &addr);
Rob Clark857a1222017-09-13 18:05:35 -04001713 if (ret != EFI_SUCCESS) {
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001714 ret = EFI_OUT_OF_RESOURCES;
1715 goto error;
Rob Clark857a1222017-09-13 18:05:35 -04001716 }
1717
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001718 /* Read file */
1719 EFI_CALL(ret = f->read(f, &bs, (void *)(uintptr_t)addr));
1720 if (ret != EFI_SUCCESS)
1721 efi_free_pages(addr, efi_size_in_pages(bs));
1722 *buffer = (void *)(uintptr_t)addr;
1723 *size = bs;
1724error:
1725 EFI_CALL(f->close(f));
1726 free(info);
Rob Clark857a1222017-09-13 18:05:35 -04001727 return ret;
1728}
1729
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001730/**
Mario Six8fac2912018-07-10 08:40:17 +02001731 * efi_load_image() - load an EFI image into memory
1732 * @boot_policy: true for request originating from the boot manager
1733 * @parent_image: the caller's image handle
1734 * @file_path: the path of the image to load
1735 * @source_buffer: memory location from which the image is installed
1736 * @source_size: size of the memory area from which the image is installed
1737 * @image_handle: handle for the newly installed image
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001738 *
1739 * This function implements the LoadImage service.
Mario Six8fac2912018-07-10 08:40:17 +02001740 *
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001741 * See the Unified Extensible Firmware Interface (UEFI) specification
1742 * for details.
1743 *
Mario Six8fac2912018-07-10 08:40:17 +02001744 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001745 */
AKASHI Takahirob0ad9052019-03-05 14:53:31 +09001746efi_status_t EFIAPI efi_load_image(bool boot_policy,
1747 efi_handle_t parent_image,
1748 struct efi_device_path *file_path,
1749 void *source_buffer,
1750 efi_uintn_t source_size,
1751 efi_handle_t *image_handle)
Alexander Grafc15d9212016-03-04 01:09:59 +01001752{
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001753 struct efi_device_path *dp, *fp;
Tom Rini04c49062018-09-30 10:38:15 -04001754 struct efi_loaded_image *info = NULL;
Heinrich Schuchardt3c3a7352018-09-23 17:21:51 +02001755 struct efi_loaded_image_obj **image_obj =
1756 (struct efi_loaded_image_obj **)image_handle;
Heinrich Schuchardtd4d7ca92017-12-04 18:03:03 +01001757 efi_status_t ret;
Heinrich Schuchardt47e35a92019-03-04 17:50:05 +01001758 void *dest_buffer;
Alexander Grafc15d9212016-03-04 01:09:59 +01001759
Heinrich Schuchardt4cde1fa2018-04-03 22:29:30 +02001760 EFI_ENTRY("%d, %p, %pD, %p, %zd, %p", boot_policy, parent_image,
Alexander Grafc15d9212016-03-04 01:09:59 +01001761 file_path, source_buffer, source_size, image_handle);
Rob Clark857a1222017-09-13 18:05:35 -04001762
Heinrich Schuchardt2e0a7902019-05-05 16:55:06 +02001763 if (!image_handle || !efi_search_obj(parent_image)) {
Heinrich Schuchardtc935c2f2018-03-07 02:40:51 +01001764 ret = EFI_INVALID_PARAMETER;
1765 goto error;
1766 }
1767
1768 if (!source_buffer && !file_path) {
1769 ret = EFI_NOT_FOUND;
1770 goto error;
1771 }
Heinrich Schuchardt2e0a7902019-05-05 16:55:06 +02001772 /* The parent image handle must refer to a loaded image */
1773 if (!parent_image->type) {
1774 ret = EFI_INVALID_PARAMETER;
1775 goto error;
1776 }
Rob Clark857a1222017-09-13 18:05:35 -04001777
1778 if (!source_buffer) {
Heinrich Schuchardt47e35a92019-03-04 17:50:05 +01001779 ret = efi_load_image_from_path(file_path, &dest_buffer,
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001780 &source_size);
Heinrich Schuchardtd4d7ca92017-12-04 18:03:03 +01001781 if (ret != EFI_SUCCESS)
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001782 goto error;
Rob Clark857a1222017-09-13 18:05:35 -04001783 } else {
Heinrich Schuchardt78a23b52019-05-05 16:55:06 +02001784 if (!source_size) {
1785 ret = EFI_LOAD_ERROR;
1786 goto error;
1787 }
Heinrich Schuchardt47e35a92019-03-04 17:50:05 +01001788 dest_buffer = source_buffer;
Rob Clark857a1222017-09-13 18:05:35 -04001789 }
Heinrich Schuchardt28b39172019-04-20 19:24:43 +00001790 /* split file_path which contains both the device and file parts */
1791 efi_dp_split_file_path(file_path, &dp, &fp);
Heinrich Schuchardte3d3a0c2018-12-24 09:19:07 +01001792 ret = efi_setup_loaded_image(dp, fp, image_obj, &info);
Heinrich Schuchardt47e35a92019-03-04 17:50:05 +01001793 if (ret == EFI_SUCCESS)
1794 ret = efi_load_pe(*image_obj, dest_buffer, info);
1795 if (!source_buffer)
1796 /* Release buffer to which file was loaded */
1797 efi_free_pages((uintptr_t)dest_buffer,
1798 efi_size_in_pages(source_size));
1799 if (ret == EFI_SUCCESS) {
1800 info->system_table = &systab;
1801 info->parent_handle = parent_image;
1802 } else {
1803 /* The image is invalid. Release all associated resources. */
1804 efi_delete_handle(*image_handle);
1805 *image_handle = NULL;
1806 free(info);
1807 }
Heinrich Schuchardtc935c2f2018-03-07 02:40:51 +01001808error:
Heinrich Schuchardtd4d7ca92017-12-04 18:03:03 +01001809 return EFI_EXIT(ret);
Alexander Grafc15d9212016-03-04 01:09:59 +01001810}
1811
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001812/**
Alexander Graffa5246b2018-11-15 21:23:47 +01001813 * efi_exit_caches() - fix up caches for EFI payloads if necessary
1814 */
1815static void efi_exit_caches(void)
1816{
1817#if defined(CONFIG_ARM) && !defined(CONFIG_ARM64)
1818 /*
1819 * Grub on 32bit ARM needs to have caches disabled before jumping into
1820 * a zImage, but does not know of all cache layers. Give it a hand.
1821 */
1822 if (efi_is_direct_boot)
1823 cleanup_before_linux();
1824#endif
1825}
1826
1827/**
Mario Six8fac2912018-07-10 08:40:17 +02001828 * efi_exit_boot_services() - stop all boot services
1829 * @image_handle: handle of the loaded image
1830 * @map_key: key of the memory map
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001831 *
1832 * This function implements the ExitBootServices service.
Mario Six8fac2912018-07-10 08:40:17 +02001833 *
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001834 * See the Unified Extensible Firmware Interface (UEFI) specification
1835 * for details.
1836 *
Mario Six8fac2912018-07-10 08:40:17 +02001837 * All timer events are disabled. For exit boot services events the
1838 * notification function is called. The boot services are disabled in the
1839 * system table.
Heinrich Schuchardtb1fbb212018-01-19 20:24:52 +01001840 *
Mario Six8fac2912018-07-10 08:40:17 +02001841 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001842 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01001843static efi_status_t EFIAPI efi_exit_boot_services(efi_handle_t image_handle,
Heinrich Schuchardt8bd4f412019-05-05 21:58:35 +02001844 efi_uintn_t map_key)
Alexander Grafc15d9212016-03-04 01:09:59 +01001845{
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +01001846 struct efi_event *evt;
Heinrich Schuchardt2d4c7382017-09-15 10:06:18 +02001847
Heinrich Schuchardt8bd4f412019-05-05 21:58:35 +02001848 EFI_ENTRY("%p, %zx", image_handle, map_key);
Alexander Grafc15d9212016-03-04 01:09:59 +01001849
Heinrich Schuchardt0f233c42018-07-02 12:53:55 +02001850 /* Check that the caller has read the current memory map */
1851 if (map_key != efi_memory_map_key)
1852 return EFI_INVALID_PARAMETER;
1853
Heinrich Schuchardtb1fbb212018-01-19 20:24:52 +01001854 /* Make sure that notification functions are not called anymore */
1855 efi_tpl = TPL_HIGH_LEVEL;
1856
1857 /* Check if ExitBootServices has already been called */
1858 if (!systab.boottime)
1859 return EFI_EXIT(EFI_SUCCESS);
1860
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +01001861 /* Add related events to the event group */
1862 list_for_each_entry(evt, &efi_events, link) {
1863 if (evt->type == EVT_SIGNAL_EXIT_BOOT_SERVICES)
1864 evt->group = &efi_guid_event_group_exit_boot_services;
1865 }
Heinrich Schuchardt2d4c7382017-09-15 10:06:18 +02001866 /* Notify that ExitBootServices is invoked. */
Heinrich Schuchardt370c7a82018-02-18 15:17:50 +01001867 list_for_each_entry(evt, &efi_events, link) {
Heinrich Schuchardtbf7f1692018-02-18 15:17:52 +01001868 if (evt->group &&
1869 !guidcmp(evt->group,
1870 &efi_guid_event_group_exit_boot_services)) {
1871 efi_signal_event(evt, false);
1872 break;
1873 }
Heinrich Schuchardt2d4c7382017-09-15 10:06:18 +02001874 }
Heinrich Schuchardt2d4c7382017-09-15 10:06:18 +02001875
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02001876 /* TODO: Should persist EFI variables here */
Rob Clark15f3d742017-09-13 18:05:37 -04001877
Alexander Graf2ebeb442016-11-17 01:02:57 +01001878 board_quiesce_devices();
1879
Alexander Graffa5246b2018-11-15 21:23:47 +01001880 /* Fix up caches for EFI payloads if necessary */
1881 efi_exit_caches();
1882
Alexander Grafc15d9212016-03-04 01:09:59 +01001883 /* This stops all lingering devices */
1884 bootm_disable_interrupts();
1885
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02001886 /* Disable boot time services */
Heinrich Schuchardtb1fbb212018-01-19 20:24:52 +01001887 systab.con_in_handle = NULL;
1888 systab.con_in = NULL;
1889 systab.con_out_handle = NULL;
1890 systab.con_out = NULL;
1891 systab.stderr_handle = NULL;
1892 systab.std_err = NULL;
1893 systab.boottime = NULL;
1894
1895 /* Recalculate CRC32 */
Heinrich Schuchardt15070db2018-06-28 12:45:31 +02001896 efi_update_table_header_crc32(&systab.hdr);
Heinrich Schuchardtb1fbb212018-01-19 20:24:52 +01001897
Alexander Grafc15d9212016-03-04 01:09:59 +01001898 /* Give the payload some time to boot */
Heinrich Schuchardt18081d42017-10-18 18:13:04 +02001899 efi_set_watchdog(0);
Alexander Grafc15d9212016-03-04 01:09:59 +01001900 WATCHDOG_RESET();
1901
1902 return EFI_EXIT(EFI_SUCCESS);
1903}
1904
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001905/**
Mario Six8fac2912018-07-10 08:40:17 +02001906 * efi_get_next_monotonic_count() - get next value of the counter
1907 * @count: returned value of the counter
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001908 *
1909 * This function implements the NextMonotonicCount service.
Mario Six8fac2912018-07-10 08:40:17 +02001910 *
1911 * See the Unified Extensible Firmware Interface (UEFI) specification for
1912 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001913 *
Mario Six8fac2912018-07-10 08:40:17 +02001914 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001915 */
Alexander Grafc15d9212016-03-04 01:09:59 +01001916static efi_status_t EFIAPI efi_get_next_monotonic_count(uint64_t *count)
1917{
Heinrich Schuchardt91064592018-02-18 15:17:49 +01001918 static uint64_t mono;
Heinrich Schuchardtddc787d2019-05-17 12:47:17 +02001919 efi_status_t ret;
Heinrich Schuchardt91064592018-02-18 15:17:49 +01001920
Alexander Grafc15d9212016-03-04 01:09:59 +01001921 EFI_ENTRY("%p", count);
Heinrich Schuchardtddc787d2019-05-17 12:47:17 +02001922 if (!count) {
1923 ret = EFI_INVALID_PARAMETER;
1924 goto out;
1925 }
Alexander Grafc15d9212016-03-04 01:09:59 +01001926 *count = mono++;
Heinrich Schuchardtddc787d2019-05-17 12:47:17 +02001927 ret = EFI_SUCCESS;
1928out:
1929 return EFI_EXIT(ret);
Alexander Grafc15d9212016-03-04 01:09:59 +01001930}
1931
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001932/**
Mario Six8fac2912018-07-10 08:40:17 +02001933 * efi_stall() - sleep
1934 * @microseconds: period to sleep in microseconds
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001935 *
Mario Six8fac2912018-07-10 08:40:17 +02001936 * This function implements the Stall service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001937 *
Mario Six8fac2912018-07-10 08:40:17 +02001938 * See the Unified Extensible Firmware Interface (UEFI) specification for
1939 * details.
1940 *
1941 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001942 */
Alexander Grafc15d9212016-03-04 01:09:59 +01001943static efi_status_t EFIAPI efi_stall(unsigned long microseconds)
1944{
1945 EFI_ENTRY("%ld", microseconds);
1946 udelay(microseconds);
1947 return EFI_EXIT(EFI_SUCCESS);
1948}
1949
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001950/**
Mario Six8fac2912018-07-10 08:40:17 +02001951 * efi_set_watchdog_timer() - reset the watchdog timer
1952 * @timeout: seconds before reset by watchdog
1953 * @watchdog_code: code to be logged when resetting
1954 * @data_size: size of buffer in bytes
1955 * @watchdog_data: buffer with data describing the reset reason
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001956 *
Heinrich Schuchardt18081d42017-10-18 18:13:04 +02001957 * This function implements the SetWatchdogTimer service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001958 *
Mario Six8fac2912018-07-10 08:40:17 +02001959 * See the Unified Extensible Firmware Interface (UEFI) specification for
1960 * details.
1961 *
1962 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001963 */
Alexander Grafc15d9212016-03-04 01:09:59 +01001964static efi_status_t EFIAPI efi_set_watchdog_timer(unsigned long timeout,
1965 uint64_t watchdog_code,
1966 unsigned long data_size,
1967 uint16_t *watchdog_data)
1968{
Masahiro Yamadac7570a32018-08-06 20:47:40 +09001969 EFI_ENTRY("%ld, 0x%llx, %ld, %p", timeout, watchdog_code,
Alexander Grafc15d9212016-03-04 01:09:59 +01001970 data_size, watchdog_data);
Heinrich Schuchardt18081d42017-10-18 18:13:04 +02001971 return EFI_EXIT(efi_set_watchdog(timeout));
Alexander Grafc15d9212016-03-04 01:09:59 +01001972}
1973
Heinrich Schuchardt59999172018-05-11 18:15:41 +02001974/**
Mario Six8fac2912018-07-10 08:40:17 +02001975 * efi_close_protocol() - close a protocol
1976 * @handle: handle on which the protocol shall be closed
1977 * @protocol: GUID of the protocol to close
1978 * @agent_handle: handle of the driver
1979 * @controller_handle: handle of the controller
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001980 *
1981 * This function implements the CloseProtocol service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001982 *
Mario Six8fac2912018-07-10 08:40:17 +02001983 * See the Unified Extensible Firmware Interface (UEFI) specification for
1984 * details.
1985 *
1986 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02001987 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01001988static efi_status_t EFIAPI efi_close_protocol(efi_handle_t handle,
Heinrich Schuchardte547c662017-10-05 16:35:53 +02001989 const efi_guid_t *protocol,
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01001990 efi_handle_t agent_handle,
1991 efi_handle_t controller_handle)
Alexander Grafc15d9212016-03-04 01:09:59 +01001992{
Heinrich Schuchardt4fd1ee22018-01-11 08:15:59 +01001993 struct efi_handler *handler;
1994 struct efi_open_protocol_info_item *item;
1995 struct efi_open_protocol_info_item *pos;
1996 efi_status_t r;
1997
Rob Clark238f88c2017-09-13 18:05:41 -04001998 EFI_ENTRY("%p, %pUl, %p, %p", handle, protocol, agent_handle,
Alexander Grafc15d9212016-03-04 01:09:59 +01001999 controller_handle);
Heinrich Schuchardt4fd1ee22018-01-11 08:15:59 +01002000
Heinrich Schuchardt5d8231b2019-05-05 10:37:51 +02002001 if (!efi_search_obj(agent_handle) ||
2002 (controller_handle && !efi_search_obj(controller_handle))) {
Heinrich Schuchardt4fd1ee22018-01-11 08:15:59 +01002003 r = EFI_INVALID_PARAMETER;
2004 goto out;
2005 }
2006 r = efi_search_protocol(handle, protocol, &handler);
2007 if (r != EFI_SUCCESS)
2008 goto out;
2009
2010 r = EFI_NOT_FOUND;
2011 list_for_each_entry_safe(item, pos, &handler->open_infos, link) {
2012 if (item->info.agent_handle == agent_handle &&
2013 item->info.controller_handle == controller_handle) {
2014 efi_delete_open_info(item);
2015 r = EFI_SUCCESS;
2016 break;
2017 }
2018 }
2019out:
2020 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +01002021}
2022
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002023/**
Mario Six8fac2912018-07-10 08:40:17 +02002024 * efi_open_protocol_information() - provide information about then open status
2025 * of a protocol on a handle
2026 * @handle: handle for which the information shall be retrieved
2027 * @protocol: GUID of the protocol
2028 * @entry_buffer: buffer to receive the open protocol information
2029 * @entry_count: number of entries available in the buffer
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002030 *
2031 * This function implements the OpenProtocolInformation service.
Mario Six8fac2912018-07-10 08:40:17 +02002032 *
2033 * See the Unified Extensible Firmware Interface (UEFI) specification for
2034 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002035 *
Mario Six8fac2912018-07-10 08:40:17 +02002036 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002037 */
Heinrich Schuchardt91064592018-02-18 15:17:49 +01002038static efi_status_t EFIAPI efi_open_protocol_information(
2039 efi_handle_t handle, const efi_guid_t *protocol,
Alexander Grafc15d9212016-03-04 01:09:59 +01002040 struct efi_open_protocol_info_entry **entry_buffer,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01002041 efi_uintn_t *entry_count)
Alexander Grafc15d9212016-03-04 01:09:59 +01002042{
Heinrich Schuchardtf2ef22e2018-01-11 08:16:00 +01002043 unsigned long buffer_size;
2044 unsigned long count;
2045 struct efi_handler *handler;
2046 struct efi_open_protocol_info_item *item;
2047 efi_status_t r;
2048
Rob Clark238f88c2017-09-13 18:05:41 -04002049 EFI_ENTRY("%p, %pUl, %p, %p", handle, protocol, entry_buffer,
Alexander Grafc15d9212016-03-04 01:09:59 +01002050 entry_count);
Heinrich Schuchardtf2ef22e2018-01-11 08:16:00 +01002051
2052 /* Check parameters */
2053 if (!entry_buffer) {
2054 r = EFI_INVALID_PARAMETER;
2055 goto out;
2056 }
2057 r = efi_search_protocol(handle, protocol, &handler);
2058 if (r != EFI_SUCCESS)
2059 goto out;
2060
2061 /* Count entries */
2062 count = 0;
2063 list_for_each_entry(item, &handler->open_infos, link) {
2064 if (item->info.open_count)
2065 ++count;
2066 }
2067 *entry_count = count;
2068 *entry_buffer = NULL;
2069 if (!count) {
2070 r = EFI_SUCCESS;
2071 goto out;
2072 }
2073
2074 /* Copy entries */
2075 buffer_size = count * sizeof(struct efi_open_protocol_info_entry);
Heinrich Schuchardtabb43872018-10-03 20:02:29 +02002076 r = efi_allocate_pool(EFI_BOOT_SERVICES_DATA, buffer_size,
Heinrich Schuchardtf2ef22e2018-01-11 08:16:00 +01002077 (void **)entry_buffer);
2078 if (r != EFI_SUCCESS)
2079 goto out;
2080 list_for_each_entry_reverse(item, &handler->open_infos, link) {
2081 if (item->info.open_count)
2082 (*entry_buffer)[--count] = item->info;
2083 }
2084out:
2085 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +01002086}
2087
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002088/**
Mario Six8fac2912018-07-10 08:40:17 +02002089 * efi_protocols_per_handle() - get protocols installed on a handle
2090 * @handle: handle for which the information is retrieved
2091 * @protocol_buffer: buffer with protocol GUIDs
2092 * @protocol_buffer_count: number of entries in the buffer
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002093 *
2094 * This function implements the ProtocolsPerHandleService.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002095 *
Mario Six8fac2912018-07-10 08:40:17 +02002096 * See the Unified Extensible Firmware Interface (UEFI) specification for
2097 * details.
2098 *
2099 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002100 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01002101static efi_status_t EFIAPI efi_protocols_per_handle(
2102 efi_handle_t handle, efi_guid_t ***protocol_buffer,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01002103 efi_uintn_t *protocol_buffer_count)
Alexander Grafc15d9212016-03-04 01:09:59 +01002104{
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002105 unsigned long buffer_size;
2106 struct efi_object *efiobj;
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01002107 struct list_head *protocol_handle;
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002108 efi_status_t r;
2109
Alexander Grafc15d9212016-03-04 01:09:59 +01002110 EFI_ENTRY("%p, %p, %p", handle, protocol_buffer,
2111 protocol_buffer_count);
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002112
2113 if (!handle || !protocol_buffer || !protocol_buffer_count)
2114 return EFI_EXIT(EFI_INVALID_PARAMETER);
2115
2116 *protocol_buffer = NULL;
Rob Clarkd51b8ca2017-07-20 07:59:39 -04002117 *protocol_buffer_count = 0;
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002118
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01002119 efiobj = efi_search_obj(handle);
2120 if (!efiobj)
2121 return EFI_EXIT(EFI_INVALID_PARAMETER);
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002122
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01002123 /* Count protocols */
2124 list_for_each(protocol_handle, &efiobj->protocols) {
2125 ++*protocol_buffer_count;
2126 }
2127
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02002128 /* Copy GUIDs */
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01002129 if (*protocol_buffer_count) {
2130 size_t j = 0;
2131
2132 buffer_size = sizeof(efi_guid_t *) * *protocol_buffer_count;
Heinrich Schuchardtabb43872018-10-03 20:02:29 +02002133 r = efi_allocate_pool(EFI_BOOT_SERVICES_DATA, buffer_size,
Heinrich Schuchardt99ce2062017-11-26 14:05:17 +01002134 (void **)protocol_buffer);
2135 if (r != EFI_SUCCESS)
2136 return EFI_EXIT(r);
2137 list_for_each(protocol_handle, &efiobj->protocols) {
2138 struct efi_handler *protocol;
2139
2140 protocol = list_entry(protocol_handle,
2141 struct efi_handler, link);
2142 (*protocol_buffer)[j] = (void *)protocol->guid;
2143 ++j;
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002144 }
xypron.glpk@gmx.de8960c972017-07-13 23:24:32 +02002145 }
2146
2147 return EFI_EXIT(EFI_SUCCESS);
Alexander Grafc15d9212016-03-04 01:09:59 +01002148}
2149
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002150/**
Mario Six8fac2912018-07-10 08:40:17 +02002151 * efi_locate_handle_buffer() - locate handles implementing a protocol
2152 * @search_type: selection criterion
2153 * @protocol: GUID of the protocol
2154 * @search_key: registration key
2155 * @no_handles: number of returned handles
2156 * @buffer: buffer with the returned handles
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002157 *
2158 * This function implements the LocateHandleBuffer service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002159 *
Mario Six8fac2912018-07-10 08:40:17 +02002160 * See the Unified Extensible Firmware Interface (UEFI) specification for
2161 * details.
2162 *
2163 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002164 */
Alexander Grafc15d9212016-03-04 01:09:59 +01002165static efi_status_t EFIAPI efi_locate_handle_buffer(
2166 enum efi_locate_search_type search_type,
Heinrich Schuchardte547c662017-10-05 16:35:53 +02002167 const efi_guid_t *protocol, void *search_key,
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01002168 efi_uintn_t *no_handles, efi_handle_t **buffer)
Alexander Grafc15d9212016-03-04 01:09:59 +01002169{
xypron.glpk@gmx.de550a68a2017-07-11 22:06:22 +02002170 efi_status_t r;
Heinrich Schuchardt798a4412017-11-06 21:17:48 +01002171 efi_uintn_t buffer_size = 0;
xypron.glpk@gmx.de550a68a2017-07-11 22:06:22 +02002172
Rob Clark238f88c2017-09-13 18:05:41 -04002173 EFI_ENTRY("%d, %pUl, %p, %p, %p", search_type, protocol, search_key,
Alexander Grafc15d9212016-03-04 01:09:59 +01002174 no_handles, buffer);
xypron.glpk@gmx.de550a68a2017-07-11 22:06:22 +02002175
2176 if (!no_handles || !buffer) {
2177 r = EFI_INVALID_PARAMETER;
2178 goto out;
2179 }
2180 *no_handles = 0;
2181 *buffer = NULL;
2182 r = efi_locate_handle(search_type, protocol, search_key, &buffer_size,
2183 *buffer);
2184 if (r != EFI_BUFFER_TOO_SMALL)
2185 goto out;
Heinrich Schuchardtabb43872018-10-03 20:02:29 +02002186 r = efi_allocate_pool(EFI_BOOT_SERVICES_DATA, buffer_size,
xypron.glpk@gmx.de550a68a2017-07-11 22:06:22 +02002187 (void **)buffer);
2188 if (r != EFI_SUCCESS)
2189 goto out;
2190 r = efi_locate_handle(search_type, protocol, search_key, &buffer_size,
2191 *buffer);
2192 if (r == EFI_SUCCESS)
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01002193 *no_handles = buffer_size / sizeof(efi_handle_t);
xypron.glpk@gmx.de550a68a2017-07-11 22:06:22 +02002194out:
2195 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +01002196}
2197
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002198/**
Mario Six8fac2912018-07-10 08:40:17 +02002199 * efi_locate_protocol() - find an interface implementing a protocol
2200 * @protocol: GUID of the protocol
2201 * @registration: registration key passed to the notification function
2202 * @protocol_interface: interface implementing the protocol
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002203 *
2204 * This function implements the LocateProtocol service.
Mario Six8fac2912018-07-10 08:40:17 +02002205 *
2206 * See the Unified Extensible Firmware Interface (UEFI) specification for
2207 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002208 *
Mario Six8fac2912018-07-10 08:40:17 +02002209 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002210 */
Heinrich Schuchardte547c662017-10-05 16:35:53 +02002211static efi_status_t EFIAPI efi_locate_protocol(const efi_guid_t *protocol,
Alexander Grafc15d9212016-03-04 01:09:59 +01002212 void *registration,
2213 void **protocol_interface)
2214{
xypron.glpk@gmx.de4534ad62017-07-11 22:06:24 +02002215 struct list_head *lhandle;
Heinrich Schuchardt57505e92017-10-26 19:25:57 +02002216 efi_status_t ret;
Alexander Grafc15d9212016-03-04 01:09:59 +01002217
Rob Clark238f88c2017-09-13 18:05:41 -04002218 EFI_ENTRY("%pUl, %p, %p", protocol, registration, protocol_interface);
xypron.glpk@gmx.de4534ad62017-07-11 22:06:24 +02002219
2220 if (!protocol || !protocol_interface)
2221 return EFI_EXIT(EFI_INVALID_PARAMETER);
2222
2223 list_for_each(lhandle, &efi_obj_list) {
2224 struct efi_object *efiobj;
Heinrich Schuchardt57505e92017-10-26 19:25:57 +02002225 struct efi_handler *handler;
xypron.glpk@gmx.de4534ad62017-07-11 22:06:24 +02002226
2227 efiobj = list_entry(lhandle, struct efi_object, link);
xypron.glpk@gmx.de4534ad62017-07-11 22:06:24 +02002228
Heinrich Schuchardtadb50d02018-09-26 05:27:55 +02002229 ret = efi_search_protocol(efiobj, protocol, &handler);
Heinrich Schuchardt57505e92017-10-26 19:25:57 +02002230 if (ret == EFI_SUCCESS) {
2231 *protocol_interface = handler->protocol_interface;
2232 return EFI_EXIT(EFI_SUCCESS);
Alexander Grafc15d9212016-03-04 01:09:59 +01002233 }
2234 }
xypron.glpk@gmx.de4534ad62017-07-11 22:06:24 +02002235 *protocol_interface = NULL;
Alexander Grafc15d9212016-03-04 01:09:59 +01002236
2237 return EFI_EXIT(EFI_NOT_FOUND);
2238}
2239
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002240/**
Mario Six8fac2912018-07-10 08:40:17 +02002241 * efi_locate_device_path() - Get the device path and handle of an device
2242 * implementing a protocol
2243 * @protocol: GUID of the protocol
2244 * @device_path: device path
2245 * @device: handle of the device
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002246 *
2247 * This function implements the LocateDevicePath service.
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002248 *
Mario Six8fac2912018-07-10 08:40:17 +02002249 * See the Unified Extensible Firmware Interface (UEFI) specification for
2250 * details.
2251 *
2252 * Return: status code
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002253 */
2254static efi_status_t EFIAPI efi_locate_device_path(
2255 const efi_guid_t *protocol,
2256 struct efi_device_path **device_path,
2257 efi_handle_t *device)
2258{
2259 struct efi_device_path *dp;
2260 size_t i;
2261 struct efi_handler *handler;
2262 efi_handle_t *handles;
2263 size_t len, len_dp;
2264 size_t len_best = 0;
2265 efi_uintn_t no_handles;
2266 u8 *remainder;
2267 efi_status_t ret;
2268
2269 EFI_ENTRY("%pUl, %p, %p", protocol, device_path, device);
2270
Heinrich Schuchardt6db1e5c2019-05-10 19:21:41 +02002271 if (!protocol || !device_path || !*device_path) {
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002272 ret = EFI_INVALID_PARAMETER;
2273 goto out;
2274 }
2275
2276 /* Find end of device path */
Heinrich Schuchardt51ca4f52018-04-16 07:59:08 +02002277 len = efi_dp_instance_size(*device_path);
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002278
2279 /* Get all handles implementing the protocol */
2280 ret = EFI_CALL(efi_locate_handle_buffer(BY_PROTOCOL, protocol, NULL,
2281 &no_handles, &handles));
2282 if (ret != EFI_SUCCESS)
2283 goto out;
2284
2285 for (i = 0; i < no_handles; ++i) {
2286 /* Find the device path protocol */
2287 ret = efi_search_protocol(handles[i], &efi_guid_device_path,
2288 &handler);
2289 if (ret != EFI_SUCCESS)
2290 continue;
2291 dp = (struct efi_device_path *)handler->protocol_interface;
Heinrich Schuchardt51ca4f52018-04-16 07:59:08 +02002292 len_dp = efi_dp_instance_size(dp);
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002293 /*
2294 * This handle can only be a better fit
2295 * if its device path length is longer than the best fit and
2296 * if its device path length is shorter of equal the searched
2297 * device path.
2298 */
2299 if (len_dp <= len_best || len_dp > len)
2300 continue;
2301 /* Check if dp is a subpath of device_path */
2302 if (memcmp(*device_path, dp, len_dp))
2303 continue;
Heinrich Schuchardt6db1e5c2019-05-10 19:21:41 +02002304 if (!device) {
2305 ret = EFI_INVALID_PARAMETER;
2306 goto out;
2307 }
Heinrich Schuchardt06ec6892017-11-26 14:05:10 +01002308 *device = handles[i];
2309 len_best = len_dp;
2310 }
2311 if (len_best) {
2312 remainder = (u8 *)*device_path + len_best;
2313 *device_path = (struct efi_device_path *)remainder;
2314 ret = EFI_SUCCESS;
2315 } else {
2316 ret = EFI_NOT_FOUND;
2317 }
2318out:
2319 return EFI_EXIT(ret);
2320}
2321
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002322/**
Mario Six8fac2912018-07-10 08:40:17 +02002323 * efi_install_multiple_protocol_interfaces() - Install multiple protocol
2324 * interfaces
2325 * @handle: handle on which the protocol interfaces shall be installed
2326 * @...: NULL terminated argument list with pairs of protocol GUIDS and
2327 * interfaces
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002328 *
2329 * This function implements the MultipleProtocolInterfaces service.
Mario Six8fac2912018-07-10 08:40:17 +02002330 *
2331 * See the Unified Extensible Firmware Interface (UEFI) specification for
2332 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002333 *
Mario Six8fac2912018-07-10 08:40:17 +02002334 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002335 */
Heinrich Schuchardt744d83e2019-04-12 06:59:49 +02002336efi_status_t EFIAPI efi_install_multiple_protocol_interfaces
Heinrich Schuchardt4f94ec52018-09-26 05:27:54 +02002337 (efi_handle_t *handle, ...)
Alexander Grafc15d9212016-03-04 01:09:59 +01002338{
2339 EFI_ENTRY("%p", handle);
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002340
Alexander Graf404a7c82018-06-18 17:23:05 +02002341 efi_va_list argptr;
Heinrich Schuchardte547c662017-10-05 16:35:53 +02002342 const efi_guid_t *protocol;
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002343 void *protocol_interface;
Heinrich Schuchardt61ba10d2019-05-16 21:54:04 +02002344 efi_handle_t old_handle;
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002345 efi_status_t r = EFI_SUCCESS;
2346 int i = 0;
2347
2348 if (!handle)
2349 return EFI_EXIT(EFI_INVALID_PARAMETER);
2350
Alexander Graf404a7c82018-06-18 17:23:05 +02002351 efi_va_start(argptr, handle);
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002352 for (;;) {
Alexander Graf404a7c82018-06-18 17:23:05 +02002353 protocol = efi_va_arg(argptr, efi_guid_t*);
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002354 if (!protocol)
2355 break;
Alexander Graf404a7c82018-06-18 17:23:05 +02002356 protocol_interface = efi_va_arg(argptr, void*);
Heinrich Schuchardt61ba10d2019-05-16 21:54:04 +02002357 /* Check that a device path has not been installed before */
2358 if (!guidcmp(protocol, &efi_guid_device_path)) {
2359 struct efi_device_path *dp = protocol_interface;
2360
2361 r = EFI_CALL(efi_locate_device_path(protocol, &dp,
2362 &old_handle));
2363 if (r == EFI_SUCCESS) {
2364 r = EFI_ALREADY_STARTED;
2365 break;
2366 }
2367 }
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01002368 r = EFI_CALL(efi_install_protocol_interface(
2369 handle, protocol,
2370 EFI_NATIVE_INTERFACE,
2371 protocol_interface));
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002372 if (r != EFI_SUCCESS)
2373 break;
2374 i++;
2375 }
Alexander Graf404a7c82018-06-18 17:23:05 +02002376 efi_va_end(argptr);
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002377 if (r == EFI_SUCCESS)
2378 return EFI_EXIT(r);
2379
Heinrich Schuchardtec47f3e2017-10-26 19:25:42 +02002380 /* If an error occurred undo all changes. */
Alexander Graf404a7c82018-06-18 17:23:05 +02002381 efi_va_start(argptr, handle);
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002382 for (; i; --i) {
Alexander Graf404a7c82018-06-18 17:23:05 +02002383 protocol = efi_va_arg(argptr, efi_guid_t*);
2384 protocol_interface = efi_va_arg(argptr, void*);
Heinrich Schuchardt4f94ec52018-09-26 05:27:54 +02002385 EFI_CALL(efi_uninstall_protocol_interface(*handle, protocol,
Heinrich Schuchardt7cdc17f2017-11-06 21:17:45 +01002386 protocol_interface));
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002387 }
Alexander Graf404a7c82018-06-18 17:23:05 +02002388 efi_va_end(argptr);
xypron.glpk@gmx.de83eebc72017-07-11 22:06:20 +02002389
2390 return EFI_EXIT(r);
Alexander Grafc15d9212016-03-04 01:09:59 +01002391}
2392
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002393/**
Mario Six8fac2912018-07-10 08:40:17 +02002394 * efi_uninstall_multiple_protocol_interfaces() - uninstall multiple protocol
2395 * interfaces
2396 * @handle: handle from which the protocol interfaces shall be removed
2397 * @...: NULL terminated argument list with pairs of protocol GUIDS and
2398 * interfaces
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002399 *
2400 * This function implements the UninstallMultipleProtocolInterfaces service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002401 *
Mario Six8fac2912018-07-10 08:40:17 +02002402 * See the Unified Extensible Firmware Interface (UEFI) specification for
2403 * details.
2404 *
2405 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002406 */
Alexander Grafc15d9212016-03-04 01:09:59 +01002407static efi_status_t EFIAPI efi_uninstall_multiple_protocol_interfaces(
Heinrich Schuchardt4f94ec52018-09-26 05:27:54 +02002408 efi_handle_t handle, ...)
Alexander Grafc15d9212016-03-04 01:09:59 +01002409{
2410 EFI_ENTRY("%p", handle);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002411
Alexander Graf404a7c82018-06-18 17:23:05 +02002412 efi_va_list argptr;
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002413 const efi_guid_t *protocol;
2414 void *protocol_interface;
2415 efi_status_t r = EFI_SUCCESS;
2416 size_t i = 0;
2417
2418 if (!handle)
2419 return EFI_EXIT(EFI_INVALID_PARAMETER);
2420
Alexander Graf404a7c82018-06-18 17:23:05 +02002421 efi_va_start(argptr, handle);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002422 for (;;) {
Alexander Graf404a7c82018-06-18 17:23:05 +02002423 protocol = efi_va_arg(argptr, efi_guid_t*);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002424 if (!protocol)
2425 break;
Alexander Graf404a7c82018-06-18 17:23:05 +02002426 protocol_interface = efi_va_arg(argptr, void*);
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02002427 r = efi_uninstall_protocol(handle, protocol,
2428 protocol_interface);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002429 if (r != EFI_SUCCESS)
2430 break;
2431 i++;
2432 }
Alexander Graf404a7c82018-06-18 17:23:05 +02002433 efi_va_end(argptr);
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02002434 if (r == EFI_SUCCESS) {
2435 /* If the last protocol has been removed, delete the handle. */
2436 if (list_empty(&handle->protocols)) {
2437 list_del(&handle->link);
2438 free(handle);
2439 }
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002440 return EFI_EXIT(r);
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02002441 }
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002442
2443 /* If an error occurred undo all changes. */
Alexander Graf404a7c82018-06-18 17:23:05 +02002444 efi_va_start(argptr, handle);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002445 for (; i; --i) {
Alexander Graf404a7c82018-06-18 17:23:05 +02002446 protocol = efi_va_arg(argptr, efi_guid_t*);
2447 protocol_interface = efi_va_arg(argptr, void*);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002448 EFI_CALL(efi_install_protocol_interface(&handle, protocol,
2449 EFI_NATIVE_INTERFACE,
2450 protocol_interface));
2451 }
Alexander Graf404a7c82018-06-18 17:23:05 +02002452 efi_va_end(argptr);
Heinrich Schuchardta616dcf2017-10-26 19:25:44 +02002453
Heinrich Schuchardt1c76eda2018-09-24 19:57:27 +02002454 /* In case of an error always return EFI_INVALID_PARAMETER */
2455 return EFI_EXIT(EFI_INVALID_PARAMETER);
Alexander Grafc15d9212016-03-04 01:09:59 +01002456}
2457
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002458/**
Mario Six8fac2912018-07-10 08:40:17 +02002459 * efi_calculate_crc32() - calculate cyclic redundancy code
2460 * @data: buffer with data
2461 * @data_size: size of buffer in bytes
2462 * @crc32_p: cyclic redundancy code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002463 *
2464 * This function implements the CalculateCrc32 service.
Mario Six8fac2912018-07-10 08:40:17 +02002465 *
2466 * See the Unified Extensible Firmware Interface (UEFI) specification for
2467 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002468 *
Mario Six8fac2912018-07-10 08:40:17 +02002469 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002470 */
Heinrich Schuchardtf2725582018-07-07 15:36:04 +02002471static efi_status_t EFIAPI efi_calculate_crc32(const void *data,
2472 efi_uintn_t data_size,
2473 u32 *crc32_p)
Alexander Grafc15d9212016-03-04 01:09:59 +01002474{
Heinrich Schuchardt3f0282c2019-05-16 23:31:29 +02002475 efi_status_t ret = EFI_SUCCESS;
2476
Heinrich Schuchardtf2725582018-07-07 15:36:04 +02002477 EFI_ENTRY("%p, %zu", data, data_size);
Heinrich Schuchardt3f0282c2019-05-16 23:31:29 +02002478 if (!data || !data_size || !crc32_p) {
2479 ret = EFI_INVALID_PARAMETER;
2480 goto out;
2481 }
Alexander Grafc15d9212016-03-04 01:09:59 +01002482 *crc32_p = crc32(0, data, data_size);
Heinrich Schuchardt3f0282c2019-05-16 23:31:29 +02002483out:
2484 return EFI_EXIT(ret);
Alexander Grafc15d9212016-03-04 01:09:59 +01002485}
2486
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002487/**
Mario Six8fac2912018-07-10 08:40:17 +02002488 * efi_copy_mem() - copy memory
2489 * @destination: destination of the copy operation
2490 * @source: source of the copy operation
2491 * @length: number of bytes to copy
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002492 *
2493 * This function implements the CopyMem service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002494 *
Mario Six8fac2912018-07-10 08:40:17 +02002495 * See the Unified Extensible Firmware Interface (UEFI) specification for
2496 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002497 */
Heinrich Schuchardtd0a349e2017-10-05 16:35:52 +02002498static void EFIAPI efi_copy_mem(void *destination, const void *source,
2499 size_t length)
Alexander Grafc15d9212016-03-04 01:09:59 +01002500{
Heinrich Schuchardtd0a349e2017-10-05 16:35:52 +02002501 EFI_ENTRY("%p, %p, %ld", destination, source, (unsigned long)length);
Heinrich Schuchardtefba6ba2019-01-09 21:41:13 +01002502 memmove(destination, source, length);
Heinrich Schuchardta5270e02017-10-05 16:35:51 +02002503 EFI_EXIT(EFI_SUCCESS);
Alexander Grafc15d9212016-03-04 01:09:59 +01002504}
2505
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002506/**
Mario Six8fac2912018-07-10 08:40:17 +02002507 * efi_set_mem() - Fill memory with a byte value.
2508 * @buffer: buffer to fill
2509 * @size: size of buffer in bytes
2510 * @value: byte to copy to the buffer
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002511 *
2512 * This function implements the SetMem service.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002513 *
Mario Six8fac2912018-07-10 08:40:17 +02002514 * See the Unified Extensible Firmware Interface (UEFI) specification for
2515 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002516 */
Heinrich Schuchardtd0a349e2017-10-05 16:35:52 +02002517static void EFIAPI efi_set_mem(void *buffer, size_t size, uint8_t value)
Alexander Grafc15d9212016-03-04 01:09:59 +01002518{
Heinrich Schuchardtd0a349e2017-10-05 16:35:52 +02002519 EFI_ENTRY("%p, %ld, 0x%x", buffer, (unsigned long)size, value);
Alexander Grafc15d9212016-03-04 01:09:59 +01002520 memset(buffer, value, size);
Heinrich Schuchardta5270e02017-10-05 16:35:51 +02002521 EFI_EXIT(EFI_SUCCESS);
Alexander Grafc15d9212016-03-04 01:09:59 +01002522}
2523
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002524/**
Mario Six8fac2912018-07-10 08:40:17 +02002525 * efi_protocol_open() - open protocol interface on a handle
2526 * @handler: handler of a protocol
2527 * @protocol_interface: interface implementing the protocol
2528 * @agent_handle: handle of the driver
2529 * @controller_handle: handle of the controller
2530 * @attributes: attributes indicating how to open the protocol
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002531 *
Mario Six8fac2912018-07-10 08:40:17 +02002532 * Return: status code
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002533 */
2534static efi_status_t efi_protocol_open(
2535 struct efi_handler *handler,
2536 void **protocol_interface, void *agent_handle,
2537 void *controller_handle, uint32_t attributes)
2538{
2539 struct efi_open_protocol_info_item *item;
2540 struct efi_open_protocol_info_entry *match = NULL;
2541 bool opened_by_driver = false;
2542 bool opened_exclusive = false;
2543
2544 /* If there is no agent, only return the interface */
2545 if (!agent_handle)
2546 goto out;
2547
2548 /* For TEST_PROTOCOL ignore interface attribute */
2549 if (attributes != EFI_OPEN_PROTOCOL_TEST_PROTOCOL)
2550 *protocol_interface = NULL;
2551
2552 /*
2553 * Check if the protocol is already opened by a driver with the same
2554 * attributes or opened exclusively
2555 */
2556 list_for_each_entry(item, &handler->open_infos, link) {
2557 if (item->info.agent_handle == agent_handle) {
2558 if ((attributes & EFI_OPEN_PROTOCOL_BY_DRIVER) &&
2559 (item->info.attributes == attributes))
2560 return EFI_ALREADY_STARTED;
2561 }
2562 if (item->info.attributes & EFI_OPEN_PROTOCOL_EXCLUSIVE)
2563 opened_exclusive = true;
2564 }
2565
2566 /* Only one controller can open the protocol exclusively */
2567 if (opened_exclusive && attributes &
2568 (EFI_OPEN_PROTOCOL_EXCLUSIVE | EFI_OPEN_PROTOCOL_BY_DRIVER))
2569 return EFI_ACCESS_DENIED;
2570
2571 /* Prepare exclusive opening */
2572 if (attributes & EFI_OPEN_PROTOCOL_EXCLUSIVE) {
2573 /* Try to disconnect controllers */
2574 list_for_each_entry(item, &handler->open_infos, link) {
2575 if (item->info.attributes ==
2576 EFI_OPEN_PROTOCOL_BY_DRIVER)
2577 EFI_CALL(efi_disconnect_controller(
2578 item->info.controller_handle,
2579 item->info.agent_handle,
2580 NULL));
2581 }
2582 opened_by_driver = false;
2583 /* Check if all controllers are disconnected */
2584 list_for_each_entry(item, &handler->open_infos, link) {
2585 if (item->info.attributes & EFI_OPEN_PROTOCOL_BY_DRIVER)
2586 opened_by_driver = true;
2587 }
Heinrich Schuchardt8d0b45d2018-09-30 13:40:43 +02002588 /* Only one controller can be connected */
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002589 if (opened_by_driver)
2590 return EFI_ACCESS_DENIED;
2591 }
2592
2593 /* Find existing entry */
2594 list_for_each_entry(item, &handler->open_infos, link) {
2595 if (item->info.agent_handle == agent_handle &&
2596 item->info.controller_handle == controller_handle)
2597 match = &item->info;
2598 }
2599 /* None found, create one */
2600 if (!match) {
2601 match = efi_create_open_info(handler);
2602 if (!match)
2603 return EFI_OUT_OF_RESOURCES;
2604 }
2605
2606 match->agent_handle = agent_handle;
2607 match->controller_handle = controller_handle;
2608 match->attributes = attributes;
2609 match->open_count++;
2610
2611out:
2612 /* For TEST_PROTOCOL ignore interface attribute. */
2613 if (attributes != EFI_OPEN_PROTOCOL_TEST_PROTOCOL)
2614 *protocol_interface = handler->protocol_interface;
2615
2616 return EFI_SUCCESS;
2617}
2618
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002619/**
Mario Six8fac2912018-07-10 08:40:17 +02002620 * efi_open_protocol() - open protocol interface on a handle
2621 * @handle: handle on which the protocol shall be opened
2622 * @protocol: GUID of the protocol
2623 * @protocol_interface: interface implementing the protocol
2624 * @agent_handle: handle of the driver
2625 * @controller_handle: handle of the controller
2626 * @attributes: attributes indicating how to open the protocol
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002627 *
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002628 * This function implements the OpenProtocol interface.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002629 *
Mario Six8fac2912018-07-10 08:40:17 +02002630 * See the Unified Extensible Firmware Interface (UEFI) specification for
2631 * details.
2632 *
2633 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002634 */
Heinrich Schuchardt4f94ec52018-09-26 05:27:54 +02002635static efi_status_t EFIAPI efi_open_protocol
2636 (efi_handle_t handle, const efi_guid_t *protocol,
2637 void **protocol_interface, efi_handle_t agent_handle,
2638 efi_handle_t controller_handle, uint32_t attributes)
Alexander Grafc15d9212016-03-04 01:09:59 +01002639{
Heinrich Schuchardte5e78a32017-11-26 14:05:15 +01002640 struct efi_handler *handler;
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002641 efi_status_t r = EFI_INVALID_PARAMETER;
Alexander Grafc15d9212016-03-04 01:09:59 +01002642
Rob Clark238f88c2017-09-13 18:05:41 -04002643 EFI_ENTRY("%p, %pUl, %p, %p, %p, 0x%x", handle, protocol,
Alexander Grafc15d9212016-03-04 01:09:59 +01002644 protocol_interface, agent_handle, controller_handle,
2645 attributes);
xypron.glpk@gmx.dec35c9242017-07-11 22:06:14 +02002646
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002647 if (!handle || !protocol ||
2648 (!protocol_interface && attributes !=
2649 EFI_OPEN_PROTOCOL_TEST_PROTOCOL)) {
xypron.glpk@gmx.dec35c9242017-07-11 22:06:14 +02002650 goto out;
2651 }
2652
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002653 switch (attributes) {
2654 case EFI_OPEN_PROTOCOL_BY_HANDLE_PROTOCOL:
2655 case EFI_OPEN_PROTOCOL_GET_PROTOCOL:
2656 case EFI_OPEN_PROTOCOL_TEST_PROTOCOL:
2657 break;
2658 case EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER:
2659 if (controller_handle == handle)
2660 goto out;
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002661 /* fall-through */
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002662 case EFI_OPEN_PROTOCOL_BY_DRIVER:
2663 case EFI_OPEN_PROTOCOL_BY_DRIVER | EFI_OPEN_PROTOCOL_EXCLUSIVE:
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002664 /* Check that the controller handle is valid */
2665 if (!efi_search_obj(controller_handle))
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002666 goto out;
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002667 /* fall-through */
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002668 case EFI_OPEN_PROTOCOL_EXCLUSIVE:
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002669 /* Check that the agent handle is valid */
2670 if (!efi_search_obj(agent_handle))
xypron.glpk@gmx.def097c842017-07-11 22:06:15 +02002671 goto out;
2672 break;
2673 default:
2674 goto out;
2675 }
2676
Heinrich Schuchardte5e78a32017-11-26 14:05:15 +01002677 r = efi_search_protocol(handle, protocol, &handler);
Heinrich Schuchardtb673e4b2019-05-05 11:24:53 +02002678 switch (r) {
2679 case EFI_SUCCESS:
2680 break;
2681 case EFI_NOT_FOUND:
2682 r = EFI_UNSUPPORTED;
2683 goto out;
2684 default:
Heinrich Schuchardte5e78a32017-11-26 14:05:15 +01002685 goto out;
Heinrich Schuchardtb673e4b2019-05-05 11:24:53 +02002686 }
Alexander Grafc15d9212016-03-04 01:09:59 +01002687
Heinrich Schuchardt8cb38c02018-01-11 08:15:58 +01002688 r = efi_protocol_open(handler, protocol_interface, agent_handle,
2689 controller_handle, attributes);
Alexander Grafc15d9212016-03-04 01:09:59 +01002690out:
2691 return EFI_EXIT(r);
2692}
2693
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002694/**
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002695 * efi_start_image() - call the entry point of an image
2696 * @image_handle: handle of the image
2697 * @exit_data_size: size of the buffer
2698 * @exit_data: buffer to receive the exit data of the called image
2699 *
2700 * This function implements the StartImage service.
2701 *
2702 * See the Unified Extensible Firmware Interface (UEFI) specification for
2703 * details.
2704 *
2705 * Return: status code
2706 */
2707efi_status_t EFIAPI efi_start_image(efi_handle_t image_handle,
2708 efi_uintn_t *exit_data_size,
2709 u16 **exit_data)
2710{
2711 struct efi_loaded_image_obj *image_obj =
2712 (struct efi_loaded_image_obj *)image_handle;
2713 efi_status_t ret;
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002714 void *info;
2715 efi_handle_t parent_image = current_image;
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002716
2717 EFI_ENTRY("%p, %p, %p", image_handle, exit_data_size, exit_data);
2718
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002719 /* Check parameters */
2720 ret = EFI_CALL(efi_open_protocol(image_handle, &efi_guid_loaded_image,
2721 &info, NULL, NULL,
2722 EFI_OPEN_PROTOCOL_GET_PROTOCOL));
2723 if (ret != EFI_SUCCESS)
2724 return EFI_EXIT(EFI_INVALID_PARAMETER);
2725
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002726 efi_is_direct_boot = false;
2727
Heinrich Schuchardt3d445122019-04-30 17:57:30 +02002728 image_obj->exit_data_size = exit_data_size;
2729 image_obj->exit_data = exit_data;
2730
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002731 /* call the image! */
2732 if (setjmp(&image_obj->exit_jmp)) {
2733 /*
2734 * We called the entry point of the child image with EFI_CALL
2735 * in the lines below. The child image called the Exit() boot
2736 * service efi_exit() which executed the long jump that brought
2737 * us to the current line. This implies that the second half
2738 * of the EFI_CALL macro has not been executed.
2739 */
2740#ifdef CONFIG_ARM
2741 /*
2742 * efi_exit() called efi_restore_gd(). We have to undo this
2743 * otherwise __efi_entry_check() will put the wrong value into
2744 * app_gd.
2745 */
2746 gd = app_gd;
2747#endif
2748 /*
2749 * To get ready to call EFI_EXIT below we have to execute the
2750 * missed out steps of EFI_CALL.
2751 */
2752 assert(__efi_entry_check());
Heinrich Schuchardt952e2062019-05-05 11:56:23 +02002753 EFI_PRINT("%lu returned by started image\n",
2754 (unsigned long)((uintptr_t)image_obj->exit_status &
2755 ~EFI_ERROR_MASK));
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002756 current_image = parent_image;
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002757 return EFI_EXIT(image_obj->exit_status);
2758 }
2759
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002760 current_image = image_handle;
Heinrich Schuchardtb27ced42019-05-01 14:20:18 +02002761 image_obj->header.type = EFI_OBJECT_TYPE_STARTED_IMAGE;
AKASHI Takahiro14ff23b2019-04-19 12:22:35 +09002762 EFI_PRINT("Jumping into 0x%p\n", image_obj->entry);
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002763 ret = EFI_CALL(image_obj->entry(image_handle, &systab));
2764
2765 /*
2766 * Usually UEFI applications call Exit() instead of returning.
2767 * But because the world doesn't consist of ponies and unicorns,
2768 * we're happy to emulate that behavior on behalf of a payload
2769 * that forgot.
2770 */
2771 return EFI_CALL(systab.boottime->exit(image_handle, ret, 0, NULL));
2772}
2773
2774/**
Heinrich Schuchardt4ed66e52019-05-01 18:25:45 +02002775 * efi_delete_image() - delete loaded image from memory)
2776 *
2777 * @image_obj: handle of the loaded image
2778 * @loaded_image_protocol: loaded image protocol
2779 */
2780static void efi_delete_image(struct efi_loaded_image_obj *image_obj,
2781 struct efi_loaded_image *loaded_image_protocol)
2782{
2783 efi_free_pages((uintptr_t)loaded_image_protocol->image_base,
2784 efi_size_in_pages(loaded_image_protocol->image_size));
2785 efi_delete_handle(&image_obj->header);
2786}
2787
2788/**
Heinrich Schuchardt6b3581a2019-05-01 19:04:32 +02002789 * efi_unload_image() - unload an EFI image
2790 * @image_handle: handle of the image to be unloaded
2791 *
2792 * This function implements the UnloadImage service.
2793 *
2794 * See the Unified Extensible Firmware Interface (UEFI) specification for
2795 * details.
2796 *
2797 * Return: status code
2798 */
2799efi_status_t EFIAPI efi_unload_image(efi_handle_t image_handle)
2800{
Heinrich Schuchardt4ed66e52019-05-01 18:25:45 +02002801 efi_status_t ret = EFI_SUCCESS;
Heinrich Schuchardt6b3581a2019-05-01 19:04:32 +02002802 struct efi_object *efiobj;
Heinrich Schuchardt4ed66e52019-05-01 18:25:45 +02002803 struct efi_loaded_image *loaded_image_protocol;
Heinrich Schuchardt6b3581a2019-05-01 19:04:32 +02002804
2805 EFI_ENTRY("%p", image_handle);
Heinrich Schuchardt6b3581a2019-05-01 19:04:32 +02002806
Heinrich Schuchardt4ed66e52019-05-01 18:25:45 +02002807 efiobj = efi_search_obj(image_handle);
2808 if (!efiobj) {
2809 ret = EFI_INVALID_PARAMETER;
2810 goto out;
2811 }
2812 /* Find the loaded image protocol */
2813 ret = EFI_CALL(efi_open_protocol(image_handle, &efi_guid_loaded_image,
2814 (void **)&loaded_image_protocol,
2815 NULL, NULL,
2816 EFI_OPEN_PROTOCOL_GET_PROTOCOL));
2817 if (ret != EFI_SUCCESS) {
2818 ret = EFI_INVALID_PARAMETER;
2819 goto out;
2820 }
2821 switch (efiobj->type) {
2822 case EFI_OBJECT_TYPE_STARTED_IMAGE:
2823 /* Call the unload function */
2824 if (!loaded_image_protocol->unload) {
2825 ret = EFI_UNSUPPORTED;
2826 goto out;
2827 }
2828 ret = EFI_CALL(loaded_image_protocol->unload(image_handle));
2829 if (ret != EFI_SUCCESS)
2830 goto out;
2831 break;
2832 case EFI_OBJECT_TYPE_LOADED_IMAGE:
2833 break;
2834 default:
2835 ret = EFI_INVALID_PARAMETER;
2836 goto out;
2837 }
2838 efi_delete_image((struct efi_loaded_image_obj *)efiobj,
2839 loaded_image_protocol);
2840out:
2841 return EFI_EXIT(ret);
Heinrich Schuchardt6b3581a2019-05-01 19:04:32 +02002842}
2843
2844/**
Heinrich Schuchardt3d445122019-04-30 17:57:30 +02002845 * efi_update_exit_data() - fill exit data parameters of StartImage()
2846 *
2847 * @image_obj image handle
2848 * @exit_data_size size of the exit data buffer
2849 * @exit_data buffer with data returned by UEFI payload
2850 * Return: status code
2851 */
2852static efi_status_t efi_update_exit_data(struct efi_loaded_image_obj *image_obj,
2853 efi_uintn_t exit_data_size,
2854 u16 *exit_data)
2855{
2856 efi_status_t ret;
2857
2858 /*
2859 * If exit_data is not provided to StartImage(), exit_data_size must be
2860 * ignored.
2861 */
2862 if (!image_obj->exit_data)
2863 return EFI_SUCCESS;
2864 if (image_obj->exit_data_size)
2865 *image_obj->exit_data_size = exit_data_size;
2866 if (exit_data_size && exit_data) {
2867 ret = efi_allocate_pool(EFI_BOOT_SERVICES_DATA,
2868 exit_data_size,
2869 (void **)image_obj->exit_data);
2870 if (ret != EFI_SUCCESS)
2871 return ret;
2872 memcpy(*image_obj->exit_data, exit_data, exit_data_size);
2873 } else {
2874 image_obj->exit_data = NULL;
2875 }
2876 return EFI_SUCCESS;
2877}
2878
2879/**
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002880 * efi_exit() - leave an EFI application or driver
2881 * @image_handle: handle of the application or driver that is exiting
2882 * @exit_status: status code
2883 * @exit_data_size: size of the buffer in bytes
2884 * @exit_data: buffer with data describing an error
2885 *
2886 * This function implements the Exit service.
2887 *
2888 * See the Unified Extensible Firmware Interface (UEFI) specification for
2889 * details.
2890 *
2891 * Return: status code
2892 */
2893static efi_status_t EFIAPI efi_exit(efi_handle_t image_handle,
2894 efi_status_t exit_status,
2895 efi_uintn_t exit_data_size,
2896 u16 *exit_data)
2897{
2898 /*
2899 * TODO: We should call the unload procedure of the loaded
2900 * image protocol.
2901 */
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002902 efi_status_t ret;
Heinrich Schuchardt37587522019-05-01 20:07:04 +02002903 struct efi_loaded_image *loaded_image_protocol;
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002904 struct efi_loaded_image_obj *image_obj =
2905 (struct efi_loaded_image_obj *)image_handle;
2906
2907 EFI_ENTRY("%p, %ld, %zu, %p", image_handle, exit_status,
2908 exit_data_size, exit_data);
2909
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002910 /* Check parameters */
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002911 ret = EFI_CALL(efi_open_protocol(image_handle, &efi_guid_loaded_image,
Heinrich Schuchardt37587522019-05-01 20:07:04 +02002912 (void **)&loaded_image_protocol,
2913 NULL, NULL,
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002914 EFI_OPEN_PROTOCOL_GET_PROTOCOL));
Heinrich Schuchardt37587522019-05-01 20:07:04 +02002915 if (ret != EFI_SUCCESS) {
2916 ret = EFI_INVALID_PARAMETER;
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002917 goto out;
Heinrich Schuchardt37587522019-05-01 20:07:04 +02002918 }
2919
2920 /* Unloading of unstarted images */
2921 switch (image_obj->header.type) {
2922 case EFI_OBJECT_TYPE_STARTED_IMAGE:
2923 break;
2924 case EFI_OBJECT_TYPE_LOADED_IMAGE:
2925 efi_delete_image(image_obj, loaded_image_protocol);
2926 ret = EFI_SUCCESS;
2927 goto out;
2928 default:
2929 /* Handle does not refer to loaded image */
2930 ret = EFI_INVALID_PARAMETER;
2931 goto out;
2932 }
2933 /* A started image can only be unloaded it is the last one started. */
2934 if (image_handle != current_image) {
2935 ret = EFI_INVALID_PARAMETER;
2936 goto out;
2937 }
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002938
Heinrich Schuchardt3d445122019-04-30 17:57:30 +02002939 /* Exit data is only foreseen in case of failure. */
2940 if (exit_status != EFI_SUCCESS) {
2941 ret = efi_update_exit_data(image_obj, exit_data_size,
2942 exit_data);
2943 /* Exiting has priority. Don't return error to caller. */
2944 if (ret != EFI_SUCCESS)
2945 EFI_PRINT("%s: out of memory\n", __func__);
2946 }
Heinrich Schuchardt37587522019-05-01 20:07:04 +02002947 if (image_obj->image_type == IMAGE_SUBSYSTEM_EFI_APPLICATION ||
2948 exit_status != EFI_SUCCESS)
2949 efi_delete_image(image_obj, loaded_image_protocol);
Heinrich Schuchardt3d445122019-04-30 17:57:30 +02002950
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002951 /* Make sure entry/exit counts for EFI world cross-overs match */
2952 EFI_EXIT(exit_status);
2953
2954 /*
2955 * But longjmp out with the U-Boot gd, not the application's, as
2956 * the other end is a setjmp call inside EFI context.
2957 */
2958 efi_restore_gd();
2959
2960 image_obj->exit_status = exit_status;
2961 longjmp(&image_obj->exit_jmp, 1);
2962
2963 panic("EFI application exited");
Heinrich Schuchardt8efe0792019-03-26 19:03:17 +01002964out:
Heinrich Schuchardt37587522019-05-01 20:07:04 +02002965 return EFI_EXIT(ret);
Heinrich Schuchardt2650a4d2019-03-26 19:02:05 +01002966}
2967
2968/**
Mario Six8fac2912018-07-10 08:40:17 +02002969 * efi_handle_protocol() - get interface of a protocol on a handle
2970 * @handle: handle on which the protocol shall be opened
2971 * @protocol: GUID of the protocol
2972 * @protocol_interface: interface implementing the protocol
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002973 *
2974 * This function implements the HandleProtocol service.
Mario Six8fac2912018-07-10 08:40:17 +02002975 *
2976 * See the Unified Extensible Firmware Interface (UEFI) specification for
2977 * details.
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002978 *
Mario Six8fac2912018-07-10 08:40:17 +02002979 * Return: status code
Heinrich Schuchardta40db6e2017-09-21 18:30:11 +02002980 */
Heinrich Schuchardtb7cb8b42018-01-11 08:16:09 +01002981static efi_status_t EFIAPI efi_handle_protocol(efi_handle_t handle,
Heinrich Schuchardte547c662017-10-05 16:35:53 +02002982 const efi_guid_t *protocol,
Alexander Grafc15d9212016-03-04 01:09:59 +01002983 void **protocol_interface)
2984{
xypron.glpk@gmx.de1bf5d872017-06-29 21:16:19 +02002985 return efi_open_protocol(handle, protocol, protocol_interface, NULL,
2986 NULL, EFI_OPEN_PROTOCOL_BY_HANDLE_PROTOCOL);
Alexander Grafc15d9212016-03-04 01:09:59 +01002987}
2988
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002989/**
Mario Six8fac2912018-07-10 08:40:17 +02002990 * efi_bind_controller() - bind a single driver to a controller
2991 * @controller_handle: controller handle
2992 * @driver_image_handle: driver handle
2993 * @remain_device_path: remaining path
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002994 *
Mario Six8fac2912018-07-10 08:40:17 +02002995 * Return: status code
Heinrich Schuchardt59999172018-05-11 18:15:41 +02002996 */
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01002997static efi_status_t efi_bind_controller(
2998 efi_handle_t controller_handle,
2999 efi_handle_t driver_image_handle,
3000 struct efi_device_path *remain_device_path)
3001{
3002 struct efi_driver_binding_protocol *binding_protocol;
3003 efi_status_t r;
3004
3005 r = EFI_CALL(efi_open_protocol(driver_image_handle,
3006 &efi_guid_driver_binding_protocol,
3007 (void **)&binding_protocol,
3008 driver_image_handle, NULL,
3009 EFI_OPEN_PROTOCOL_GET_PROTOCOL));
3010 if (r != EFI_SUCCESS)
3011 return r;
3012 r = EFI_CALL(binding_protocol->supported(binding_protocol,
3013 controller_handle,
3014 remain_device_path));
3015 if (r == EFI_SUCCESS)
3016 r = EFI_CALL(binding_protocol->start(binding_protocol,
3017 controller_handle,
3018 remain_device_path));
3019 EFI_CALL(efi_close_protocol(driver_image_handle,
3020 &efi_guid_driver_binding_protocol,
3021 driver_image_handle, NULL));
3022 return r;
3023}
3024
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003025/**
Mario Six8fac2912018-07-10 08:40:17 +02003026 * efi_connect_single_controller() - connect a single driver to a controller
3027 * @controller_handle: controller
3028 * @driver_image_handle: driver
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02003029 * @remain_device_path: remaining path
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003030 *
Mario Six8fac2912018-07-10 08:40:17 +02003031 * Return: status code
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003032 */
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01003033static efi_status_t efi_connect_single_controller(
3034 efi_handle_t controller_handle,
3035 efi_handle_t *driver_image_handle,
3036 struct efi_device_path *remain_device_path)
3037{
3038 efi_handle_t *buffer;
3039 size_t count;
3040 size_t i;
3041 efi_status_t r;
3042 size_t connected = 0;
3043
3044 /* Get buffer with all handles with driver binding protocol */
3045 r = EFI_CALL(efi_locate_handle_buffer(BY_PROTOCOL,
3046 &efi_guid_driver_binding_protocol,
3047 NULL, &count, &buffer));
3048 if (r != EFI_SUCCESS)
3049 return r;
3050
3051 /* Context Override */
3052 if (driver_image_handle) {
3053 for (; *driver_image_handle; ++driver_image_handle) {
3054 for (i = 0; i < count; ++i) {
3055 if (buffer[i] == *driver_image_handle) {
3056 buffer[i] = NULL;
3057 r = efi_bind_controller(
3058 controller_handle,
3059 *driver_image_handle,
3060 remain_device_path);
3061 /*
3062 * For drivers that do not support the
3063 * controller or are already connected
3064 * we receive an error code here.
3065 */
3066 if (r == EFI_SUCCESS)
3067 ++connected;
3068 }
3069 }
3070 }
3071 }
3072
3073 /*
3074 * TODO: Some overrides are not yet implemented:
3075 * - Platform Driver Override
3076 * - Driver Family Override Search
3077 * - Bus Specific Driver Override
3078 */
3079
3080 /* Driver Binding Search */
3081 for (i = 0; i < count; ++i) {
3082 if (buffer[i]) {
3083 r = efi_bind_controller(controller_handle,
3084 buffer[i],
3085 remain_device_path);
3086 if (r == EFI_SUCCESS)
3087 ++connected;
3088 }
3089 }
3090
3091 efi_free_pool(buffer);
3092 if (!connected)
3093 return EFI_NOT_FOUND;
3094 return EFI_SUCCESS;
3095}
3096
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003097/**
Mario Six8fac2912018-07-10 08:40:17 +02003098 * efi_connect_controller() - connect a controller to a driver
3099 * @controller_handle: handle of the controller
3100 * @driver_image_handle: handle of the driver
3101 * @remain_device_path: device path of a child controller
3102 * @recursive: true to connect all child controllers
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01003103 *
3104 * This function implements the ConnectController service.
Mario Six8fac2912018-07-10 08:40:17 +02003105 *
3106 * See the Unified Extensible Firmware Interface (UEFI) specification for
3107 * details.
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01003108 *
3109 * First all driver binding protocol handles are tried for binding drivers.
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02003110 * Afterwards all handles that have opened a protocol of the controller
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01003111 * with EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER are connected to drivers.
3112 *
Mario Six8fac2912018-07-10 08:40:17 +02003113 * Return: status code
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01003114 */
3115static efi_status_t EFIAPI efi_connect_controller(
3116 efi_handle_t controller_handle,
3117 efi_handle_t *driver_image_handle,
3118 struct efi_device_path *remain_device_path,
3119 bool recursive)
3120{
3121 efi_status_t r;
3122 efi_status_t ret = EFI_NOT_FOUND;
3123 struct efi_object *efiobj;
3124
Heinrich Schuchardt7c89fb02018-12-09 16:39:20 +01003125 EFI_ENTRY("%p, %p, %pD, %d", controller_handle, driver_image_handle,
Heinrich Schuchardt760255f2018-01-11 08:16:02 +01003126 remain_device_path, recursive);
3127
3128 efiobj = efi_search_obj(controller_handle);
3129 if (!efiobj) {
3130 ret = EFI_INVALID_PARAMETER;
3131 goto out;
3132 }
3133
3134 r = efi_connect_single_controller(controller_handle,
3135 driver_image_handle,
3136 remain_device_path);
3137 if (r == EFI_SUCCESS)
3138 ret = EFI_SUCCESS;
3139 if (recursive) {
3140 struct efi_handler *handler;
3141 struct efi_open_protocol_info_item *item;
3142
3143 list_for_each_entry(handler, &efiobj->protocols, link) {
3144 list_for_each_entry(item, &handler->open_infos, link) {
3145 if (item->info.attributes &
3146 EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) {
3147 r = EFI_CALL(efi_connect_controller(
3148 item->info.controller_handle,
3149 driver_image_handle,
3150 remain_device_path,
3151 recursive));
3152 if (r == EFI_SUCCESS)
3153 ret = EFI_SUCCESS;
3154 }
3155 }
3156 }
3157 }
3158 /* Check for child controller specified by end node */
3159 if (ret != EFI_SUCCESS && remain_device_path &&
3160 remain_device_path->type == DEVICE_PATH_TYPE_END)
3161 ret = EFI_SUCCESS;
3162out:
3163 return EFI_EXIT(ret);
3164}
3165
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003166/**
Mario Six8fac2912018-07-10 08:40:17 +02003167 * efi_reinstall_protocol_interface() - reinstall protocol interface
3168 * @handle: handle on which the protocol shall be reinstalled
3169 * @protocol: GUID of the protocol to be installed
3170 * @old_interface: interface to be removed
3171 * @new_interface: interface to be installed
Heinrich Schuchardt90761b82018-05-11 12:09:22 +02003172 *
3173 * This function implements the ReinstallProtocolInterface service.
Mario Six8fac2912018-07-10 08:40:17 +02003174 *
3175 * See the Unified Extensible Firmware Interface (UEFI) specification for
3176 * details.
Heinrich Schuchardt90761b82018-05-11 12:09:22 +02003177 *
3178 * The old interface is uninstalled. The new interface is installed.
3179 * Drivers are connected.
3180 *
Mario Six8fac2912018-07-10 08:40:17 +02003181 * Return: status code
Heinrich Schuchardt90761b82018-05-11 12:09:22 +02003182 */
3183static efi_status_t EFIAPI efi_reinstall_protocol_interface(
3184 efi_handle_t handle, const efi_guid_t *protocol,
3185 void *old_interface, void *new_interface)
3186{
3187 efi_status_t ret;
3188
3189 EFI_ENTRY("%p, %pUl, %p, %p", handle, protocol, old_interface,
3190 new_interface);
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02003191
3192 /* Uninstall protocol but do not delete handle */
3193 ret = efi_uninstall_protocol(handle, protocol, old_interface);
Heinrich Schuchardt90761b82018-05-11 12:09:22 +02003194 if (ret != EFI_SUCCESS)
3195 goto out;
Heinrich Schuchardt1b451342018-09-28 22:14:17 +02003196
3197 /* Install the new protocol */
3198 ret = efi_add_protocol(handle, protocol, new_interface);
3199 /*
3200 * The UEFI spec does not specify what should happen to the handle
3201 * if in case of an error no protocol interface remains on the handle.
3202 * So let's do nothing here.
3203 */
Heinrich Schuchardt90761b82018-05-11 12:09:22 +02003204 if (ret != EFI_SUCCESS)
3205 goto out;
3206 /*
3207 * The returned status code has to be ignored.
3208 * Do not create an error if no suitable driver for the handle exists.
3209 */
3210 EFI_CALL(efi_connect_controller(handle, NULL, NULL, true));
3211out:
3212 return EFI_EXIT(ret);
3213}
3214
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003215/**
Mario Six8fac2912018-07-10 08:40:17 +02003216 * efi_get_child_controllers() - get all child controllers associated to a driver
3217 * @efiobj: handle of the controller
3218 * @driver_handle: handle of the driver
3219 * @number_of_children: number of child controllers
3220 * @child_handle_buffer: handles of the the child controllers
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003221 *
Heinrich Schuchardte9943282018-01-11 08:16:04 +01003222 * The allocated buffer has to be freed with free().
3223 *
Mario Six8fac2912018-07-10 08:40:17 +02003224 * Return: status code
Heinrich Schuchardte9943282018-01-11 08:16:04 +01003225 */
3226static efi_status_t efi_get_child_controllers(
3227 struct efi_object *efiobj,
3228 efi_handle_t driver_handle,
3229 efi_uintn_t *number_of_children,
3230 efi_handle_t **child_handle_buffer)
3231{
3232 struct efi_handler *handler;
3233 struct efi_open_protocol_info_item *item;
3234 efi_uintn_t count = 0, i;
3235 bool duplicate;
3236
3237 /* Count all child controller associations */
3238 list_for_each_entry(handler, &efiobj->protocols, link) {
3239 list_for_each_entry(item, &handler->open_infos, link) {
3240 if (item->info.agent_handle == driver_handle &&
3241 item->info.attributes &
3242 EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER)
3243 ++count;
3244 }
3245 }
3246 /*
3247 * Create buffer. In case of duplicate child controller assignments
3248 * the buffer will be too large. But that does not harm.
3249 */
3250 *number_of_children = 0;
3251 *child_handle_buffer = calloc(count, sizeof(efi_handle_t));
3252 if (!*child_handle_buffer)
3253 return EFI_OUT_OF_RESOURCES;
3254 /* Copy unique child handles */
3255 list_for_each_entry(handler, &efiobj->protocols, link) {
3256 list_for_each_entry(item, &handler->open_infos, link) {
3257 if (item->info.agent_handle == driver_handle &&
3258 item->info.attributes &
3259 EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) {
3260 /* Check this is a new child controller */
3261 duplicate = false;
3262 for (i = 0; i < *number_of_children; ++i) {
3263 if ((*child_handle_buffer)[i] ==
3264 item->info.controller_handle)
3265 duplicate = true;
3266 }
3267 /* Copy handle to buffer */
3268 if (!duplicate) {
3269 i = (*number_of_children)++;
3270 (*child_handle_buffer)[i] =
3271 item->info.controller_handle;
3272 }
3273 }
3274 }
3275 }
3276 return EFI_SUCCESS;
3277}
3278
Heinrich Schuchardt59999172018-05-11 18:15:41 +02003279/**
Mario Six8fac2912018-07-10 08:40:17 +02003280 * efi_disconnect_controller() - disconnect a controller from a driver
3281 * @controller_handle: handle of the controller
3282 * @driver_image_handle: handle of the driver
3283 * @child_handle: handle of the child to destroy
Heinrich Schuchardte9943282018-01-11 08:16:04 +01003284 *
3285 * This function implements the DisconnectController service.
Mario Six8fac2912018-07-10 08:40:17 +02003286 *
3287 * See the Unified Extensible Firmware Interface (UEFI) specification for
3288 * details.
Heinrich Schuchardte9943282018-01-11 08:16:04 +01003289 *
Mario Six8fac2912018-07-10 08:40:17 +02003290 * Return: status code
Heinrich Schuchardte9943282018-01-11 08:16:04 +01003291 */
3292static efi_status_t EFIAPI efi_disconnect_controller(
3293 efi_handle_t controller_handle,
3294 efi_handle_t driver_image_handle,
3295 efi_handle_t child_handle)
3296{
3297 struct efi_driver_binding_protocol *binding_protocol;
3298 efi_handle_t *child_handle_buffer = NULL;
3299 size_t number_of_children = 0;
3300 efi_status_t r;
3301 size_t stop_count = 0;
3302 struct efi_object *efiobj;
3303
3304 EFI_ENTRY("%p, %p, %p", controller_handle, driver_image_handle,
3305 child_handle);
3306
3307 efiobj = efi_search_obj(controller_handle);
3308 if (!efiobj) {
3309 r = EFI_INVALID_PARAMETER;
3310 goto out;
3311 }
3312
3313 if (child_handle && !efi_search_obj(child_handle)) {
3314 r = EFI_INVALID_PARAMETER;
3315 goto out;
3316 }
3317
3318 /* If no driver handle is supplied, disconnect all drivers */
3319 if (!driver_image_handle) {
3320 r = efi_disconnect_all_drivers(efiobj, NULL, child_handle);
3321 goto out;
3322 }
3323
3324 /* Create list of child handles */
3325 if (child_handle) {
3326 number_of_children = 1;
3327 child_handle_buffer = &child_handle;
3328 } else {
3329 efi_get_child_controllers(efiobj,
3330 driver_image_handle,
3331 &number_of_children,
3332 &child_handle_buffer);
3333 }
3334
3335 /* Get the driver binding protocol */
3336 r = EFI_CALL(efi_open_protocol(driver_image_handle,
3337 &efi_guid_driver_binding_protocol,
3338 (void **)&binding_protocol,
3339 driver_image_handle, NULL,
3340 EFI_OPEN_PROTOCOL_GET_PROTOCOL));
3341 if (r != EFI_SUCCESS)
3342 goto out;
3343 /* Remove the children */
3344 if (number_of_children) {
3345 r = EFI_CALL(binding_protocol->stop(binding_protocol,
3346 controller_handle,
3347 number_of_children,
3348 child_handle_buffer));
3349 if (r == EFI_SUCCESS)
3350 ++stop_count;
3351 }
3352 /* Remove the driver */
3353 if (!child_handle)
3354 r = EFI_CALL(binding_protocol->stop(binding_protocol,
3355 controller_handle,
3356 0, NULL));
3357 if (r == EFI_SUCCESS)
3358 ++stop_count;
3359 EFI_CALL(efi_close_protocol(driver_image_handle,
3360 &efi_guid_driver_binding_protocol,
3361 driver_image_handle, NULL));
3362
3363 if (stop_count)
3364 r = EFI_SUCCESS;
3365 else
3366 r = EFI_NOT_FOUND;
3367out:
3368 if (!child_handle)
3369 free(child_handle_buffer);
3370 return EFI_EXIT(r);
3371}
3372
Heinrich Schuchardt15070db2018-06-28 12:45:31 +02003373static struct efi_boot_services efi_boot_services = {
Alexander Grafc15d9212016-03-04 01:09:59 +01003374 .hdr = {
Heinrich Schuchardte75b3cb2018-06-28 12:45:27 +02003375 .signature = EFI_BOOT_SERVICES_SIGNATURE,
3376 .revision = EFI_SPECIFICATION_VERSION,
Heinrich Schuchardt10204252018-06-28 12:45:29 +02003377 .headersize = sizeof(struct efi_boot_services),
Alexander Grafc15d9212016-03-04 01:09:59 +01003378 },
3379 .raise_tpl = efi_raise_tpl,
3380 .restore_tpl = efi_restore_tpl,
3381 .allocate_pages = efi_allocate_pages_ext,
3382 .free_pages = efi_free_pages_ext,
3383 .get_memory_map = efi_get_memory_map_ext,
Stefan Brüns5a09aef2016-10-09 22:17:18 +02003384 .allocate_pool = efi_allocate_pool_ext,
Stefan Brüns67b67d92016-10-09 22:17:26 +02003385 .free_pool = efi_free_pool_ext,
xypron.glpk@gmx.de852a0e1772017-07-18 20:17:20 +02003386 .create_event = efi_create_event_ext,
xypron.glpk@gmx.dea587fd12017-07-18 20:17:21 +02003387 .set_timer = efi_set_timer_ext,
Alexander Grafc15d9212016-03-04 01:09:59 +01003388 .wait_for_event = efi_wait_for_event,
xypron.glpk@gmx.de30708232017-07-18 20:17:18 +02003389 .signal_event = efi_signal_event_ext,
Alexander Grafc15d9212016-03-04 01:09:59 +01003390 .close_event = efi_close_event,
3391 .check_event = efi_check_event,
Heinrich Schuchardt0a27ac82017-11-06 21:17:44 +01003392 .install_protocol_interface = efi_install_protocol_interface,
Alexander Grafc15d9212016-03-04 01:09:59 +01003393 .reinstall_protocol_interface = efi_reinstall_protocol_interface,
Heinrich Schuchardt7cdc17f2017-11-06 21:17:45 +01003394 .uninstall_protocol_interface = efi_uninstall_protocol_interface,
Alexander Grafc15d9212016-03-04 01:09:59 +01003395 .handle_protocol = efi_handle_protocol,
3396 .reserved = NULL,
3397 .register_protocol_notify = efi_register_protocol_notify,
xypron.glpk@gmx.de69f94032017-07-11 22:06:21 +02003398 .locate_handle = efi_locate_handle_ext,
Alexander Grafc15d9212016-03-04 01:09:59 +01003399 .locate_device_path = efi_locate_device_path,
Alexander Grafc5c11632016-08-19 01:23:24 +02003400 .install_configuration_table = efi_install_configuration_table_ext,
Alexander Grafc15d9212016-03-04 01:09:59 +01003401 .load_image = efi_load_image,
3402 .start_image = efi_start_image,
Alexander Graf988c0662016-05-20 23:28:23 +02003403 .exit = efi_exit,
Alexander Grafc15d9212016-03-04 01:09:59 +01003404 .unload_image = efi_unload_image,
3405 .exit_boot_services = efi_exit_boot_services,
3406 .get_next_monotonic_count = efi_get_next_monotonic_count,
3407 .stall = efi_stall,
3408 .set_watchdog_timer = efi_set_watchdog_timer,
3409 .connect_controller = efi_connect_controller,
3410 .disconnect_controller = efi_disconnect_controller,
3411 .open_protocol = efi_open_protocol,
3412 .close_protocol = efi_close_protocol,
3413 .open_protocol_information = efi_open_protocol_information,
3414 .protocols_per_handle = efi_protocols_per_handle,
3415 .locate_handle_buffer = efi_locate_handle_buffer,
3416 .locate_protocol = efi_locate_protocol,
Heinrich Schuchardt91064592018-02-18 15:17:49 +01003417 .install_multiple_protocol_interfaces =
3418 efi_install_multiple_protocol_interfaces,
3419 .uninstall_multiple_protocol_interfaces =
3420 efi_uninstall_multiple_protocol_interfaces,
Alexander Grafc15d9212016-03-04 01:09:59 +01003421 .calculate_crc32 = efi_calculate_crc32,
3422 .copy_mem = efi_copy_mem,
3423 .set_mem = efi_set_mem,
Heinrich Schuchardt717c4582018-02-04 23:05:13 +01003424 .create_event_ex = efi_create_event_ex,
Alexander Grafc15d9212016-03-04 01:09:59 +01003425};
3426
Heinrich Schuchardt27685f72018-06-28 12:45:30 +02003427static u16 __efi_runtime_data firmware_vendor[] = L"Das U-Boot";
Alexander Grafc15d9212016-03-04 01:09:59 +01003428
Alexander Graf393dd912016-10-14 13:45:30 +02003429struct efi_system_table __efi_runtime_data systab = {
Alexander Grafc15d9212016-03-04 01:09:59 +01003430 .hdr = {
3431 .signature = EFI_SYSTEM_TABLE_SIGNATURE,
Heinrich Schuchardte75b3cb2018-06-28 12:45:27 +02003432 .revision = EFI_SPECIFICATION_VERSION,
Heinrich Schuchardt10204252018-06-28 12:45:29 +02003433 .headersize = sizeof(struct efi_system_table),
Alexander Grafc15d9212016-03-04 01:09:59 +01003434 },
Heinrich Schuchardt27685f72018-06-28 12:45:30 +02003435 .fw_vendor = firmware_vendor,
3436 .fw_revision = FW_VERSION << 16 | FW_PATCHLEVEL << 8,
Heinrich Schuchardt91064592018-02-18 15:17:49 +01003437 .con_in = (void *)&efi_con_in,
3438 .con_out = (void *)&efi_con_out,
3439 .std_err = (void *)&efi_con_out,
3440 .runtime = (void *)&efi_runtime_services,
3441 .boottime = (void *)&efi_boot_services,
Alexander Grafc15d9212016-03-04 01:09:59 +01003442 .nr_tables = 0,
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02003443 .tables = NULL,
Alexander Grafc15d9212016-03-04 01:09:59 +01003444};
Heinrich Schuchardt15070db2018-06-28 12:45:31 +02003445
3446/**
3447 * efi_initialize_system_table() - Initialize system table
3448 *
Heinrich Schuchardt7b4b2a22018-09-03 05:00:43 +02003449 * Return: status code
Heinrich Schuchardt15070db2018-06-28 12:45:31 +02003450 */
3451efi_status_t efi_initialize_system_table(void)
3452{
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02003453 efi_status_t ret;
3454
3455 /* Allocate configuration table array */
3456 ret = efi_allocate_pool(EFI_RUNTIME_SERVICES_DATA,
3457 EFI_MAX_CONFIGURATION_TABLES *
3458 sizeof(struct efi_configuration_table),
3459 (void **)&systab.tables);
3460
Heinrich Schuchardtcf70a732018-09-03 19:12:24 +02003461 /* Set CRC32 field in table headers */
Heinrich Schuchardt15070db2018-06-28 12:45:31 +02003462 efi_update_table_header_crc32(&systab.hdr);
3463 efi_update_table_header_crc32(&efi_runtime_services.hdr);
3464 efi_update_table_header_crc32(&efi_boot_services.hdr);
Heinrich Schuchardt2f528c22018-06-28 12:45:32 +02003465
3466 return ret;
Heinrich Schuchardt15070db2018-06-28 12:45:31 +02003467}