// SPDX-License-Identifier: GPL-2.0+ /* * EFI application boot time services * * Copyright (c) 2016 Alexander Graf */ #include #include #include #include #include #include #include #include #include DECLARE_GLOBAL_DATA_PTR; /* Task priority level */ static efi_uintn_t efi_tpl = TPL_APPLICATION; /* This list contains all the EFI objects our payload has access to */ LIST_HEAD(efi_obj_list); /* List of all events */ LIST_HEAD(efi_events); #ifdef CONFIG_ARM /* * The "gd" pointer lives in a register on ARM and AArch64 that we declare * fixed when compiling U-Boot. However, the payload does not know about that * restriction so we need to manually swap its and our view of that register on * EFI callback entry/exit. */ static volatile void *efi_gd, *app_gd; #endif static int entry_count; static int nesting_level; /* GUID of the device tree table */ const efi_guid_t efi_guid_fdt = EFI_FDT_GUID; /* GUID of the EFI_DRIVER_BINDING_PROTOCOL */ const efi_guid_t efi_guid_driver_binding_protocol = EFI_DRIVER_BINDING_PROTOCOL_GUID; /* event group ExitBootServices() invoked */ const efi_guid_t efi_guid_event_group_exit_boot_services = EFI_EVENT_GROUP_EXIT_BOOT_SERVICES; /* event group SetVirtualAddressMap() invoked */ const efi_guid_t efi_guid_event_group_virtual_address_change = EFI_EVENT_GROUP_VIRTUAL_ADDRESS_CHANGE; /* event group memory map changed */ const efi_guid_t efi_guid_event_group_memory_map_change = EFI_EVENT_GROUP_MEMORY_MAP_CHANGE; /* event group boot manager about to boot */ const efi_guid_t efi_guid_event_group_ready_to_boot = EFI_EVENT_GROUP_READY_TO_BOOT; /* event group ResetSystem() invoked (before ExitBootServices) */ const efi_guid_t efi_guid_event_group_reset_system = EFI_EVENT_GROUP_RESET_SYSTEM; static efi_status_t EFIAPI efi_disconnect_controller( efi_handle_t controller_handle, efi_handle_t driver_image_handle, efi_handle_t child_handle); /* Called on every callback entry */ int __efi_entry_check(void) { int ret = entry_count++ == 0; #ifdef CONFIG_ARM assert(efi_gd); app_gd = gd; gd = efi_gd; #endif return ret; } /* Called on every callback exit */ int __efi_exit_check(void) { int ret = --entry_count == 0; #ifdef CONFIG_ARM gd = app_gd; #endif return ret; } /* Called from do_bootefi_exec() */ void efi_save_gd(void) { #ifdef CONFIG_ARM efi_gd = gd; #endif } /* * Special case handler for error/abort that just forces things back to u-boot * world so we can dump out an abort message, without any care about returning * back to UEFI world. */ void efi_restore_gd(void) { #ifdef CONFIG_ARM /* Only restore if we're already in EFI context */ if (!efi_gd) return; gd = efi_gd; #endif } /** * indent_string() - returns a string for indenting with two spaces per level * @level: indent level * * A maximum of ten indent levels is supported. Higher indent levels will be * truncated. * * Return: A string for indenting with two spaces per level is * returned. */ static const char *indent_string(int level) { const char *indent = " "; const int max = strlen(indent); level = min(max, level * 2); return &indent[max - level]; } const char *__efi_nesting(void) { return indent_string(nesting_level); } const char *__efi_nesting_inc(void) { return indent_string(nesting_level++); } const char *__efi_nesting_dec(void) { return indent_string(--nesting_level); } /** * efi_queue_event() - queue an EFI event * @event: event to signal * @check_tpl: check the TPL level * * This function queues the notification function of the event for future * execution. * * The notification function is called if the task priority level of the event * is higher than the current task priority level. * * For the SignalEvent service see efi_signal_event_ext. * */ static void efi_queue_event(struct efi_event *event, bool check_tpl) { if (event->notify_function) { event->is_queued = true; /* Check TPL */ if (check_tpl && efi_tpl >= event->notify_tpl) return; EFI_CALL_VOID(event->notify_function(event, event->notify_context)); } event->is_queued = false; } /** * is_valid_tpl() - check if the task priority level is valid * * @tpl: TPL level to check * Return: status code */ efi_status_t is_valid_tpl(efi_uintn_t tpl) { switch (tpl) { case TPL_APPLICATION: case TPL_CALLBACK: case TPL_NOTIFY: case TPL_HIGH_LEVEL: return EFI_SUCCESS; default: return EFI_INVALID_PARAMETER; } } /** * efi_signal_event() - signal an EFI event * @event: event to signal * @check_tpl: check the TPL level * * This function signals an event. If the event belongs to an event group all * events of the group are signaled. If they are of type EVT_NOTIFY_SIGNAL * their notification function is queued. * * For the SignalEvent service see efi_signal_event_ext. */ void efi_signal_event(struct efi_event *event, bool check_tpl) { if (event->group) { struct efi_event *evt; /* * The signaled state has to set before executing any * notification function */ list_for_each_entry(evt, &efi_events, link) { if (!evt->group || guidcmp(evt->group, event->group)) continue; if (evt->is_signaled) continue; evt->is_signaled = true; if (evt->type & EVT_NOTIFY_SIGNAL && evt->notify_function) evt->is_queued = true; } list_for_each_entry(evt, &efi_events, link) { if (!evt->group || guidcmp(evt->group, event->group)) continue; if (evt->is_queued) efi_queue_event(evt, check_tpl); } } else if (!event->is_signaled) { event->is_signaled = true; if (event->type & EVT_NOTIFY_SIGNAL) efi_queue_event(event, check_tpl); } } /** * efi_raise_tpl() - raise the task priority level * @new_tpl: new value of the task priority level * * This function implements the RaiseTpl service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: old value of the task priority level */ static unsigned long EFIAPI efi_raise_tpl(efi_uintn_t new_tpl) { efi_uintn_t old_tpl = efi_tpl; EFI_ENTRY("0x%zx", new_tpl); if (new_tpl < efi_tpl) debug("WARNING: new_tpl < current_tpl in %s\n", __func__); efi_tpl = new_tpl; if (efi_tpl > TPL_HIGH_LEVEL) efi_tpl = TPL_HIGH_LEVEL; EFI_EXIT(EFI_SUCCESS); return old_tpl; } /** * efi_restore_tpl() - lower the task priority level * @old_tpl: value of the task priority level to be restored * * This function implements the RestoreTpl service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. */ static void EFIAPI efi_restore_tpl(efi_uintn_t old_tpl) { EFI_ENTRY("0x%zx", old_tpl); if (old_tpl > efi_tpl) debug("WARNING: old_tpl > current_tpl in %s\n", __func__); efi_tpl = old_tpl; if (efi_tpl > TPL_HIGH_LEVEL) efi_tpl = TPL_HIGH_LEVEL; /* * Lowering the TPL may have made queued events eligible for execution. */ efi_timer_check(); EFI_EXIT(EFI_SUCCESS); } /** * efi_allocate_pages_ext() - allocate memory pages * @type: type of allocation to be performed * @memory_type: usage type of the allocated memory * @pages: number of pages to be allocated * @memory: allocated memory * * This function implements the AllocatePages service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_allocate_pages_ext(int type, int memory_type, efi_uintn_t pages, uint64_t *memory) { efi_status_t r; EFI_ENTRY("%d, %d, 0x%zx, %p", type, memory_type, pages, memory); r = efi_allocate_pages(type, memory_type, pages, memory); return EFI_EXIT(r); } /** * efi_free_pages_ext() - Free memory pages. * @memory: start of the memory area to be freed * @pages: number of pages to be freed * * This function implements the FreePages service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_free_pages_ext(uint64_t memory, efi_uintn_t pages) { efi_status_t r; EFI_ENTRY("%llx, 0x%zx", memory, pages); r = efi_free_pages(memory, pages); return EFI_EXIT(r); } /** * efi_get_memory_map_ext() - get map describing memory usage * @memory_map_size: on entry the size, in bytes, of the memory map buffer, * on exit the size of the copied memory map * @memory_map: buffer to which the memory map is written * @map_key: key for the memory map * @descriptor_size: size of an individual memory descriptor * @descriptor_version: version number of the memory descriptor structure * * This function implements the GetMemoryMap service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_get_memory_map_ext( efi_uintn_t *memory_map_size, struct efi_mem_desc *memory_map, efi_uintn_t *map_key, efi_uintn_t *descriptor_size, uint32_t *descriptor_version) { efi_status_t r; EFI_ENTRY("%p, %p, %p, %p, %p", memory_map_size, memory_map, map_key, descriptor_size, descriptor_version); r = efi_get_memory_map(memory_map_size, memory_map, map_key, descriptor_size, descriptor_version); return EFI_EXIT(r); } /** * efi_allocate_pool_ext() - allocate memory from pool * @pool_type: type of the pool from which memory is to be allocated * @size: number of bytes to be allocated * @buffer: allocated memory * * This function implements the AllocatePool service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_allocate_pool_ext(int pool_type, efi_uintn_t size, void **buffer) { efi_status_t r; EFI_ENTRY("%d, %zd, %p", pool_type, size, buffer); r = efi_allocate_pool(pool_type, size, buffer); return EFI_EXIT(r); } /** * efi_free_pool_ext() - free memory from pool * @buffer: start of memory to be freed * * This function implements the FreePool service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_free_pool_ext(void *buffer) { efi_status_t r; EFI_ENTRY("%p", buffer); r = efi_free_pool(buffer); return EFI_EXIT(r); } /** * efi_add_handle() - add a new object to the object list * @obj: object to be added * * The protocols list is initialized. The object handle is set. */ void efi_add_handle(struct efi_object *obj) { if (!obj) return; INIT_LIST_HEAD(&obj->protocols); obj->handle = obj; list_add_tail(&obj->link, &efi_obj_list); } /** * efi_create_handle() - create handle * @handle: new handle * * Return: status code */ efi_status_t efi_create_handle(efi_handle_t *handle) { struct efi_object *obj; obj = calloc(1, sizeof(struct efi_object)); if (!obj) return EFI_OUT_OF_RESOURCES; efi_add_handle(obj); *handle = obj->handle; return EFI_SUCCESS; } /** * efi_search_protocol() - find a protocol on a handle. * @handle: handle * @protocol_guid: GUID of the protocol * @handler: reference to the protocol * * Return: status code */ efi_status_t efi_search_protocol(const efi_handle_t handle, const efi_guid_t *protocol_guid, struct efi_handler **handler) { struct efi_object *efiobj; struct list_head *lhandle; if (!handle || !protocol_guid) return EFI_INVALID_PARAMETER; efiobj = efi_search_obj(handle); if (!efiobj) return EFI_INVALID_PARAMETER; list_for_each(lhandle, &efiobj->protocols) { struct efi_handler *protocol; protocol = list_entry(lhandle, struct efi_handler, link); if (!guidcmp(protocol->guid, protocol_guid)) { if (handler) *handler = protocol; return EFI_SUCCESS; } } return EFI_NOT_FOUND; } /** * efi_remove_protocol() - delete protocol from a handle * @handle: handle from which the protocol shall be deleted * @protocol: GUID of the protocol to be deleted * @protocol_interface: interface of the protocol implementation * * Return: status code */ efi_status_t efi_remove_protocol(const efi_handle_t handle, const efi_guid_t *protocol, void *protocol_interface) { struct efi_handler *handler; efi_status_t ret; ret = efi_search_protocol(handle, protocol, &handler); if (ret != EFI_SUCCESS) return ret; if (guidcmp(handler->guid, protocol)) return EFI_INVALID_PARAMETER; if (handler->protocol_interface != protocol_interface) return EFI_INVALID_PARAMETER; list_del(&handler->link); free(handler); return EFI_SUCCESS; } /** * efi_remove_all_protocols() - delete all protocols from a handle * @handle: handle from which the protocols shall be deleted * * Return: status code */ efi_status_t efi_remove_all_protocols(const efi_handle_t handle) { struct efi_object *efiobj; struct efi_handler *protocol; struct efi_handler *pos; efiobj = efi_search_obj(handle); if (!efiobj) return EFI_INVALID_PARAMETER; list_for_each_entry_safe(protocol, pos, &efiobj->protocols, link) { efi_status_t ret; ret = efi_remove_protocol(handle, protocol->guid, protocol->protocol_interface); if (ret != EFI_SUCCESS) return ret; } return EFI_SUCCESS; } /** * efi_delete_handle() - delete handle * * @obj: handle to delete */ void efi_delete_handle(struct efi_object *obj) { if (!obj) return; efi_remove_all_protocols(obj->handle); list_del(&obj->link); free(obj); } /** * efi_is_event() - check if a pointer is a valid event * @event: pointer to check * * Return: status code */ static efi_status_t efi_is_event(const struct efi_event *event) { const struct efi_event *evt; if (!event) return EFI_INVALID_PARAMETER; list_for_each_entry(evt, &efi_events, link) { if (evt == event) return EFI_SUCCESS; } return EFI_INVALID_PARAMETER; } /** * efi_create_event() - create an event * @type: type of the event to create * @notify_tpl: task priority level of the event * @notify_function: notification function of the event * @notify_context: pointer passed to the notification function * @group: event group * @event: created event * * This function is used inside U-Boot code to create an event. * * For the API function implementing the CreateEvent service see * efi_create_event_ext. * * Return: status code */ efi_status_t efi_create_event(uint32_t type, efi_uintn_t notify_tpl, void (EFIAPI *notify_function) ( struct efi_event *event, void *context), void *notify_context, efi_guid_t *group, struct efi_event **event) { struct efi_event *evt; if (event == NULL) return EFI_INVALID_PARAMETER; switch (type) { case 0: case EVT_TIMER: case EVT_NOTIFY_SIGNAL: case EVT_TIMER | EVT_NOTIFY_SIGNAL: case EVT_NOTIFY_WAIT: case EVT_TIMER | EVT_NOTIFY_WAIT: case EVT_SIGNAL_EXIT_BOOT_SERVICES: case EVT_SIGNAL_VIRTUAL_ADDRESS_CHANGE: break; default: return EFI_INVALID_PARAMETER; } if ((type & (EVT_NOTIFY_WAIT | EVT_NOTIFY_SIGNAL)) && (is_valid_tpl(notify_tpl) != EFI_SUCCESS)) return EFI_INVALID_PARAMETER; evt = calloc(1, sizeof(struct efi_event)); if (!evt) return EFI_OUT_OF_RESOURCES; evt->type = type; evt->notify_tpl = notify_tpl; evt->notify_function = notify_function; evt->notify_context = notify_context; evt->group = group; /* Disable timers on boot up */ evt->trigger_next = -1ULL; evt->is_queued = false; evt->is_signaled = false; list_add_tail(&evt->link, &efi_events); *event = evt; return EFI_SUCCESS; } /* * efi_create_event_ex() - create an event in a group * @type: type of the event to create * @notify_tpl: task priority level of the event * @notify_function: notification function of the event * @notify_context: pointer passed to the notification function * @event: created event * @event_group: event group * * This function implements the CreateEventEx service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ efi_status_t EFIAPI efi_create_event_ex(uint32_t type, efi_uintn_t notify_tpl, void (EFIAPI *notify_function) ( struct efi_event *event, void *context), void *notify_context, efi_guid_t *event_group, struct efi_event **event) { EFI_ENTRY("%d, 0x%zx, %p, %p, %pUl", type, notify_tpl, notify_function, notify_context, event_group); return EFI_EXIT(efi_create_event(type, notify_tpl, notify_function, notify_context, event_group, event)); } /** * efi_create_event_ext() - create an event * @type: type of the event to create * @notify_tpl: task priority level of the event * @notify_function: notification function of the event * @notify_context: pointer passed to the notification function * @event: created event * * This function implements the CreateEvent service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_create_event_ext( uint32_t type, efi_uintn_t notify_tpl, void (EFIAPI *notify_function) ( struct efi_event *event, void *context), void *notify_context, struct efi_event **event) { EFI_ENTRY("%d, 0x%zx, %p, %p", type, notify_tpl, notify_function, notify_context); return EFI_EXIT(efi_create_event(type, notify_tpl, notify_function, notify_context, NULL, event)); } /** * efi_timer_check() - check if a timer event has occurred * * Check if a timer event has occurred or a queued notification function should * be called. * * Our timers have to work without interrupts, so we check whenever keyboard * input or disk accesses happen if enough time elapsed for them to fire. */ void efi_timer_check(void) { struct efi_event *evt; u64 now = timer_get_us(); list_for_each_entry(evt, &efi_events, link) { if (evt->is_queued) efi_queue_event(evt, true); if (!(evt->type & EVT_TIMER) || now < evt->trigger_next) continue; switch (evt->trigger_type) { case EFI_TIMER_RELATIVE: evt->trigger_type = EFI_TIMER_STOP; break; case EFI_TIMER_PERIODIC: evt->trigger_next += evt->trigger_time; break; default: continue; } evt->is_signaled = false; efi_signal_event(evt, true); } WATCHDOG_RESET(); } /** * efi_set_timer() - set the trigger time for a timer event or stop the event * @event: event for which the timer is set * @type: type of the timer * @trigger_time: trigger period in multiples of 100 ns * * This is the function for internal usage in U-Boot. For the API function * implementing the SetTimer service see efi_set_timer_ext. * * Return: status code */ efi_status_t efi_set_timer(struct efi_event *event, enum efi_timer_delay type, uint64_t trigger_time) { /* Check that the event is valid */ if (efi_is_event(event) != EFI_SUCCESS || !(event->type & EVT_TIMER)) return EFI_INVALID_PARAMETER; /* * The parameter defines a multiple of 100 ns. * We use multiples of 1000 ns. So divide by 10. */ do_div(trigger_time, 10); switch (type) { case EFI_TIMER_STOP: event->trigger_next = -1ULL; break; case EFI_TIMER_PERIODIC: case EFI_TIMER_RELATIVE: event->trigger_next = timer_get_us() + trigger_time; break; default: return EFI_INVALID_PARAMETER; } event->trigger_type = type; event->trigger_time = trigger_time; event->is_signaled = false; return EFI_SUCCESS; } /** * efi_set_timer_ext() - Set the trigger time for a timer event or stop the * event * @event: event for which the timer is set * @type: type of the timer * @trigger_time: trigger period in multiples of 100 ns * * This function implements the SetTimer service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * * Return: status code */ static efi_status_t EFIAPI efi_set_timer_ext(struct efi_event *event, enum efi_timer_delay type, uint64_t trigger_time) { EFI_ENTRY("%p, %d, %llx", event, type, trigger_time); return EFI_EXIT(efi_set_timer(event, type, trigger_time)); } /** * efi_wait_for_event() - wait for events to be signaled * @num_events: number of events to be waited for * @event: events to be waited for * @index: index of the event that was signaled * * This function implements the WaitForEvent service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_wait_for_event(efi_uintn_t num_events, struct efi_event **event, efi_uintn_t *index) { int i; EFI_ENTRY("%zd, %p, %p", num_events, event, index); /* Check parameters */ if (!num_events || !event) return EFI_EXIT(EFI_INVALID_PARAMETER); /* Check TPL */ if (efi_tpl != TPL_APPLICATION) return EFI_EXIT(EFI_UNSUPPORTED); for (i = 0; i < num_events; ++i) { if (efi_is_event(event[i]) != EFI_SUCCESS) return EFI_EXIT(EFI_INVALID_PARAMETER); if (!event[i]->type || event[i]->type & EVT_NOTIFY_SIGNAL) return EFI_EXIT(EFI_INVALID_PARAMETER); if (!event[i]->is_signaled) efi_queue_event(event[i], true); } /* Wait for signal */ for (;;) { for (i = 0; i < num_events; ++i) { if (event[i]->is_signaled) goto out; } /* Allow events to occur. */ efi_timer_check(); } out: /* * Reset the signal which is passed to the caller to allow periodic * events to occur. */ event[i]->is_signaled = false; if (index) *index = i; return EFI_EXIT(EFI_SUCCESS); } /** * efi_signal_event_ext() - signal an EFI event * @event: event to signal * * This function implements the SignalEvent service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * This functions sets the signaled state of the event and queues the * notification function for execution. * * Return: status code */ static efi_status_t EFIAPI efi_signal_event_ext(struct efi_event *event) { EFI_ENTRY("%p", event); if (efi_is_event(event) != EFI_SUCCESS) return EFI_EXIT(EFI_INVALID_PARAMETER); efi_signal_event(event, true); return EFI_EXIT(EFI_SUCCESS); } /** * efi_close_event() - close an EFI event * @event: event to close * * This function implements the CloseEvent service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_close_event(struct efi_event *event) { EFI_ENTRY("%p", event); if (efi_is_event(event) != EFI_SUCCESS) return EFI_EXIT(EFI_INVALID_PARAMETER); list_del(&event->link); free(event); return EFI_EXIT(EFI_SUCCESS); } /** * efi_check_event() - check if an event is signaled * @event: event to check * * This function implements the CheckEvent service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * If an event is not signaled yet, the notification function is queued. The * signaled state is cleared. * * Return: status code */ static efi_status_t EFIAPI efi_check_event(struct efi_event *event) { EFI_ENTRY("%p", event); efi_timer_check(); if (efi_is_event(event) != EFI_SUCCESS || event->type & EVT_NOTIFY_SIGNAL) return EFI_EXIT(EFI_INVALID_PARAMETER); if (!event->is_signaled) efi_queue_event(event, true); if (event->is_signaled) { event->is_signaled = false; return EFI_EXIT(EFI_SUCCESS); } return EFI_EXIT(EFI_NOT_READY); } /** * efi_search_obj() - find the internal EFI object for a handle * @handle: handle to find * * Return: EFI object */ struct efi_object *efi_search_obj(const efi_handle_t handle) { struct efi_object *efiobj; list_for_each_entry(efiobj, &efi_obj_list, link) { if (efiobj->handle == handle) return efiobj; } return NULL; } /** * efi_open_protocol_info_entry() - create open protocol info entry and add it * to a protocol * @handler: handler of a protocol * * Return: open protocol info entry */ static struct efi_open_protocol_info_entry *efi_create_open_info( struct efi_handler *handler) { struct efi_open_protocol_info_item *item; item = calloc(1, sizeof(struct efi_open_protocol_info_item)); if (!item) return NULL; /* Append the item to the open protocol info list. */ list_add_tail(&item->link, &handler->open_infos); return &item->info; } /** * efi_delete_open_info() - remove an open protocol info entry from a protocol * @item: open protocol info entry to delete * * Return: status code */ static efi_status_t efi_delete_open_info( struct efi_open_protocol_info_item *item) { list_del(&item->link); free(item); return EFI_SUCCESS; } /** * efi_add_protocol() - install new protocol on a handle * @handle: handle on which the protocol shall be installed * @protocol: GUID of the protocol to be installed * @protocol_interface: interface of the protocol implementation * * Return: status code */ efi_status_t efi_add_protocol(const efi_handle_t handle, const efi_guid_t *protocol, void *protocol_interface) { struct efi_object *efiobj; struct efi_handler *handler; efi_status_t ret; efiobj = efi_search_obj(handle); if (!efiobj) return EFI_INVALID_PARAMETER; ret = efi_search_protocol(handle, protocol, NULL); if (ret != EFI_NOT_FOUND) return EFI_INVALID_PARAMETER; handler = calloc(1, sizeof(struct efi_handler)); if (!handler) return EFI_OUT_OF_RESOURCES; handler->guid = protocol; handler->protocol_interface = protocol_interface; INIT_LIST_HEAD(&handler->open_infos); list_add_tail(&handler->link, &efiobj->protocols); if (!guidcmp(&efi_guid_device_path, protocol)) EFI_PRINT("installed device path '%pD'\n", protocol_interface); return EFI_SUCCESS; } /** * efi_install_protocol_interface() - install protocol interface * @handle: handle on which the protocol shall be installed * @protocol: GUID of the protocol to be installed * @protocol_interface_type: type of the interface to be installed, * always EFI_NATIVE_INTERFACE * @protocol_interface: interface of the protocol implementation * * This function implements the InstallProtocolInterface service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_install_protocol_interface( void **handle, const efi_guid_t *protocol, int protocol_interface_type, void *protocol_interface) { efi_status_t r; EFI_ENTRY("%p, %pUl, %d, %p", handle, protocol, protocol_interface_type, protocol_interface); if (!handle || !protocol || protocol_interface_type != EFI_NATIVE_INTERFACE) { r = EFI_INVALID_PARAMETER; goto out; } /* Create new handle if requested. */ if (!*handle) { r = efi_create_handle(handle); if (r != EFI_SUCCESS) goto out; debug("%sEFI: new handle %p\n", indent_string(nesting_level), *handle); } else { debug("%sEFI: handle %p\n", indent_string(nesting_level), *handle); } /* Add new protocol */ r = efi_add_protocol(*handle, protocol, protocol_interface); out: return EFI_EXIT(r); } /** * efi_get_drivers() - get all drivers associated to a controller * @efiobj: handle of the controller * @protocol: protocol GUID (optional) * @number_of_drivers: number of child controllers * @driver_handle_buffer: handles of the the drivers * * The allocated buffer has to be freed with free(). * * Return: status code */ static efi_status_t efi_get_drivers(struct efi_object *efiobj, const efi_guid_t *protocol, efi_uintn_t *number_of_drivers, efi_handle_t **driver_handle_buffer) { struct efi_handler *handler; struct efi_open_protocol_info_item *item; efi_uintn_t count = 0, i; bool duplicate; /* Count all driver associations */ list_for_each_entry(handler, &efiobj->protocols, link) { if (protocol && guidcmp(handler->guid, protocol)) continue; list_for_each_entry(item, &handler->open_infos, link) { if (item->info.attributes & EFI_OPEN_PROTOCOL_BY_DRIVER) ++count; } } /* * Create buffer. In case of duplicate driver assignments the buffer * will be too large. But that does not harm. */ *number_of_drivers = 0; *driver_handle_buffer = calloc(count, sizeof(efi_handle_t)); if (!*driver_handle_buffer) return EFI_OUT_OF_RESOURCES; /* Collect unique driver handles */ list_for_each_entry(handler, &efiobj->protocols, link) { if (protocol && guidcmp(handler->guid, protocol)) continue; list_for_each_entry(item, &handler->open_infos, link) { if (item->info.attributes & EFI_OPEN_PROTOCOL_BY_DRIVER) { /* Check this is a new driver */ duplicate = false; for (i = 0; i < *number_of_drivers; ++i) { if ((*driver_handle_buffer)[i] == item->info.agent_handle) duplicate = true; } /* Copy handle to buffer */ if (!duplicate) { i = (*number_of_drivers)++; (*driver_handle_buffer)[i] = item->info.agent_handle; } } } } return EFI_SUCCESS; } /** * efi_disconnect_all_drivers() - disconnect all drivers from a controller * @efiobj: handle of the controller * @protocol: protocol GUID (optional) * @child_handle: handle of the child to destroy * * This function implements the DisconnectController service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t efi_disconnect_all_drivers( struct efi_object *efiobj, const efi_guid_t *protocol, efi_handle_t child_handle) { efi_uintn_t number_of_drivers; efi_handle_t *driver_handle_buffer; efi_status_t r, ret; ret = efi_get_drivers(efiobj, protocol, &number_of_drivers, &driver_handle_buffer); if (ret != EFI_SUCCESS) return ret; ret = EFI_NOT_FOUND; while (number_of_drivers) { r = EFI_CALL(efi_disconnect_controller( efiobj->handle, driver_handle_buffer[--number_of_drivers], child_handle)); if (r == EFI_SUCCESS) ret = r; } free(driver_handle_buffer); return ret; } /** * efi_uninstall_protocol_interface() - uninstall protocol interface * @handle: handle from which the protocol shall be removed * @protocol: GUID of the protocol to be removed * @protocol_interface: interface to be removed * * This function implements the UninstallProtocolInterface service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_uninstall_protocol_interface( efi_handle_t handle, const efi_guid_t *protocol, void *protocol_interface) { struct efi_object *efiobj; struct efi_handler *handler; struct efi_open_protocol_info_item *item; struct efi_open_protocol_info_item *pos; efi_status_t r; EFI_ENTRY("%p, %pUl, %p", handle, protocol, protocol_interface); /* Check handle */ efiobj = efi_search_obj(handle); if (!efiobj) { r = EFI_INVALID_PARAMETER; goto out; } /* Find the protocol on the handle */ r = efi_search_protocol(handle, protocol, &handler); if (r != EFI_SUCCESS) goto out; /* Disconnect controllers */ efi_disconnect_all_drivers(efiobj, protocol, NULL); if (!list_empty(&handler->open_infos)) { r = EFI_ACCESS_DENIED; goto out; } /* Close protocol */ list_for_each_entry_safe(item, pos, &handler->open_infos, link) { if (item->info.attributes == EFI_OPEN_PROTOCOL_BY_HANDLE_PROTOCOL || item->info.attributes == EFI_OPEN_PROTOCOL_GET_PROTOCOL || item->info.attributes == EFI_OPEN_PROTOCOL_TEST_PROTOCOL) list_del(&item->link); } if (!list_empty(&handler->open_infos)) { r = EFI_ACCESS_DENIED; goto out; } r = efi_remove_protocol(handle, protocol, protocol_interface); out: return EFI_EXIT(r); } /** * efi_register_protocol_notify() - register an event for notification when a * protocol is installed. * @protocol: GUID of the protocol whose installation shall be notified * @event: event to be signaled upon installation of the protocol * @registration: key for retrieving the registration information * * This function implements the RegisterProtocolNotify service. * See the Unified Extensible Firmware Interface (UEFI) specification * for details. * * Return: status code */ static efi_status_t EFIAPI efi_register_protocol_notify( const efi_guid_t *protocol, struct efi_event *event, void **registration) { EFI_ENTRY("%pUl, %p, %p", protocol, event, registration); return EFI_EXIT(EFI_OUT_OF_RESOURCES); } /** * efi_search() - determine if an EFI handle implements a protocol * @search_type: selection criterion * @protocol: GUID of the protocol * @search_key: registration key * @efiobj: handle * * See the documentation of the LocateHandle service in the UEFI specification. * * Return: 0 if the handle implements the protocol */ static int efi_search(enum efi_locate_search_type search_type, const efi_guid_t *protocol, void *search_key, struct efi_object *efiobj) { efi_status_t ret; switch (search_type) { case ALL_HANDLES: return 0; case BY_REGISTER_NOTIFY: /* TODO: RegisterProtocolNotify is not implemented yet */ return -1; case BY_PROTOCOL: ret = efi_search_protocol(efiobj->handle, protocol, NULL); return (ret != EFI_SUCCESS); default: /* Invalid search type */ return -1; } } /** * efi_locate_handle() - locate handles implementing a protocol * @search_type: selection criterion * @protocol: GUID of the protocol * @search_key: registration key * @buffer_size: size of the buffer to receive the handles in bytes * @buffer: buffer to receive the relevant handles * * This function is meant for U-Boot internal calls. For the API implementation * of the LocateHandle service see efi_locate_handle_ext. * * Return: status code */ static efi_status_t efi_locate_handle( enum efi_locate_search_type search_type, const efi_guid_t *protocol, void *search_key, efi_uintn_t *buffer_size, efi_handle_t *buffer) { struct efi_object *efiobj; efi_uintn_t size = 0; /* Check parameters */ switch (search_type) { case ALL_HANDLES: break; case BY_REGISTER_NOTIFY: if (!search_key) return EFI_INVALID_PARAMETER; /* RegisterProtocolNotify is not implemented yet */ return EFI_UNSUPPORTED; case BY_PROTOCOL: if (!protocol) return EFI_INVALID_PARAMETER; break; default: return EFI_INVALID_PARAMETER; } /* * efi_locate_handle_buffer uses this function for * the calculation of the necessary buffer size. * So do not require a buffer for buffersize == 0. */ if (!buffer_size || (*buffer_size && !buffer)) return EFI_INVALID_PARAMETER; /* Count how much space we need */ list_for_each_entry(efiobj, &efi_obj_list, link) { if (!efi_search(search_type, protocol, search_key, efiobj)) size += sizeof(void *); } if (*buffer_size < size) { *buffer_size = size; return EFI_BUFFER_TOO_SMALL; } *buffer_size = size; if (size == 0) return EFI_NOT_FOUND; /* Then fill the array */ list_for_each_entry(efiobj, &efi_obj_list, link) { if (!efi_search(search_type, protocol, search_key, efiobj)) *buffer++ = efiobj->handle; } return EFI_SUCCESS; } /** * efi_locate_handle_ext() - locate handles implementing a protocol. * @search_type: selection criterion * @protocol: GUID of the protocol * @search_key: registration key * @buffer_size: size of the buffer to receive the handles in bytes * @buffer: buffer to receive the relevant handles * * This function implements the LocateHandle service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: 0 if the handle implements the protocol */ static efi_status_t EFIAPI efi_locate_handle_ext( enum efi_locate_search_type search_type, const efi_guid_t *protocol, void *search_key, efi_uintn_t *buffer_size, efi_handle_t *buffer) { EFI_ENTRY("%d, %pUl, %p, %p, %p", search_type, protocol, search_key, buffer_size, buffer); return EFI_EXIT(efi_locate_handle(search_type, protocol, search_key, buffer_size, buffer)); } /** * efi_remove_configuration_table() - collapses configuration table entries, * removing index i * * @i: index of the table entry to be removed */ static void efi_remove_configuration_table(int i) { struct efi_configuration_table *this = &systab.tables[i]; struct efi_configuration_table *next = &systab.tables[i + 1]; struct efi_configuration_table *end = &systab.tables[systab.nr_tables]; memmove(this, next, (ulong)end - (ulong)next); systab.nr_tables--; } /** * efi_install_configuration_table() - adds, updates, or removes a * configuration table * @guid: GUID of the installed table * @table: table to be installed * * This function is used for internal calls. For the API implementation of the * InstallConfigurationTable service see efi_install_configuration_table_ext. * * Return: status code */ efi_status_t efi_install_configuration_table(const efi_guid_t *guid, void *table) { struct efi_event *evt; int i; if (!guid) return EFI_INVALID_PARAMETER; /* Check for GUID override */ for (i = 0; i < systab.nr_tables; i++) { if (!guidcmp(guid, &systab.tables[i].guid)) { if (table) systab.tables[i].table = table; else efi_remove_configuration_table(i); goto out; } } if (!table) return EFI_NOT_FOUND; /* No override, check for overflow */ if (i >= EFI_MAX_CONFIGURATION_TABLES) return EFI_OUT_OF_RESOURCES; /* Add a new entry */ memcpy(&systab.tables[i].guid, guid, sizeof(*guid)); systab.tables[i].table = table; systab.nr_tables = i + 1; out: /* systab.nr_tables may have changed. So we need to update the CRC32 */ efi_update_table_header_crc32(&systab.hdr); /* Notify that the configuration table was changed */ list_for_each_entry(evt, &efi_events, link) { if (evt->group && !guidcmp(evt->group, guid)) { efi_signal_event(evt, false); break; } } return EFI_SUCCESS; } /** * efi_install_configuration_table_ex() - Adds, updates, or removes a * configuration table. * @guid: GUID of the installed table * @table: table to be installed * * This function implements the InstallConfigurationTable service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_install_configuration_table_ext(efi_guid_t *guid, void *table) { EFI_ENTRY("%pUl, %p", guid, table); return EFI_EXIT(efi_install_configuration_table(guid, table)); } /** * efi_setup_loaded_image() - initialize a loaded image * @info: loaded image info to be passed to the entry point of the image * @obj: internal object associated with the loaded image * @device_path: device path of the loaded image * @file_path: file path of the loaded image * * Initialize a loaded_image_info and loaded_image_info object with correct * protocols, boot-device, etc. * * Return: status code */ efi_status_t efi_setup_loaded_image(struct efi_device_path *device_path, struct efi_device_path *file_path, struct efi_loaded_image_obj **handle_ptr, struct efi_loaded_image **info_ptr) { efi_status_t ret; struct efi_loaded_image *info; struct efi_loaded_image_obj *obj; info = calloc(1, sizeof(*info)); if (!info) return EFI_OUT_OF_RESOURCES; obj = calloc(1, sizeof(*obj)); if (!obj) { free(info); return EFI_OUT_OF_RESOURCES; } /* Add internal object to object list */ efi_add_handle(&obj->parent); if (info_ptr) *info_ptr = info; if (handle_ptr) *handle_ptr = obj; info->revision = EFI_LOADED_IMAGE_PROTOCOL_REVISION; info->file_path = file_path; info->system_table = &systab; if (device_path) { info->device_handle = efi_dp_find_obj(device_path, NULL); /* * When asking for the device path interface, return * bootefi_device_path */ ret = efi_add_protocol(obj->parent.handle, &efi_guid_device_path, device_path); if (ret != EFI_SUCCESS) goto failure; } /* * When asking for the loaded_image interface, just * return handle which points to loaded_image_info */ ret = efi_add_protocol(obj->parent.handle, &efi_guid_loaded_image, info); if (ret != EFI_SUCCESS) goto failure; return ret; failure: printf("ERROR: Failure to install protocols for loaded image\n"); return ret; } /** * efi_load_image_from_path() - load an image using a file path * @file_path: the path of the image to load * @buffer: buffer containing the loaded image * * Return: status code */ efi_status_t efi_load_image_from_path(struct efi_device_path *file_path, void **buffer) { struct efi_file_info *info = NULL; struct efi_file_handle *f; static efi_status_t ret; efi_uintn_t bs; f = efi_file_from_path(file_path); if (!f) return EFI_DEVICE_ERROR; bs = 0; EFI_CALL(ret = f->getinfo(f, (efi_guid_t *)&efi_file_info_guid, &bs, info)); if (ret == EFI_BUFFER_TOO_SMALL) { info = malloc(bs); EFI_CALL(ret = f->getinfo(f, (efi_guid_t *)&efi_file_info_guid, &bs, info)); } if (ret != EFI_SUCCESS) goto error; ret = efi_allocate_pool(EFI_LOADER_DATA, info->file_size, buffer); if (ret) goto error; bs = info->file_size; EFI_CALL(ret = f->read(f, &bs, *buffer)); error: free(info); EFI_CALL(f->close(f)); if (ret != EFI_SUCCESS) { efi_free_pool(*buffer); *buffer = NULL; } return ret; } /** * efi_load_image() - load an EFI image into memory * @boot_policy: true for request originating from the boot manager * @parent_image: the caller's image handle * @file_path: the path of the image to load * @source_buffer: memory location from which the image is installed * @source_size: size of the memory area from which the image is installed * @image_handle: handle for the newly installed image * * This function implements the LoadImage service. * * See the Unified Extensible Firmware Interface (UEFI) specification * for details. * * Return: status code */ static efi_status_t EFIAPI efi_load_image(bool boot_policy, efi_handle_t parent_image, struct efi_device_path *file_path, void *source_buffer, efi_uintn_t source_size, efi_handle_t *image_handle) { struct efi_loaded_image *info = NULL; struct efi_loaded_image_obj **image_obj = (struct efi_loaded_image_obj **)image_handle; efi_status_t ret; EFI_ENTRY("%d, %p, %pD, %p, %zd, %p", boot_policy, parent_image, file_path, source_buffer, source_size, image_handle); if (!image_handle || !parent_image) { ret = EFI_INVALID_PARAMETER; goto error; } if (!source_buffer && !file_path) { ret = EFI_NOT_FOUND; goto error; } if (!source_buffer) { struct efi_device_path *dp, *fp; ret = efi_load_image_from_path(file_path, &source_buffer); if (ret != EFI_SUCCESS) goto failure; /* * split file_path which contains both the device and * file parts: */ efi_dp_split_file_path(file_path, &dp, &fp); ret = efi_setup_loaded_image(dp, fp, image_obj, &info); if (ret != EFI_SUCCESS) goto failure; } else { /* In this case, file_path is the "device" path, i.e. * something like a HARDWARE_DEVICE:MEMORY_MAPPED */ ret = efi_setup_loaded_image(file_path, NULL, image_obj, &info); if (ret != EFI_SUCCESS) goto error; } (*image_obj)->entry = efi_load_pe(*image_obj, source_buffer, info); if (!(*image_obj)->entry) { ret = EFI_UNSUPPORTED; goto failure; } info->system_table = &systab; info->parent_handle = parent_image; return EFI_EXIT(EFI_SUCCESS); failure: efi_delete_handle(*image_handle); *image_handle = NULL; free(info); error: return EFI_EXIT(ret); } /** * efi_start_image() - call the entry point of an image * @image_handle: handle of the image * @exit_data_size: size of the buffer * @exit_data: buffer to receive the exit data of the called image * * This function implements the StartImage service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_start_image(efi_handle_t image_handle, unsigned long *exit_data_size, s16 **exit_data) { struct efi_loaded_image_obj *image_obj = (struct efi_loaded_image_obj *)image_handle; efi_status_t ret; EFI_ENTRY("%p, %p, %p", image_handle, exit_data_size, exit_data); /* call the image! */ if (setjmp(&image_obj->exit_jmp)) { /* * We called the entry point of the child image with EFI_CALL * in the lines below. The child image called the Exit() boot * service efi_exit() which executed the long jump that brought * us to the current line. This implies that the second half * of the EFI_CALL macro has not been executed. */ #ifdef CONFIG_ARM /* * efi_exit() called efi_restore_gd(). We have to undo this * otherwise __efi_entry_check() will put the wrong value into * app_gd. */ gd = app_gd; #endif /* * To get ready to call EFI_EXIT below we have to execute the * missed out steps of EFI_CALL. */ assert(__efi_entry_check()); debug("%sEFI: %lu returned by started image\n", __efi_nesting_dec(), (unsigned long)((uintptr_t)image_obj->exit_status & ~EFI_ERROR_MASK)); return EFI_EXIT(image_obj->exit_status); } ret = EFI_CALL(image_obj->entry(image_handle, &systab)); /* * Usually UEFI applications call Exit() instead of returning. * But because the world doesn't consist of ponies and unicorns, * we're happy to emulate that behavior on behalf of a payload * that forgot. */ return EFI_CALL(systab.boottime->exit(image_handle, ret, 0, NULL)); } /** * efi_exit() - leave an EFI application or driver * @image_handle: handle of the application or driver that is exiting * @exit_status: status code * @exit_data_size: size of the buffer in bytes * @exit_data: buffer with data describing an error * * This function implements the Exit service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_exit(efi_handle_t image_handle, efi_status_t exit_status, unsigned long exit_data_size, int16_t *exit_data) { /* * TODO: We should call the unload procedure of the loaded * image protocol. */ struct efi_loaded_image_obj *image_obj = (struct efi_loaded_image_obj *)image_handle; EFI_ENTRY("%p, %ld, %ld, %p", image_handle, exit_status, exit_data_size, exit_data); /* Make sure entry/exit counts for EFI world cross-overs match */ EFI_EXIT(exit_status); /* * But longjmp out with the U-Boot gd, not the application's, as * the other end is a setjmp call inside EFI context. */ efi_restore_gd(); image_obj->exit_status = exit_status; longjmp(&image_obj->exit_jmp, 1); panic("EFI application exited"); } /** * efi_unload_image() - unload an EFI image * @image_handle: handle of the image to be unloaded * * This function implements the UnloadImage service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_unload_image(efi_handle_t image_handle) { struct efi_object *efiobj; EFI_ENTRY("%p", image_handle); efiobj = efi_search_obj(image_handle); if (efiobj) list_del(&efiobj->link); return EFI_EXIT(EFI_SUCCESS); } /** * efi_exit_boot_services() - stop all boot services * @image_handle: handle of the loaded image * @map_key: key of the memory map * * This function implements the ExitBootServices service. * * See the Unified Extensible Firmware Interface (UEFI) specification * for details. * * All timer events are disabled. For exit boot services events the * notification function is called. The boot services are disabled in the * system table. * * Return: status code */ static efi_status_t EFIAPI efi_exit_boot_services(efi_handle_t image_handle, unsigned long map_key) { struct efi_event *evt; EFI_ENTRY("%p, %ld", image_handle, map_key); /* Check that the caller has read the current memory map */ if (map_key != efi_memory_map_key) return EFI_INVALID_PARAMETER; /* Make sure that notification functions are not called anymore */ efi_tpl = TPL_HIGH_LEVEL; /* Check if ExitBootServices has already been called */ if (!systab.boottime) return EFI_EXIT(EFI_SUCCESS); /* Add related events to the event group */ list_for_each_entry(evt, &efi_events, link) { if (evt->type == EVT_SIGNAL_EXIT_BOOT_SERVICES) evt->group = &efi_guid_event_group_exit_boot_services; } /* Notify that ExitBootServices is invoked. */ list_for_each_entry(evt, &efi_events, link) { if (evt->group && !guidcmp(evt->group, &efi_guid_event_group_exit_boot_services)) { efi_signal_event(evt, false); break; } } /* TODO: Should persist EFI variables here */ board_quiesce_devices(); /* This stops all lingering devices */ bootm_disable_interrupts(); /* Disable boot time services */ systab.con_in_handle = NULL; systab.con_in = NULL; systab.con_out_handle = NULL; systab.con_out = NULL; systab.stderr_handle = NULL; systab.std_err = NULL; systab.boottime = NULL; /* Recalculate CRC32 */ efi_update_table_header_crc32(&systab.hdr); /* Give the payload some time to boot */ efi_set_watchdog(0); WATCHDOG_RESET(); return EFI_EXIT(EFI_SUCCESS); } /** * efi_get_next_monotonic_count() - get next value of the counter * @count: returned value of the counter * * This function implements the NextMonotonicCount service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_get_next_monotonic_count(uint64_t *count) { static uint64_t mono; EFI_ENTRY("%p", count); *count = mono++; return EFI_EXIT(EFI_SUCCESS); } /** * efi_stall() - sleep * @microseconds: period to sleep in microseconds * * This function implements the Stall service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_stall(unsigned long microseconds) { EFI_ENTRY("%ld", microseconds); udelay(microseconds); return EFI_EXIT(EFI_SUCCESS); } /** * efi_set_watchdog_timer() - reset the watchdog timer * @timeout: seconds before reset by watchdog * @watchdog_code: code to be logged when resetting * @data_size: size of buffer in bytes * @watchdog_data: buffer with data describing the reset reason * * This function implements the SetWatchdogTimer service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_set_watchdog_timer(unsigned long timeout, uint64_t watchdog_code, unsigned long data_size, uint16_t *watchdog_data) { EFI_ENTRY("%ld, 0x%llx, %ld, %p", timeout, watchdog_code, data_size, watchdog_data); return EFI_EXIT(efi_set_watchdog(timeout)); } /** * efi_close_protocol() - close a protocol * @handle: handle on which the protocol shall be closed * @protocol: GUID of the protocol to close * @agent_handle: handle of the driver * @controller_handle: handle of the controller * * This function implements the CloseProtocol service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_close_protocol(efi_handle_t handle, const efi_guid_t *protocol, efi_handle_t agent_handle, efi_handle_t controller_handle) { struct efi_handler *handler; struct efi_open_protocol_info_item *item; struct efi_open_protocol_info_item *pos; efi_status_t r; EFI_ENTRY("%p, %pUl, %p, %p", handle, protocol, agent_handle, controller_handle); if (!agent_handle) { r = EFI_INVALID_PARAMETER; goto out; } r = efi_search_protocol(handle, protocol, &handler); if (r != EFI_SUCCESS) goto out; r = EFI_NOT_FOUND; list_for_each_entry_safe(item, pos, &handler->open_infos, link) { if (item->info.agent_handle == agent_handle && item->info.controller_handle == controller_handle) { efi_delete_open_info(item); r = EFI_SUCCESS; break; } } out: return EFI_EXIT(r); } /** * efi_open_protocol_information() - provide information about then open status * of a protocol on a handle * @handle: handle for which the information shall be retrieved * @protocol: GUID of the protocol * @entry_buffer: buffer to receive the open protocol information * @entry_count: number of entries available in the buffer * * This function implements the OpenProtocolInformation service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_open_protocol_information( efi_handle_t handle, const efi_guid_t *protocol, struct efi_open_protocol_info_entry **entry_buffer, efi_uintn_t *entry_count) { unsigned long buffer_size; unsigned long count; struct efi_handler *handler; struct efi_open_protocol_info_item *item; efi_status_t r; EFI_ENTRY("%p, %pUl, %p, %p", handle, protocol, entry_buffer, entry_count); /* Check parameters */ if (!entry_buffer) { r = EFI_INVALID_PARAMETER; goto out; } r = efi_search_protocol(handle, protocol, &handler); if (r != EFI_SUCCESS) goto out; /* Count entries */ count = 0; list_for_each_entry(item, &handler->open_infos, link) { if (item->info.open_count) ++count; } *entry_count = count; *entry_buffer = NULL; if (!count) { r = EFI_SUCCESS; goto out; } /* Copy entries */ buffer_size = count * sizeof(struct efi_open_protocol_info_entry); r = efi_allocate_pool(EFI_BOOT_SERVICES_DATA, buffer_size, (void **)entry_buffer); if (r != EFI_SUCCESS) goto out; list_for_each_entry_reverse(item, &handler->open_infos, link) { if (item->info.open_count) (*entry_buffer)[--count] = item->info; } out: return EFI_EXIT(r); } /** * efi_protocols_per_handle() - get protocols installed on a handle * @handle: handle for which the information is retrieved * @protocol_buffer: buffer with protocol GUIDs * @protocol_buffer_count: number of entries in the buffer * * This function implements the ProtocolsPerHandleService. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_protocols_per_handle( efi_handle_t handle, efi_guid_t ***protocol_buffer, efi_uintn_t *protocol_buffer_count) { unsigned long buffer_size; struct efi_object *efiobj; struct list_head *protocol_handle; efi_status_t r; EFI_ENTRY("%p, %p, %p", handle, protocol_buffer, protocol_buffer_count); if (!handle || !protocol_buffer || !protocol_buffer_count) return EFI_EXIT(EFI_INVALID_PARAMETER); *protocol_buffer = NULL; *protocol_buffer_count = 0; efiobj = efi_search_obj(handle); if (!efiobj) return EFI_EXIT(EFI_INVALID_PARAMETER); /* Count protocols */ list_for_each(protocol_handle, &efiobj->protocols) { ++*protocol_buffer_count; } /* Copy GUIDs */ if (*protocol_buffer_count) { size_t j = 0; buffer_size = sizeof(efi_guid_t *) * *protocol_buffer_count; r = efi_allocate_pool(EFI_BOOT_SERVICES_DATA, buffer_size, (void **)protocol_buffer); if (r != EFI_SUCCESS) return EFI_EXIT(r); list_for_each(protocol_handle, &efiobj->protocols) { struct efi_handler *protocol; protocol = list_entry(protocol_handle, struct efi_handler, link); (*protocol_buffer)[j] = (void *)protocol->guid; ++j; } } return EFI_EXIT(EFI_SUCCESS); } /** * efi_locate_handle_buffer() - locate handles implementing a protocol * @search_type: selection criterion * @protocol: GUID of the protocol * @search_key: registration key * @no_handles: number of returned handles * @buffer: buffer with the returned handles * * This function implements the LocateHandleBuffer service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_locate_handle_buffer( enum efi_locate_search_type search_type, const efi_guid_t *protocol, void *search_key, efi_uintn_t *no_handles, efi_handle_t **buffer) { efi_status_t r; efi_uintn_t buffer_size = 0; EFI_ENTRY("%d, %pUl, %p, %p, %p", search_type, protocol, search_key, no_handles, buffer); if (!no_handles || !buffer) { r = EFI_INVALID_PARAMETER; goto out; } *no_handles = 0; *buffer = NULL; r = efi_locate_handle(search_type, protocol, search_key, &buffer_size, *buffer); if (r != EFI_BUFFER_TOO_SMALL) goto out; r = efi_allocate_pool(EFI_BOOT_SERVICES_DATA, buffer_size, (void **)buffer); if (r != EFI_SUCCESS) goto out; r = efi_locate_handle(search_type, protocol, search_key, &buffer_size, *buffer); if (r == EFI_SUCCESS) *no_handles = buffer_size / sizeof(efi_handle_t); out: return EFI_EXIT(r); } /** * efi_locate_protocol() - find an interface implementing a protocol * @protocol: GUID of the protocol * @registration: registration key passed to the notification function * @protocol_interface: interface implementing the protocol * * This function implements the LocateProtocol service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_locate_protocol(const efi_guid_t *protocol, void *registration, void **protocol_interface) { struct list_head *lhandle; efi_status_t ret; EFI_ENTRY("%pUl, %p, %p", protocol, registration, protocol_interface); if (!protocol || !protocol_interface) return EFI_EXIT(EFI_INVALID_PARAMETER); list_for_each(lhandle, &efi_obj_list) { struct efi_object *efiobj; struct efi_handler *handler; efiobj = list_entry(lhandle, struct efi_object, link); ret = efi_search_protocol(efiobj->handle, protocol, &handler); if (ret == EFI_SUCCESS) { *protocol_interface = handler->protocol_interface; return EFI_EXIT(EFI_SUCCESS); } } *protocol_interface = NULL; return EFI_EXIT(EFI_NOT_FOUND); } /** * efi_locate_device_path() - Get the device path and handle of an device * implementing a protocol * @protocol: GUID of the protocol * @device_path: device path * @device: handle of the device * * This function implements the LocateDevicePath service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_locate_device_path( const efi_guid_t *protocol, struct efi_device_path **device_path, efi_handle_t *device) { struct efi_device_path *dp; size_t i; struct efi_handler *handler; efi_handle_t *handles; size_t len, len_dp; size_t len_best = 0; efi_uintn_t no_handles; u8 *remainder; efi_status_t ret; EFI_ENTRY("%pUl, %p, %p", protocol, device_path, device); if (!protocol || !device_path || !*device_path || !device) { ret = EFI_INVALID_PARAMETER; goto out; } /* Find end of device path */ len = efi_dp_instance_size(*device_path); /* Get all handles implementing the protocol */ ret = EFI_CALL(efi_locate_handle_buffer(BY_PROTOCOL, protocol, NULL, &no_handles, &handles)); if (ret != EFI_SUCCESS) goto out; for (i = 0; i < no_handles; ++i) { /* Find the device path protocol */ ret = efi_search_protocol(handles[i], &efi_guid_device_path, &handler); if (ret != EFI_SUCCESS) continue; dp = (struct efi_device_path *)handler->protocol_interface; len_dp = efi_dp_instance_size(dp); /* * This handle can only be a better fit * if its device path length is longer than the best fit and * if its device path length is shorter of equal the searched * device path. */ if (len_dp <= len_best || len_dp > len) continue; /* Check if dp is a subpath of device_path */ if (memcmp(*device_path, dp, len_dp)) continue; *device = handles[i]; len_best = len_dp; } if (len_best) { remainder = (u8 *)*device_path + len_best; *device_path = (struct efi_device_path *)remainder; ret = EFI_SUCCESS; } else { ret = EFI_NOT_FOUND; } out: return EFI_EXIT(ret); } /** * efi_install_multiple_protocol_interfaces() - Install multiple protocol * interfaces * @handle: handle on which the protocol interfaces shall be installed * @...: NULL terminated argument list with pairs of protocol GUIDS and * interfaces * * This function implements the MultipleProtocolInterfaces service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_install_multiple_protocol_interfaces( void **handle, ...) { EFI_ENTRY("%p", handle); efi_va_list argptr; const efi_guid_t *protocol; void *protocol_interface; efi_status_t r = EFI_SUCCESS; int i = 0; if (!handle) return EFI_EXIT(EFI_INVALID_PARAMETER); efi_va_start(argptr, handle); for (;;) { protocol = efi_va_arg(argptr, efi_guid_t*); if (!protocol) break; protocol_interface = efi_va_arg(argptr, void*); r = EFI_CALL(efi_install_protocol_interface( handle, protocol, EFI_NATIVE_INTERFACE, protocol_interface)); if (r != EFI_SUCCESS) break; i++; } efi_va_end(argptr); if (r == EFI_SUCCESS) return EFI_EXIT(r); /* If an error occurred undo all changes. */ efi_va_start(argptr, handle); for (; i; --i) { protocol = efi_va_arg(argptr, efi_guid_t*); protocol_interface = efi_va_arg(argptr, void*); EFI_CALL(efi_uninstall_protocol_interface(handle, protocol, protocol_interface)); } efi_va_end(argptr); return EFI_EXIT(r); } /** * efi_uninstall_multiple_protocol_interfaces() - uninstall multiple protocol * interfaces * @handle: handle from which the protocol interfaces shall be removed * @...: NULL terminated argument list with pairs of protocol GUIDS and * interfaces * * This function implements the UninstallMultipleProtocolInterfaces service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_uninstall_multiple_protocol_interfaces( void *handle, ...) { EFI_ENTRY("%p", handle); efi_va_list argptr; const efi_guid_t *protocol; void *protocol_interface; efi_status_t r = EFI_SUCCESS; size_t i = 0; if (!handle) return EFI_EXIT(EFI_INVALID_PARAMETER); efi_va_start(argptr, handle); for (;;) { protocol = efi_va_arg(argptr, efi_guid_t*); if (!protocol) break; protocol_interface = efi_va_arg(argptr, void*); r = EFI_CALL(efi_uninstall_protocol_interface( handle, protocol, protocol_interface)); if (r != EFI_SUCCESS) break; i++; } efi_va_end(argptr); if (r == EFI_SUCCESS) return EFI_EXIT(r); /* If an error occurred undo all changes. */ efi_va_start(argptr, handle); for (; i; --i) { protocol = efi_va_arg(argptr, efi_guid_t*); protocol_interface = efi_va_arg(argptr, void*); EFI_CALL(efi_install_protocol_interface(&handle, protocol, EFI_NATIVE_INTERFACE, protocol_interface)); } efi_va_end(argptr); return EFI_EXIT(r); } /** * efi_calculate_crc32() - calculate cyclic redundancy code * @data: buffer with data * @data_size: size of buffer in bytes * @crc32_p: cyclic redundancy code * * This function implements the CalculateCrc32 service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_calculate_crc32(const void *data, efi_uintn_t data_size, u32 *crc32_p) { EFI_ENTRY("%p, %zu", data, data_size); *crc32_p = crc32(0, data, data_size); return EFI_EXIT(EFI_SUCCESS); } /** * efi_copy_mem() - copy memory * @destination: destination of the copy operation * @source: source of the copy operation * @length: number of bytes to copy * * This function implements the CopyMem service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. */ static void EFIAPI efi_copy_mem(void *destination, const void *source, size_t length) { EFI_ENTRY("%p, %p, %ld", destination, source, (unsigned long)length); memcpy(destination, source, length); EFI_EXIT(EFI_SUCCESS); } /** * efi_set_mem() - Fill memory with a byte value. * @buffer: buffer to fill * @size: size of buffer in bytes * @value: byte to copy to the buffer * * This function implements the SetMem service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. */ static void EFIAPI efi_set_mem(void *buffer, size_t size, uint8_t value) { EFI_ENTRY("%p, %ld, 0x%x", buffer, (unsigned long)size, value); memset(buffer, value, size); EFI_EXIT(EFI_SUCCESS); } /** * efi_protocol_open() - open protocol interface on a handle * @handler: handler of a protocol * @protocol_interface: interface implementing the protocol * @agent_handle: handle of the driver * @controller_handle: handle of the controller * @attributes: attributes indicating how to open the protocol * * Return: status code */ static efi_status_t efi_protocol_open( struct efi_handler *handler, void **protocol_interface, void *agent_handle, void *controller_handle, uint32_t attributes) { struct efi_open_protocol_info_item *item; struct efi_open_protocol_info_entry *match = NULL; bool opened_by_driver = false; bool opened_exclusive = false; /* If there is no agent, only return the interface */ if (!agent_handle) goto out; /* For TEST_PROTOCOL ignore interface attribute */ if (attributes != EFI_OPEN_PROTOCOL_TEST_PROTOCOL) *protocol_interface = NULL; /* * Check if the protocol is already opened by a driver with the same * attributes or opened exclusively */ list_for_each_entry(item, &handler->open_infos, link) { if (item->info.agent_handle == agent_handle) { if ((attributes & EFI_OPEN_PROTOCOL_BY_DRIVER) && (item->info.attributes == attributes)) return EFI_ALREADY_STARTED; } if (item->info.attributes & EFI_OPEN_PROTOCOL_EXCLUSIVE) opened_exclusive = true; } /* Only one controller can open the protocol exclusively */ if (opened_exclusive && attributes & (EFI_OPEN_PROTOCOL_EXCLUSIVE | EFI_OPEN_PROTOCOL_BY_DRIVER)) return EFI_ACCESS_DENIED; /* Prepare exclusive opening */ if (attributes & EFI_OPEN_PROTOCOL_EXCLUSIVE) { /* Try to disconnect controllers */ list_for_each_entry(item, &handler->open_infos, link) { if (item->info.attributes == EFI_OPEN_PROTOCOL_BY_DRIVER) EFI_CALL(efi_disconnect_controller( item->info.controller_handle, item->info.agent_handle, NULL)); } opened_by_driver = false; /* Check if all controllers are disconnected */ list_for_each_entry(item, &handler->open_infos, link) { if (item->info.attributes & EFI_OPEN_PROTOCOL_BY_DRIVER) opened_by_driver = true; } /* Only one controller can be connected */ if (opened_by_driver) return EFI_ACCESS_DENIED; } /* Find existing entry */ list_for_each_entry(item, &handler->open_infos, link) { if (item->info.agent_handle == agent_handle && item->info.controller_handle == controller_handle) match = &item->info; } /* None found, create one */ if (!match) { match = efi_create_open_info(handler); if (!match) return EFI_OUT_OF_RESOURCES; } match->agent_handle = agent_handle; match->controller_handle = controller_handle; match->attributes = attributes; match->open_count++; out: /* For TEST_PROTOCOL ignore interface attribute. */ if (attributes != EFI_OPEN_PROTOCOL_TEST_PROTOCOL) *protocol_interface = handler->protocol_interface; return EFI_SUCCESS; } /** * efi_open_protocol() - open protocol interface on a handle * @handle: handle on which the protocol shall be opened * @protocol: GUID of the protocol * @protocol_interface: interface implementing the protocol * @agent_handle: handle of the driver * @controller_handle: handle of the controller * @attributes: attributes indicating how to open the protocol * * This function implements the OpenProtocol interface. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_open_protocol( void *handle, const efi_guid_t *protocol, void **protocol_interface, void *agent_handle, void *controller_handle, uint32_t attributes) { struct efi_handler *handler; efi_status_t r = EFI_INVALID_PARAMETER; EFI_ENTRY("%p, %pUl, %p, %p, %p, 0x%x", handle, protocol, protocol_interface, agent_handle, controller_handle, attributes); if (!handle || !protocol || (!protocol_interface && attributes != EFI_OPEN_PROTOCOL_TEST_PROTOCOL)) { goto out; } switch (attributes) { case EFI_OPEN_PROTOCOL_BY_HANDLE_PROTOCOL: case EFI_OPEN_PROTOCOL_GET_PROTOCOL: case EFI_OPEN_PROTOCOL_TEST_PROTOCOL: break; case EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER: if (controller_handle == handle) goto out; /* fall-through */ case EFI_OPEN_PROTOCOL_BY_DRIVER: case EFI_OPEN_PROTOCOL_BY_DRIVER | EFI_OPEN_PROTOCOL_EXCLUSIVE: /* Check that the controller handle is valid */ if (!efi_search_obj(controller_handle)) goto out; /* fall-through */ case EFI_OPEN_PROTOCOL_EXCLUSIVE: /* Check that the agent handle is valid */ if (!efi_search_obj(agent_handle)) goto out; break; default: goto out; } r = efi_search_protocol(handle, protocol, &handler); if (r != EFI_SUCCESS) goto out; r = efi_protocol_open(handler, protocol_interface, agent_handle, controller_handle, attributes); out: return EFI_EXIT(r); } /** * efi_handle_protocol() - get interface of a protocol on a handle * @handle: handle on which the protocol shall be opened * @protocol: GUID of the protocol * @protocol_interface: interface implementing the protocol * * This function implements the HandleProtocol service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_handle_protocol(efi_handle_t handle, const efi_guid_t *protocol, void **protocol_interface) { return efi_open_protocol(handle, protocol, protocol_interface, NULL, NULL, EFI_OPEN_PROTOCOL_BY_HANDLE_PROTOCOL); } /** * efi_bind_controller() - bind a single driver to a controller * @controller_handle: controller handle * @driver_image_handle: driver handle * @remain_device_path: remaining path * * Return: status code */ static efi_status_t efi_bind_controller( efi_handle_t controller_handle, efi_handle_t driver_image_handle, struct efi_device_path *remain_device_path) { struct efi_driver_binding_protocol *binding_protocol; efi_status_t r; r = EFI_CALL(efi_open_protocol(driver_image_handle, &efi_guid_driver_binding_protocol, (void **)&binding_protocol, driver_image_handle, NULL, EFI_OPEN_PROTOCOL_GET_PROTOCOL)); if (r != EFI_SUCCESS) return r; r = EFI_CALL(binding_protocol->supported(binding_protocol, controller_handle, remain_device_path)); if (r == EFI_SUCCESS) r = EFI_CALL(binding_protocol->start(binding_protocol, controller_handle, remain_device_path)); EFI_CALL(efi_close_protocol(driver_image_handle, &efi_guid_driver_binding_protocol, driver_image_handle, NULL)); return r; } /** * efi_connect_single_controller() - connect a single driver to a controller * @controller_handle: controller * @driver_image_handle: driver * @remain_device_path: remaining path * * Return: status code */ static efi_status_t efi_connect_single_controller( efi_handle_t controller_handle, efi_handle_t *driver_image_handle, struct efi_device_path *remain_device_path) { efi_handle_t *buffer; size_t count; size_t i; efi_status_t r; size_t connected = 0; /* Get buffer with all handles with driver binding protocol */ r = EFI_CALL(efi_locate_handle_buffer(BY_PROTOCOL, &efi_guid_driver_binding_protocol, NULL, &count, &buffer)); if (r != EFI_SUCCESS) return r; /* Context Override */ if (driver_image_handle) { for (; *driver_image_handle; ++driver_image_handle) { for (i = 0; i < count; ++i) { if (buffer[i] == *driver_image_handle) { buffer[i] = NULL; r = efi_bind_controller( controller_handle, *driver_image_handle, remain_device_path); /* * For drivers that do not support the * controller or are already connected * we receive an error code here. */ if (r == EFI_SUCCESS) ++connected; } } } } /* * TODO: Some overrides are not yet implemented: * - Platform Driver Override * - Driver Family Override Search * - Bus Specific Driver Override */ /* Driver Binding Search */ for (i = 0; i < count; ++i) { if (buffer[i]) { r = efi_bind_controller(controller_handle, buffer[i], remain_device_path); if (r == EFI_SUCCESS) ++connected; } } efi_free_pool(buffer); if (!connected) return EFI_NOT_FOUND; return EFI_SUCCESS; } /** * efi_connect_controller() - connect a controller to a driver * @controller_handle: handle of the controller * @driver_image_handle: handle of the driver * @remain_device_path: device path of a child controller * @recursive: true to connect all child controllers * * This function implements the ConnectController service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * First all driver binding protocol handles are tried for binding drivers. * Afterwards all handles that have opened a protocol of the controller * with EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER are connected to drivers. * * Return: status code */ static efi_status_t EFIAPI efi_connect_controller( efi_handle_t controller_handle, efi_handle_t *driver_image_handle, struct efi_device_path *remain_device_path, bool recursive) { efi_status_t r; efi_status_t ret = EFI_NOT_FOUND; struct efi_object *efiobj; EFI_ENTRY("%p, %p, %p, %d", controller_handle, driver_image_handle, remain_device_path, recursive); efiobj = efi_search_obj(controller_handle); if (!efiobj) { ret = EFI_INVALID_PARAMETER; goto out; } r = efi_connect_single_controller(controller_handle, driver_image_handle, remain_device_path); if (r == EFI_SUCCESS) ret = EFI_SUCCESS; if (recursive) { struct efi_handler *handler; struct efi_open_protocol_info_item *item; list_for_each_entry(handler, &efiobj->protocols, link) { list_for_each_entry(item, &handler->open_infos, link) { if (item->info.attributes & EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) { r = EFI_CALL(efi_connect_controller( item->info.controller_handle, driver_image_handle, remain_device_path, recursive)); if (r == EFI_SUCCESS) ret = EFI_SUCCESS; } } } } /* Check for child controller specified by end node */ if (ret != EFI_SUCCESS && remain_device_path && remain_device_path->type == DEVICE_PATH_TYPE_END) ret = EFI_SUCCESS; out: return EFI_EXIT(ret); } /** * efi_reinstall_protocol_interface() - reinstall protocol interface * @handle: handle on which the protocol shall be reinstalled * @protocol: GUID of the protocol to be installed * @old_interface: interface to be removed * @new_interface: interface to be installed * * This function implements the ReinstallProtocolInterface service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * The old interface is uninstalled. The new interface is installed. * Drivers are connected. * * Return: status code */ static efi_status_t EFIAPI efi_reinstall_protocol_interface( efi_handle_t handle, const efi_guid_t *protocol, void *old_interface, void *new_interface) { efi_status_t ret; EFI_ENTRY("%p, %pUl, %p, %p", handle, protocol, old_interface, new_interface); ret = EFI_CALL(efi_uninstall_protocol_interface(handle, protocol, old_interface)); if (ret != EFI_SUCCESS) goto out; ret = EFI_CALL(efi_install_protocol_interface(&handle, protocol, EFI_NATIVE_INTERFACE, new_interface)); if (ret != EFI_SUCCESS) goto out; /* * The returned status code has to be ignored. * Do not create an error if no suitable driver for the handle exists. */ EFI_CALL(efi_connect_controller(handle, NULL, NULL, true)); out: return EFI_EXIT(ret); } /** * efi_get_child_controllers() - get all child controllers associated to a driver * @efiobj: handle of the controller * @driver_handle: handle of the driver * @number_of_children: number of child controllers * @child_handle_buffer: handles of the the child controllers * * The allocated buffer has to be freed with free(). * * Return: status code */ static efi_status_t efi_get_child_controllers( struct efi_object *efiobj, efi_handle_t driver_handle, efi_uintn_t *number_of_children, efi_handle_t **child_handle_buffer) { struct efi_handler *handler; struct efi_open_protocol_info_item *item; efi_uintn_t count = 0, i; bool duplicate; /* Count all child controller associations */ list_for_each_entry(handler, &efiobj->protocols, link) { list_for_each_entry(item, &handler->open_infos, link) { if (item->info.agent_handle == driver_handle && item->info.attributes & EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) ++count; } } /* * Create buffer. In case of duplicate child controller assignments * the buffer will be too large. But that does not harm. */ *number_of_children = 0; *child_handle_buffer = calloc(count, sizeof(efi_handle_t)); if (!*child_handle_buffer) return EFI_OUT_OF_RESOURCES; /* Copy unique child handles */ list_for_each_entry(handler, &efiobj->protocols, link) { list_for_each_entry(item, &handler->open_infos, link) { if (item->info.agent_handle == driver_handle && item->info.attributes & EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) { /* Check this is a new child controller */ duplicate = false; for (i = 0; i < *number_of_children; ++i) { if ((*child_handle_buffer)[i] == item->info.controller_handle) duplicate = true; } /* Copy handle to buffer */ if (!duplicate) { i = (*number_of_children)++; (*child_handle_buffer)[i] = item->info.controller_handle; } } } } return EFI_SUCCESS; } /** * efi_disconnect_controller() - disconnect a controller from a driver * @controller_handle: handle of the controller * @driver_image_handle: handle of the driver * @child_handle: handle of the child to destroy * * This function implements the DisconnectController service. * * See the Unified Extensible Firmware Interface (UEFI) specification for * details. * * Return: status code */ static efi_status_t EFIAPI efi_disconnect_controller( efi_handle_t controller_handle, efi_handle_t driver_image_handle, efi_handle_t child_handle) { struct efi_driver_binding_protocol *binding_protocol; efi_handle_t *child_handle_buffer = NULL; size_t number_of_children = 0; efi_status_t r; size_t stop_count = 0; struct efi_object *efiobj; EFI_ENTRY("%p, %p, %p", controller_handle, driver_image_handle, child_handle); efiobj = efi_search_obj(controller_handle); if (!efiobj) { r = EFI_INVALID_PARAMETER; goto out; } if (child_handle && !efi_search_obj(child_handle)) { r = EFI_INVALID_PARAMETER; goto out; } /* If no driver handle is supplied, disconnect all drivers */ if (!driver_image_handle) { r = efi_disconnect_all_drivers(efiobj, NULL, child_handle); goto out; } /* Create list of child handles */ if (child_handle) { number_of_children = 1; child_handle_buffer = &child_handle; } else { efi_get_child_controllers(efiobj, driver_image_handle, &number_of_children, &child_handle_buffer); } /* Get the driver binding protocol */ r = EFI_CALL(efi_open_protocol(driver_image_handle, &efi_guid_driver_binding_protocol, (void **)&binding_protocol, driver_image_handle, NULL, EFI_OPEN_PROTOCOL_GET_PROTOCOL)); if (r != EFI_SUCCESS) goto out; /* Remove the children */ if (number_of_children) { r = EFI_CALL(binding_protocol->stop(binding_protocol, controller_handle, number_of_children, child_handle_buffer)); if (r == EFI_SUCCESS) ++stop_count; } /* Remove the driver */ if (!child_handle) r = EFI_CALL(binding_protocol->stop(binding_protocol, controller_handle, 0, NULL)); if (r == EFI_SUCCESS) ++stop_count; EFI_CALL(efi_close_protocol(driver_image_handle, &efi_guid_driver_binding_protocol, driver_image_handle, NULL)); if (stop_count) r = EFI_SUCCESS; else r = EFI_NOT_FOUND; out: if (!child_handle) free(child_handle_buffer); return EFI_EXIT(r); } static struct efi_boot_services efi_boot_services = { .hdr = { .signature = EFI_BOOT_SERVICES_SIGNATURE, .revision = EFI_SPECIFICATION_VERSION, .headersize = sizeof(struct efi_boot_services), }, .raise_tpl = efi_raise_tpl, .restore_tpl = efi_restore_tpl, .allocate_pages = efi_allocate_pages_ext, .free_pages = efi_free_pages_ext, .get_memory_map = efi_get_memory_map_ext, .allocate_pool = efi_allocate_pool_ext, .free_pool = efi_free_pool_ext, .create_event = efi_create_event_ext, .set_timer = efi_set_timer_ext, .wait_for_event = efi_wait_for_event, .signal_event = efi_signal_event_ext, .close_event = efi_close_event, .check_event = efi_check_event, .install_protocol_interface = efi_install_protocol_interface, .reinstall_protocol_interface = efi_reinstall_protocol_interface, .uninstall_protocol_interface = efi_uninstall_protocol_interface, .handle_protocol = efi_handle_protocol, .reserved = NULL, .register_protocol_notify = efi_register_protocol_notify, .locate_handle = efi_locate_handle_ext, .locate_device_path = efi_locate_device_path, .install_configuration_table = efi_install_configuration_table_ext, .load_image = efi_load_image, .start_image = efi_start_image, .exit = efi_exit, .unload_image = efi_unload_image, .exit_boot_services = efi_exit_boot_services, .get_next_monotonic_count = efi_get_next_monotonic_count, .stall = efi_stall, .set_watchdog_timer = efi_set_watchdog_timer, .connect_controller = efi_connect_controller, .disconnect_controller = efi_disconnect_controller, .open_protocol = efi_open_protocol, .close_protocol = efi_close_protocol, .open_protocol_information = efi_open_protocol_information, .protocols_per_handle = efi_protocols_per_handle, .locate_handle_buffer = efi_locate_handle_buffer, .locate_protocol = efi_locate_protocol, .install_multiple_protocol_interfaces = efi_install_multiple_protocol_interfaces, .uninstall_multiple_protocol_interfaces = efi_uninstall_multiple_protocol_interfaces, .calculate_crc32 = efi_calculate_crc32, .copy_mem = efi_copy_mem, .set_mem = efi_set_mem, .create_event_ex = efi_create_event_ex, }; static u16 __efi_runtime_data firmware_vendor[] = L"Das U-Boot"; struct efi_system_table __efi_runtime_data systab = { .hdr = { .signature = EFI_SYSTEM_TABLE_SIGNATURE, .revision = EFI_SPECIFICATION_VERSION, .headersize = sizeof(struct efi_system_table), }, .fw_vendor = firmware_vendor, .fw_revision = FW_VERSION << 16 | FW_PATCHLEVEL << 8, .con_in = (void *)&efi_con_in, .con_out = (void *)&efi_con_out, .std_err = (void *)&efi_con_out, .runtime = (void *)&efi_runtime_services, .boottime = (void *)&efi_boot_services, .nr_tables = 0, .tables = NULL, }; /** * efi_initialize_system_table() - Initialize system table * * Return: status code */ efi_status_t efi_initialize_system_table(void) { efi_status_t ret; /* Allocate configuration table array */ ret = efi_allocate_pool(EFI_RUNTIME_SERVICES_DATA, EFI_MAX_CONFIGURATION_TABLES * sizeof(struct efi_configuration_table), (void **)&systab.tables); /* Set CRC32 field in table headers */ efi_update_table_header_crc32(&systab.hdr); efi_update_table_header_crc32(&efi_runtime_services.hdr); efi_update_table_header_crc32(&efi_boot_services.hdr); return ret; }