ArmPlatformPkg/PL35xSmc: Added function PL35xSmcSetRefresh

Signed-off-by: Olivier Martin <olivier.martin@arm.com>



git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@13254 6f19259b-4bc3-4df7-8a09-765794883524

2 files changed, 19 insertions, 4 deletions

diff --git a/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.S b/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.S
index 7c2a09c..3630389 100755
--- a/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.S
+++ b/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.S
@@ -1,10 +1,10 @@
 #

-#  Copyright (c) 2011, ARM Limited. All rights reserved.

+#  Copyright (c) 2011-2012, ARM 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                                            

+#  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.             

@@ -22,6 +22,7 @@
 .align 3

 

 GCC_ASM_EXPORT(PL35xSmcInitialize)

+GCC_ASM_EXPORT(PL35xSmcSetRefresh)

 

 // IN r1 Smc Base Address

 // IN r2 Smc Configuration Start Address

@@ -50,4 +51,10 @@ ASM_PFX(PL35xSmcInitialize):
   add   r2, #0xC

   b     ASM_PFX(PL35xSmcInitialize)

 

-ASM_FUNCTION_REMOVE_IF_UNREFERENCED
\ No newline at end of file
+// IN r1 Smc Base Address

+// IN r2 Smc Refresh Period 0

+// IN r3 Smc Refresh Period 1

+ASM_PFX(PL35xSmcSetRefresh):

+  str   r2, [r1, #PL350_SMC_REFRESH_0_OFFSET]

+  str   r3, [r1, #PL350_SMC_REFRESH_1_OFFSET]

+  blx lr

diff --git a/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.asm b/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.asm
index 8edc6c1..297b2d7 100755
--- a/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.asm
+++ b/ArmPlatformPkg/Drivers/PL35xSmc/InitializeSMC.asm
@@ -1,5 +1,5 @@
 //

-//  Copyright (c) 2011, ARM Limited. All rights reserved.

+//  Copyright (c) 2011-2012, ARM Limited. All rights reserved.

 //  

 //  This program and the accompanying materials                          

 //  are licensed and made available under the terms and conditions of the BSD License         

@@ -19,6 +19,7 @@
   INCLUDE AsmMacroIoLib.inc

   

   EXPORT  PL35xSmcInitialize

+  EXPORT  PL35xSmcSetRefresh

 

   PRESERVE8

   AREA    ModuleInitializeSMC, CODE, READONLY

@@ -50,3 +51,10 @@ PL35xSmcInitialize
   add   r2, #0xC

   b     PL35xSmcInitialize

 

+// IN r1 Smc Base Address

+// IN r2 Smc Refresh Period 0

+// IN r3 Smc Refresh Period 1

+PL35xSmcSetRefresh

+  str   r2, [r1, #PL350_SMC_REFRESH_0_OFFSET]

+  str   r3, [r1, #PL350_SMC_REFRESH_1_OFFSET]

+  blx lr