123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620 |
- /*
- * Copyright (C) 2014 Michael Brown <mbrown@fensystems.co.uk>.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of the
- * License, or any later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
- * 02110-1301, USA.
- *
- * You can also choose to distribute this program under the terms of
- * the Unmodified Binary Distribution Licence (as given in the file
- * COPYING.UBDL), provided that you have satisfied its requirements.
- */
-
- FILE_LICENCE ( GPL2_OR_LATER_OR_UBDL );
-
- /**
- * @file
- *
- * EFI image wrapping
- *
- */
-
- #include <string.h>
- #include <stdio.h>
- #include <errno.h>
- #include <ipxe/efi/efi.h>
- #include <ipxe/efi/Protocol/LoadedImage.h>
- #include <ipxe/efi/efi_wrap.h>
-
- /** EFI system table wrapper */
- static EFI_SYSTEM_TABLE efi_systab_wrapper;
-
- /** EFI boot services table wrapper */
- static EFI_BOOT_SERVICES efi_bs_wrapper;
-
- /** Colour for debug messages */
- #define colour &efi_systab_wrapper
-
- /**
- * Convert EFI status code to text
- *
- * @v efirc EFI status code
- * @ret text EFI status code text
- */
- static const char * efi_status ( EFI_STATUS efirc ) {
- static char buf[ 19 /* "0xXXXXXXXXXXXXXXXX" + NUL */ ];
-
- switch ( efirc ) {
- case EFI_SUCCESS : return "0";
- case EFI_LOAD_ERROR : return "LOAD_ERROR";
- case EFI_INVALID_PARAMETER : return "INVALID_PARAMETER";
- case EFI_UNSUPPORTED : return "UNSUPPORTED";
- case EFI_BAD_BUFFER_SIZE : return "BAD_BUFFER_SIZE";
- case EFI_BUFFER_TOO_SMALL : return "BUFFER_TOO_SMALL";
- case EFI_NOT_READY : return "NOT_READY";
- case EFI_DEVICE_ERROR : return "DEVICE_ERROR";
- case EFI_WRITE_PROTECTED : return "WRITE_PROTECTED";
- case EFI_OUT_OF_RESOURCES : return "OUT_OF_RESOURCES";
- case EFI_VOLUME_CORRUPTED : return "VOLUME_CORRUPTED";
- case EFI_VOLUME_FULL : return "VOLUME_FULL";
- case EFI_NO_MEDIA : return "NO_MEDIA";
- case EFI_MEDIA_CHANGED : return "MEDIA_CHANGED";
- case EFI_NOT_FOUND : return "NOT_FOUND";
- case EFI_ACCESS_DENIED : return "ACCESS_DENIED";
- case EFI_NO_RESPONSE : return "NO_RESPONSE";
- case EFI_NO_MAPPING : return "NO_MAPPING";
- case EFI_TIMEOUT : return "TIMEOUT";
- case EFI_NOT_STARTED : return "NOT_STARTED";
- case EFI_ALREADY_STARTED : return "ALREADY_STARTED";
- case EFI_ABORTED : return "ABORTED";
- case EFI_ICMP_ERROR : return "ICMP_ERROR";
- case EFI_TFTP_ERROR : return "TFTP_ERROR";
- case EFI_PROTOCOL_ERROR : return "PROTOCOL_ERROR";
- case EFI_INCOMPATIBLE_VERSION : return "INCOMPATIBLE_VERSION";
- case EFI_SECURITY_VIOLATION : return "SECURITY_VIOLATION";
- case EFI_CRC_ERROR : return "CRC_ERROR";
- case EFI_END_OF_MEDIA : return "END_OF_MEDIA";
- case EFI_END_OF_FILE : return "END_OF_FILE";
- case EFI_INVALID_LANGUAGE : return "INVALID_LANGUAGE";
- case EFI_COMPROMISED_DATA : return "COMPROMISED_DATA";
- case EFI_WARN_UNKNOWN_GLYPH : return "WARN_UNKNOWN_GLYPH";
- case EFI_WARN_DELETE_FAILURE : return "WARN_DELETE_FAILURE";
- case EFI_WARN_WRITE_FAILURE : return "WARN_WRITE_FAILURE";
- case EFI_WARN_BUFFER_TOO_SMALL : return "WARN_BUFFER_TOO_SMALL";
- case EFI_WARN_STALE_DATA : return "WARN_STALE_DATA";
- default:
- snprintf ( buf, sizeof ( buf ), "%#lx",
- ( unsigned long ) efirc );
- return buf;
- }
- }
-
- /**
- * Convert EFI boolean to text
- *
- * @v boolean Boolean value
- * @ret text Boolean value text
- */
- static const char * efi_boolean ( BOOLEAN boolean ) {
-
- return ( boolean ? "TRUE" : "FALSE" );
- }
-
- /**
- * Wrap InstallProtocolInterface()
- *
- */
- static EFI_STATUS EFIAPI
- efi_install_protocol_interface_wrapper ( EFI_HANDLE *handle, EFI_GUID *protocol,
- EFI_INTERFACE_TYPE interface_type,
- VOID *interface ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "InstallProtocolInterface ( %s, %s, %d, %p ) ",
- efi_handle_name ( *handle ), efi_guid_ntoa ( protocol ),
- interface_type, interface );
- efirc = bs->InstallProtocolInterface ( handle, protocol, interface_type,
- interface );
- DBGC ( colour, "= %s ( %s ) -> %p\n",
- efi_status ( efirc ), efi_handle_name ( *handle ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap ReinstallProtocolInterface()
- *
- */
- static EFI_STATUS EFIAPI
- efi_reinstall_protocol_interface_wrapper ( EFI_HANDLE handle,
- EFI_GUID *protocol,
- VOID *old_interface,
- VOID *new_interface ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "ReinstallProtocolInterface ( %s, %s, %p, %p ) ",
- efi_handle_name ( handle ), efi_guid_ntoa ( protocol ),
- old_interface, new_interface );
- efirc = bs->ReinstallProtocolInterface ( handle, protocol,
- old_interface, new_interface );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap UninstallProtocolInterface()
- *
- */
- static EFI_STATUS EFIAPI
- efi_uninstall_protocol_interface_wrapper ( EFI_HANDLE handle,
- EFI_GUID *protocol,
- VOID *interface ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "UninstallProtocolInterface ( %s, %s, %p ) ",
- efi_handle_name ( handle ), efi_guid_ntoa ( protocol ),
- interface );
- efirc = bs->UninstallProtocolInterface ( handle, protocol, interface );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap HandleProtocol()
- *
- */
- static EFI_STATUS EFIAPI
- efi_handle_protocol_wrapper ( EFI_HANDLE handle, EFI_GUID *protocol,
- VOID **interface ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "HandleProtocol ( %s, %s ) ",
- efi_handle_name ( handle ), efi_guid_ntoa ( protocol ) );
- efirc = bs->HandleProtocol ( handle, protocol, interface );
- DBGC ( colour, "= %s ( %p ) -> %p\n",
- efi_status ( efirc ), *interface, retaddr );
- return efirc;
- }
-
- /**
- * Wrap LocateHandle()
- *
- */
- static EFI_STATUS EFIAPI
- efi_locate_handle_wrapper ( EFI_LOCATE_SEARCH_TYPE search_type,
- EFI_GUID *protocol, VOID *search_key,
- UINTN *buffer_size, EFI_HANDLE *buffer ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- unsigned int i;
- EFI_STATUS efirc;
-
- DBGC ( colour, "LocateHandle ( %s, %s, %p, %zd ) ",
- efi_locate_search_type_name ( search_type ),
- efi_guid_ntoa ( protocol ), search_key,
- ( ( size_t ) *buffer_size ) );
- efirc = bs->LocateHandle ( search_type, protocol, search_key,
- buffer_size, buffer );
- DBGC ( colour, "= %s ( %zd", efi_status ( efirc ),
- ( ( size_t ) *buffer_size ) );
- if ( efirc == 0 ) {
- DBGC ( colour, ", {" );
- for ( i = 0; i < ( *buffer_size / sizeof ( buffer[0] ) ); i++ ){
- DBGC ( colour, "%s%s", ( i ? ", " : " " ),
- efi_handle_name ( buffer[i] ) );
- }
- DBGC ( colour, " }" );
- }
- DBGC ( colour, " ) -> %p\n", retaddr );
- return efirc;
- }
-
- /**
- * Wrap LocateDevicePath()
- *
- */
- static EFI_STATUS EFIAPI
- efi_locate_device_path_wrapper ( EFI_GUID *protocol,
- EFI_DEVICE_PATH_PROTOCOL **device_path,
- EFI_HANDLE *device ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "LocateDevicePath ( %s, %s ) ",
- efi_guid_ntoa ( protocol ), efi_devpath_text ( *device_path ) );
- efirc = bs->LocateDevicePath ( protocol, device_path, device );
- DBGC ( colour, "= %s ( %s, ",
- efi_status ( efirc ), efi_devpath_text ( *device_path ) );
- DBGC ( colour, "%s ) -> %p\n", efi_handle_name ( *device ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap LoadImage()
- *
- */
- static EFI_STATUS EFIAPI
- efi_load_image_wrapper ( BOOLEAN boot_policy, EFI_HANDLE parent_image_handle,
- EFI_DEVICE_PATH_PROTOCOL *device_path,
- VOID *source_buffer, UINTN source_size,
- EFI_HANDLE *image_handle ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "LoadImage ( %s, %s, ", efi_boolean ( boot_policy ),
- efi_handle_name ( parent_image_handle ) );
- DBGC ( colour, "%s, %p, %#llx ) ",
- efi_devpath_text ( device_path ), source_buffer,
- ( ( unsigned long long ) source_size ) );
- efirc = bs->LoadImage ( boot_policy, parent_image_handle, device_path,
- source_buffer, source_size, image_handle );
- DBGC ( colour, "= %s ( ", efi_status ( efirc ) );
- if ( efirc == 0 )
- DBGC ( colour, "%s ", efi_handle_name ( *image_handle ) );
- DBGC ( colour, ") -> %p\n", retaddr );
-
- /* Wrap the new image */
- if ( efirc == 0 )
- efi_wrap ( *image_handle );
-
- return efirc;
- }
-
- /**
- * Wrap StartImage()
- *
- */
- static EFI_STATUS EFIAPI
- efi_start_image_wrapper ( EFI_HANDLE image_handle, UINTN *exit_data_size,
- CHAR16 **exit_data ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "StartImage ( %s ) ", efi_handle_name ( image_handle ) );
- efirc = bs->StartImage ( image_handle, exit_data_size, exit_data );
- DBGC ( colour, "= %s", efi_status ( efirc ) );
- if ( ( efirc != 0 ) && exit_data && *exit_data_size )
- DBGC ( colour, " ( \"%ls\" )", *exit_data );
- DBGC ( colour, " -> %p\n", retaddr );
- if ( ( efirc != 0 ) && exit_data && *exit_data_size )
- DBGC_HD ( colour, *exit_data, *exit_data_size );
- return efirc;
- }
-
- /**
- * Wrap Exit()
- *
- */
- static EFI_STATUS EFIAPI
- efi_exit_wrapper ( EFI_HANDLE image_handle, EFI_STATUS exit_status,
- UINTN exit_data_size, CHAR16 *exit_data ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- if ( ( exit_status != 0 ) && exit_data && exit_data_size )
- DBGC_HD ( colour, exit_data, exit_data_size );
- DBGC ( colour, "Exit ( %s, %s",
- efi_handle_name ( image_handle ), efi_status ( exit_status ) );
- if ( ( exit_status != 0 ) && exit_data && exit_data_size )
- DBGC ( colour, ", \"%ls\"", exit_data );
- DBGC ( colour, " ) " );
- efirc = bs->Exit ( image_handle, exit_status, exit_data_size,
- exit_data );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap UnloadImage()
- *
- */
- static EFI_STATUS EFIAPI
- efi_unload_image_wrapper ( EFI_HANDLE image_handle ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "UnloadImage ( %s ) ",
- efi_handle_name ( image_handle ) );
- efirc = bs->UnloadImage ( image_handle );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap ExitBootServices()
- *
- */
- static EFI_STATUS EFIAPI
- efi_exit_boot_services_wrapper ( EFI_HANDLE image_handle, UINTN map_key ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "ExitBootServices ( %s, %#llx ) ",
- efi_handle_name ( image_handle ),
- ( ( unsigned long long ) map_key ) );
- efirc = bs->ExitBootServices ( image_handle, map_key );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap ConnectController()
- *
- */
- static EFI_STATUS EFIAPI
- efi_connect_controller_wrapper ( EFI_HANDLE controller_handle,
- EFI_HANDLE *driver_image_handle,
- EFI_DEVICE_PATH_PROTOCOL *remaining_path,
- BOOLEAN recursive ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_HANDLE *tmp;
- EFI_STATUS efirc;
-
- DBGC ( colour, "ConnectController ( %s, {",
- efi_handle_name ( controller_handle ) );
- if ( driver_image_handle ) {
- for ( tmp = driver_image_handle ; *tmp ; tmp++ ) {
- DBGC ( colour, "%s%s",
- ( ( tmp == driver_image_handle ) ? " " : ", " ),
- efi_handle_name ( *tmp ) );
- }
- }
- DBGC ( colour, " }, %s, %s ) ", efi_devpath_text ( remaining_path ),
- efi_boolean ( recursive ) );
- efirc = bs->ConnectController ( controller_handle, driver_image_handle,
- remaining_path, recursive );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap DisconnectController()
- *
- */
- static EFI_STATUS EFIAPI
- efi_disconnect_controller_wrapper ( EFI_HANDLE controller_handle,
- EFI_HANDLE driver_image_handle,
- EFI_HANDLE child_handle ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "DisconnectController ( %s",
- efi_handle_name ( controller_handle ) );
- DBGC ( colour, ", %s", efi_handle_name ( driver_image_handle ) );
- DBGC ( colour, ", %s ) ", efi_handle_name ( child_handle ) );
- efirc = bs->DisconnectController ( controller_handle,
- driver_image_handle,
- child_handle );
- DBGC ( colour, "= %s -> %p\n", efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap OpenProtocol()
- *
- */
- static EFI_STATUS EFIAPI
- efi_open_protocol_wrapper ( EFI_HANDLE handle, EFI_GUID *protocol,
- VOID **interface, EFI_HANDLE agent_handle,
- EFI_HANDLE controller_handle, UINT32 attributes ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "OpenProtocol ( %s, %s, ",
- efi_handle_name ( handle ), efi_guid_ntoa ( protocol ) );
- DBGC ( colour, "%s, ", efi_handle_name ( agent_handle ) );
- DBGC ( colour, "%s, %s ) ", efi_handle_name ( controller_handle ),
- efi_open_attributes_name ( attributes ) );
- efirc = bs->OpenProtocol ( handle, protocol, interface, agent_handle,
- controller_handle, attributes );
- DBGC ( colour, "= %s ( %p ) -> %p\n",
- efi_status ( efirc ), *interface, retaddr );
- return efirc;
- }
-
- /**
- * Wrap CloseProtocol()
- *
- */
- static EFI_STATUS EFIAPI
- efi_close_protocol_wrapper ( EFI_HANDLE handle, EFI_GUID *protocol,
- EFI_HANDLE agent_handle,
- EFI_HANDLE controller_handle ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "CloseProtocol ( %s, %s, ",
- efi_handle_name ( handle ), efi_guid_ntoa ( protocol ) );
- DBGC ( colour, "%s, ", efi_handle_name ( agent_handle ) );
- DBGC ( colour, "%s ) ", efi_handle_name ( controller_handle ) );
- efirc = bs->CloseProtocol ( handle, protocol, agent_handle,
- controller_handle );
- DBGC ( colour, "= %s -> %p\n",
- efi_status ( efirc ), retaddr );
- return efirc;
- }
-
- /**
- * Wrap ProtocolsPerHandle()
- *
- */
- static EFI_STATUS EFIAPI
- efi_protocols_per_handle_wrapper ( EFI_HANDLE handle,
- EFI_GUID ***protocol_buffer,
- UINTN *protocol_buffer_count ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- unsigned int i;
- EFI_STATUS efirc;
-
- DBGC ( colour, "ProtocolsPerHandle ( %s ) ",
- efi_handle_name ( handle ) );
- efirc = bs->ProtocolsPerHandle ( handle, protocol_buffer,
- protocol_buffer_count );
- DBGC ( colour, "= %s", efi_status ( efirc ) );
- if ( efirc == 0 ) {
- DBGC ( colour, " ( {" );
- for ( i = 0 ; i < *protocol_buffer_count ; i++ ) {
- DBGC ( colour, "%s%s", ( i ? ", " : " " ),
- efi_guid_ntoa ( (*protocol_buffer)[i] ) );
- }
- DBGC ( colour, " } )" );
- }
- DBGC ( colour, " -> %p\n", retaddr );
- return efirc;
- }
-
- /**
- * Wrap LocateHandleBuffer()
- *
- */
- static EFI_STATUS EFIAPI
- efi_locate_handle_buffer_wrapper ( EFI_LOCATE_SEARCH_TYPE search_type,
- EFI_GUID *protocol, VOID *search_key,
- UINTN *no_handles, EFI_HANDLE **buffer ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- unsigned int i;
- EFI_STATUS efirc;
-
- DBGC ( colour, "LocateHandleBuffer ( %s, %s, %p ) ",
- efi_locate_search_type_name ( search_type ),
- efi_guid_ntoa ( protocol ), search_key );
- efirc = bs->LocateHandleBuffer ( search_type, protocol, search_key,
- no_handles, buffer );
- DBGC ( colour, "= %s", efi_status ( efirc ) );
- if ( efirc == 0 ) {
- DBGC ( colour, " ( %d, {", ( ( unsigned int ) *no_handles ) );
- for ( i = 0 ; i < *no_handles ; i++ ) {
- DBGC ( colour, "%s%s", ( i ? ", " : " " ),
- efi_handle_name ( (*buffer)[i] ) );
- }
- DBGC ( colour, " } )" );
- }
- DBGC ( colour, " -> %p\n", retaddr );
- return efirc;
- }
-
- /**
- * Wrap LocateProtocol()
- *
- */
- static EFI_STATUS EFIAPI
- efi_locate_protocol_wrapper ( EFI_GUID *protocol, VOID *registration,
- VOID **interface ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- void *retaddr = __builtin_return_address ( 0 );
- EFI_STATUS efirc;
-
- DBGC ( colour, "LocateProtocol ( %s, %p ) ",
- efi_guid_ntoa ( protocol ), registration );
- efirc = bs->LocateProtocol ( protocol, registration, interface );
- DBGC ( colour, "= %s ( %p ) -> %p\n",
- efi_status ( efirc ), *interface, retaddr );
- return efirc;
- }
-
- /**
- * Wrap the calls made by a loaded image
- *
- * @v handle Image handle
- */
- void efi_wrap ( EFI_HANDLE handle ) {
- EFI_BOOT_SERVICES *bs = efi_systab->BootServices;
- union {
- EFI_LOADED_IMAGE_PROTOCOL *image;
- void *intf;
- } loaded;
- EFI_STATUS efirc;
- int rc;
-
- /* Do nothing unless debugging is enabled */
- if ( ! DBG_LOG )
- return;
-
- /* Populate table wrappers */
- memcpy ( &efi_systab_wrapper, efi_systab,
- sizeof ( efi_systab_wrapper ) );
- memcpy ( &efi_bs_wrapper, bs, sizeof ( efi_bs_wrapper ) );
- efi_systab_wrapper.BootServices = &efi_bs_wrapper;
- efi_bs_wrapper.InstallProtocolInterface
- = efi_install_protocol_interface_wrapper;
- efi_bs_wrapper.ReinstallProtocolInterface
- = efi_reinstall_protocol_interface_wrapper;
- efi_bs_wrapper.UninstallProtocolInterface
- = efi_uninstall_protocol_interface_wrapper;
- efi_bs_wrapper.HandleProtocol = efi_handle_protocol_wrapper;
- efi_bs_wrapper.LocateHandle = efi_locate_handle_wrapper;
- efi_bs_wrapper.LocateDevicePath = efi_locate_device_path_wrapper;
- efi_bs_wrapper.LoadImage = efi_load_image_wrapper;
- efi_bs_wrapper.StartImage = efi_start_image_wrapper;
- efi_bs_wrapper.Exit = efi_exit_wrapper;
- efi_bs_wrapper.UnloadImage = efi_unload_image_wrapper;
- efi_bs_wrapper.ExitBootServices = efi_exit_boot_services_wrapper;
- efi_bs_wrapper.ConnectController
- = efi_connect_controller_wrapper;
- efi_bs_wrapper.DisconnectController
- = efi_disconnect_controller_wrapper;
- efi_bs_wrapper.OpenProtocol = efi_open_protocol_wrapper;
- efi_bs_wrapper.CloseProtocol = efi_close_protocol_wrapper;
- efi_bs_wrapper.ProtocolsPerHandle
- = efi_protocols_per_handle_wrapper;
- efi_bs_wrapper.LocateHandleBuffer
- = efi_locate_handle_buffer_wrapper;
- efi_bs_wrapper.LocateProtocol = efi_locate_protocol_wrapper;
-
- /* Open loaded image protocol */
- if ( ( efirc = bs->OpenProtocol ( handle,
- &efi_loaded_image_protocol_guid,
- &loaded.intf, efi_image_handle, NULL,
- EFI_OPEN_PROTOCOL_GET_PROTOCOL ))!=0){
- rc = -EEFI ( efirc );
- DBGC ( colour, "WRAP %s could not get loaded image protocol: "
- "%s\n", efi_handle_name ( handle ), strerror ( rc ) );
- return;
- }
-
- /* Provide system table wrapper to image */
- loaded.image->SystemTable = &efi_systab_wrapper;
- DBGC ( colour, "WRAP %s at base %p has protocols:\n",
- efi_handle_name ( handle ), loaded.image->ImageBase );
- DBGC_EFI_PROTOCOLS ( colour, handle );
- DBGC ( colour, "WRAP %s parent", efi_handle_name ( handle ) );
- DBGC ( colour, " %s\n", efi_handle_name ( loaded.image->ParentHandle ));
- DBGC ( colour, "WRAP %s device", efi_handle_name ( handle ) );
- DBGC ( colour, " %s\n", efi_handle_name ( loaded.image->DeviceHandle ));
- DBGC ( colour, "WRAP %s file", efi_handle_name ( handle ) );
- DBGC ( colour, " %s\n", efi_devpath_text ( loaded.image->FilePath ) );
-
- /* Close loaded image protocol */
- bs->CloseProtocol ( handle, &efi_loaded_image_protocol_guid,
- efi_image_handle, NULL );
- }
|