Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 1 | /* |
Feder Liang | 7abe9a4 | 2021-12-03 17:54:58 +0800 | [diff] [blame] | 2 | * Copyright (c) 2017-2022, Arm Limited. All rights reserved. |
Chris Brand | 5c8b639 | 2022-05-20 14:46:12 -0700 | [diff] [blame] | 3 | * Copyright (c) 2022 Cypress Semiconductor Corporation (an Infineon company) |
| 4 | * or an affiliate of Cypress Semiconductor Corporation. All rights reserved. |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 5 | * |
| 6 | * SPDX-License-Identifier: BSD-3-Clause |
| 7 | * |
| 8 | */ |
| 9 | |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 10 | #include "cmsis_os2.h" |
Xinyu Zhang | 4c640e8 | 2021-09-22 15:25:09 +0800 | [diff] [blame] | 11 | #include "cmsis_compiler.h" |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 12 | #include "tfm_ns_interface.h" |
Xinyu Zhang | eebbea3 | 2021-09-01 15:26:39 +0800 | [diff] [blame] | 13 | #include "tfm_nsid_manager.h" |
Kevin Peng | 342ec68 | 2022-04-29 10:36:58 +0800 | [diff] [blame] | 14 | #include "test_app.h" |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 15 | #include "tfm_plat_ns.h" |
Raef Coles | 5ee45ed | 2020-09-24 11:25:44 +0100 | [diff] [blame] | 16 | #include "driver/Driver_USART.h" |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 17 | #include "device_cfg.h" |
Chris Brand | 5c8b639 | 2022-05-20 14:46:12 -0700 | [diff] [blame] | 18 | #ifdef TFM_PARTITION_NS_AGENT_MAILBOX |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 19 | #include "tfm_multi_core_api.h" |
| 20 | #include "tfm_ns_mailbox.h" |
| 21 | #endif |
Summer Qin | 7789423 | 2020-08-28 11:24:15 +0800 | [diff] [blame] | 22 | #include "tfm_log.h" |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 23 | #include "uart_stdout.h" |
Gabor Toth | 608e92f | 2022-09-06 12:41:41 +0200 | [diff] [blame] | 24 | #if (CONFIG_TFM_FLOAT_ABI >= 1) |
Feder Liang | 7abe9a4 | 2021-12-03 17:54:58 +0800 | [diff] [blame] | 25 | #include "cmsis.h" |
| 26 | #endif |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 27 | |
| 28 | /** |
| 29 | * \brief Modified table template for user defined SVC functions |
| 30 | * |
| 31 | * \details RTX has a weak definition of osRtxUserSVC, which |
| 32 | * is overridden here |
| 33 | */ |
David Hu | acba69e | 2021-09-10 15:36:48 +0800 | [diff] [blame] | 34 | #if defined(__ARMCC_VERSION) |
| 35 | #if (__ARMCC_VERSION == 6110004) |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 36 | /* Workaround needed for a bug in Armclang 6.11, more details at: |
| 37 | * http://www.keil.com/support/docs/4089.htm |
| 38 | */ |
| 39 | __attribute__((section(".gnu.linkonce"))) |
| 40 | #endif |
David Hu | acba69e | 2021-09-10 15:36:48 +0800 | [diff] [blame] | 41 | |
| 42 | /* Avoids the semihosting issue */ |
| 43 | #if (__ARMCC_VERSION >= 6010050) |
| 44 | __asm(" .global __ARM_use_no_argv\n"); |
| 45 | #endif |
| 46 | #endif |
| 47 | |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 48 | /** |
| 49 | * \brief List of RTOS thread attributes |
| 50 | */ |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 51 | static const osThreadAttr_t thread_attr = { |
| 52 | .name = "test_thread", |
Xinyu Zhang | eebbea3 | 2021-09-01 15:26:39 +0800 | [diff] [blame] | 53 | .stack_size = 4096U, |
| 54 | .tz_module = ((TZ_ModuleId_t)TFM_DEFAULT_NSID) |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 55 | }; |
Kevin Peng | 342ec68 | 2022-04-29 10:36:58 +0800 | [diff] [blame] | 56 | /** |
| 57 | * \brief Static globals to hold RTOS related quantities, |
| 58 | * main thread |
| 59 | */ |
| 60 | static osThreadFunc_t thread_func = test_app; |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 61 | |
David Hu | 98adf32 | 2020-09-01 16:18:46 +0800 | [diff] [blame] | 62 | #ifdef TFM_MULTI_CORE_NS_OS_MAILBOX_THREAD |
| 63 | static osThreadFunc_t mailbox_thread_func = tfm_ns_mailbox_thread_runner; |
David Hu | 98adf32 | 2020-09-01 16:18:46 +0800 | [diff] [blame] | 64 | static const osThreadAttr_t mailbox_thread_attr = { |
| 65 | .name = "mailbox_thread", |
Robert Rostohar | 26ebd14 | 2020-12-21 16:48:58 +0100 | [diff] [blame] | 66 | .stack_size = 1024U |
David Hu | 98adf32 | 2020-09-01 16:18:46 +0800 | [diff] [blame] | 67 | }; |
| 68 | #endif |
| 69 | |
Chris Brand | 5c8b639 | 2022-05-20 14:46:12 -0700 | [diff] [blame] | 70 | #ifdef TFM_PARTITION_NS_AGENT_MAILBOX |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 71 | static struct ns_mailbox_queue_t ns_mailbox_queue; |
| 72 | |
| 73 | static void tfm_ns_multi_core_boot(void) |
| 74 | { |
| 75 | int32_t ret; |
| 76 | |
Chris Brand | a149929 | 2021-10-28 12:02:05 -0700 | [diff] [blame] | 77 | LOG_MSG("Non-secure code running on non-secure core.\r\n"); |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 78 | |
| 79 | if (tfm_ns_wait_for_s_cpu_ready()) { |
Chris Brand | a149929 | 2021-10-28 12:02:05 -0700 | [diff] [blame] | 80 | LOG_MSG("Error sync'ing with secure core.\r\n"); |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 81 | |
| 82 | /* Avoid undefined behavior after multi-core sync-up failed */ |
| 83 | for (;;) { |
| 84 | } |
| 85 | } |
| 86 | |
| 87 | ret = tfm_ns_mailbox_init(&ns_mailbox_queue); |
| 88 | if (ret != MAILBOX_SUCCESS) { |
Chris Brand | a149929 | 2021-10-28 12:02:05 -0700 | [diff] [blame] | 89 | LOG_MSG("Non-secure mailbox initialization failed.\r\n"); |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 90 | |
| 91 | /* Avoid undefined behavior after NS mailbox initialization failed */ |
| 92 | for (;;) { |
| 93 | } |
| 94 | } |
| 95 | } |
Chris Brand | 5c8b639 | 2022-05-20 14:46:12 -0700 | [diff] [blame] | 96 | #endif /* TFM_PARTITION_NS_AGENT_MAILBOX */ |
| 97 | |
| 98 | #ifdef CONFIG_TFM_USE_TRUSTZONE |
David Hu | cdc51fb | 2021-04-06 18:10:46 +0800 | [diff] [blame] | 99 | extern uint32_t tfm_ns_interface_init(void); |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 100 | #endif |
| 101 | |
| 102 | /** |
| 103 | * \brief Platform peripherals and devices initialization. |
| 104 | * Can be overridden for platform specific initialization. |
| 105 | * |
| 106 | * \return ARM_DRIVER_OK if the initialization succeeds |
| 107 | */ |
| 108 | __WEAK int32_t tfm_ns_platform_init(void) |
| 109 | { |
| 110 | stdio_init(); |
| 111 | |
| 112 | return ARM_DRIVER_OK; |
| 113 | } |
| 114 | |
| 115 | /** |
| 116 | * \brief Platform peripherals and devices de-initialization. |
| 117 | * Can be overridden for platform specific initialization. |
| 118 | * |
| 119 | * \return ARM_DRIVER_OK if the de-initialization succeeds |
| 120 | */ |
| 121 | __WEAK int32_t tfm_ns_platform_uninit(void) |
| 122 | { |
| 123 | stdio_uninit(); |
| 124 | |
| 125 | return ARM_DRIVER_OK; |
| 126 | } |
| 127 | |
Feder Liang | 7abe9a4 | 2021-12-03 17:54:58 +0800 | [diff] [blame] | 128 | |
| 129 | __WEAK int32_t tfm_ns_cp_init(void) |
| 130 | { |
Gabor Toth | 608e92f | 2022-09-06 12:41:41 +0200 | [diff] [blame] | 131 | #if (CONFIG_TFM_FLOAT_ABI >= 1) |
Feder Liang | 7abe9a4 | 2021-12-03 17:54:58 +0800 | [diff] [blame] | 132 | #ifdef __GNUC__ |
| 133 | /* Enable NSPE privileged and unprivilged access to the FP Extension */ |
| 134 | SCB->CPACR |= (3U << 10U*2U) /* enable CP10 full access */ |
| 135 | | (3U << 11U*2U); /* enable CP11 full access */ |
| 136 | #endif |
| 137 | #endif |
| 138 | return ARM_DRIVER_OK; |
| 139 | } |
| 140 | |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 141 | /** |
| 142 | * \brief main() function |
| 143 | */ |
| 144 | #ifndef __GNUC__ |
| 145 | __attribute__((noreturn)) |
| 146 | #endif |
| 147 | int main(void) |
| 148 | { |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 149 | if (tfm_ns_platform_init() != ARM_DRIVER_OK) { |
| 150 | /* Avoid undefined behavior if platform init failed */ |
| 151 | while(1); |
| 152 | } |
| 153 | |
Feder Liang | 7abe9a4 | 2021-12-03 17:54:58 +0800 | [diff] [blame] | 154 | if (tfm_ns_cp_init() != ARM_DRIVER_OK) { |
| 155 | /* Avoid undefined behavior if co-porcessor init failed */ |
| 156 | while(1); |
| 157 | } |
| 158 | |
David Hu | 4ae00fe | 2021-01-27 17:48:07 +0800 | [diff] [blame] | 159 | (void) osKernelInitialize(); |
| 160 | |
Chris Brand | 5c8b639 | 2022-05-20 14:46:12 -0700 | [diff] [blame] | 161 | #ifdef TFM_PARTITION_NS_AGENT_MAILBOX |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 162 | tfm_ns_multi_core_boot(); |
Chris Brand | 5c8b639 | 2022-05-20 14:46:12 -0700 | [diff] [blame] | 163 | #endif |
| 164 | |
| 165 | #ifdef CONFIG_TFM_USE_TRUSTZONE |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 166 | /* Initialize the TFM NS interface */ |
| 167 | tfm_ns_interface_init(); |
David Hu | cdc51fb | 2021-04-06 18:10:46 +0800 | [diff] [blame] | 168 | #endif |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 169 | |
David Hu | 98adf32 | 2020-09-01 16:18:46 +0800 | [diff] [blame] | 170 | #ifdef TFM_MULTI_CORE_NS_OS_MAILBOX_THREAD |
| 171 | (void) osThreadNew(mailbox_thread_func, NULL, &mailbox_thread_attr); |
| 172 | #endif |
| 173 | |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 174 | (void) osThreadNew(thread_func, NULL, &thread_attr); |
Kevin Peng | 62a8711 | 2020-07-07 15:07:46 +0800 | [diff] [blame] | 175 | |
| 176 | LOG_MSG("Non-Secure system starting...\r\n"); |
| 177 | (void) osKernelStart(); |
| 178 | |
| 179 | /* Reached only in case of error */ |
| 180 | for (;;) { |
| 181 | } |
| 182 | } |