mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-07 11:46:17 +09:00
83d290c56f
When U-Boot started using SPDX tags we were among the early adopters and there weren't a lot of other examples to borrow from. So we picked the area of the file that usually had a full license text and replaced it with an appropriate SPDX-License-Identifier: entry. Since then, the Linux Kernel has adopted SPDX tags and they place it as the very first line in a file (except where shebangs are used, then it's second line) and with slightly different comment styles than us. In part due to community overlap, in part due to better tag visibility and in part for other minor reasons, switch over to that style. This commit changes all instances where we have a single declared license in the tag as both the before and after are identical in tag contents. There's also a few places where I found we did not have a tag and have introduced one. Signed-off-by: Tom Rini <trini@konsulko.com>
385 lines
10 KiB
C
385 lines
10 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* efi_selftest_controllers
|
|
*
|
|
* Copyright (c) 2017 Heinrich Schuchardt <xypron.glpk@gmx.de>
|
|
*
|
|
* This unit test checks the following protocol services:
|
|
* ConnectController, DisconnectController,
|
|
* InstallProtocol, UninstallProtocol,
|
|
* OpenProtocol, CloseProtcol, OpenProtocolInformation
|
|
*/
|
|
|
|
#include <efi_selftest.h>
|
|
|
|
#define NUMBER_OF_CHILD_CONTROLLERS 4
|
|
|
|
static struct efi_boot_services *boottime;
|
|
const efi_guid_t guid_driver_binding_protocol =
|
|
EFI_DRIVER_BINDING_PROTOCOL_GUID;
|
|
static efi_guid_t guid_controller =
|
|
EFI_GUID(0xe6ab1d96, 0x6bff, 0xdb42,
|
|
0xaa, 0x05, 0xc8, 0x1f, 0x7f, 0x45, 0x26, 0x34);
|
|
static efi_guid_t guid_child_controller =
|
|
EFI_GUID(0x1d41f6f5, 0x2c41, 0xddfb,
|
|
0xe2, 0x9b, 0xb8, 0x0e, 0x2e, 0xe8, 0x3a, 0x85);
|
|
static efi_handle_t handle_controller;
|
|
static efi_handle_t handle_child_controller[NUMBER_OF_CHILD_CONTROLLERS];
|
|
static efi_handle_t handle_driver;
|
|
|
|
/*
|
|
* Count child controllers
|
|
*
|
|
* @handle handle on which child controllers are installed
|
|
* @protocol protocol for which the child controlles where installed
|
|
* @count number of child controllers
|
|
* @return status code
|
|
*/
|
|
static efi_status_t count_child_controllers(efi_handle_t handle,
|
|
efi_guid_t *protocol,
|
|
efi_uintn_t *count)
|
|
{
|
|
efi_status_t ret;
|
|
efi_uintn_t entry_count;
|
|
struct efi_open_protocol_info_entry *entry_buffer;
|
|
|
|
*count = 0;
|
|
ret = boottime->open_protocol_information(handle, protocol,
|
|
&entry_buffer, &entry_count);
|
|
if (ret != EFI_SUCCESS)
|
|
return ret;
|
|
if (!entry_count)
|
|
return EFI_SUCCESS;
|
|
while (entry_count) {
|
|
if (entry_buffer[--entry_count].attributes &
|
|
EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER)
|
|
++*count;
|
|
}
|
|
ret = boottime->free_pool(entry_buffer);
|
|
if (ret != EFI_SUCCESS)
|
|
efi_st_error("Cannot free buffer\n");
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Check if the driver supports the controller.
|
|
*
|
|
* @this driver binding protocol
|
|
* @controller_handle handle of the controller
|
|
* @remaining_device_path path specifying the child controller
|
|
* @return status code
|
|
*/
|
|
static efi_status_t EFIAPI supported(
|
|
struct efi_driver_binding_protocol *this,
|
|
efi_handle_t controller_handle,
|
|
struct efi_device_path *remaining_device_path)
|
|
{
|
|
efi_status_t ret;
|
|
void *interface;
|
|
|
|
ret = boottime->open_protocol(
|
|
controller_handle, &guid_controller,
|
|
&interface, handle_driver,
|
|
controller_handle, EFI_OPEN_PROTOCOL_BY_DRIVER);
|
|
switch (ret) {
|
|
case EFI_ACCESS_DENIED:
|
|
case EFI_ALREADY_STARTED:
|
|
return ret;
|
|
case EFI_SUCCESS:
|
|
break;
|
|
default:
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
ret = boottime->close_protocol(
|
|
controller_handle, &guid_controller,
|
|
handle_driver, controller_handle);
|
|
if (ret != EFI_SUCCESS)
|
|
ret = EFI_UNSUPPORTED;
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Create child controllers and attach driver.
|
|
*
|
|
* @this driver binding protocol
|
|
* @controller_handle handle of the controller
|
|
* @remaining_device_path path specifying the child controller
|
|
* @return status code
|
|
*/
|
|
static efi_status_t EFIAPI start(
|
|
struct efi_driver_binding_protocol *this,
|
|
efi_handle_t controller_handle,
|
|
struct efi_device_path *remaining_device_path)
|
|
{
|
|
size_t i;
|
|
efi_status_t ret;
|
|
void *interface;
|
|
|
|
/* Attach driver to controller */
|
|
ret = boottime->open_protocol(
|
|
controller_handle, &guid_controller,
|
|
&interface, handle_driver,
|
|
controller_handle, EFI_OPEN_PROTOCOL_BY_DRIVER);
|
|
switch (ret) {
|
|
case EFI_ACCESS_DENIED:
|
|
case EFI_ALREADY_STARTED:
|
|
return ret;
|
|
case EFI_SUCCESS:
|
|
break;
|
|
default:
|
|
return EFI_UNSUPPORTED;
|
|
}
|
|
|
|
/* Create child controllers */
|
|
for (i = 0; i < NUMBER_OF_CHILD_CONTROLLERS; ++i) {
|
|
ret = boottime->install_protocol_interface(
|
|
&handle_child_controller[i], &guid_child_controller,
|
|
EFI_NATIVE_INTERFACE, NULL);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("InstallProtocolInterface failed\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
ret = boottime->open_protocol(
|
|
controller_handle, &guid_controller,
|
|
&interface, handle_child_controller[i],
|
|
handle_child_controller[i],
|
|
EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("OpenProtocol failed\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Remove a single child controller from the parent controller.
|
|
*
|
|
* @controller_handle parent controller
|
|
* @child_handle child controller
|
|
* @return status code
|
|
*/
|
|
static efi_status_t disconnect_child(efi_handle_t controller_handle,
|
|
efi_handle_t child_handle)
|
|
{
|
|
efi_status_t ret;
|
|
|
|
ret = boottime->close_protocol(
|
|
controller_handle, &guid_controller,
|
|
child_handle, child_handle);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Cannot close protocol\n");
|
|
return ret;
|
|
}
|
|
ret = boottime->uninstall_protocol_interface(
|
|
child_handle, &guid_child_controller, NULL);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Cannot uninstall protocol interface\n");
|
|
return ret;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Remove child controllers and disconnect the controller.
|
|
*
|
|
* @this driver binding protocol
|
|
* @controller_handle handle of the controller
|
|
* @number_of_children number of child controllers to remove
|
|
* @child_handle_buffer handles of the child controllers to remove
|
|
* @return status code
|
|
*/
|
|
static efi_status_t EFIAPI stop(
|
|
struct efi_driver_binding_protocol *this,
|
|
efi_handle_t controller_handle,
|
|
size_t number_of_children,
|
|
efi_handle_t *child_handle_buffer)
|
|
{
|
|
efi_status_t ret;
|
|
efi_uintn_t count;
|
|
struct efi_open_protocol_info_entry *entry_buffer;
|
|
|
|
/* Destroy provided child controllers */
|
|
if (number_of_children) {
|
|
efi_uintn_t i;
|
|
|
|
for (i = 0; i < number_of_children; ++i) {
|
|
ret = disconnect_child(controller_handle,
|
|
child_handle_buffer[i]);
|
|
if (ret != EFI_SUCCESS)
|
|
return ret;
|
|
}
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/* Destroy all children */
|
|
ret = boottime->open_protocol_information(
|
|
controller_handle, &guid_controller,
|
|
&entry_buffer, &count);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("OpenProtocolInformation failed\n");
|
|
return ret;
|
|
}
|
|
while (count) {
|
|
if (entry_buffer[--count].attributes &
|
|
EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) {
|
|
ret = disconnect_child(
|
|
controller_handle,
|
|
entry_buffer[count].agent_handle);
|
|
if (ret != EFI_SUCCESS)
|
|
return ret;
|
|
}
|
|
}
|
|
ret = boottime->free_pool(entry_buffer);
|
|
if (ret != EFI_SUCCESS)
|
|
efi_st_error("Cannot free buffer\n");
|
|
|
|
/* Detach driver from controller */
|
|
ret = boottime->close_protocol(
|
|
controller_handle, &guid_controller,
|
|
handle_driver, controller_handle);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Cannot close protocol\n");
|
|
return ret;
|
|
}
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/* Driver binding protocol interface */
|
|
static struct efi_driver_binding_protocol binding_interface = {
|
|
supported,
|
|
start,
|
|
stop,
|
|
0xffffffff,
|
|
NULL,
|
|
NULL,
|
|
};
|
|
|
|
/*
|
|
* Setup unit test.
|
|
*
|
|
* @handle handle of the loaded image
|
|
* @systable system table
|
|
*/
|
|
static int setup(const efi_handle_t img_handle,
|
|
const struct efi_system_table *systable)
|
|
{
|
|
efi_status_t ret;
|
|
|
|
boottime = systable->boottime;
|
|
|
|
/* Create controller handle */
|
|
ret = boottime->install_protocol_interface(
|
|
&handle_controller, &guid_controller,
|
|
EFI_NATIVE_INTERFACE, NULL);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("InstallProtocolInterface failed\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Create driver handle */
|
|
ret = boottime->install_protocol_interface(
|
|
&handle_driver, &guid_driver_binding_protocol,
|
|
EFI_NATIVE_INTERFACE, &binding_interface);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("InstallProtocolInterface failed\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
|
|
return EFI_ST_SUCCESS;
|
|
}
|
|
|
|
/*
|
|
* Execute unit test.
|
|
*
|
|
* The number of child controllers is checked after each of the following
|
|
* actions:
|
|
*
|
|
* Connect a controller to a driver.
|
|
* Disconnect and destroy a child controller.
|
|
* Disconnect and destroy the remaining child controllers.
|
|
*
|
|
* Connect a controller to a driver.
|
|
* Uninstall the driver protocol from the controller.
|
|
*/
|
|
static int execute(void)
|
|
{
|
|
efi_status_t ret;
|
|
efi_uintn_t count;
|
|
|
|
/* Connect controller to driver */
|
|
ret = boottime->connect_controller(handle_controller, NULL, NULL, 1);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Failed to connect controller\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Check number of child controllers */
|
|
ret = count_child_controllers(handle_controller, &guid_controller,
|
|
&count);
|
|
if (ret != EFI_SUCCESS || count != NUMBER_OF_CHILD_CONTROLLERS) {
|
|
efi_st_error("Number of children %u != %u\n",
|
|
(unsigned int)count, NUMBER_OF_CHILD_CONTROLLERS);
|
|
}
|
|
/* Destroy second child controller */
|
|
ret = boottime->disconnect_controller(handle_controller,
|
|
handle_driver,
|
|
handle_child_controller[1]);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Failed to disconnect child controller\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Check number of child controllers */
|
|
ret = count_child_controllers(handle_controller, &guid_controller,
|
|
&count);
|
|
if (ret != EFI_SUCCESS || count != NUMBER_OF_CHILD_CONTROLLERS - 1) {
|
|
efi_st_error("Destroying single child controller failed\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Destroy remaining child controllers and disconnect controller */
|
|
ret = boottime->disconnect_controller(handle_controller, NULL, NULL);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Failed to disconnect controller\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Check number of child controllers */
|
|
ret = count_child_controllers(handle_controller, &guid_controller,
|
|
&count);
|
|
if (ret != EFI_SUCCESS || count) {
|
|
efi_st_error("Destroying child controllers failed\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
|
|
/* Connect controller to driver */
|
|
ret = boottime->connect_controller(handle_controller, NULL, NULL, 1);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Failed to connect controller\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Check number of child controllers */
|
|
ret = count_child_controllers(handle_controller, &guid_controller,
|
|
&count);
|
|
if (ret != EFI_SUCCESS || count != NUMBER_OF_CHILD_CONTROLLERS) {
|
|
efi_st_error("Number of children %u != %u\n",
|
|
(unsigned int)count, NUMBER_OF_CHILD_CONTROLLERS);
|
|
}
|
|
/* Uninstall controller protocol */
|
|
ret = boottime->uninstall_protocol_interface(handle_controller,
|
|
&guid_controller, NULL);
|
|
if (ret != EFI_SUCCESS) {
|
|
efi_st_error("Failed to uninstall protocols\n");
|
|
return EFI_ST_FAILURE;
|
|
}
|
|
/* Check number of child controllers */
|
|
ret = count_child_controllers(handle_controller, &guid_controller,
|
|
&count);
|
|
if (ret == EFI_SUCCESS)
|
|
efi_st_error("Uninstall failed\n");
|
|
return EFI_ST_SUCCESS;
|
|
}
|
|
|
|
EFI_UNIT_TEST(controllers) = {
|
|
.name = "controllers",
|
|
.phase = EFI_EXECUTE_BEFORE_BOOTTIME_EXIT,
|
|
.setup = setup,
|
|
.execute = execute,
|
|
};
|