---
bsps/shared/start/bspreset-arm-psci.c | 20 ++++++++++++++++++++
1 file changed, 20 insertions(+)
diff --git a/bsps/shared/start/bspreset-arm-psci.c
b/bsps/shared/start/bspreset-arm-psci.c
index 215be5c9b5..bafdfe6299 100644
--- a/bsps/shared/start/bspreset-arm-psci.c
+++ b/bsps/shared/start/bspreset-arm-psci.c
@@ -37,9 +37,28 @@
#include <bsp.h>
#include <bsp/bootcard.h>
+#if defined( AARCH64_MULTILIB_ARCH_V8 ) || \
+ defined( AARCH64_MULTILIB_ARCH_V8_ILP32 )
+#include <rtems/score/aarch64-smc.h>
+#endif
+
void bsp_reset(void)
{
uint32_t PSCI_FN_SYSTEM_RESET = 0x84000009;
+#ifdef BSP_RESET_SMC
+ (void) _AArch64_SMC_Invoke(
+ PSCI_FN_SYSTEM_RESET,
+ 0,
+ 0,
+ 0,
+ 0,
+ 0,
+ 0,
+ 0,
+ 0,
+ NULL
+ );
+#else
__asm__ volatile(
#if defined(AARCH64_MULTILIB_ARCH_V8) ||
defined(AARCH64_MULTILIB_ARCH_V8_ILP32)
"mov x0, %0\n"
@@ -53,4 +72,5 @@ void bsp_reset(void)
#endif
: : "r" (PSCI_FN_SYSTEM_RESET)
);
+#endif
}
--
2.25.1
_______________________________________________
devel mailing list
devel@rtems.org
http://lists.rtems.org/mailman/listinfo/devel
