--- /dev/null
+/*++ @file\r
+ Emu driver to produce CPU Architectural Protocol.\r
+ \r
+Copyright (c) 2006 - 2011, Intel Corporation. All rights reserved.<BR>\r
+Portions copyright (c) 2011, Apple Inc. All rights reserved.\r
+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
+\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
+\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
+ EmuFlushCpuDataCache,\r
+ EmuEnableInterrupt,\r
+ EmuDisableInterrupt,\r
+ EmuGetInterruptState,\r
+ EmuInit,\r
+ EmuRegisterInterruptHandler,\r
+ EmuGetTimerValue,\r
+ EmuSetMemoryAttributes,\r
+ 0,\r
+ 4\r
+ },\r
+ {\r
+ {\r
+ CpuMemoryServiceRead,\r
+ CpuMemoryServiceWrite\r
+ },\r
+ {\r
+ CpuIoServiceRead,\r
+ CpuIoServiceWrite\r
+ }\r
+ },\r
+ TRUE\r
+};\r
+\r
+#define EFI_CPU_DATA_MAXIMUM_LENGTH 0x100\r
+\r
+\r
+\r
+//\r
+// Service routines for the driver\r
+//\r
+EFI_STATUS\r
+EFIAPI\r
+EmuFlushCpuDataCache (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This,\r
+ IN EFI_PHYSICAL_ADDRESS Start,\r
+ IN UINT64 Length,\r
+ IN EFI_CPU_FLUSH_TYPE FlushType\r
+ )\r
+{\r
+ if (FlushType == EfiCpuFlushTypeWriteBackInvalidate) {\r
+ //\r
+ // Only WB flush is supported. We actually need do nothing on Emu emulator\r
+ // environment. Classify this to follow EFI spec\r
+ //\r
+ return EFI_SUCCESS;\r
+ }\r
+ //\r
+ // Other flush types are not supported by Emu emulator\r
+ //\r
+ return EFI_UNSUPPORTED;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+EmuEnableInterrupt (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This\r
+ )\r
+{\r
+ CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
+\r
+ Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
+ Private->InterruptState = TRUE;\r
+ gEmuThunk->EnableInterrupt ();\r
+ return EFI_SUCCESS;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+EmuDisableInterrupt (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This\r
+ )\r
+{\r
+ CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
+\r
+ Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
+ Private->InterruptState = FALSE;\r
+ gEmuThunk->DisableInterrupt ();\r
+ return EFI_SUCCESS;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+EmuGetInterruptState (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This,\r
+ OUT BOOLEAN *State\r
+ )\r
+{\r
+ CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
+\r
+ if (State == NULL) {\r
+ return EFI_INVALID_PARAMETER;\r
+ }\r
+\r
+ Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
+ *State = Private->InterruptState;\r
+ return EFI_SUCCESS;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+EmuInit (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This,\r
+ IN EFI_CPU_INIT_TYPE InitType\r
+ )\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
+EFI_STATUS\r
+EFIAPI\r
+EmuRegisterInterruptHandler (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This,\r
+ IN EFI_EXCEPTION_TYPE InterruptType,\r
+ IN EFI_CPU_INTERRUPT_HANDLER InterruptHandler\r
+ )\r
+{\r
+ CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
+\r
+ //\r
+ // Do parameter checking for EFI spec conformance\r
+ //\r
+ if (InterruptType < 0 || InterruptType > 0xff) {\r
+ return EFI_UNSUPPORTED;\r
+ }\r
+ //\r
+ // Do nothing for Emu emulation\r
+ //\r
+ Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
+ return EFI_UNSUPPORTED;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+EmuGetTimerValue (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This,\r
+ IN UINT32 TimerIndex,\r
+ OUT UINT64 *TimerValue,\r
+ OUT UINT64 *TimerPeriod OPTIONAL\r
+ )\r
+{\r
+ if (TimerValue == NULL) {\r
+ return EFI_INVALID_PARAMETER;\r
+ }\r
+\r
+ if (TimerIndex != 0) {\r
+ return EFI_INVALID_PARAMETER;\r
+ }\r
+ \r
+ *TimerValue = gEmuThunk->QueryPerformanceCounter ();\r
+ \r
+ if (TimerPeriod != NULL) {\r
+ *TimerPeriod = mTimerPeriod;\r
+ } \r
+\r
+ return EFI_SUCCESS;\r
+}\r
+\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+EmuSetMemoryAttributes (\r
+ IN EFI_CPU_ARCH_PROTOCOL *This,\r
+ IN EFI_PHYSICAL_ADDRESS BaseAddress,\r
+ IN UINT64 Length,\r
+ IN UINT64 Attributes\r
+ )\r
+{\r
+ CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
+\r
+ //\r
+ // Check for invalid parameter for Spec conformance\r
+ //\r
+ if (Length == 0) {\r
+ return EFI_INVALID_PARAMETER;\r
+ }\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
+\r
+/**\r
+ Logs SMBIOS record.\r
+\r
+ @param Smbios Pointer to SMBIOS protocol instance.\r
+ @param Buffer Pointer to the data buffer.\r
+\r
+**/\r
+VOID\r
+LogSmbiosData (\r
+ IN EFI_SMBIOS_PROTOCOL *Smbios,\r
+ IN UINT8 *Buffer\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ EFI_SMBIOS_HANDLE SmbiosHandle;\r
+ \r
+ SmbiosHandle = 0;\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
+VOID\r
+CpuUpdateSmbios (\r
+ VOID\r
+ )\r
+{\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
+ // Locate Smbios protocol.\r
+ //\r
+ Status = gBS->LocateProtocol (&gEfiSmbiosProtocolGuid, NULL, (VOID **)&Smbios);\r
+ \r
+ if (EFI_ERROR (Status)) {\r
+ return;\r
+ }\r
+\r
+ //\r
+ // Initialize strings to HII database\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
+ TotalSize = 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
+\r
+\r
+\r
+/**\r
+ Callback function for idle events.\r
+ \r
+ @param Event Event whose notification function is being invoked.\r
+ @param Context The pointer to the notification function's context,\r
+ which is implementation-dependent.\r
+\r
+**/\r
+VOID\r
+EFIAPI\r
+IdleLoopEventCallback (\r
+ IN EFI_EVENT Event,\r
+ IN VOID *Context\r
+ )\r
+{\r
+ gEmuThunk->CpuSleep ();\r
+}\r
+\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+InitializeCpu (\r
+ IN EFI_HANDLE ImageHandle,\r
+ IN EFI_SYSTEM_TABLE *SystemTable\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ UINT64 Frequency;\r
+ EFI_EVENT IdleLoopEvent;\r
+\r
+ //\r
+ // Retrieve the frequency of the performance counter in Hz.\r
+ // \r
+ Frequency = gEmuThunk->QueryPerformanceFrequency ();\r
+ \r
+ //\r
+ // Convert frequency in Hz to a clock period in femtoseconds.\r
+ //\r
+ mTimerPeriod = DivU64x64Remainder (1000000000000000ULL, Frequency, NULL);\r
+\r
+ CpuUpdateSmbios ();\r
+ \r
+ CpuMpServicesInit ();\r
+ \r
+ Status = gBS->CreateEventEx (\r
+ EVT_NOTIFY_SIGNAL,\r
+ TPL_NOTIFY,\r
+ IdleLoopEventCallback,\r
+ NULL,\r
+ &gIdleLoopEventGuid,\r
+ &IdleLoopEvent\r
+ );\r
+ ASSERT_EFI_ERROR (Status);\r
+\r
+\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
+ return Status;\r
+}\r