1 files changed, 124 insertions, 0 deletions
diff --git a/Silicon/Intel/PurleyRcPkg/Library/UsraAccessLib/CsrAccess.c b/Silicon/Intel/PurleyRcPkg/Library/UsraAccessLib/CsrAccess.c
new file mode 100644
index 0000000000..b8f2663591
--- /dev/null
+++ b/Silicon/Intel/PurleyRcPkg/Library/UsraAccessLib/CsrAccess.c
@@ -0,0 +1,124 @@
+/** @file
+
+Copyright (c) 2018, Intel Corporation. All rights reserved.<BR>
+This program and the accompanying materials are licensed and made available under
+the terms and conditions of the BSD License that 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 "UsraAccessLib.h"
+
+/**
+  This API get the CSR address from the given USRA Address.
+
+  @param[in] Global               Global pointer
+  @param[in] Virtual              Virtual address
+  @param[in] Address              A pointer of the address of the USRA Address Structure
+  @param[out] AlignedAddress      A pointer of aligned address converted from USRA address
+
+  @retval NONE
+**/
+VOID
+GetCsrAccessAddress (
+  IN VOID                     *Global,
+  IN BOOLEAN                  Virtual,
+  IN USRA_ADDRESS             *Address,
+  OUT UINTN                   *AlignedAddress
+  )
+{
+  CsrGetPcieAlignAddress (Global, Virtual, Address, AlignedAddress);
+}
+
+/**
+  This API performs 8-bit, 16-bit, 32-bit or 64-bit CSR silicon register read operations.
+  It transfers data from a register into a naturally aligned data buffer.
+
+  @param[in] Address              A pointer of the address of the USRA Address Structure to be read out
+  @param[in] Buffer               A pointer of buffer for the value read from the register
+
+  @retval RETURN_SUCCESS          The function completed successfully.
+**/
+RETURN_STATUS
+CsrRegisterRead (
+  IN USRA_ADDRESS             *Address,
+  IN VOID                     *Buffer
+  )
+{
+  UINTN                       AlignedAddress = 0;
+
+  GetCsrAccessAddress (NULL, 0, Address, &AlignedAddress);
+
+    UsraRegAlignedRead((UINT32)Address->Attribute.AccessWidth, AlignedAddress, Buffer);
+  
+  return RETURN_SUCCESS;
+}
+
+/**
+  This API performs 8-bit, 16-bit, 32-bit or 64-bit CSR silicon register write operations.
+  It transfers data from a naturally aligned data buffer into a register.
+
+  @param[in] Address              A pointer of the address of the USRA Address Structure to be written
+  @param[in] Buffer               A pointer of buffer for the value write to the register
+
+  @retval RETURN_SUCCESS          The function completed successfully.
+**/
+RETURN_STATUS
+CsrRegisterWrite (
+  IN USRA_ADDRESS             *Address,
+  OUT VOID                    *Buffer
+  )
+{
+  UINTN                       AlignedAddress = 0;
+
+  GetCsrAccessAddress (NULL, 0, Address, &AlignedAddress);
+
+    UsraRegAlignedWrite((UINT32)Address->Attribute.AccessWidth, AlignedAddress, Buffer);  
+
+  if (FeaturePcdGet (PcdUsraSupportS3))
+  {
+    if(Address->Attribute.S3Enable)
+    {
+      S3BootScriptSaveMemWrite ((S3_BOOT_SCRIPT_LIB_WIDTH)Address->Attribute.AccessWidth, (UINT64)AlignedAddress, 1, Buffer);
+    }
+  }
+
+  return RETURN_SUCCESS;
+}
+
+/**
+  This API performs 8-bit, 16-bit, 32-bit or 64-bit CSR silicon register AND then OR operations. It read data from a
+  register, And it with the AndBuffer, then Or it with the OrBuffer, and write the result back to the register
+
+  @param[in] Address              A pointer of the address of the silicon register to be written
+  @param[in] AndBuffer            A pointer of buffer for the value used for AND operation
+                                  A NULL pointer means no AND operation. RegisterModify() equivalents to RegisterOr()
+  @param[in] OrBuffer             A pointer of buffer for the value used for OR operation
+                                  A NULL pointer means no OR operation. RegisterModify() equivalents to RegisterAnd()
+
+  @retval RETURN_SUCCESS          The function completed successfully.
+**/
+RETURN_STATUS
+CsrRegisterModify (
+  IN USRA_ADDRESS             *Address,
+  IN VOID                     *AndBuffer,
+  IN VOID                     *OrBuffer
+  )
+{
+
+  UINT64                      Data;
+  UINT8                       WidthTable[] = {1,2,4,8};
+  UINTN                       AlignedAddress = 0;
+
+  GetCsrAccessAddress (NULL, 0, Address, &AlignedAddress);
+
+    UsraRegAlignedRead((UINT32)Address->Attribute.AccessWidth, AlignedAddress, &Data);
+    DataAndOr (&Data, AndBuffer, OrBuffer, WidthTable[(UINT8)Address->Attribute.AccessWidth]);
+    UsraRegAlignedWrite((UINT32)Address->Attribute.AccessWidth, AlignedAddress, &Data);
+
+  return RETURN_SUCCESS;
+}