xref: /rk3399_rockchip-uboot/lib/efi_loader/efi_boottime.c (revision 51bfb5b6f522b1fbe453c18df03648d72b08131f)
1 /*
2  *  EFI application boot time services
3  *
4  *  Copyright (c) 2016 Alexander Graf
5  *
6  *  SPDX-License-Identifier:     GPL-2.0+
7  */
8 
9 #include <common.h>
10 #include <efi_loader.h>
11 #include <malloc.h>
12 #include <asm/global_data.h>
13 #include <libfdt_env.h>
14 #include <u-boot/crc.h>
15 #include <bootm.h>
16 #include <inttypes.h>
17 #include <watchdog.h>
18 
19 DECLARE_GLOBAL_DATA_PTR;
20 
21 /* This list contains all the EFI objects our payload has access to */
22 LIST_HEAD(efi_obj_list);
23 
24 /*
25  * If we're running on nasty systems (32bit ARM booting into non-EFI Linux)
26  * we need to do trickery with caches. Since we don't want to break the EFI
27  * aware boot path, only apply hacks when loading exiting directly (breaking
28  * direct Linux EFI booting along the way - oh well).
29  */
30 static bool efi_is_direct_boot = true;
31 
32 /*
33  * EFI can pass arbitrary additional "tables" containing vendor specific
34  * information to the payload. One such table is the FDT table which contains
35  * a pointer to a flattened device tree blob.
36  *
37  * In most cases we want to pass an FDT to the payload, so reserve one slot of
38  * config table space for it. The pointer gets populated by do_bootefi_exec().
39  */
40 static struct efi_configuration_table EFI_RUNTIME_DATA efi_conf_table[1];
41 
42 /*
43  * The "gd" pointer lives in a register on ARM and AArch64 that we declare
44  * fixed when compiling U-Boot. However, the payload does not know about that
45  * restriction so we need to manually swap its and our view of that register on
46  * EFI callback entry/exit.
47  */
48 static volatile void *efi_gd, *app_gd;
49 
50 /* Called from do_bootefi_exec() */
51 void efi_save_gd(void)
52 {
53 	efi_gd = gd;
54 }
55 
56 /* Called on every callback entry */
57 void efi_restore_gd(void)
58 {
59 	/* Only restore if we're already in EFI context */
60 	if (!efi_gd)
61 		return;
62 
63 	if (gd != efi_gd)
64 		app_gd = gd;
65 	gd = efi_gd;
66 }
67 
68 /* Called on every callback exit */
69 efi_status_t efi_exit_func(efi_status_t ret)
70 {
71 	gd = app_gd;
72 	return ret;
73 }
74 
75 static efi_status_t efi_unsupported(const char *funcname)
76 {
77 	debug("EFI: App called into unimplemented function %s\n", funcname);
78 	return EFI_EXIT(EFI_UNSUPPORTED);
79 }
80 
81 static int guidcmp(const efi_guid_t *g1, const efi_guid_t *g2)
82 {
83 	return memcmp(g1, g2, sizeof(efi_guid_t));
84 }
85 
86 static unsigned long EFIAPI efi_raise_tpl(unsigned long new_tpl)
87 {
88 	EFI_ENTRY("0x%lx", new_tpl);
89 	return EFI_EXIT(0);
90 }
91 
92 static void EFIAPI efi_restore_tpl(unsigned long old_tpl)
93 {
94 	EFI_ENTRY("0x%lx", old_tpl);
95 	EFI_EXIT(efi_unsupported(__func__));
96 }
97 
98 efi_status_t EFIAPI efi_allocate_pages_ext(int type, int memory_type,
99 					   unsigned long pages,
100 					   uint64_t *memory)
101 {
102 	efi_status_t r;
103 
104 	EFI_ENTRY("%d, %d, 0x%lx, %p", type, memory_type, pages, memory);
105 	r = efi_allocate_pages(type, memory_type, pages, memory);
106 	return EFI_EXIT(r);
107 }
108 
109 efi_status_t EFIAPI efi_free_pages_ext(uint64_t memory, unsigned long pages)
110 {
111 	efi_status_t r;
112 
113 	EFI_ENTRY("%"PRIx64", 0x%lx", memory, pages);
114 	r = efi_free_pages(memory, pages);
115 	return EFI_EXIT(r);
116 }
117 
118 efi_status_t EFIAPI efi_get_memory_map_ext(unsigned long *memory_map_size,
119 					   struct efi_mem_desc *memory_map,
120 					   unsigned long *map_key,
121 					   unsigned long *descriptor_size,
122 					   uint32_t *descriptor_version)
123 {
124 	efi_status_t r;
125 
126 	EFI_ENTRY("%p, %p, %p, %p, %p", memory_map_size, memory_map,
127 		  map_key, descriptor_size, descriptor_version);
128 	r = efi_get_memory_map(memory_map_size, memory_map, map_key,
129 			       descriptor_size, descriptor_version);
130 	return EFI_EXIT(r);
131 }
132 
133 static efi_status_t EFIAPI efi_allocate_pool_ext(int pool_type,
134 						 unsigned long size,
135 						 void **buffer)
136 {
137 	efi_status_t r;
138 
139 	EFI_ENTRY("%d, %ld, %p", pool_type, size, buffer);
140 	r = efi_allocate_pool(pool_type, size, buffer);
141 	return EFI_EXIT(r);
142 }
143 
144 static efi_status_t EFIAPI efi_free_pool_ext(void *buffer)
145 {
146 	efi_status_t r;
147 
148 	EFI_ENTRY("%p", buffer);
149 	r = efi_free_pool(buffer);
150 	return EFI_EXIT(r);
151 }
152 
153 /*
154  * Our event capabilities are very limited. Only support a single
155  * event to exist, so we don't need to maintain lists.
156  */
157 static struct {
158 	enum efi_event_type type;
159 	u32 trigger_type;
160 	u32 trigger_time;
161 	u64 trigger_next;
162 	unsigned long notify_tpl;
163 	void (*notify_function) (void *event, void *context);
164 	void *notify_context;
165 } efi_event = {
166 	/* Disable timers on bootup */
167 	.trigger_next = -1ULL,
168 };
169 
170 static efi_status_t EFIAPI efi_create_event(
171 			enum efi_event_type type, ulong notify_tpl,
172 			void (*notify_function) (void *event, void *context),
173 			void *notify_context, void **event)
174 {
175 	EFI_ENTRY("%d, 0x%lx, %p, %p", type, notify_tpl, notify_function,
176 		  notify_context);
177 	if (efi_event.notify_function) {
178 		/* We only support one event at a time */
179 		return EFI_EXIT(EFI_OUT_OF_RESOURCES);
180 	}
181 
182 	efi_event.type = type;
183 	efi_event.notify_tpl = notify_tpl;
184 	efi_event.notify_function = notify_function;
185 	efi_event.notify_context = notify_context;
186 	*event = &efi_event;
187 
188 	return EFI_EXIT(EFI_SUCCESS);
189 }
190 
191 /*
192  * Our timers have to work without interrupts, so we check whenever keyboard
193  * input or disk accesses happen if enough time elapsed for it to fire.
194  */
195 void efi_timer_check(void)
196 {
197 	u64 now = timer_get_us();
198 
199 	if (now >= efi_event.trigger_next) {
200 		/* Triggering! */
201 		if (efi_event.trigger_type == EFI_TIMER_PERIODIC)
202 			efi_event.trigger_next += efi_event.trigger_time / 10;
203 		efi_event.notify_function(&efi_event, efi_event.notify_context);
204 	}
205 
206 	WATCHDOG_RESET();
207 }
208 
209 static efi_status_t EFIAPI efi_set_timer(void *event, int type,
210 					 uint64_t trigger_time)
211 {
212 	/* We don't have 64bit division available everywhere, so limit timer
213 	 * distances to 32bit bits. */
214 	u32 trigger32 = trigger_time;
215 
216 	EFI_ENTRY("%p, %d, %"PRIx64, event, type, trigger_time);
217 
218 	if (trigger32 < trigger_time) {
219 		printf("WARNING: Truncating timer from %"PRIx64" to %x\n",
220 		       trigger_time, trigger32);
221 	}
222 
223 	if (event != &efi_event) {
224 		/* We only support one event at a time */
225 		return EFI_EXIT(EFI_INVALID_PARAMETER);
226 	}
227 
228 	switch (type) {
229 	case EFI_TIMER_STOP:
230 		efi_event.trigger_next = -1ULL;
231 		break;
232 	case EFI_TIMER_PERIODIC:
233 	case EFI_TIMER_RELATIVE:
234 		efi_event.trigger_next = timer_get_us() + (trigger32 / 10);
235 		break;
236 	default:
237 		return EFI_EXIT(EFI_INVALID_PARAMETER);
238 	}
239 	efi_event.trigger_type = type;
240 	efi_event.trigger_time = trigger_time;
241 
242 	return EFI_EXIT(EFI_SUCCESS);
243 }
244 
245 static efi_status_t EFIAPI efi_wait_for_event(unsigned long num_events,
246 					      void *event, unsigned long *index)
247 {
248 	u64 now;
249 
250 	EFI_ENTRY("%ld, %p, %p", num_events, event, index);
251 
252 	now = timer_get_us();
253 	while (now < efi_event.trigger_next) { }
254 	efi_timer_check();
255 
256 	return EFI_EXIT(EFI_SUCCESS);
257 }
258 
259 static efi_status_t EFIAPI efi_signal_event(void *event)
260 {
261 	EFI_ENTRY("%p", event);
262 	return EFI_EXIT(EFI_SUCCESS);
263 }
264 
265 static efi_status_t EFIAPI efi_close_event(void *event)
266 {
267 	EFI_ENTRY("%p", event);
268 	efi_event.trigger_next = -1ULL;
269 	return EFI_EXIT(EFI_SUCCESS);
270 }
271 
272 static efi_status_t EFIAPI efi_check_event(void *event)
273 {
274 	EFI_ENTRY("%p", event);
275 	return EFI_EXIT(EFI_NOT_READY);
276 }
277 
278 static efi_status_t EFIAPI efi_install_protocol_interface(void **handle,
279 			efi_guid_t *protocol, int protocol_interface_type,
280 			void *protocol_interface)
281 {
282 	EFI_ENTRY("%p, %p, %d, %p", handle, protocol, protocol_interface_type,
283 		  protocol_interface);
284 	return EFI_EXIT(EFI_OUT_OF_RESOURCES);
285 }
286 static efi_status_t EFIAPI efi_reinstall_protocol_interface(void *handle,
287 			efi_guid_t *protocol, void *old_interface,
288 			void *new_interface)
289 {
290 	EFI_ENTRY("%p, %p, %p, %p", handle, protocol, old_interface,
291 		  new_interface);
292 	return EFI_EXIT(EFI_ACCESS_DENIED);
293 }
294 
295 static efi_status_t EFIAPI efi_uninstall_protocol_interface(void *handle,
296 			efi_guid_t *protocol, void *protocol_interface)
297 {
298 	EFI_ENTRY("%p, %p, %p", handle, protocol, protocol_interface);
299 	return EFI_EXIT(EFI_NOT_FOUND);
300 }
301 
302 static efi_status_t EFIAPI efi_register_protocol_notify(efi_guid_t *protocol,
303 							void *event,
304 							void **registration)
305 {
306 	EFI_ENTRY("%p, %p, %p", protocol, event, registration);
307 	return EFI_EXIT(EFI_OUT_OF_RESOURCES);
308 }
309 
310 static int efi_search(enum efi_locate_search_type search_type,
311 		      efi_guid_t *protocol, void *search_key,
312 		      struct efi_object *efiobj)
313 {
314 	int i;
315 
316 	switch (search_type) {
317 	case all_handles:
318 		return 0;
319 	case by_register_notify:
320 		return -1;
321 	case by_protocol:
322 		for (i = 0; i < ARRAY_SIZE(efiobj->protocols); i++) {
323 			const efi_guid_t *guid = efiobj->protocols[i].guid;
324 			if (guid && !guidcmp(guid, protocol))
325 				return 0;
326 		}
327 		return -1;
328 	}
329 
330 	return -1;
331 }
332 
333 static efi_status_t EFIAPI efi_locate_handle(
334 			enum efi_locate_search_type search_type,
335 			efi_guid_t *protocol, void *search_key,
336 			unsigned long *buffer_size, efi_handle_t *buffer)
337 {
338 	struct list_head *lhandle;
339 	unsigned long size = 0;
340 
341 	EFI_ENTRY("%d, %p, %p, %p, %p", search_type, protocol, search_key,
342 		  buffer_size, buffer);
343 
344 	/* Count how much space we need */
345 	list_for_each(lhandle, &efi_obj_list) {
346 		struct efi_object *efiobj;
347 		efiobj = list_entry(lhandle, struct efi_object, link);
348 		if (!efi_search(search_type, protocol, search_key, efiobj)) {
349 			size += sizeof(void*);
350 		}
351 	}
352 
353 	if (*buffer_size < size) {
354 		*buffer_size = size;
355 		return EFI_EXIT(EFI_BUFFER_TOO_SMALL);
356 	}
357 
358 	/* Then fill the array */
359 	list_for_each(lhandle, &efi_obj_list) {
360 		struct efi_object *efiobj;
361 		efiobj = list_entry(lhandle, struct efi_object, link);
362 		if (!efi_search(search_type, protocol, search_key, efiobj)) {
363 			*(buffer++) = efiobj->handle;
364 		}
365 	}
366 
367 	*buffer_size = size;
368 	return EFI_EXIT(EFI_SUCCESS);
369 }
370 
371 static efi_status_t EFIAPI efi_locate_device_path(efi_guid_t *protocol,
372 			struct efi_device_path **device_path,
373 			efi_handle_t *device)
374 {
375 	EFI_ENTRY("%p, %p, %p", protocol, device_path, device);
376 	return EFI_EXIT(EFI_NOT_FOUND);
377 }
378 
379 static efi_status_t EFIAPI efi_install_configuration_table(efi_guid_t *guid,
380 							   void *table)
381 {
382 	int i;
383 
384 	EFI_ENTRY("%p, %p", guid, table);
385 
386 	/* Check for guid override */
387 	for (i = 0; i < systab.nr_tables; i++) {
388 		if (!guidcmp(guid, &efi_conf_table[i].guid)) {
389 			efi_conf_table[i].table = table;
390 			return EFI_EXIT(EFI_SUCCESS);
391 		}
392 	}
393 
394 	/* No override, check for overflow */
395 	if (i >= ARRAY_SIZE(efi_conf_table))
396 		return EFI_EXIT(EFI_OUT_OF_RESOURCES);
397 
398 	/* Add a new entry */
399 	memcpy(&efi_conf_table[i].guid, guid, sizeof(*guid));
400 	efi_conf_table[i].table = table;
401 	systab.nr_tables = i;
402 
403 	return EFI_EXIT(EFI_SUCCESS);
404 }
405 
406 static efi_status_t EFIAPI efi_load_image(bool boot_policy,
407 					  efi_handle_t parent_image,
408 					  struct efi_device_path *file_path,
409 					  void *source_buffer,
410 					  unsigned long source_size,
411 					  efi_handle_t *image_handle)
412 {
413 	static struct efi_object loaded_image_info_obj = {
414 		.protocols = {
415 			{
416 				.guid = &efi_guid_loaded_image,
417 				.open = &efi_return_handle,
418 			},
419 		},
420 	};
421 	struct efi_loaded_image *info;
422 	struct efi_object *obj;
423 
424 	EFI_ENTRY("%d, %p, %p, %p, %ld, %p", boot_policy, parent_image,
425 		  file_path, source_buffer, source_size, image_handle);
426 	info = malloc(sizeof(*info));
427 	obj = malloc(sizeof(loaded_image_info_obj));
428 	memset(info, 0, sizeof(*info));
429 	memcpy(obj, &loaded_image_info_obj, sizeof(loaded_image_info_obj));
430 	obj->handle = info;
431 	info->file_path = file_path;
432 	info->reserved = efi_load_pe(source_buffer, info);
433 	if (!info->reserved) {
434 		free(info);
435 		free(obj);
436 		return EFI_EXIT(EFI_UNSUPPORTED);
437 	}
438 
439 	*image_handle = info;
440 	list_add_tail(&obj->link, &efi_obj_list);
441 
442 	return EFI_EXIT(EFI_SUCCESS);
443 }
444 
445 static efi_status_t EFIAPI efi_start_image(efi_handle_t image_handle,
446 					   unsigned long *exit_data_size,
447 					   s16 **exit_data)
448 {
449 	ulong (*entry)(void *image_handle, struct efi_system_table *st);
450 	struct efi_loaded_image *info = image_handle;
451 
452 	EFI_ENTRY("%p, %p, %p", image_handle, exit_data_size, exit_data);
453 	entry = info->reserved;
454 
455 	efi_is_direct_boot = false;
456 
457 	/* call the image! */
458 	if (setjmp(&info->exit_jmp)) {
459 		/* We returned from the child image */
460 		return EFI_EXIT(info->exit_status);
461 	}
462 
463 	entry(image_handle, &systab);
464 
465 	/* Should usually never get here */
466 	return EFI_EXIT(EFI_SUCCESS);
467 }
468 
469 static efi_status_t EFIAPI efi_exit(efi_handle_t image_handle,
470 			efi_status_t exit_status, unsigned long exit_data_size,
471 			int16_t *exit_data)
472 {
473 	struct efi_loaded_image *loaded_image_info = (void*)image_handle;
474 
475 	EFI_ENTRY("%p, %ld, %ld, %p", image_handle, exit_status,
476 		  exit_data_size, exit_data);
477 
478 	loaded_image_info->exit_status = exit_status;
479 	longjmp(&loaded_image_info->exit_jmp, 1);
480 
481 	panic("EFI application exited");
482 }
483 
484 static struct efi_object *efi_search_obj(void *handle)
485 {
486 	struct list_head *lhandle;
487 
488 	list_for_each(lhandle, &efi_obj_list) {
489 		struct efi_object *efiobj;
490 		efiobj = list_entry(lhandle, struct efi_object, link);
491 		if (efiobj->handle == handle)
492 			return efiobj;
493 	}
494 
495 	return NULL;
496 }
497 
498 static efi_status_t EFIAPI efi_unload_image(void *image_handle)
499 {
500 	struct efi_object *efiobj;
501 
502 	EFI_ENTRY("%p", image_handle);
503 	efiobj = efi_search_obj(image_handle);
504 	if (efiobj)
505 		list_del(&efiobj->link);
506 
507 	return EFI_EXIT(EFI_SUCCESS);
508 }
509 
510 static void efi_exit_caches(void)
511 {
512 #if defined(CONFIG_ARM) && !defined(CONFIG_ARM64)
513 	/*
514 	 * Grub on 32bit ARM needs to have caches disabled before jumping into
515 	 * a zImage, but does not know of all cache layers. Give it a hand.
516 	 */
517 	if (efi_is_direct_boot)
518 		cleanup_before_linux();
519 #endif
520 }
521 
522 static efi_status_t EFIAPI efi_exit_boot_services(void *image_handle,
523 						  unsigned long map_key)
524 {
525 	EFI_ENTRY("%p, %ld", image_handle, map_key);
526 
527 	/* Fix up caches for EFI payloads if necessary */
528 	efi_exit_caches();
529 
530 	/* This stops all lingering devices */
531 	bootm_disable_interrupts();
532 
533 	/* Give the payload some time to boot */
534 	WATCHDOG_RESET();
535 
536 	return EFI_EXIT(EFI_SUCCESS);
537 }
538 
539 static efi_status_t EFIAPI efi_get_next_monotonic_count(uint64_t *count)
540 {
541 	static uint64_t mono = 0;
542 	EFI_ENTRY("%p", count);
543 	*count = mono++;
544 	return EFI_EXIT(EFI_SUCCESS);
545 }
546 
547 static efi_status_t EFIAPI efi_stall(unsigned long microseconds)
548 {
549 	EFI_ENTRY("%ld", microseconds);
550 	udelay(microseconds);
551 	return EFI_EXIT(EFI_SUCCESS);
552 }
553 
554 static efi_status_t EFIAPI efi_set_watchdog_timer(unsigned long timeout,
555 						  uint64_t watchdog_code,
556 						  unsigned long data_size,
557 						  uint16_t *watchdog_data)
558 {
559 	EFI_ENTRY("%ld, 0x%"PRIx64", %ld, %p", timeout, watchdog_code,
560 		  data_size, watchdog_data);
561 	return EFI_EXIT(efi_unsupported(__func__));
562 }
563 
564 static efi_status_t EFIAPI efi_connect_controller(
565 			efi_handle_t controller_handle,
566 			efi_handle_t *driver_image_handle,
567 			struct efi_device_path *remain_device_path,
568 			bool recursive)
569 {
570 	EFI_ENTRY("%p, %p, %p, %d", controller_handle, driver_image_handle,
571 		  remain_device_path, recursive);
572 	return EFI_EXIT(EFI_NOT_FOUND);
573 }
574 
575 static efi_status_t EFIAPI efi_disconnect_controller(void *controller_handle,
576 						     void *driver_image_handle,
577 						     void *child_handle)
578 {
579 	EFI_ENTRY("%p, %p, %p", controller_handle, driver_image_handle,
580 		  child_handle);
581 	return EFI_EXIT(EFI_INVALID_PARAMETER);
582 }
583 
584 static efi_status_t EFIAPI efi_close_protocol(void *handle,
585 					      efi_guid_t *protocol,
586 					      void *agent_handle,
587 					      void *controller_handle)
588 {
589 	EFI_ENTRY("%p, %p, %p, %p", handle, protocol, agent_handle,
590 		  controller_handle);
591 	return EFI_EXIT(EFI_NOT_FOUND);
592 }
593 
594 static efi_status_t EFIAPI efi_open_protocol_information(efi_handle_t handle,
595 			efi_guid_t *protocol,
596 			struct efi_open_protocol_info_entry **entry_buffer,
597 			unsigned long *entry_count)
598 {
599 	EFI_ENTRY("%p, %p, %p, %p", handle, protocol, entry_buffer,
600 		  entry_count);
601 	return EFI_EXIT(EFI_NOT_FOUND);
602 }
603 
604 static efi_status_t EFIAPI efi_protocols_per_handle(void *handle,
605 			efi_guid_t ***protocol_buffer,
606 			unsigned long *protocol_buffer_count)
607 {
608 	EFI_ENTRY("%p, %p, %p", handle, protocol_buffer,
609 		  protocol_buffer_count);
610 	return EFI_EXIT(EFI_OUT_OF_RESOURCES);
611 }
612 
613 static efi_status_t EFIAPI efi_locate_handle_buffer(
614 			enum efi_locate_search_type search_type,
615 			efi_guid_t *protocol, void *search_key,
616 			unsigned long *no_handles, efi_handle_t **buffer)
617 {
618 	EFI_ENTRY("%d, %p, %p, %p, %p", search_type, protocol, search_key,
619 		  no_handles, buffer);
620 	return EFI_EXIT(EFI_NOT_FOUND);
621 }
622 
623 static struct efi_class_map efi_class_maps[] = {
624 	{
625 		.guid = &efi_guid_console_control,
626 		.interface = &efi_console_control
627 	},
628 };
629 
630 static efi_status_t EFIAPI efi_locate_protocol(efi_guid_t *protocol,
631 					       void *registration,
632 					       void **protocol_interface)
633 {
634 	int i;
635 
636 	EFI_ENTRY("%p, %p, %p", protocol, registration, protocol_interface);
637 	for (i = 0; i < ARRAY_SIZE(efi_class_maps); i++) {
638 		struct efi_class_map *curmap = &efi_class_maps[i];
639 		if (!guidcmp(protocol, curmap->guid)) {
640 			*protocol_interface = (void*)curmap->interface;
641 			return EFI_EXIT(EFI_SUCCESS);
642 		}
643 	}
644 
645 	return EFI_EXIT(EFI_NOT_FOUND);
646 }
647 
648 static efi_status_t EFIAPI efi_install_multiple_protocol_interfaces(
649 			void **handle, ...)
650 {
651 	EFI_ENTRY("%p", handle);
652 	return EFI_EXIT(EFI_OUT_OF_RESOURCES);
653 }
654 
655 static efi_status_t EFIAPI efi_uninstall_multiple_protocol_interfaces(
656 			void *handle, ...)
657 {
658 	EFI_ENTRY("%p", handle);
659 	return EFI_EXIT(EFI_INVALID_PARAMETER);
660 }
661 
662 static efi_status_t EFIAPI efi_calculate_crc32(void *data,
663 					       unsigned long data_size,
664 					       uint32_t *crc32_p)
665 {
666 	EFI_ENTRY("%p, %ld", data, data_size);
667 	*crc32_p = crc32(0, data, data_size);
668 	return EFI_EXIT(EFI_SUCCESS);
669 }
670 
671 static void EFIAPI efi_copy_mem(void *destination, void *source,
672 				unsigned long length)
673 {
674 	EFI_ENTRY("%p, %p, %ld", destination, source, length);
675 	memcpy(destination, source, length);
676 }
677 
678 static void EFIAPI efi_set_mem(void *buffer, unsigned long size, uint8_t value)
679 {
680 	EFI_ENTRY("%p, %ld, 0x%x", buffer, size, value);
681 	memset(buffer, value, size);
682 }
683 
684 static efi_status_t EFIAPI efi_open_protocol(
685 			void *handle, efi_guid_t *protocol,
686 			void **protocol_interface, void *agent_handle,
687 			void *controller_handle, uint32_t attributes)
688 {
689 	struct list_head *lhandle;
690 	int i;
691 	efi_status_t r = EFI_UNSUPPORTED;
692 
693 	EFI_ENTRY("%p, %p, %p, %p, %p, 0x%x", handle, protocol,
694 		  protocol_interface, agent_handle, controller_handle,
695 		  attributes);
696 	list_for_each(lhandle, &efi_obj_list) {
697 		struct efi_object *efiobj;
698 		efiobj = list_entry(lhandle, struct efi_object, link);
699 
700 		if (efiobj->handle != handle)
701 			continue;
702 
703 		for (i = 0; i < ARRAY_SIZE(efiobj->protocols); i++) {
704 			struct efi_handler *handler = &efiobj->protocols[i];
705 			const efi_guid_t *hprotocol = handler->guid;
706 			if (!hprotocol)
707 				break;
708 			if (!guidcmp(hprotocol, protocol)) {
709 				r = handler->open(handle, protocol,
710 				    protocol_interface, agent_handle,
711 				    controller_handle, attributes);
712 				goto out;
713 			}
714 		}
715 	}
716 
717 out:
718 	return EFI_EXIT(r);
719 }
720 
721 static efi_status_t EFIAPI efi_handle_protocol(void *handle,
722 					       efi_guid_t *protocol,
723 					       void **protocol_interface)
724 {
725 	return efi_open_protocol(handle, protocol, protocol_interface,
726 				 NULL, NULL, 0);
727 }
728 
729 static const struct efi_boot_services efi_boot_services = {
730 	.hdr = {
731 		.headersize = sizeof(struct efi_table_hdr),
732 	},
733 	.raise_tpl = efi_raise_tpl,
734 	.restore_tpl = efi_restore_tpl,
735 	.allocate_pages = efi_allocate_pages_ext,
736 	.free_pages = efi_free_pages_ext,
737 	.get_memory_map = efi_get_memory_map_ext,
738 	.allocate_pool = efi_allocate_pool_ext,
739 	.free_pool = efi_free_pool_ext,
740 	.create_event = efi_create_event,
741 	.set_timer = efi_set_timer,
742 	.wait_for_event = efi_wait_for_event,
743 	.signal_event = efi_signal_event,
744 	.close_event = efi_close_event,
745 	.check_event = efi_check_event,
746 	.install_protocol_interface = efi_install_protocol_interface,
747 	.reinstall_protocol_interface = efi_reinstall_protocol_interface,
748 	.uninstall_protocol_interface = efi_uninstall_protocol_interface,
749 	.handle_protocol = efi_handle_protocol,
750 	.reserved = NULL,
751 	.register_protocol_notify = efi_register_protocol_notify,
752 	.locate_handle = efi_locate_handle,
753 	.locate_device_path = efi_locate_device_path,
754 	.install_configuration_table = efi_install_configuration_table,
755 	.load_image = efi_load_image,
756 	.start_image = efi_start_image,
757 	.exit = efi_exit,
758 	.unload_image = efi_unload_image,
759 	.exit_boot_services = efi_exit_boot_services,
760 	.get_next_monotonic_count = efi_get_next_monotonic_count,
761 	.stall = efi_stall,
762 	.set_watchdog_timer = efi_set_watchdog_timer,
763 	.connect_controller = efi_connect_controller,
764 	.disconnect_controller = efi_disconnect_controller,
765 	.open_protocol = efi_open_protocol,
766 	.close_protocol = efi_close_protocol,
767 	.open_protocol_information = efi_open_protocol_information,
768 	.protocols_per_handle = efi_protocols_per_handle,
769 	.locate_handle_buffer = efi_locate_handle_buffer,
770 	.locate_protocol = efi_locate_protocol,
771 	.install_multiple_protocol_interfaces = efi_install_multiple_protocol_interfaces,
772 	.uninstall_multiple_protocol_interfaces = efi_uninstall_multiple_protocol_interfaces,
773 	.calculate_crc32 = efi_calculate_crc32,
774 	.copy_mem = efi_copy_mem,
775 	.set_mem = efi_set_mem,
776 };
777 
778 
779 static uint16_t EFI_RUNTIME_DATA firmware_vendor[] =
780 	{ 'D','a','s',' ','U','-','b','o','o','t',0 };
781 
782 struct efi_system_table EFI_RUNTIME_DATA systab = {
783 	.hdr = {
784 		.signature = EFI_SYSTEM_TABLE_SIGNATURE,
785 		.revision = 0x20005, /* 2.5 */
786 		.headersize = sizeof(struct efi_table_hdr),
787 	},
788 	.fw_vendor = (long)firmware_vendor,
789 	.con_in = (void*)&efi_con_in,
790 	.con_out = (void*)&efi_con_out,
791 	.std_err = (void*)&efi_con_out,
792 	.runtime = (void*)&efi_runtime_services,
793 	.boottime = (void*)&efi_boot_services,
794 	.nr_tables = 0,
795 	.tables = (void*)efi_conf_table,
796 };
797