psoc64: Update TF-M for MBedOS

Charley Chu · Charley Chu · commit d3d03c9129f7 · 2020-07-16T21:55:16.000-07:00
- Replace TF-M OS wrapper API with CMSIS API
    - Add busy loop in mailbox_raw_spin_lock()
    - Use static allocated semaphore for NS lock

Signed-off-by: Charley Chu &lt;haoc@cypress.com&gt;
diff --git a/features/FEATURE_EXPERIMENTAL_API/FEATURE_PSA/TARGET_TFM/TARGET_TFM_DUALCPU/src/platform_ns_mailbox.c b/features/FEATURE_EXPERIMENTAL_API/FEATURE_PSA/TARGET_TFM/TARGET_TFM_DUALCPU/src/platform_ns_mailbox.c
@@ -16,9 +16,9 @@
 #include "cy_ipc_sema.h"
 
 #include "ns_ipc_config.h"
-#include "os_wrapper/thread.h"
 #include "tfm_ns_mailbox.h"
 #include "platform_multicore.h"
+#include "cmsis_os2.h"
 
 static uint8_t saved_irq_state = 1;
 
@@ -120,12 +120,12 @@ int32_t tfm_ns_mailbox_hal_init(struct ns_mailbox_queue_t *queue)
 
 const void *tfm_ns_mailbox_get_task_handle(void)
 {
-    return os_wrapper_thread_get_handle();
+    return osThreadGetId();;
 }
 
 void tfm_ns_mailbox_hal_wait_reply(mailbox_msg_handle_t handle)
 {
-    os_wrapper_thread_wait_flag((uint32_t)handle, OS_WRAPPER_WAIT_FOREVER);
+    osThreadFlagsWait(handle, osFlagsWaitAll, osWaitForever);
 }
 
 static cy_en_ipcsema_status_t mailbox_raw_spin_lock(uint32_t ipc_channel,
@@ -179,6 +179,10 @@ static cy_en_ipcsema_status_t mailbox_raw_spin_lock(uint32_t ipc_channel,
                  * notification event from secure core. However, it is more
                  * complex and requires more code and more modifications.
                  */
+                volatile uint32_t count = 1000;
+                while(count > 0) {
+                    count--;
+                }
                 Cy_IPC_Sema_Status(sema_num);
             }
         }
@@ -277,7 +281,7 @@ void cpuss_interrupts_ipc_8_IRQHandler(void)
 {
     uint32_t magic;
     mailbox_msg_handle_t handle;
-    void *task_handle;
+    osThreadId_t task_handle;
 
     if (!mailbox_clear_intr())
         return;
@@ -291,9 +295,9 @@ void cpuss_interrupts_ipc_8_IRQHandler(void)
                 break;
             }
 
-            task_handle = (void *)tfm_ns_mailbox_get_msg_owner(handle);
+            task_handle = (osThreadId_t)tfm_ns_mailbox_get_msg_owner(handle);
             if (task_handle) {
-                os_wrapper_thread_set_flag_isr(task_handle, (uint32_t)handle);
+                osThreadFlagsSet(task_handle, handle);
             }
         }
     }
diff --git a/features/FEATURE_EXPERIMENTAL_API/FEATURE_PSA/TARGET_TFM/TARGET_TFM_DUALCPU/src/tfm_multi_core_api.c b/features/FEATURE_EXPERIMENTAL_API/FEATURE_PSA/TARGET_TFM/TARGET_TFM_DUALCPU/src/tfm_multi_core_api.c
@@ -5,22 +5,30 @@
  *
  */
 
-#include "os_wrapper/semaphore.h"
-
 #include "tfm_api.h"
 #include "tfm_mailbox.h"
 #include "tfm_multi_core_api.h"
+#include "cmsis_os2.h"
+#include "mbed_rtos_storage.h"
 
 #define MAX_SEMAPHORE_COUNT            NUM_MAILBOX_QUEUE_SLOT
 
 static void *ns_lock_handle = NULL;
