[mirror_edk2.git] / EmulatorPkg / CpuRuntimeDxe / Cpu.c

/*++ @file\r
  Emu driver to produce CPU Architectural Protocol.\r
\r
Copyright (c) 2006 - 2012, Intel Corporation. All rights reserved.<BR>\r
Portions copyright (c) 2011 - 2012, 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
SMBIOS_TABLE_TYPE4 mCpuSmbiosType4 = {\r
  { EFI_SMBIOS_TYPE_PROCESSOR_INFORMATION, sizeof (SMBIOS_TABLE_TYPE4), 0},\r
  1,                    // Socket String\r
  ProcessorOther,       // ProcessorType;          ///< The enumeration value from PROCESSOR_TYPE_DATA.\r
  ProcessorFamilyOther, // ProcessorFamily;        ///< The enumeration value from PROCESSOR_FAMILY_DATA.\r
  2,                    // ProcessorManufacture String;\r
  {                     // ProcessorId;\r
    {  // PROCESSOR_SIGNATURE\r
      0, //  ProcessorSteppingId:4;\r
      0, //  ProcessorModel:     4;\r
      0, //  ProcessorFamily:    4;\r
      0, //  ProcessorType:      2;\r
      0, //  ProcessorReserved1: 2;\r
      0, //  ProcessorXModel:    4;\r
      0, //  ProcessorXFamily:   8;\r
      0, //  ProcessorReserved2: 4;\r
    }, \r
    {  // PROCESSOR_FEATURE_FLAGS\r
      0, //  ProcessorFpu       :1;\r
      0, //  ProcessorVme       :1;\r
      0, //  ProcessorDe        :1;\r
      0, //  ProcessorPse       :1;\r
      0, //  ProcessorTsc       :1;\r
      0, //  ProcessorMsr       :1;\r
      0, //  ProcessorPae       :1;\r
      0, //  ProcessorMce       :1;\r
      0, //  ProcessorCx8       :1;\r
      0, //  ProcessorApic      :1;\r
      0, //  ProcessorReserved1 :1;\r
      0, //  ProcessorSep       :1;\r
      0, //  ProcessorMtrr      :1;\r
      0, //  ProcessorPge       :1;\r
      0, //  ProcessorMca       :1;\r
      0, //  ProcessorCmov      :1;\r
      0, //  ProcessorPat       :1;\r
      0, //  ProcessorPse36     :1;\r
      0, //  ProcessorPsn       :1;\r
      0, //  ProcessorClfsh     :1;\r
      0, //  ProcessorReserved2 :1;\r
      0, //  ProcessorDs        :1;\r
      0, //  ProcessorAcpi      :1;\r
      0, //  ProcessorMmx       :1;\r
      0, //  ProcessorFxsr      :1;\r
      0, //  ProcessorSse       :1;\r
      0, //  ProcessorSse2      :1;\r
      0, //  ProcessorSs        :1;\r
      0, //  ProcessorReserved3 :1;\r
      0, //  ProcessorTm        :1;\r
      0, //  ProcessorReserved4 :2;\r
    }\r
  },\r
  3,                    // ProcessorVersion String;\r
  {                     // Voltage;\r
    1,  // ProcessorVoltageCapability5V        :1; \r
    1,  // ProcessorVoltageCapability3_3V      :1;  \r
    1,  // ProcessorVoltageCapability2_9V      :1;  \r
    0,  // ProcessorVoltageCapabilityReserved  :1; ///< Bit 3, must be zero.\r
    0,  // ProcessorVoltageReserved            :3; ///< Bits 4-6, must be zero.\r
    0   // ProcessorVoltageIndicateLegacy      :1;\r
  },              \r
  0,                      // ExternalClock;\r
  0,                      // MaxSpeed;\r
  0,                      // CurrentSpeed;\r
  0x41,                   // Status;\r
  ProcessorUpgradeOther,  // ProcessorUpgrade;      ///< The enumeration value from PROCESSOR_UPGRADE.\r
  0,                      // L1CacheHandle;\r
  0,                      // L2CacheHandle;\r
  0,                      // L3CacheHandle;\r
  4,                      // SerialNumber;\r
  5,                      // AssetTag;\r
  6,                      // PartNumber;\r
  0,                      // CoreCount;\r
  0,                      // EnabledCoreCount;\r
  0,                      // ThreadCount;\r
  0,                      // ProcessorCharacteristics;\r
  0,                      // ProcessorFamily2;\r
};\r
\r
CHAR8 *mCpuSmbiosType4Strings[] = {\r
  "Socket",\r
  "http://www.tianocore.org/edk2/",\r
  "Emulated Processor",\r
  "1.0",\r
  "1.0",\r
  "1.0",\r
  NULL\r
};\r
\r
\r
/**\r
  Create SMBIOS record.\r
\r
  Converts a fixed SMBIOS structure and an array of pointers to strings into\r
  an SMBIOS record where the strings are cat'ed on the end of the fixed record\r
  and terminated via a double NULL and add to SMBIOS table.\r
\r
  SMBIOS_TABLE_TYPE32 gSmbiosType12 = {\r
    { EFI_SMBIOS_TYPE_SYSTEM_CONFIGURATION_OPTIONS, sizeof (SMBIOS_TABLE_TYPE12), 0 },\r
    1 // StringCount\r
  };\r
  CHAR8 *gSmbiosType12Strings[] = {\r
    "Not Found",\r
    NULL\r
  };\r
  \r
  ...\r
  LogSmbiosData (\r
    (EFI_SMBIOS_TABLE_HEADER*)&gSmbiosType12, \r
    gSmbiosType12Strings\r
    );\r
\r
  @param  Template    Fixed SMBIOS structure, required.\r
  @param  StringArray Array of strings to convert to an SMBIOS string pack. \r
                      NULL is OK.\r
\r
**/\r
EFI_STATUS\r
LogSmbiosData (\r
  IN  EFI_SMBIOS_TABLE_HEADER *Template,\r
  IN  CHAR8                   **StringPack \r
  )\r
{\r
  EFI_STATUS                Status;\r
  EFI_SMBIOS_PROTOCOL       *Smbios;  \r
  EFI_SMBIOS_HANDLE         SmbiosHandle;\r
  EFI_SMBIOS_TABLE_HEADER   *Record;\r
  UINTN                     Index;\r
  UINTN                     StringSize;\r
  UINTN                     Size;\r
  CHAR8                     *Str;\r
\r
  //\r
  // Locate Smbios protocol.\r
  //\r
  Status = gBS->LocateProtocol (&gEfiSmbiosProtocolGuid, NULL, (VOID **)&Smbios);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  // Calculate the size of the fixed record and optional string pack\r
  Size = Template->Length;\r
  if (StringPack == NULL) {\r
    // At least a double null is required\r
    Size += 2;\r
  } else {\r
    for (Index = 0; StringPack[Index] != NULL; Index++) {\r
      StringSize = AsciiStrSize (StringPack[Index]);\r
      Size += StringSize;\r
    }\r
    if (StringPack[0] == NULL) {\r
      // At least a double null is required\r
      Size += 1;\r
    }\r
    // Don't forget the terminating double null\r
    Size += 1;\r
  }\r
\r
  // Copy over Template\r
  Record = (EFI_SMBIOS_TABLE_HEADER *)AllocateZeroPool (Size);\r
  if (Record == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
  CopyMem (Record, Template, Template->Length);\r
\r
  // Append string pack\r
  Str = ((CHAR8 *)Record) + Record->Length;\r
  for (Index = 0; StringPack[Index] != NULL; Index++) {\r
    StringSize = AsciiStrSize (StringPack[Index]);\r
    CopyMem (Str, StringPack[Index], StringSize);\r
    Str += StringSize;\r
  }\r
  *Str = 0;\r
  \r
  SmbiosHandle = SMBIOS_HANDLE_PI_RESERVED;\r
  Status = Smbios->Add (\r
                     Smbios,\r
                     gImageHandle,\r
                     &SmbiosHandle,\r
                     Record\r
                     );\r
  ASSERT_EFI_ERROR (Status);\r
  \r
  FreePool (Record);\r
  return Status;\r
}\r
\r
\r
\r
\r
VOID\r
CpuUpdateSmbios (\r
  IN UINTN  MaxCpus\r
  )\r
{\r
  mCpuSmbiosType4.CoreCount        = (UINT8) MaxCpus;\r
  mCpuSmbiosType4.EnabledCoreCount = (UINT8) MaxCpus;\r
  mCpuSmbiosType4.ThreadCount      = (UINT8) MaxCpus;\r
\r
  LogSmbiosData ((EFI_SMBIOS_TABLE_HEADER *)&mCpuSmbiosType4, mCpuSmbiosType4Strings);\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
  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
  //\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
  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
  //\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
  return EFI_UNSUPPORTED;\r
}\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
  UINTN         MaxCpu;\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
  CpuMpServicesInit (&MaxCpu);\r
\r
  CpuUpdateSmbios (MaxCpu);\r
\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
Commit	Line	Data
949f388f	1	/*++ @file\r
949f388f	2	Emu driver to produce CPU Architectural Protocol.\r
d18d8a1d	3	\r
e148512e	4	Copyright (c) 2006 - 2012, Intel Corporation. All rights reserved.<BR>\r
a0af6b27	5	Portions copyright (c) 2011 - 2012, Apple Inc. All rights reserved.\r
949f388f	6	This program and the accompanying materials\r
	7	are licensed and made available under the terms and conditions of the BSD License\r
	8	which accompanies this distribution. The full text of the license may be found at\r
	9	http://opensource.org/licenses/bsd-license.php\r
	10	\r
	11	THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
	12	WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
	13	\r
	14	**/\r
	15	\r
	16	#include "CpuDriver.h"\r
	17	\r
	18	UINT64 mTimerPeriod;\r
	19	\r
	20	CPU_ARCH_PROTOCOL_PRIVATE mCpuTemplate = {\r
	21	CPU_ARCH_PROT_PRIVATE_SIGNATURE,\r
	22	NULL,\r
	23	{\r
	24	EmuFlushCpuDataCache,\r
	25	EmuEnableInterrupt,\r
	26	EmuDisableInterrupt,\r
	27	EmuGetInterruptState,\r
	28	EmuInit,\r
	29	EmuRegisterInterruptHandler,\r
	30	EmuGetTimerValue,\r
	31	EmuSetMemoryAttributes,\r
	32	0,\r
	33	4\r
	34	},\r
	35	{\r
	36	{\r
	37	CpuMemoryServiceRead,\r
	38	CpuMemoryServiceWrite\r
	39	},\r
	40	{\r
	41	CpuIoServiceRead,\r
	42	CpuIoServiceWrite\r
	43	}\r
	44	},\r
	45	TRUE\r
	46	};\r
	47	\r
	48	#define EFI_CPU_DATA_MAXIMUM_LENGTH 0x100\r
	49	\r
a0af6b27	50	SMBIOS_TABLE_TYPE4 mCpuSmbiosType4 = {\r
	51	{ EFI_SMBIOS_TYPE_PROCESSOR_INFORMATION, sizeof (SMBIOS_TABLE_TYPE4), 0},\r
	52	1, // Socket String\r
	53	ProcessorOther, // ProcessorType; ///< The enumeration value from PROCESSOR_TYPE_DATA.\r
	54	ProcessorFamilyOther, // ProcessorFamily; ///< The enumeration value from PROCESSOR_FAMILY_DATA.\r
	55	2, // ProcessorManufacture String;\r
	56	{ // ProcessorId;\r
	57	{ // PROCESSOR_SIGNATURE\r
	58	0, // ProcessorSteppingId:4;\r
	59	0, // ProcessorModel: 4;\r
	60	0, // ProcessorFamily: 4;\r
	61	0, // ProcessorType: 2;\r
	62	0, // ProcessorReserved1: 2;\r
	63	0, // ProcessorXModel: 4;\r
	64	0, // ProcessorXFamily: 8;\r
	65	0, // ProcessorReserved2: 4;\r
	66	}, \r
	67	{ // PROCESSOR_FEATURE_FLAGS\r
	68	0, // ProcessorFpu :1;\r
	69	0, // ProcessorVme :1;\r
	70	0, // ProcessorDe :1;\r
	71	0, // ProcessorPse :1;\r
	72	0, // ProcessorTsc :1;\r
	73	0, // ProcessorMsr :1;\r
	74	0, // ProcessorPae :1;\r
	75	0, // ProcessorMce :1;\r
	76	0, // ProcessorCx8 :1;\r
	77	0, // ProcessorApic :1;\r
	78	0, // ProcessorReserved1 :1;\r
	79	0, // ProcessorSep :1;\r
	80	0, // ProcessorMtrr :1;\r
	81	0, // ProcessorPge :1;\r
	82	0, // ProcessorMca :1;\r
	83	0, // ProcessorCmov :1;\r
	84	0, // ProcessorPat :1;\r
	85	0, // ProcessorPse36 :1;\r
	86	0, // ProcessorPsn :1;\r
	87	0, // ProcessorClfsh :1;\r
	88	0, // ProcessorReserved2 :1;\r
	89	0, // ProcessorDs :1;\r
	90	0, // ProcessorAcpi :1;\r
	91	0, // ProcessorMmx :1;\r
	92	0, // ProcessorFxsr :1;\r
	93	0, // ProcessorSse :1;\r
	94	0, // ProcessorSse2 :1;\r
	95	0, // ProcessorSs :1;\r
	96	0, // ProcessorReserved3 :1;\r
	97	0, // ProcessorTm :1;\r
	98	0, // ProcessorReserved4 :2;\r
	99	}\r
	100	},\r
	101	3, // ProcessorVersion String;\r
	102	{ // Voltage;\r
	103	1, // ProcessorVoltageCapability5V :1; \r
	104	1, // ProcessorVoltageCapability3_3V :1; \r
	105	1, // ProcessorVoltageCapability2_9V :1; \r
	106	0, // ProcessorVoltageCapabilityReserved :1; ///< Bit 3, must be zero.\r
	107	0, // ProcessorVoltageReserved :3; ///< Bits 4-6, must be zero.\r
	108	0 // ProcessorVoltageIndicateLegacy :1;\r
	109	}, \r
	110	0, // ExternalClock;\r
	111	0, // MaxSpeed;\r
	112	0, // CurrentSpeed;\r
	113	0x41, // Status;\r
114	ProcessorUpgradeOther, // ProcessorUpgrade; ///< The enumeration value from PROCESSOR_UPGRADE.\r
115	0, // L1CacheHandle;\r
116	0, // L2CacheHandle;\r
117	0, // L3CacheHandle;\r
118	4, // SerialNumber;\r
119	5, // AssetTag;\r
120	6, // PartNumber;\r
121	0, // CoreCount;\r
122	0, // EnabledCoreCount;\r
123	0, // ThreadCount;\r
124	0, // ProcessorCharacteristics;\r
125	0, // ProcessorFamily2;\r
126	};\r
127	\r
128	CHAR8 *mCpuSmbiosType4Strings[] = {\r
129	"Socket",\r
dff5a05b	130	"http://www.tianocore.org/edk2/",\r
a0af6b27	131	"Emulated Processor",\r
	132	"1.0",\r
	133	"1.0",\r
	134	"1.0",\r
	135	NULL\r
	136	};\r
	137	\r
	138	\r
	139	/**\r
b02127ec	140	Create SMBIOS record.\r
	141	\r
	142	Converts a fixed SMBIOS structure and an array of pointers to strings into\r
	143	an SMBIOS record where the strings are cat'ed on the end of the fixed record\r
	144	and terminated via a double NULL and add to SMBIOS table.\r
	145	\r
	146	SMBIOS_TABLE_TYPE32 gSmbiosType12 = {\r
	147	{ EFI_SMBIOS_TYPE_SYSTEM_CONFIGURATION_OPTIONS, sizeof (SMBIOS_TABLE_TYPE12), 0 },\r
	148	1 // StringCount\r
	149	};\r
	150	CHAR8 *gSmbiosType12Strings[] = {\r
	151	"Not Found",\r
	152	NULL\r
	153	};\r
	154	\r
	155	...\r
	156	LogSmbiosData (\r
	157	(EFI_SMBIOS_TABLE_HEADER*)&gSmbiosType12, \r
	158	gSmbiosType12Strings\r
	159	);\r
a0af6b27	160	\r
b02127ec	161	@param Template Fixed SMBIOS structure, required.\r
	162	@param StringArray Array of strings to convert to an SMBIOS string pack. \r
	163	NULL is OK.\r
a0af6b27	164	\r
	165	**/\r
	166	EFI_STATUS\r
	167	LogSmbiosData (\r
	168	IN EFI_SMBIOS_TABLE_HEADER *Template,\r
	169	IN CHAR8 **StringPack \r
	170	)\r
	171	{\r
	172	EFI_STATUS Status;\r
	173	EFI_SMBIOS_PROTOCOL *Smbios; \r
	174	EFI_SMBIOS_HANDLE SmbiosHandle;\r
	175	EFI_SMBIOS_TABLE_HEADER *Record;\r
	176	UINTN Index;\r
	177	UINTN StringSize;\r
	178	UINTN Size;\r
	179	CHAR8 *Str;\r
	180	\r
	181	//\r
	182	// Locate Smbios protocol.\r
	183	//\r
	184	Status = gBS->LocateProtocol (&gEfiSmbiosProtocolGuid, NULL, (VOID **)&Smbios);\r
	185	if (EFI_ERROR (Status)) {\r
	186	return Status;\r
	187	}\r
	188	\r
	189	// Calculate the size of the fixed record and optional string pack\r
	190	Size = Template->Length;\r
b02127ec	191	if (StringPack == NULL) {\r
	192	// At least a double null is required\r
	193	Size += 2;\r
	194	} else {\r
	195	for (Index = 0; StringPack[Index] != NULL; Index++) {\r
	196	StringSize = AsciiStrSize (StringPack[Index]);\r
	197	Size += StringSize;\r
	198	}\r
	199	if (StringPack[0] == NULL) {\r
	200	// At least a double null is required\r
	201	Size += 1;\r
	202	}\r
	203	// Don't forget the terminating double null\r
	204	Size += 1;\r
a0af6b27	205	}\r
a0af6b27	206	\r
	207	// Copy over Template\r
	208	Record = (EFI_SMBIOS_TABLE_HEADER *)AllocateZeroPool (Size);\r
	209	if (Record == NULL) {\r
	210	return EFI_OUT_OF_RESOURCES;\r
	211	}\r
	212	CopyMem (Record, Template, Template->Length);\r
	213	\r
	214	// Append string pack\r
	215	Str = ((CHAR8 *)Record) + Record->Length;\r
	216	for (Index = 0; StringPack[Index] != NULL; Index++) {\r
	217	StringSize = AsciiStrSize (StringPack[Index]);\r
	218	CopyMem (Str, StringPack[Index], StringSize);\r
	219	Str += StringSize;\r
	220	}\r
	221	*Str = 0;\r
	222	\r
	223	SmbiosHandle = SMBIOS_HANDLE_PI_RESERVED;\r
	224	Status = Smbios->Add (\r
	225	Smbios,\r
	226	gImageHandle,\r
	227	&SmbiosHandle,\r
	228	Record\r
	229	);\r
	230	ASSERT_EFI_ERROR (Status);\r
	231	\r
	232	FreePool (Record);\r
	233	return Status;\r
	234	}\r
	235	\r
	236	\r
	237	\r
	238	\r
	239	VOID\r
	240	CpuUpdateSmbios (\r
	241	IN UINTN MaxCpus\r
	242	)\r
	243	{\r
e148512e	244	mCpuSmbiosType4.CoreCount = (UINT8) MaxCpus;\r
	245	mCpuSmbiosType4.EnabledCoreCount = (UINT8) MaxCpus;\r
	246	mCpuSmbiosType4.ThreadCount = (UINT8) MaxCpus;\r
a0af6b27	247	\r
	248	LogSmbiosData ((EFI_SMBIOS_TABLE_HEADER *)&mCpuSmbiosType4, mCpuSmbiosType4Strings);\r
	249	}\r
949f388f	250	\r
	251	\r
	252	//\r
	253	// Service routines for the driver\r
	254	//\r
	255	EFI_STATUS\r
	256	EFIAPI\r
	257	EmuFlushCpuDataCache (\r
	258	IN EFI_CPU_ARCH_PROTOCOL *This,\r
	259	IN EFI_PHYSICAL_ADDRESS Start,\r
	260	IN UINT64 Length,\r
	261	IN EFI_CPU_FLUSH_TYPE FlushType\r
	262	)\r
	263	{\r
	264	if (FlushType == EfiCpuFlushTypeWriteBackInvalidate) {\r
	265	//\r
	266	// Only WB flush is supported. We actually need do nothing on Emu emulator\r
	267	// environment. Classify this to follow EFI spec\r
	268	//\r
	269	return EFI_SUCCESS;\r
	270	}\r
	271	//\r
	272	// Other flush types are not supported by Emu emulator\r
	273	//\r
	274	return EFI_UNSUPPORTED;\r
	275	}\r
	276	\r
	277	EFI_STATUS\r
	278	EFIAPI\r
	279	EmuEnableInterrupt (\r
	280	IN EFI_CPU_ARCH_PROTOCOL *This\r
	281	)\r
	282	{\r
	283	CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
	284	\r
	285	Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
	286	Private->InterruptState = TRUE;\r
	287	gEmuThunk->EnableInterrupt ();\r
	288	return EFI_SUCCESS;\r
	289	}\r
	290	\r
	291	EFI_STATUS\r
	292	EFIAPI\r
	293	EmuDisableInterrupt (\r
	294	IN EFI_CPU_ARCH_PROTOCOL *This\r
	295	)\r
	296	{\r
	297	CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
	298	\r
	299	Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
	300	Private->InterruptState = FALSE;\r
	301	gEmuThunk->DisableInterrupt ();\r
	302	return EFI_SUCCESS;\r
	303	}\r
	304	\r
	305	EFI_STATUS\r
	306	EFIAPI\r
	307	EmuGetInterruptState (\r
	308	IN EFI_CPU_ARCH_PROTOCOL *This,\r
	309	OUT BOOLEAN *State\r
	310	)\r
	311	{\r
	312	CPU_ARCH_PROTOCOL_PRIVATE *Private;\r
	313	\r
314	if (State == NULL) {\r
315	return EFI_INVALID_PARAMETER;\r
316	}\r
317	\r
318	Private = CPU_ARCH_PROTOCOL_PRIVATE_DATA_FROM_THIS (This);\r
319	*State = Private->InterruptState;\r
320	return EFI_SUCCESS;\r
321	}\r
322	\r
323	EFI_STATUS\r
324	EFIAPI\r
325	EmuInit (\r
326	IN EFI_CPU_ARCH_PROTOCOL *This,\r
327	IN EFI_CPU_INIT_TYPE InitType\r
328	)\r
329	{\r
949f388f	330	return EFI_UNSUPPORTED;\r
	331	}\r
	332	\r
	333	EFI_STATUS\r
	334	EFIAPI\r
	335	EmuRegisterInterruptHandler (\r
	336	IN EFI_CPU_ARCH_PROTOCOL *This,\r
	337	IN EFI_EXCEPTION_TYPE InterruptType,\r
	338	IN EFI_CPU_INTERRUPT_HANDLER InterruptHandler\r
	339	)\r
	340	{\r
949f388f	341	//\r
	342	// Do parameter checking for EFI spec conformance\r
	343	//\r
	344	if (InterruptType < 0 \|\| InterruptType > 0xff) {\r
	345	return EFI_UNSUPPORTED;\r
	346	}\r
	347	//\r
	348	// Do nothing for Emu emulation\r
	349	//\r
949f388f	350	return EFI_UNSUPPORTED;\r
	351	}\r
	352	\r
	353	EFI_STATUS\r
	354	EFIAPI\r
	355	EmuGetTimerValue (\r
	356	IN EFI_CPU_ARCH_PROTOCOL *This,\r
	357	IN UINT32 TimerIndex,\r
	358	OUT UINT64 *TimerValue,\r
	359	OUT UINT64 *TimerPeriod OPTIONAL\r
	360	)\r
	361	{\r
	362	if (TimerValue == NULL) {\r
	363	return EFI_INVALID_PARAMETER;\r
	364	}\r
	365	\r
	366	if (TimerIndex != 0) {\r
	367	return EFI_INVALID_PARAMETER;\r
	368	}\r
d18d8a1d	369	\r
949f388f	370	*TimerValue = gEmuThunk->QueryPerformanceCounter ();\r
d18d8a1d	371	\r
949f388f	372	if (TimerPeriod != NULL) {\r
949f388f	373	*TimerPeriod = mTimerPeriod;\r
d18d8a1d	374	}\r
949f388f	375	\r
	376	return EFI_SUCCESS;\r
	377	}\r
	378	\r
	379	\r
	380	EFI_STATUS\r
	381	EFIAPI\r
	382	EmuSetMemoryAttributes (\r
	383	IN EFI_CPU_ARCH_PROTOCOL *This,\r
	384	IN EFI_PHYSICAL_ADDRESS BaseAddress,\r
	385	IN UINT64 Length,\r
	386	IN UINT64 Attributes\r
	387	)\r
	388	{\r
949f388f	389	//\r
	390	// Check for invalid parameter for Spec conformance\r
	391	//\r
	392	if (Length == 0) {\r
	393	return EFI_INVALID_PARAMETER;\r
	394	}\r
	395	\r
	396	//\r
	397	// Do nothing for Nt32 emulation\r
	398	//\r
949f388f	399	return EFI_UNSUPPORTED;\r
	400	}\r
	401	\r
	402	\r
	403	\r
57c7d70f	404	\r
	405	/**\r
	406	Callback function for idle events.\r
d18d8a1d	407	\r
57c7d70f	408	@param Event Event whose notification function is being invoked.\r
	409	@param Context The pointer to the notification function's context,\r
	410	which is implementation-dependent.\r
	411	\r
	412	**/\r
	413	VOID\r
	414	EFIAPI\r
	415	IdleLoopEventCallback (\r
	416	IN EFI_EVENT Event,\r
	417	IN VOID *Context\r
	418	)\r
	419	{\r
	420	gEmuThunk->CpuSleep ();\r
	421	}\r
	422	\r
	423	\r
949f388f	424	EFI_STATUS\r
	425	EFIAPI\r
	426	InitializeCpu (\r
	427	IN EFI_HANDLE ImageHandle,\r
	428	IN EFI_SYSTEM_TABLE *SystemTable\r
	429	)\r
	430	{\r
	431	EFI_STATUS Status;\r
	432	UINT64 Frequency;\r
57c7d70f	433	EFI_EVENT IdleLoopEvent;\r
a0af6b27	434	UINTN MaxCpu;\r
949f388f	435	\r
	436	//\r
	437	// Retrieve the frequency of the performance counter in Hz.\r
d18d8a1d	438	//\r
949f388f	439	Frequency = gEmuThunk->QueryPerformanceFrequency ();\r
d18d8a1d	440	\r
949f388f	441	//\r
	442	// Convert frequency in Hz to a clock period in femtoseconds.\r
	443	//\r
7e284acb	444	mTimerPeriod = DivU64x64Remainder (1000000000000000ULL, Frequency, NULL);\r
949f388f	445	\r
a0af6b27	446	CpuMpServicesInit (&MaxCpu);\r
	447	\r
	448	CpuUpdateSmbios (MaxCpu);\r
d18d8a1d	449	\r
d18d8a1d	450	\r
57c7d70f	451	Status = gBS->CreateEventEx (\r
	452	EVT_NOTIFY_SIGNAL,\r
	453	TPL_NOTIFY,\r
	454	IdleLoopEventCallback,\r
	455	NULL,\r
	456	&gIdleLoopEventGuid,\r
	457	&IdleLoopEvent\r
	458	);\r
	459	ASSERT_EFI_ERROR (Status);\r
	460	\r
949f388f	461	\r
	462	Status = gBS->InstallMultipleProtocolInterfaces (\r
	463	&mCpuTemplate.Handle,\r
	464	&gEfiCpuArchProtocolGuid, &mCpuTemplate.Cpu,\r
	465	&gEfiCpuIo2ProtocolGuid, &mCpuTemplate.CpuIo,\r
	466	NULL\r
	467	);\r
	468	ASSERT_EFI_ERROR (Status);\r
	469	\r
	470	return Status;\r
	471	}\r