1 files changed, 64 insertions, 0 deletions
diff --git a/Platform/Hisilicon/D05/EarlyConfigPeim/EarlyConfigPeimD05.c b/Platform/Hisilicon/D05/EarlyConfigPeim/EarlyConfigPeimD05.c
new file mode 100644
index 0000000000..76a055cbe9
--- /dev/null
+++ b/Platform/Hisilicon/D05/EarlyConfigPeim/EarlyConfigPeimD05.c
@@ -0,0 +1,64 @@
+/** @file
+*
+*  Copyright (c) 2016, Hisilicon Limited. All rights reserved.
+*  Copyright (c) 2016, Linaro Limited. All rights reserved.
+*
+*  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 <PiPei.h>
+#include <PlatformArch.h>
+#include <Uefi.h>
+#include <Library/ArmLib.h>
+#include <Library/CacheMaintenanceLib.h>
+#include <Library/DebugLib.h>
+#include <Library/IoLib.h>
+#include <Library/OemAddressMapLib.h>
+#include <Library/OemMiscLib.h>
+#include <Library/PcdLib.h>
+#include <Library/PlatformSysCtrlLib.h>
+
+VOID
+QResetAp (
+  VOID
+  )
+{
+  MmioWrite64(FixedPcdGet64(PcdMailBoxAddress), 0x0);
+  (VOID)WriteBackInvalidateDataCacheRange((VOID *) FixedPcdGet64(PcdMailBoxAddress), 8);
+
+  if (!PcdGet64 (PcdTrustedFirmwareEnable)) {
+    StartupAp();
+  }
+}
+
+
+EFI_STATUS
+EFIAPI
+EarlyConfigEntry (
+  IN       EFI_PEI_FILE_HANDLE  FileHandle,
+  IN CONST EFI_PEI_SERVICES     **PeiServices
+  )
+{
+  DEBUG((DEBUG_INFO,"SMMU CONFIG........."));
+  (VOID)SmmuConfigForBios();
+  DEBUG((DEBUG_INFO,"Done\n"));
+
+  DEBUG((DEBUG_INFO,"AP CONFIG........."));
+  (VOID)QResetAp();
+  DEBUG((DEBUG_INFO,"Done\n"));
+
+  DEBUG((DEBUG_INFO,"MN CONFIG........."));
+  (VOID)MN_CONFIG();
+  DEBUG((DEBUG_INFO,"Done\n"));
+
+  return EFI_SUCCESS;
+}
+