+static mbed_rtos_storage_semaphore_t tfm_ns_sema_obj;
 
 __attribute__((weak))
 enum tfm_status_e tfm_ns_interface_init(void)
 {
-    ns_lock_handle = os_wrapper_semaphore_create(MAX_SEMAPHORE_COUNT,
-                                                 MAX_SEMAPHORE_COUNT,
-                                                 NULL);
+    osSemaphoreAttr_t sema_attrib = {
+        .name = "tfm_ns_lock",
+        .attr_bits = 0,
+        .cb_size = sizeof(tfm_ns_sema_obj),
+        .cb_mem = &tfm_ns_sema_obj
+    };
+
+    ns_lock_handle = osSemaphoreNew(MAX_SEMAPHORE_COUNT,
+                                    MAX_SEMAPHORE_COUNT,
+                                    &sema_attrib);
     if (!ns_lock_handle) {
         return TFM_ERROR_GENERIC;
     }
@@ -35,11 +43,10 @@ int32_t tfm_ns_wait_for_s_cpu_ready(void)
 
 uint32_t tfm_ns_multi_core_lock_acquire(void)
 {
-    return os_wrapper_semaphore_acquire(ns_lock_handle,
-                                        OS_WRAPPER_WAIT_FOREVER);
+    return osSemaphoreAcquire(ns_lock_handle, osWaitForever);
 }
 
 uint32_t tfm_ns_multi_core_lock_release(void)
 {
-    return os_wrapper_semaphore_release(ns_lock_handle);
+    return osSemaphoreRelease(ns_lock_handle);
 }
diff --git a/features/FEATURE_EXPERIMENTAL_API/FEATURE_PSA/TARGET_TFM/TARGET_TFM_DUALCPU/src/tfm_multi_core_psa_ns_api.c b/features/FEATURE_EXPERIMENTAL_API/FEATURE_PSA/TARGET_TFM/TARGET_TFM_DUALCPU/src/tfm_multi_core_psa_ns_api.c
@@ -8,8 +8,6 @@
 #include <stdint.h>
 #include <stdbool.h>
 
-#include "os_wrapper/mutex.h"
-
 #include "psa/client.h"
 #include "psa/error.h"
 #include "tfm_api.h"
@@ -64,7 +62,7 @@ uint32_t psa_framework_version(void)
     uint32_t version;
     int32_t ret;
 
-    if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_acquire() != 0) {
         return PSA_VERSION_NONE;
     }
 
@@ -82,7 +80,7 @@ uint32_t psa_framework_version(void)
         version = PSA_VERSION_NONE;
     }
 
-    if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_release() != 0) {
         return PSA_VERSION_NONE;
     }
 
@@ -98,7 +96,7 @@ uint32_t psa_version(uint32_t sid)
 
     params.psa_version_params.sid = sid;
 
-    if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_acquire() != 0) {
         return PSA_VERSION_NONE;
     }
 
@@ -116,7 +114,7 @@ uint32_t psa_version(uint32_t sid)
         version = PSA_VERSION_NONE;
     }
 
-    if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_release() != 0) {
         return PSA_VERSION_NONE;
     }
 
@@ -133,7 +131,7 @@ psa_handle_t psa_connect(uint32_t sid, uint32_t version)
     params.psa_connect_params.sid = sid;
     params.psa_connect_params.version = version;
 
-    if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_acquire() != 0) {
         return PSA_NULL_HANDLE;
     }
 
@@ -151,7 +149,7 @@ psa_handle_t psa_connect(uint32_t sid, uint32_t version)
         psa_handle = PSA_NULL_HANDLE;
     }
 
-    if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_release() != 0) {
         return PSA_NULL_HANDLE;
     }
 
@@ -174,7 +172,7 @@ psa_status_t psa_call(psa_handle_t handle, int32_t type,
     params.psa_call_params.out_vec = out_vec;
     params.psa_call_params.out_len = out_len;
 
-    if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_acquire() != 0) {
         return PSA_ERROR_GENERIC_ERROR;
     }
 
@@ -192,7 +190,7 @@ psa_status_t psa_call(psa_handle_t handle, int32_t type,
         status = PSA_INTER_CORE_COMM_ERR;
     }
 
-    if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_release() != 0) {
         return PSA_ERROR_GENERIC_ERROR;
     }
 
@@ -207,7 +205,7 @@ void psa_close(psa_handle_t handle)
 
     params.psa_close_params.handle = handle;
 
