blob: 75f85cf69b37dbf4a3e815d169bc20d7d88e3c1a [file] [log] [blame]
Kevin Peng62a87112020-07-07 15:07:46 +08001/*
Feder Liang7abe9a42021-12-03 17:54:58 +08002 * Copyright (c) 2017-2022, Arm Limited. All rights reserved.
Chris Brand5c8b6392022-05-20 14:46:12 -07003 * Copyright (c) 2022 Cypress Semiconductor Corporation (an Infineon company)
4 * or an affiliate of Cypress Semiconductor Corporation. All rights reserved.
Kevin Peng62a87112020-07-07 15:07:46 +08005 *
6 * SPDX-License-Identifier: BSD-3-Clause
7 *
8 */
9
Kevin Peng62a87112020-07-07 15:07:46 +080010#include "cmsis_os2.h"
Xinyu Zhang4c640e82021-09-22 15:25:09 +080011#include "cmsis_compiler.h"
Kevin Peng62a87112020-07-07 15:07:46 +080012#include "tfm_ns_interface.h"
Xinyu Zhangeebbea32021-09-01 15:26:39 +080013#include "tfm_nsid_manager.h"
Kevin Peng342ec682022-04-29 10:36:58 +080014#include "test_app.h"
Kevin Peng62a87112020-07-07 15:07:46 +080015#include "tfm_plat_ns.h"
Raef Coles5ee45ed2020-09-24 11:25:44 +010016#include "driver/Driver_USART.h"
Kevin Peng62a87112020-07-07 15:07:46 +080017#include "device_cfg.h"
Chris Brand5c8b6392022-05-20 14:46:12 -070018#ifdef TFM_PARTITION_NS_AGENT_MAILBOX
Kevin Peng62a87112020-07-07 15:07:46 +080019#include "tfm_multi_core_api.h"
20#include "tfm_ns_mailbox.h"
21#endif
Summer Qin77894232020-08-28 11:24:15 +080022#include "tfm_log.h"
Kevin Peng62a87112020-07-07 15:07:46 +080023#include "uart_stdout.h"
Gabor Toth608e92f2022-09-06 12:41:41 +020024#if (CONFIG_TFM_FLOAT_ABI >= 1)
Feder Liang7abe9a42021-12-03 17:54:58 +080025#include "cmsis.h"
26#endif
Kevin Peng62a87112020-07-07 15:07:46 +080027
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 Huacba69e2021-09-10 15:36:48 +080034#if defined(__ARMCC_VERSION)
35#if (__ARMCC_VERSION == 6110004)
Kevin Peng62a87112020-07-07 15:07:46 +080036/* 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 Huacba69e2021-09-10 15:36:48 +080041
42/* Avoids the semihosting issue */
43#if (__ARMCC_VERSION >= 6010050)
44__asm(" .global __ARM_use_no_argv\n");
45#endif
46#endif
47
Kevin Peng62a87112020-07-07 15:07:46 +080048/**
49 * \brief List of RTOS thread attributes
50 */
Kevin Peng62a87112020-07-07 15:07:46 +080051static const osThreadAttr_t thread_attr = {
52 .name = "test_thread",
Xinyu Zhangeebbea32021-09-01 15:26:39 +080053 .stack_size = 4096U,
54 .tz_module = ((TZ_ModuleId_t)TFM_DEFAULT_NSID)
Kevin Peng62a87112020-07-07 15:07:46 +080055};
Kevin Peng342ec682022-04-29 10:36:58 +080056/**
57 * \brief Static globals to hold RTOS related quantities,
58 * main thread
59 */
60static osThreadFunc_t thread_func = test_app;
Kevin Peng62a87112020-07-07 15:07:46 +080061
David Hu98adf322020-09-01 16:18:46 +080062#ifdef TFM_MULTI_CORE_NS_OS_MAILBOX_THREAD
63static osThreadFunc_t mailbox_thread_func = tfm_ns_mailbox_thread_runner;
David Hu98adf322020-09-01 16:18:46 +080064static const osThreadAttr_t mailbox_thread_attr = {
65 .name = "mailbox_thread",
Robert Rostohar26ebd142020-12-21 16:48:58 +010066 .stack_size = 1024U
David Hu98adf322020-09-01 16:18:46 +080067};
68#endif
69
Chris Brand5c8b6392022-05-20 14:46:12 -070070#ifdef TFM_PARTITION_NS_AGENT_MAILBOX
Kevin Peng62a87112020-07-07 15:07:46 +080071static struct ns_mailbox_queue_t ns_mailbox_queue;
72
73static void tfm_ns_multi_core_boot(void)
74{
75 int32_t ret;
76
Chris Branda1499292021-10-28 12:02:05 -070077 LOG_MSG("Non-secure code running on non-secure core.\r\n");
Kevin Peng62a87112020-07-07 15:07:46 +080078
79 if (tfm_ns_wait_for_s_cpu_ready()) {
Chris Branda1499292021-10-28 12:02:05 -070080 LOG_MSG("Error sync'ing with secure core.\r\n");
Kevin Peng62a87112020-07-07 15:07:46 +080081
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 Branda1499292021-10-28 12:02:05 -070089 LOG_MSG("Non-secure mailbox initialization failed.\r\n");
Kevin Peng62a87112020-07-07 15:07:46 +080090
91 /* Avoid undefined behavior after NS mailbox initialization failed */
92 for (;;) {
93 }
94 }
95}
Chris Brand5c8b6392022-05-20 14:46:12 -070096#endif /* TFM_PARTITION_NS_AGENT_MAILBOX */
97
98#ifdef CONFIG_TFM_USE_TRUSTZONE
David Hucdc51fb2021-04-06 18:10:46 +080099extern uint32_t tfm_ns_interface_init(void);
Kevin Peng62a87112020-07-07 15:07:46 +0800100#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 Liang7abe9a42021-12-03 17:54:58 +0800128
129__WEAK int32_t tfm_ns_cp_init(void)
130{
Gabor Toth608e92f2022-09-06 12:41:41 +0200131#if (CONFIG_TFM_FLOAT_ABI >= 1)
Feder Liang7abe9a42021-12-03 17:54:58 +0800132#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 Peng62a87112020-07-07 15:07:46 +0800141/**
142 * \brief main() function
143 */
144#ifndef __GNUC__
145__attribute__((noreturn))
146#endif
147int main(void)
148{
Kevin Peng62a87112020-07-07 15:07:46 +0800149 if (tfm_ns_platform_init() != ARM_DRIVER_OK) {
150 /* Avoid undefined behavior if platform init failed */
151 while(1);
152 }
153
Feder Liang7abe9a42021-12-03 17:54:58 +0800154 if (tfm_ns_cp_init() != ARM_DRIVER_OK) {
155 /* Avoid undefined behavior if co-porcessor init failed */
156 while(1);
157 }
158
David Hu4ae00fe2021-01-27 17:48:07 +0800159 (void) osKernelInitialize();
160
Chris Brand5c8b6392022-05-20 14:46:12 -0700161#ifdef TFM_PARTITION_NS_AGENT_MAILBOX
Kevin Peng62a87112020-07-07 15:07:46 +0800162 tfm_ns_multi_core_boot();
Chris Brand5c8b6392022-05-20 14:46:12 -0700163#endif
164
165#ifdef CONFIG_TFM_USE_TRUSTZONE
Kevin Peng62a87112020-07-07 15:07:46 +0800166 /* Initialize the TFM NS interface */
167 tfm_ns_interface_init();
David Hucdc51fb2021-04-06 18:10:46 +0800168#endif
Kevin Peng62a87112020-07-07 15:07:46 +0800169
David Hu98adf322020-09-01 16:18:46 +0800170#ifdef TFM_MULTI_CORE_NS_OS_MAILBOX_THREAD
171 (void) osThreadNew(mailbox_thread_func, NULL, &mailbox_thread_attr);
172#endif
173
Kevin Peng62a87112020-07-07 15:07:46 +0800174 (void) osThreadNew(thread_func, NULL, &thread_attr);
Kevin Peng62a87112020-07-07 15:07:46 +0800175
176 LOG_MSG("Non-Secure system starting...\r\n");
177 (void) osKernelStart();
178
179 /* Reached only in case of error */
180 for (;;) {
181 }
182}