1 files changed, 104 insertions, 0 deletions
diff --git a/Silicon/Hisilicon/Library/CpldIoLib/CpldIoLibRuntime.c b/Silicon/Hisilicon/Library/CpldIoLib/CpldIoLibRuntime.c
new file mode 100644
index 0000000000..d3275276c2
--- /dev/null
+++ b/Silicon/Hisilicon/Library/CpldIoLib/CpldIoLibRuntime.c
@@ -0,0 +1,104 @@
+/** @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 <PiDxe.h>
+#include <Library/DebugLib.h>
+#include <Library/UefiBootServicesTableLib.h>
+#include <Guid/EventGroup.h>
+#include <Library/UefiRuntimeLib.h>
+#include <Library/DxeServicesTableLib.h>
+#include <Library/PcdLib.h>
+#include <Library/IoLib.h>
+#include <Library/CpldIoLib.h>
+
+UINTN           mCpldRegAddr;
+EFI_EVENT       mCpldVirtualAddressChangeEvent;
+
+
+VOID
+EFIAPI
+CpldVirtualAddressChange (
+  IN EFI_EVENT        Event,
+  IN VOID             *Context
+  )
+{
+  EfiConvertPointer (0, (VOID **) &mCpldRegAddr);
+
+  return;
+}
+
+RETURN_STATUS
+EFIAPI
+CpldRuntimeLibConstructor (
+    VOID
+)
+{
+    EFI_STATUS              Status;
+    EFI_GCD_MEMORY_SPACE_DESCRIPTOR desp = {0};
+
+    mCpldRegAddr = PcdGet64(PcdCpldBaseAddress);
+    Status = gDS->GetMemorySpaceDescriptor(mCpldRegAddr,&desp);
+    if(EFI_ERROR(Status)){
+        DEBUG ((EFI_D_ERROR, "[%a]:[%dL] GetMemorySpaceDescriptor failed: %r\n", __FUNCTION__, __LINE__, Status));
+        return Status;
+    }
+    desp.Attributes |= EFI_MEMORY_RUNTIME;
+    Status = gDS->SetMemorySpaceAttributes(mCpldRegAddr,0x10000, desp.Attributes);
+    if(EFI_ERROR(Status)){
+        DEBUG ((EFI_D_ERROR, "[%a]:[%dL] SetMemorySpaceAttributes failed: %r\n", __FUNCTION__, __LINE__, Status));
+        return Status;
+    }
+    //
+    // Register notify function for EVT_SIGNAL_VIRTUAL_ADDRESS_CHANGE
+    //
+    Status = gBS->CreateEventEx (
+                    EVT_NOTIFY_SIGNAL,
+                    TPL_NOTIFY,
+                    CpldVirtualAddressChange,
+                    NULL,
+                    &gEfiEventVirtualAddressChangeGuid,
+                    &mCpldVirtualAddressChangeEvent
+                    );
+    ASSERT_EFI_ERROR (Status);
+    return Status;
+}
+
+EFI_STATUS
+EFIAPI
+CpldRuntimeLibDestructor (
+    VOID
+  )
+{
+  EFI_STATUS  Status = EFI_SUCCESS;
+
+  if(!mCpldVirtualAddressChangeEvent ){
+     return Status;
+  }
+
+  Status = gBS->CloseEvent(mCpldVirtualAddressChangeEvent);
+  return Status;
+}
+
+VOID WriteCpldReg(UINTN ulRegAddr, UINT8 ulValue)
+{
+    MmioWrite8 (ulRegAddr + mCpldRegAddr, ulValue);
+}
+
+UINT8 ReadCpldReg(UINTN ulRegAddr)
+{
+    return MmioRead8 (ulRegAddr + mCpldRegAddr);
+}
+
+