-    if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {
+    if (tfm_ns_multi_core_lock_acquire() != 0) {
         return;
     }
 

Original file line number	Diff line number	Diff line change
`@@ -16,9 +16,9 @@`
`16`	`16`	`#include "cy_ipc_sema.h"`
`17`	`17`
`18`	`18`	`#include "ns_ipc_config.h"`
`19`		`-#include "os_wrapper/thread.h"`
`20`	`19`	`#include "tfm_ns_mailbox.h"`
`21`	`20`	`#include "platform_multicore.h"`
	`21`	`+#include "cmsis_os2.h"`
`22`	`22`
`23`	`23`	`static uint8_t saved_irq_state = 1;`
`24`	`24`
`@@ -120,12 +120,12 @@ int32_t tfm_ns_mailbox_hal_init(struct ns_mailbox_queue_t *queue)`
`120`	`120`
`121`	`121`	`const void *tfm_ns_mailbox_get_task_handle(void)`
`122`	`122`	`{`
`123`		`- return os_wrapper_thread_get_handle();`
	`123`	`+ return osThreadGetId();;`
`124`	`124`	`}`
`125`	`125`
`126`	`126`	`void tfm_ns_mailbox_hal_wait_reply(mailbox_msg_handle_t handle)`
`127`	`127`	`{`
`128`		`- os_wrapper_thread_wait_flag((uint32_t)handle, OS_WRAPPER_WAIT_FOREVER);`
	`128`	`+ osThreadFlagsWait(handle, osFlagsWaitAll, osWaitForever);`
`129`	`129`	`}`
`130`	`130`
`131`	`131`	`static cy_en_ipcsema_status_t mailbox_raw_spin_lock(uint32_t ipc_channel,`
`@@ -179,6 +179,10 @@ static cy_en_ipcsema_status_t mailbox_raw_spin_lock(uint32_t ipc_channel,`
`179`	`179`	`* notification event from secure core. However, it is more`
`180`	`180`	`* complex and requires more code and more modifications.`
`181`	`181`	`*/`
	`182`	`+ volatile uint32_t count = 1000;`
	`183`	`+ while(count > 0) {`
	`184`	`+ count--;`
	`185`	`+ }`
`182`	`186`	`Cy_IPC_Sema_Status(sema_num);`
`183`	`187`	`}`
`184`	`188`	`}`
`@@ -277,7 +281,7 @@ void cpuss_interrupts_ipc_8_IRQHandler(void)`
`277`	`281`	`{`
`278`	`282`	`uint32_t magic;`
`279`	`283`	`mailbox_msg_handle_t handle;`
`280`		`- void *task_handle;`
	`284`	`+ osThreadId_t task_handle;`
`281`	`285`
`282`	`286`	`if (!mailbox_clear_intr())`
`283`	`287`	`return;`
`@@ -291,9 +295,9 @@ void cpuss_interrupts_ipc_8_IRQHandler(void)`
`291`	`295`	`break;`
`292`	`296`	`}`
`293`	`297`
`294`		`- task_handle = (void *)tfm_ns_mailbox_get_msg_owner(handle);`
	`298`	`+ task_handle = (osThreadId_t)tfm_ns_mailbox_get_msg_owner(handle);`
`295`	`299`	`if (task_handle) {`
`296`		`- os_wrapper_thread_set_flag_isr(task_handle, (uint32_t)handle);`
	`300`	`+ osThreadFlagsSet(task_handle, handle);`
`297`	`301`	`}`
`298`	`302`	`}`
`299`	`303`	`}`
Original file line number	Diff line number	Diff line change
`@@ -8,8 +8,6 @@`
`8`	`8`	`#include <stdint.h>`
`9`	`9`	`#include <stdbool.h>`
`10`	`10`
`11`		`-#include "os_wrapper/mutex.h"`
`12`		`-`
`13`	`11`	`#include "psa/client.h"`
`14`	`12`	`#include "psa/error.h"`
`15`	`13`	`#include "tfm_api.h"`
`@@ -64,7 +62,7 @@ uint32_t psa_framework_version(void)`
`64`	`62`	`uint32_t version;`
`65`	`63`	`int32_t ret;`
`66`	`64`
`67`		`- if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {`
	`65`	`+ if (tfm_ns_multi_core_lock_acquire() != 0) {`
`68`	`66`	`return PSA_VERSION_NONE;`
`69`	`67`	`}`
`70`	`68`
`@@ -82,7 +80,7 @@ uint32_t psa_framework_version(void)`
`82`	`80`	`version = PSA_VERSION_NONE;`
`83`	`81`	`}`
`84`	`82`
`85`		`- if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {`
	`83`	`+ if (tfm_ns_multi_core_lock_release() != 0) {`
`86`	`84`	`return PSA_VERSION_NONE;`
`87`	`85`	`}`
`88`	`86`
`@@ -98,7 +96,7 @@ uint32_t psa_version(uint32_t sid)`
`98`	`96`
`99`	`97`	`params.psa_version_params.sid = sid;`
`100`	`98`
`101`		`- if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {`
	`99`	`+ if (tfm_ns_multi_core_lock_acquire() != 0) {`
`102`	`100`	`return PSA_VERSION_NONE;`
`103`	`101`	`}`
`104`	`102`
`@@ -116,7 +114,7 @@ uint32_t psa_version(uint32_t sid)`
`116`	`114`	`version = PSA_VERSION_NONE;`
`117`	`115`	`}`
`118`	`116`
`119`		`- if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {`
	`117`	`+ if (tfm_ns_multi_core_lock_release() != 0) {`
`120`	`118`	`return PSA_VERSION_NONE;`
`121`	`119`	`}`
`122`	`120`
`@@ -133,7 +131,7 @@ psa_handle_t psa_connect(uint32_t sid, uint32_t version)`
`133`	`131`	`params.psa_connect_params.sid = sid;`
`134`	`132`	`params.psa_connect_params.version = version;`
`135`	`133`
`136`		`- if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {`
	`134`	`+ if (tfm_ns_multi_core_lock_acquire() != 0) {`
`137`	`135`	`return PSA_NULL_HANDLE;`
`138`	`136`	`}`
`139`	`137`
`@@ -151,7 +149,7 @@ psa_handle_t psa_connect(uint32_t sid, uint32_t version)`
`151`	`149`	`psa_handle = PSA_NULL_HANDLE;`
`152`	`150`	`}`
`153`	`151`
`154`		`- if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {`
	`152`	`+ if (tfm_ns_multi_core_lock_release() != 0) {`
`155`	`153`	`return PSA_NULL_HANDLE;`
`156`	`154`	`}`
`157`	`155`
`@@ -174,7 +172,7 @@ psa_status_t psa_call(psa_handle_t handle, int32_t type,`
`174`	`172`	`params.psa_call_params.out_vec = out_vec;`
`175`	`173`	`params.psa_call_params.out_len = out_len;`
`176`	`174`
`177`		`- if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {`
	`175`	`+ if (tfm_ns_multi_core_lock_acquire() != 0) {`
`178`	`176`	`return PSA_ERROR_GENERIC_ERROR;`
`179`	`177`	`}`
`180`	`178`
`@@ -192,7 +190,7 @@ psa_status_t psa_call(psa_handle_t handle, int32_t type,`
`192`	`190`	`status = PSA_INTER_CORE_COMM_ERR;`
`193`	`191`	`}`
`194`	`192`
`195`		`- if (tfm_ns_multi_core_lock_release() != OS_WRAPPER_SUCCESS) {`
	`193`	`+ if (tfm_ns_multi_core_lock_release() != 0) {`
`196`	`194`	`return PSA_ERROR_GENERIC_ERROR;`
`197`	`195`	`}`
`198`	`196`
`@@ -207,7 +205,7 @@ void psa_close(psa_handle_t handle)`
`207`	`205`
`208`	`206`	`params.psa_close_params.handle = handle;`
`209`	`207`
`210`		`- if (tfm_ns_multi_core_lock_acquire() != OS_WRAPPER_SUCCESS) {`
	`208`	`+ if (tfm_ns_multi_core_lock_acquire() != 0) {`
`211`	`209`	`return;`
`212`	`210`	`}`
`213`	`211`