-/*++\r
-\r
-Copyright (c) 2006 - 2007, Intel Corporation\r
-All rights reserved. This program and the accompanying materials\r
-are licensed and made available under the terms and conditions of the BSD License\r
-which accompanies this distribution. The full text of the license may be found at\r
-http://opensource.org/licenses/bsd-license.php\r
+/**@file\r
\r
-THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
-WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
+Copyright (c) 2006 - 2013, Intel Corporation. All rights reserved.<BR>\r
+SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
Module Name:\r
\r
the CPU-specific setjump/long pair. Other services are not implemented\r
in this driver.\r
\r
---*/\r
+**/\r
\r
\r
#include "CpuDriver.h"\r
\r
+UINT64 mTimerPeriod;\r
+\r
+CPU_ARCH_PROTOCOL_PRIVATE mCpuTemplate = {\r
+ CPU_ARCH_PROT_PRIVATE_SIGNATURE,\r
+ NULL,\r
+ {\r
+ WinNtFlushCpuDataCache,\r
+ WinNtEnableInterrupt,\r
+ WinNtDisableInterrupt,\r
+ WinNtGetInterruptState,\r
+ WinNtInit,\r
+ WinNtRegisterInterruptHandler,\r
+ WinNtGetTimerValue,\r
+ WinNtSetMemoryAttributes,\r
+ 1,\r
+ 4\r
+ },\r
+ {\r
+ CpuMemoryServiceRead,\r
+ CpuMemoryServiceWrite,\r
+ CpuIoServiceRead,\r
+ CpuIoServiceWrite\r
+ },\r
+ 0,\r
+ TRUE\r
+};\r
+\r
#define EFI_CPU_DATA_MAXIMUM_LENGTH 0x100\r
\r
-EFI_STATUS\r
-EFIAPI\r
-InitializeCpu (\r
- IN EFI_HANDLE ImageHandle,\r
- IN EFI_SYSTEM_TABLE *SystemTable\r
- );\r
\r
-VOID\r
-EFIAPI\r
-WinNtIoProtocolNotifyFunction (\r
- IN EFI_EVENT Event,\r
- IN VOID *Context\r
- );\r
-\r
-typedef union {\r
- EFI_CPU_DATA_RECORD *DataRecord;\r
- UINT8 *Raw;\r
-} EFI_CPU_DATA_RECORD_BUFFER;\r
-\r
-EFI_SUBCLASS_TYPE1_HEADER mCpuDataRecordHeader = {\r
- EFI_PROCESSOR_SUBCLASS_VERSION, // Version\r
- sizeof (EFI_SUBCLASS_TYPE1_HEADER), // Header Size\r
- 0, // Instance, Initialize later\r
- EFI_SUBCLASS_INSTANCE_NON_APPLICABLE, // SubInstance\r
- 0 // RecordType, Initialize later\r
-};\r
\r
//\r
// Service routines for the driver\r
//\r
-STATIC\r
EFI_STATUS\r
EFIAPI\r
WinNtFlushCpuDataCache (\r
return EFI_UNSUPPORTED;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtEnableInterrupt (\r
return EFI_SUCCESS;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtDisableInterrupt (\r
return EFI_SUCCESS;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtGetInterruptState (\r
return EFI_SUCCESS;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtInit (\r
// TODO: This - add argument and description to function comment\r
// TODO: InitType - add argument and description to function comment\r
{\r
- CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
-\r
- Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
return EFI_UNSUPPORTED;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtRegisterInterruptHandler (\r
// TODO: InterruptType - add argument and description to function comment\r
// TODO: InterruptHandler - add argument and description to function comment\r
{\r
- CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
\r
//\r
// Do parameter checking for EFI spec conformance\r
//\r
// Do nothing for Nt32 emulation\r
//\r
- Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
return EFI_UNSUPPORTED;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtGetTimerValue (\r
if (TimerValue == NULL) {\r
return EFI_INVALID_PARAMETER;\r
}\r
-\r
- //\r
- // No timer supported\r
- //\r
- return EFI_UNSUPPORTED;\r
+ \r
+ if (TimerIndex != 0) {\r
+ return EFI_INVALID_PARAMETER;\r
+ }\r
+ \r
+ gWinNt->QueryPerformanceCounter ((LARGE_INTEGER *)TimerValue);\r
+ \r
+ if (TimerPeriod != NULL) {\r
+ *TimerPeriod = mTimerPeriod;\r
+ }\r
+ \r
+ return EFI_SUCCESS;\r
}\r
\r
-STATIC\r
+\r
EFI_STATUS\r
EFIAPI\r
WinNtSetMemoryAttributes (\r
// TODO: Attributes - add argument and description to function comment\r
// TODO: EFI_INVALID_PARAMETER - add return value to function comment\r
{\r
- CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
-\r
//\r
// Check for invalid parameter for Spec conformance\r
//\r
//\r
// Do nothing for Nt32 emulation\r
//\r
- Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
return EFI_UNSUPPORTED;\r
}\r
\r
\r
-EFI_STATUS\r
-EFIAPI\r
-InitializeCpu (\r
- IN EFI_HANDLE ImageHandle,\r
- IN EFI_SYSTEM_TABLE *SystemTable\r
- )\r
-/*++\r
-\r
-Routine Description:\r
\r
- Initialize the state information for the CPU Architectural Protocol\r
+/**\r
+ Logs SMBIOS record.\r
\r
-Arguments:\r
-\r
- ImageHandle of the loaded driver\r
- Pointer to the System Table\r
-\r
-Returns:\r
-\r
- Status\r
-\r
- EFI_SUCCESS - protocol instance can be published\r
- EFI_OUT_OF_RESOURCES - cannot allocate protocol data structure\r
- EFI_DEVICE_ERROR - cannot create the thread\r
+ @param Smbios Pointer to SMBIOS protocol instance.\r
+ @param Buffer Pointer to the data buffer.\r
\r
---*/\r
-// TODO: SystemTable - add argument and description to function comment\r
+**/\r
+VOID\r
+LogSmbiosData (\r
+ IN EFI_SMBIOS_PROTOCOL *Smbios,\r
+ IN UINT8 *Buffer\r
+ )\r
{\r
- EFI_STATUS Status;\r
- EFI_EVENT Event;\r
- CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
- VOID *Registration;\r
-\r
- Private = AllocatePool (sizeof (CPU_ARCH_PROTOCOL_PRIVATE));\r
- ASSERT (Private != NULL);\r
-\r
- Private->Signature = CPU_ARCH_PROT_PRIVATE_SIGNATURE;\r
- Private->Cpu.FlushDataCache = WinNtFlushCpuDataCache;\r
- Private->Cpu.EnableInterrupt = WinNtEnableInterrupt;\r
- Private->Cpu.DisableInterrupt = WinNtDisableInterrupt;\r
- Private->Cpu.GetInterruptState = WinNtGetInterruptState;\r
- Private->Cpu.Init = WinNtInit;\r
- Private->Cpu.RegisterInterruptHandler = WinNtRegisterInterruptHandler;\r
- Private->Cpu.GetTimerValue = WinNtGetTimerValue;\r
- Private->Cpu.SetMemoryAttributes = WinNtSetMemoryAttributes;\r
-\r
- Private->Cpu.NumberOfTimers = 0;\r
- Private->Cpu.DmaBufferAlignment = 4;\r
-\r
- Private->InterruptState = TRUE;\r
-\r
- Private->CpuIo.Mem.Read = CpuMemoryServiceRead;\r
- Private->CpuIo.Mem.Write = CpuMemoryServiceWrite;\r
- Private->CpuIo.Io.Read = CpuIoServiceRead;\r
- Private->CpuIo.Io.Write = CpuIoServiceWrite;\r
-\r
-\r
- Private->Handle = NULL;\r
- Status = gBS->InstallMultipleProtocolInterfaces (\r
- &Private->Handle,\r
- &gEfiCpuArchProtocolGuid, &Private->Cpu,\r
- &gEfiCpuIoProtocolGuid, &Private->CpuIo,\r
- NULL\r
- );\r
+ EFI_STATUS Status;\r
+ EFI_SMBIOS_HANDLE SmbiosHandle;\r
+ \r
+ SmbiosHandle = SMBIOS_HANDLE_PI_RESERVED;\r
+ Status = Smbios->Add (\r
+ Smbios,\r
+ NULL,\r
+ &SmbiosHandle,\r
+ (EFI_SMBIOS_TABLE_HEADER*)Buffer\r
+ );\r
ASSERT_EFI_ERROR (Status);\r
-\r
- //\r
- // Install notify function to store processor data to HII database and data hub.\r
- //\r
- Status = gBS->CreateEvent (\r
- EVT_NOTIFY_SIGNAL,\r
- TPL_CALLBACK,\r
- WinNtIoProtocolNotifyFunction,\r
- ImageHandle,\r
- &Event\r
- );\r
- ASSERT (!EFI_ERROR (Status));\r
-\r
- Status = gBS->RegisterProtocolNotify (\r
- &gEfiWinNtIoProtocolGuid,\r
- Event,\r
- &Registration\r
- );\r
- ASSERT (!EFI_ERROR (Status));\r
-\r
- //\r
- // Should be at EFI_D_INFO, but lets us now things are running\r
- //\r
- DEBUG ((EFI_D_ERROR, "CPU Architectural Protocol Loaded\n"));\r
-\r
-\r
-\r
- return Status;\r
}\r
\r
-UINTN\r
-Atoi (\r
- CHAR16 *String\r
+\r
+VOID\r
+CpuUpdateSmbios (\r
+ VOID\r
)\r
/*++\r
\r
Routine Description:\r
- Convert a unicode string to a UINTN\r
+ This function will log processor version and frequency data to Smbios.\r
\r
Arguments:\r
- String - Unicode string.\r
+ Event - Event whose notification function is being invoked.\r
+ Context - Pointer to the notification function's context.\r
\r
Returns:\r
- UINTN of the number represented by String.\r
+ None.\r
\r
--*/\r
{\r
- UINTN Number;\r
- CHAR16 *Str;\r
+ EFI_STATUS Status;\r
+ UINT32 TotalSize;\r
+ EFI_SMBIOS_PROTOCOL *Smbios;\r
+ EFI_HII_HANDLE HiiHandle;\r
+ STRING_REF Token;\r
+ UINTN CpuVerStrLen;\r
+ EFI_STRING CpuVerStr;\r
+ SMBIOS_TABLE_TYPE4 *SmbiosRecord;\r
+ CHAR8 *OptionalStrStart;\r
\r
//\r
- // skip preceeding white space\r
+ // Locate Smbios protocol.\r
//\r
- Str = String;\r
- while ((*Str) && (*Str == ' ' || *Str == '"')) {\r
- Str++;\r
+ Status = gBS->LocateProtocol (&gEfiSmbiosProtocolGuid, NULL, (VOID **)&Smbios);\r
+ \r
+ if (EFI_ERROR (Status)) {\r
+ return;\r
}\r
+\r
//\r
- // Convert ot a Number\r
+ // Initialize strings to HII database\r
//\r
- Number = 0;\r
- while (*Str != '\0') {\r
- if ((*Str >= '0') && (*Str <= '9')) {\r
- Number = (Number * 10) +*Str - '0';\r
- } else {\r
- break;\r
- }\r
-\r
- Str++;\r
- }\r
+ HiiHandle = HiiAddPackages (\r
+ &gEfiCallerIdGuid,\r
+ NULL,\r
+ CpuStrings,\r
+ NULL\r
+ );\r
+ ASSERT (HiiHandle != NULL);\r
+\r
+ Token = STRING_TOKEN (STR_PROCESSOR_VERSION);\r
+ CpuVerStr = HiiGetPackageString(&gEfiCallerIdGuid, Token, NULL);\r
+ CpuVerStrLen = StrLen(CpuVerStr);\r
+ ASSERT (CpuVerStrLen <= SMBIOS_STRING_MAX_LENGTH);\r
+\r
+\r
+ TotalSize = (UINT32)(sizeof(SMBIOS_TABLE_TYPE4) + CpuVerStrLen + 1 + 1);\r
+ SmbiosRecord = AllocatePool(TotalSize);\r
+ ZeroMem(SmbiosRecord, TotalSize);\r
+\r
+ SmbiosRecord->Hdr.Type = EFI_SMBIOS_TYPE_PROCESSOR_INFORMATION;\r
+ SmbiosRecord->Hdr.Length = sizeof (SMBIOS_TABLE_TYPE4);\r
+ //\r
+ // Make handle chosen by smbios protocol.add automatically.\r
+ //\r
+ SmbiosRecord->Hdr.Handle = 0; \r
+ //\r
+ // Processor version is the 1st string.\r
+ //\r
+ SmbiosRecord->ProcessorVersion = 1;\r
+ //\r
+ // Store CPU frequency data record to data hub - It's an emulator so make up a value\r
+ //\r
+ SmbiosRecord->CurrentSpeed = 1234;\r
+\r
+ OptionalStrStart = (CHAR8 *)(SmbiosRecord + 1);\r
+ UnicodeStrToAsciiStr(CpuVerStr, OptionalStrStart);\r
+\r
+ //\r
+ // Now we have got the full smbios record, call smbios protocol to add this record.\r
+ //\r
+ LogSmbiosData(Smbios, (UINT8 *) SmbiosRecord);\r
+ FreePool (SmbiosRecord);\r
\r
- return Number;\r
}\r
\r
-VOID\r
+\r
+\r
+EFI_STATUS\r
EFIAPI\r
-WinNtIoProtocolNotifyFunction (\r
- IN EFI_EVENT Event,\r
- IN VOID *Context\r
+InitializeCpu (\r
+ IN EFI_HANDLE ImageHandle,\r
+ IN EFI_SYSTEM_TABLE *SystemTable\r
)\r
/*++\r
\r
Routine Description:\r
- This function will log processor version and frequency data to data hub.\r
+\r
+ Initialize the state information for the CPU Architectural Protocol\r
\r
Arguments:\r
- Event - Event whose notification function is being invoked.\r
- Context - Pointer to the notification function's context.\r
+\r
+ ImageHandle of the loaded driver\r
+ Pointer to the System Table\r
\r
Returns:\r
- None.\r
+\r
+ Status\r
+\r
+ EFI_SUCCESS - protocol instance can be published\r
+ EFI_OUT_OF_RESOURCES - cannot allocate protocol data structure\r
+ EFI_DEVICE_ERROR - cannot create the thread\r
\r
--*/\r
{\r
- EFI_STATUS Status;\r
- EFI_CPU_DATA_RECORD_BUFFER RecordBuffer;\r
- EFI_DATA_RECORD_HEADER *Record;\r
- EFI_SUBCLASS_TYPE1_HEADER *DataHeader;\r
- UINT32 HeaderSize;\r
- UINT32 TotalSize;\r
- UINTN HandleCount;\r
- UINTN HandleIndex;\r
- UINT64 MonotonicCount;\r
- BOOLEAN RecordFound;\r
- EFI_HANDLE *HandleBuffer;\r
- EFI_WIN_NT_IO_PROTOCOL *WinNtIo;\r
- EFI_DATA_HUB_PROTOCOL *DataHub;\r
- EFI_HII_PROTOCOL *Hii;\r
- EFI_HII_HANDLE StringHandle;\r
- EFI_HII_PACKAGES *PackageList;\r
- STRING_REF Token;\r
+ EFI_STATUS Status;\r
+ UINT64 Frequency;\r
\r
- DataHub = NULL;\r
- Token = 0;\r
- MonotonicCount = 0;\r
- RecordFound = FALSE;\r
-\r
- //\r
- // Retrieve the list of all handles from the handle database\r
- //\r
- Status = gBS->LocateHandleBuffer (\r
- AllHandles,\r
- &gEfiWinNtIoProtocolGuid,\r
- NULL,\r
- &HandleCount,\r
- &HandleBuffer\r
- );\r
- if (EFI_ERROR (Status)) {\r
- return ;\r
- }\r
- //\r
- // Locate HII protocol\r
- //\r
- Status = gBS->LocateProtocol (&gEfiHiiProtocolGuid, NULL, &Hii);\r
- if (EFI_ERROR (Status)) {\r
- return ;\r
- }\r
//\r
- // Locate DataHub protocol.\r
+ // Retrieve the frequency of the performance counter in Hz.\r
+ // \r
+ gWinNt->QueryPerformanceFrequency ((LARGE_INTEGER *)&Frequency);\r
+ \r
//\r
- Status = gBS->LocateProtocol (&gEfiDataHubProtocolGuid, NULL, &DataHub);\r
- if (EFI_ERROR (Status)) {\r
- return ;\r
- }\r
+ // Convert frequency in Hz to a clock period in femtoseconds.\r
//\r
- // Initialize data record header\r
- //\r
- mCpuDataRecordHeader.Instance = 1;\r
- HeaderSize = sizeof (EFI_SUBCLASS_TYPE1_HEADER);\r
+ mTimerPeriod = DivU64x64Remainder (1000000000000000, Frequency, NULL);\r
+ \r
+ CpuUpdateSmbios ();\r
\r
- RecordBuffer.Raw = AllocatePool (HeaderSize + EFI_CPU_DATA_MAXIMUM_LENGTH);\r
- if (RecordBuffer.Raw == NULL) {\r
- return ;\r
- }\r
-\r
- CopyMem (RecordBuffer.Raw, &mCpuDataRecordHeader, HeaderSize);\r
+ Status = gBS->InstallMultipleProtocolInterfaces (\r
+ &mCpuTemplate.Handle,\r
+ &gEfiCpuArchProtocolGuid, &mCpuTemplate.Cpu,\r
+ &gEfiCpuIo2ProtocolGuid, &mCpuTemplate.CpuIo,\r
+ NULL\r
+ );\r
+ ASSERT_EFI_ERROR (Status);\r
\r
- //\r
- // Search the Handle array to find the CPU model and speed information\r
- //\r
- for (HandleIndex = 0; HandleIndex < HandleCount; HandleIndex++) {\r
- Status = gBS->OpenProtocol (\r
- HandleBuffer[HandleIndex],\r
- &gEfiWinNtIoProtocolGuid,\r
- &WinNtIo,\r
- Context,\r
- NULL,\r
- EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
- );\r
- if (EFI_ERROR (Status)) {\r
- continue;\r
- }\r
-\r
- if ((WinNtIo->WinNtThunk->Signature == EFI_WIN_NT_THUNK_PROTOCOL_SIGNATURE) &&\r
- CompareGuid (WinNtIo->TypeGuid, &gEfiWinNtCPUModelGuid)\r
- ) {\r
- //\r
- // Check if this record has been stored in data hub\r
- //\r
- do {\r
- Status = DataHub->GetNextRecord (DataHub, &MonotonicCount, NULL, &Record);\r
- if (Record->DataRecordClass == EFI_DATA_RECORD_CLASS_DATA) {\r
- DataHeader = (EFI_SUBCLASS_TYPE1_HEADER *) (Record + 1);\r
- if (CompareGuid (&Record->DataRecordGuid, &gEfiProcessorSubClassGuid) &&\r
- (DataHeader->RecordType == ProcessorVersionRecordType)\r
- ) {\r
- RecordFound = TRUE;\r
- }\r
- }\r
- } while (MonotonicCount != 0);\r
-\r
- if (RecordFound) {\r
- RecordFound = FALSE;\r
- continue;\r
- }\r
- //\r
- // Initialize strings to HII database\r
- //\r
- PackageList = PreparePackages (1, &gEfiProcessorProducerGuid, CpuStrings);\r
-\r
- Status = Hii->NewPack (Hii, PackageList, &StringHandle);\r
- ASSERT (!EFI_ERROR (Status));\r
-\r
- FreePool (PackageList);\r
-\r
- //\r
- // Store processor version data record to data hub\r
- //\r
- Status = Hii->NewString (Hii, NULL, StringHandle, &Token, WinNtIo->EnvString);\r
- ASSERT (!EFI_ERROR (Status));\r
-\r
- RecordBuffer.DataRecord->DataRecordHeader.RecordType = ProcessorVersionRecordType;\r
- RecordBuffer.DataRecord->VariableRecord.ProcessorVersion = Token;\r
- TotalSize = HeaderSize + sizeof (EFI_PROCESSOR_VERSION_DATA);\r
-\r
- Status = DataHub->LogData (\r
- DataHub,\r
- &gEfiProcessorSubClassGuid,\r
- &gEfiProcessorProducerGuid,\r
- EFI_DATA_RECORD_CLASS_DATA,\r
- RecordBuffer.Raw,\r
- TotalSize\r
- );\r
- }\r
-\r
- if ((WinNtIo->WinNtThunk->Signature == EFI_WIN_NT_THUNK_PROTOCOL_SIGNATURE) &&\r
- CompareGuid (WinNtIo->TypeGuid, &gEfiWinNtCPUSpeedGuid)\r
- ) {\r
- //\r
- // Check if this record has been stored in data hub\r
- //\r
- do {\r
- Status = DataHub->GetNextRecord (DataHub, &MonotonicCount, NULL, &Record);\r
- if (Record->DataRecordClass == EFI_DATA_RECORD_CLASS_DATA) {\r
- DataHeader = (EFI_SUBCLASS_TYPE1_HEADER *) (Record + 1);\r
- if (CompareGuid (&Record->DataRecordGuid, &gEfiProcessorSubClassGuid) &&\r
- (DataHeader->RecordType == ProcessorCoreFrequencyRecordType)\r
- ) {\r
- RecordFound = TRUE;\r
- }\r
- }\r
- } while (MonotonicCount != 0);\r
-\r
- if (RecordFound) {\r
- RecordFound = FALSE;\r
- continue;\r
- }\r
- //\r
- // Store CPU frequency data record to data hub\r
- //\r
- RecordBuffer.DataRecord->DataRecordHeader.RecordType = ProcessorCoreFrequencyRecordType;\r
- RecordBuffer.DataRecord->VariableRecord.ProcessorCoreFrequency.Value = (UINT16) Atoi (WinNtIo->EnvString);\r
- RecordBuffer.DataRecord->VariableRecord.ProcessorCoreFrequency.Exponent = 6;\r
- TotalSize = HeaderSize + sizeof (EFI_PROCESSOR_CORE_FREQUENCY_DATA);\r
-\r
- Status = DataHub->LogData (\r
- DataHub,\r
- &gEfiProcessorSubClassGuid,\r
- &gEfiProcessorProducerGuid,\r
- EFI_DATA_RECORD_CLASS_DATA,\r
- RecordBuffer.Raw,\r
- TotalSize\r
- );\r
-\r
- FreePool (RecordBuffer.Raw);\r
- }\r
-\r
- gBS->CloseProtocol (\r
- HandleBuffer[HandleIndex],\r
- &gEfiWinNtIoProtocolGuid,\r
- Context,\r
- NULL\r
- );\r
- }\r
+ return Status;\r
}\r
projects / mirror_edk2.git / blobdiff