diff --git a/soc/arm/xilinx_zynqmp/soc.c b/soc/arm/xilinx_zynqmp/soc.c
index 9deecdf11cc..b828e39f8a2 100644
--- a/soc/arm/xilinx_zynqmp/soc.c
+++ b/soc/arm/xilinx_zynqmp/soc.c
@@ -8,6 +8,7 @@
 #include <kernel.h>
 #include <device.h>
 #include <init.h>
+#include <arch/arm/aarch32/cortex_r/cmsis.h>
 
 /**
  *
@@ -34,9 +35,8 @@ void z_platform_init(void)
 	/*
 	 * Use normal exception vectors address range (0x0-0x1C).
 	 */
-	__asm__ volatile(
-		"mrc p15, 0, r0, c1, c0, 0;"		/* SCTLR */
-		"bic r0, r0, #" TOSTR(HIVECS) ";"	/* Clear HIVECS */
-		"mcr p15, 0, r0, c1, c0, 0;"
-		: : : "memory");
+	unsigned int sctlr = __get_SCTLR();
+
+	sctlr &= ~SCTLR_V_Msk;
+	__set_SCTLR(sctlr);
 }
diff --git a/soc/arm/xilinx_zynqmp/soc.h b/soc/arm/xilinx_zynqmp/soc.h
index 9a53a709ebb..a3765eda0af 100644
--- a/soc/arm/xilinx_zynqmp/soc.h
+++ b/soc/arm/xilinx_zynqmp/soc.h
@@ -8,13 +8,7 @@
 #ifndef _BOARD__H_
 #define _BOARD__H_
 
-#include <sys/util.h>
-
-#ifndef _ASMLANGUAGE
-
-#include <device.h>
-#include <sys/util.h>
-
-#endif /* !_ASMLANGUAGE */
+/* Define CMSIS configurations */
+#define __CR_REV		1U
 
 #endif /* _BOARD__H_ */