1 files changed, 5 insertions, 4 deletions
diff --git a/demos/ATSAMA5D2/RT-SAMA5D2-XPLAINED-NSEC/smcclient.c b/demos/ATSAMA5D2/RT-SAMA5D2-XPLAINED-NSEC/smcclient.c
index ec32af7d6..15f094e2b 100644
--- a/demos/ATSAMA5D2/RT-SAMA5D2-XPLAINED-NSEC/smcclient.c
+++ b/demos/ATSAMA5D2/RT-SAMA5D2-XPLAINED-NSEC/smcclient.c
@@ -26,6 +26,7 @@
  */
 
 #include "ch.h"
+#include "smcclient.h"
 
 /*===========================================================================*/
 /* Module local definitions.                                                 */
@@ -50,14 +51,14 @@
 /*===========================================================================*/
 /* Module exported functions.                                                */
 /*===========================================================================*/
-
-msg_t smcInvokeService(msg_t handle, void *data)
+msg_t smcInvokeService(smc_service_t handle, smc_params_area_t data,
+                       size_t size)
 {
   msg_t result;
 
   do {
-    asm volatile("smc #0" : "=r" (result) : "r" (handle), "r" (data));
-  } while (result == MSG_RESET);
+    asm volatile("smc #0" : "=r" (result) : "r" (handle), "r" (data), "r" (size));
+  } while (result == MSG_TIMEOUT);
   return result;
 }