1 /*- 2 * Copyright (c) 2017 Eric McCorkle 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD$ 27 */ 28 29 #include <stdbool.h> 30 31 #include <efi.h> 32 #include <efilib.h> 33 34 #include "efi_driver_utils.h" 35 36 static EFI_GUID DriverBindingProtocolGUID = DRIVER_BINDING_PROTOCOL; 37 38 EFI_STATUS 39 connect_controllers(EFI_GUID *filter) 40 { 41 EFI_STATUS status; 42 EFI_HANDLE *handles; 43 UINTN nhandles, i, hsize; 44 45 nhandles = 0; 46 hsize = 0; 47 status = BS->LocateHandle(ByProtocol, filter, NULL, 48 &hsize, NULL); 49 50 if(status != EFI_BUFFER_TOO_SMALL) { 51 return (status); 52 } 53 54 handles = malloc(hsize); 55 if (handles == NULL) 56 return (EFI_OUT_OF_RESOURCES); 57 nhandles = hsize / sizeof(EFI_HANDLE); 58 59 status = BS->LocateHandle(ByProtocol, filter, NULL, 60 &hsize, handles); 61 62 if(EFI_ERROR(status)) { 63 return (status); 64 } 65 66 for(i = 0; i < nhandles; i++) { 67 BS->ConnectController(handles[i], NULL, NULL, true); 68 } 69 70 free(handles); 71 72 return (status); 73 } 74 75 EFI_STATUS 76 install_driver(EFI_DRIVER_BINDING *driver) 77 { 78 EFI_STATUS status; 79 80 driver->ImageHandle = IH; 81 driver->DriverBindingHandle = NULL; 82 status = BS->InstallMultipleProtocolInterfaces( 83 &(driver->DriverBindingHandle), 84 &DriverBindingProtocolGUID, driver, 85 NULL); 86 87 if (EFI_ERROR(status)) { 88 printf("Failed to install driver (%ld)!\n", 89 EFI_ERROR_CODE(status)); 90 } 91 92 return (status); 93 } 94