mirror of
https://github.com/CloverHackyColor/CloverBootloader.git
synced 2024-11-30 12:43:41 +01:00
183 lines
5.3 KiB
C
183 lines
5.3 KiB
C
|
/** @file
|
||
|
UEFI Miscellaneous boot Services InstallConfigurationTable service
|
||
|
|
||
|
Copyright (c) 2006 - 2011, Intel Corporation. All rights reserved.<BR>
|
||
|
This program and the accompanying materials
|
||
|
are licensed and made available under the terms and conditions of the BSD License
|
||
|
which accompanies this distribution. The full text of the license may be found at
|
||
|
http://opensource.org/licenses/bsd-license.php
|
||
|
|
||
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
||
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||
|
|
||
|
**/
|
||
|
|
||
|
#include "DxeMain.h"
|
||
|
|
||
|
#define CONFIG_TABLE_SIZE_INCREASED 0x10
|
||
|
|
||
|
UINTN mSystemTableAllocateSize = 0;
|
||
|
|
||
|
/**
|
||
|
Boot Service called to add, modify, or remove a system configuration table from
|
||
|
the EFI System Table.
|
||
|
|
||
|
@param Guid Pointer to the GUID for the entry to add, update, or
|
||
|
remove
|
||
|
@param Table Pointer to the configuration table for the entry to add,
|
||
|
update, or remove, may be NULL.
|
||
|
|
||
|
@return EFI_SUCCESS Guid, Table pair added, updated, or removed.
|
||
|
@return EFI_INVALID_PARAMETER Input GUID is NULL.
|
||
|
@return EFI_NOT_FOUND Attempted to delete non-existant entry
|
||
|
@return EFI_OUT_OF_RESOURCES Not enough memory available
|
||
|
|
||
|
**/
|
||
|
EFI_STATUS
|
||
|
EFIAPI
|
||
|
CoreInstallConfigurationTable (
|
||
|
IN EFI_GUID *Guid,
|
||
|
IN VOID *Table
|
||
|
)
|
||
|
{
|
||
|
UINTN Index;
|
||
|
EFI_CONFIGURATION_TABLE *EfiConfigurationTable;
|
||
|
|
||
|
//
|
||
|
// If Guid is NULL, then this operation cannot be performed
|
||
|
//
|
||
|
if (Guid == NULL) {
|
||
|
return EFI_INVALID_PARAMETER;
|
||
|
}
|
||
|
// Print(L"InstallConfigTable\n");
|
||
|
EfiConfigurationTable = gDxeCoreST->ConfigurationTable;
|
||
|
|
||
|
//
|
||
|
// Search all the table for an entry that matches Guid
|
||
|
//
|
||
|
for (Index = 0; Index < gDxeCoreST->NumberOfTableEntries; Index++) {
|
||
|
if (CompareGuid (Guid, &(gDxeCoreST->ConfigurationTable[Index].VendorGuid))) {
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
// Print(L"-- index = %d\n", Index);
|
||
|
if (Index < gDxeCoreST->NumberOfTableEntries) {
|
||
|
//
|
||
|
// A match was found, so this is either a modify or a delete operation
|
||
|
//
|
||
|
// Print(L"A match was found\n");
|
||
|
if (Table != NULL) {
|
||
|
//
|
||
|
// If Table is not NULL, then this is a modify operation.
|
||
|
// Modify the table enty and return.
|
||
|
//
|
||
|
gDxeCoreST->ConfigurationTable[Index].VendorTable = Table;
|
||
|
|
||
|
//
|
||
|
// Signal Configuration Table change
|
||
|
//
|
||
|
CoreNotifySignalList (Guid);
|
||
|
// Print(L"Signalled\n");
|
||
|
return EFI_SUCCESS;
|
||
|
}
|
||
|
|
||
|
//
|
||
|
// A match was found and Table is NULL, so this is a delete operation.
|
||
|
//
|
||
|
gDxeCoreST->NumberOfTableEntries--;
|
||
|
|
||
|
//
|
||
|
// Copy over deleted entry
|
||
|
//
|
||
|
// Print(L"Copy over deleted entry\n");
|
||
|
CopyMem (
|
||
|
&(EfiConfigurationTable[Index]),
|
||
|
&(gDxeCoreST->ConfigurationTable[Index + 1]),
|
||
|
(gDxeCoreST->NumberOfTableEntries - Index) * sizeof (EFI_CONFIGURATION_TABLE)
|
||
|
);
|
||
|
|
||
|
} else {
|
||
|
|
||
|
//
|
||
|
// No matching GUIDs were found, so this is an add operation.
|
||
|
//
|
||
|
// Print(L"No matching GUIDs were found\n");
|
||
|
if (Table == NULL) {
|
||
|
//
|
||
|
// If Table is NULL on an add operation, then return an error.
|
||
|
//
|
||
|
return EFI_NOT_FOUND;
|
||
|
}
|
||
|
|
||
|
//
|
||
|
// Assume that Index == gDxeCoreST->NumberOfTableEntries
|
||
|
//
|
||
|
// Print(L"-- index = %d\n", Index);
|
||
|
if ((Index * sizeof (EFI_CONFIGURATION_TABLE)) >= mSystemTableAllocateSize) {
|
||
|
//
|
||
|
// Allocate a table with one additional entry.
|
||
|
//
|
||
|
mSystemTableAllocateSize += (CONFIG_TABLE_SIZE_INCREASED * sizeof (EFI_CONFIGURATION_TABLE));
|
||
|
// Print(L"allocate\n");
|
||
|
EfiConfigurationTable = AllocateRuntimePool (mSystemTableAllocateSize);
|
||
|
if (EfiConfigurationTable == NULL) {
|
||
|
//
|
||
|
// If a new table could not be allocated, then return an error.
|
||
|
//
|
||
|
return EFI_OUT_OF_RESOURCES;
|
||
|
}
|
||
|
|
||
|
if (gDxeCoreST->ConfigurationTable != NULL) {
|
||
|
//
|
||
|
// Copy the old table to the new table.
|
||
|
//
|
||
|
// Print(L"Copy the old table to the new table\n");
|
||
|
CopyMem (
|
||
|
EfiConfigurationTable,
|
||
|
gDxeCoreST->ConfigurationTable,
|
||
|
Index * sizeof (EFI_CONFIGURATION_TABLE)
|
||
|
);
|
||
|
|
||
|
//
|
||
|
// Free Old Table
|
||
|
//
|
||
|
// Print(L"Free Old Table\n");
|
||
|
CoreFreePool (gDxeCoreST->ConfigurationTable);
|
||
|
}
|
||
|
|
||
|
//
|
||
|
// Update System Table
|
||
|
//
|
||
|
// Print(L"Update System Table\n");
|
||
|
gDxeCoreST->ConfigurationTable = EfiConfigurationTable;
|
||
|
}
|
||
|
|
||
|
//
|
||
|
// Fill in the new entry
|
||
|
//
|
||
|
// Print(L"Fill in the new entry\n");
|
||
|
CopyGuid ((VOID *)&EfiConfigurationTable[Index].VendorGuid, Guid);
|
||
|
EfiConfigurationTable[Index].VendorTable = Table;
|
||
|
|
||
|
//
|
||
|
// This is an add operation, so increment the number of table entries
|
||
|
//
|
||
|
// Print(L"increment the number of table entries\n");
|
||
|
gDxeCoreST->NumberOfTableEntries++;
|
||
|
}
|
||
|
|
||
|
//
|
||
|
// Fix up the CRC-32 in the EFI System Table
|
||
|
//
|
||
|
// Print(L"Fix up the CRC-32 in the EFI System Table\n");
|
||
|
CalculateEfiHdrCrc (&gDxeCoreST->Hdr);
|
||
|
|
||
|
//
|
||
|
// Signal Configuration Table change
|
||
|
//
|
||
|
// Print(L"Signal Configuration Table change\n");
|
||
|
CoreNotifySignalList (Guid);
|
||
|
// Print(L"return\n");
|
||
|
return EFI_SUCCESS;
|
||
|
}
|