WIP: hook into emuvariable to sync data with coreboot smm store
changed: buffer size from 64k to 256k Change-Id: I7f443b9f36612f79787e1b4b1075176a91107686 Signed-off-by: Patrick Georgi <pgeorgi@google.com> Signed-off-by: Matt DeVillier <matt.devillier@gmail.com>
This commit is contained in:
@ -14,8 +14,53 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||||
|
||||
**/
|
||||
|
||||
#include <Library/UefiRuntimeServicesTableLib.h>
|
||||
#include "Variable.h"
|
||||
|
||||
|
||||
EFI_EVENT mVirtualAddressChangeEvent2 = NULL;
|
||||
int storeInitialized = 0;
|
||||
VOID *rt_buffer;
|
||||
UINTN rt_buffer_phys;
|
||||
|
||||
/*
|
||||
* calls into SMM with the given cmd and subcmd in eax, and arg in ebx
|
||||
*
|
||||
* static inline because the resulting assembly is often smaller than
|
||||
* the call sequence due to constant folding.
|
||||
*/
|
||||
static inline UINT32 call_smm(UINT8 cmd, UINT8 subcmd, UINT32 arg) {
|
||||
UINT32 res = 0;
|
||||
__asm__ __volatile__ (
|
||||
"outb %b0, $0xb2"
|
||||
: "=a" (res)
|
||||
: "a" ((subcmd << 8) | cmd), "b" (arg)
|
||||
: "memory");
|
||||
return res;
|
||||
}
|
||||
|
||||
#define SMMSTORE_APM_CNT 0xed
|
||||
|
||||
#define SMMSTORE_RET_SUCCESS 0
|
||||
#define SMMSTORE_RET_FAILURE 1
|
||||
#define SMMSTORE_RET_UNSUPPORTED 2
|
||||
|
||||
#define SMMSTORE_CMD_CLEAR 1
|
||||
#define SMMSTORE_CMD_READ 2
|
||||
#define SMMSTORE_CMD_APPEND 3
|
||||
|
||||
struct smmstore_params_read {
|
||||
UINT32 buf;
|
||||
UINT32 bufsize;
|
||||
};
|
||||
|
||||
struct smmstore_params_append {
|
||||
UINT32 key;
|
||||
UINT32 keysize;
|
||||
UINT32 val;
|
||||
UINT32 valsize;
|
||||
};
|
||||
|
||||
///
|
||||
/// Don't use module globals after the SetVirtualAddress map is signaled
|
||||
///
|
||||
@ -1044,6 +1089,33 @@ UpdateVariable (
|
||||
DataSize
|
||||
);
|
||||
|
||||
if (storeInitialized && ((Attributes & EFI_VARIABLE_NON_VOLATILE) != 0)) {
|
||||
|
||||
/* TODO: add hook for logging nv changes here */
|
||||
|
||||
int keysize = sizeof (EFI_GUID) + VarNameSize;
|
||||
int valsize = DataSize;
|
||||
|
||||
struct smmstore_params_append *data = rt_buffer;
|
||||
void *keydata = rt_buffer + sizeof(*data);
|
||||
void *valdata = keydata + keysize;
|
||||
data->key = (UINT32)(UINTN)rt_buffer_phys + sizeof(*data);
|
||||
data->keysize = keysize;
|
||||
data->val = data->key + keysize;
|
||||
data->valsize = valsize;
|
||||
|
||||
CopyMem (keydata, VendorGuid, sizeof (EFI_GUID));
|
||||
CopyMem (keydata + sizeof (EFI_GUID), VariableName, VarNameSize);
|
||||
CopyMem (valdata, Data, DataSize);
|
||||
|
||||
call_smm(SMMSTORE_APM_CNT, SMMSTORE_CMD_APPEND, (UINT32)rt_buffer_phys);
|
||||
/* call into SMM through EFI_ISA_IO_PROTOCOL to write to 0xb2:
|
||||
* set registers (how?)
|
||||
* UINT8 Data = ...;
|
||||
* IsaIo->Io.Write (IsaIo, EfiIsaIoWidthUInt8, 0xb2, 1, &Data);
|
||||
*/
|
||||
}
|
||||
|
||||
//
|
||||
// Mark the old variable as deleted
|
||||
//
|
||||
@ -1769,6 +1841,19 @@ InitializeVariableStore (
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
VOID
|
||||
EFIAPI
|
||||
EmuVariableAddressChangeEvent (
|
||||
IN EFI_EVENT Event,
|
||||
IN VOID *Context
|
||||
)
|
||||
{
|
||||
//
|
||||
// Converts a pointer for runtime memory management to a new virtual address.
|
||||
//
|
||||
EfiConvertPointer (0x0, (VOID **) &rt_buffer);
|
||||
}
|
||||
|
||||
/**
|
||||
Initializes variable store area for non-volatile and volatile variable.
|
||||
|
||||
@ -1816,5 +1901,77 @@ VariableCommonInitialize (
|
||||
//
|
||||
Status = InitializeVariableStore (FALSE);
|
||||
|
||||
/* TODO: add hook for filling nv store from log here */
|
||||
const int bufsize = 64 * 1024;
|
||||
rt_buffer = AllocateRuntimePool (bufsize);
|
||||
|
||||
/* needed later for the 32bit 1:1 mapped SMM interface */
|
||||
rt_buffer_phys = (UINTN)rt_buffer;
|
||||
ASSERT(rt_buffer_phys <= 0x100000000 - bufsize);
|
||||
|
||||
Status = gBS->CreateEventEx (
|
||||
EVT_NOTIFY_SIGNAL,
|
||||
TPL_NOTIFY,
|
||||
EmuVariableAddressChangeEvent,
|
||||
NULL,
|
||||
&gEfiEventVirtualAddressChangeGuid,
|
||||
&mVirtualAddressChangeEvent2
|
||||
);
|
||||
ASSERT_EFI_ERROR (Status);
|
||||
|
||||
/* read store */
|
||||
/* we're still phys mapped here, so no magic necessary */
|
||||
UINT8 buf[0x40000];
|
||||
ASSERT((UINTN)buf <= 0x100000000 - sizeof(buf));
|
||||
struct smmstore_params_read read_cmd = {
|
||||
.buf = (UINT32)(UINTN)&buf,
|
||||
.bufsize = sizeof(buf),
|
||||
};
|
||||
ASSERT((UINTN)&read_cmd <= 0x100000000 - sizeof(read_cmd));
|
||||
call_smm(SMMSTORE_APM_CNT, SMMSTORE_CMD_READ, (UINT32)(UINTN)&read_cmd);
|
||||
|
||||
DEBUG ((DEBUG_WARN, "Initialize buffer from 0x%x bytes of flash\n", read_cmd.bufsize));
|
||||
int i = 0;
|
||||
while (i < read_cmd.bufsize) {
|
||||
// assume native endian
|
||||
UINT32 keysz = ((UINT32 *)(buf + i))[0];
|
||||
if (keysz == 0xffffffff)
|
||||
break; // no more entries
|
||||
UINTN valsz = ((UINT32 *)(buf + i))[1];
|
||||
|
||||
if (i + keysz + valsz + 1 > read_cmd.bufsize)
|
||||
break;
|
||||
// TODO: check if entry is properly terminated
|
||||
|
||||
DEBUG ((DEBUG_WARN, "Found variable: key size: 0x%x, val size: %x\n", keysz, valsz));
|
||||
if (keysz > sizeof (EFI_GUID)) {
|
||||
CHAR16 *varname = (CHAR16 *)(buf + i + 8 + sizeof (EFI_GUID));
|
||||
EFI_GUID *guid = (EFI_GUID *)(buf + i + 8);
|
||||
VOID *data = (VOID *)(buf + i + 8 + keysz);
|
||||
|
||||
DEBUG ((DEBUG_WARN, "Fetching variable: %s\n", varname));
|
||||
DEBUG ((DEBUG_WARN, "buf: %p, buf+i: %p, guid: %p, varname: %p, data: %p\n", buf, buf + i, guid, varname, data));
|
||||
VARIABLE_POINTER_TRACK Variable;
|
||||
FindVariable (varname, guid, &Variable, (VARIABLE_GLOBAL *)mVariableModuleGlobal);
|
||||
|
||||
DEBUG ((DEBUG_WARN, "Updating variable: %s\n", varname));
|
||||
UpdateVariable (
|
||||
varname,
|
||||
guid,
|
||||
data,
|
||||
valsz,
|
||||
// all of these variables are nv
|
||||
EFI_VARIABLE_NON_VOLATILE | EFI_VARIABLE_BOOTSERVICE_ACCESS | EFI_VARIABLE_RUNTIME_ACCESS,
|
||||
&Variable
|
||||
);
|
||||
}
|
||||
DEBUG ((DEBUG_WARN, "Added variable: 0x%x, val size: %x\n", keysz, valsz));
|
||||
// no UEFI variable since it's at most the GUID part, so skip
|
||||
i += 8 + keysz + valsz + 1;
|
||||
i = (i + 3) & ~3;
|
||||
}
|
||||
|
||||
storeInitialized = 1;
|
||||
|
||||
return Status;
|
||||
}
|
||||
|
Reference in New Issue
Block a user