25#include <pico/runtime.h>
26#include <pico/stdio.h>
27#include <pico/unique_id.h>
32#include <arch/arm/cortex-m/stk_arch_arm-tz.h>
36#if (__ARM_FEATURE_CMSE & 1) == 0
37#error "Need ARMv8-M security extensions"
38#elif (__ARM_FEATURE_CMSE & 2) == 0
39#error "Compile with --mcmse"
51#define TASK_NS_COUNT (4U)
52#define TASK_S_COUNT (1U)
53#define TASK_COUNT (TASK_NS_COUNT + TASK_S_COUNT)
56#define KERNEL_TYPE KERNEL_STATIC
98 if (cmse_check_address_range(key, size, CMSE_NONSECURE | CMSE_MPU_READWRITE) !=
nullptr)
133 extern char __nsc_start[];
134 extern char __nsc_end[];
135 extern char __ns_ram_start[];
137 extern char __ns_flash_start[];
138 extern char __ns_flash_end[];
139 extern char __ns_scratch_start[];
140 extern char __ns_scratch_end[];
147 SAU->RBAR = (uintptr_t)__nsc_start;
148 SAU->RLAR = (((uintptr_t)__nsc_end - 1U) & ~0x1FU) | 2U | 1U;
152 SAU->RBAR = (uintptr_t)__ns_flash_start;
153 SAU->RLAR = (((uintptr_t)__ns_flash_end - 1U) & ~0x1FU) | 0U | 1U;
157 SAU->RBAR = (uintptr_t)__ns_ram_start;
158 SAU->RLAR = (((uintptr_t)__ns_scratch_start - 1U) & ~0x1FU) | 0U | 1U;
162 SAU->RBAR = (uintptr_t)__ns_scratch_start;
163 SAU->RLAR = (((uintptr_t)__ns_scratch_end - 1U) & ~0x1FU) | 0U | 1U;
166 for (uint32_t i = 4U; i < 8U; ++i)
183 SCB->SHCSR |= SCB_SHCSR_SECUREFAULTENA_Msk |
184 SCB_SHCSR_BUSFAULTENA_Msk |
185 SCB_SHCSR_USGFAULTENA_Msk |
186 SCB_SHCSR_MEMFAULTENA_Msk;
198 extern char __ns_flash_start[];
206 uint32_t *ns_vector_table =
reinterpret_cast<uint32_t *
>(__ns_flash_start);
207 uint32_t initial_msp_ns = ns_vector_table[0];
208 __TZ_set_MSP_NS(initial_msp_ns);
211 SCB_NS->VTOR =
reinterpret_cast<uintptr_t
>(__ns_flash_start);
216 uint32_t reset_handler_address = ns_vector_table[1];
220 NSFuncT ResetHandler_ns =
reinterpret_cast<NSFuncT
>(reset_handler_address & ~1UL);
244template <stk::EAccessMode _AccessMode>
281 printf(
"\r\n================ MEMMANAGE FAULT DETECTED ================\r\n");
282 printf(
"(Sandbox Violation: a task's Run() reached outside the MPU\r\n");
283 printf(
" regions granted to it - see region dump below for what\r\n");
284 printf(
" WAS active for this task at fault time)\r\n");
288 printf(
"\r\n================== HARD FAULT DETECTED ===================\r\n");
291 printf(
"ITask *: 0x%08X:\r\n", (
unsigned int)tid);
293 printf(
"EXC_RETURN: 0x%08X\r\n\r\n", (
unsigned int)ctx->
EXC_RETURN);
295 printf(
"--- Stacked CPU Registers ---\r\n");
296 printf(
"R0: 0x%08X R1: 0x%08X R2: 0x%08X\r\n", (
unsigned int)ctx->
frame.
R0, (
unsigned int)ctx->
frame.
R1, (
unsigned int)ctx->
frame.
R2);
297 printf(
"R3: 0x%08X R12: 0x%08X LR: 0x%08X\r\n", (
unsigned int)ctx->
frame.
R3, (
unsigned int)ctx->
frame.
R12, (
unsigned int)ctx->
frame.
LR);
298 printf(
"PC: 0x%08X xPSR: 0x%08X\r\n\r\n", (
unsigned int)ctx->
frame.
PC, (
unsigned int)ctx->
frame.
xPSR);
300 printf(
"--- System Control Registers ---\r\n");
301 printf(
"CFSR: 0x%08X HFSR: 0x%08X AFSR: 0x%08X\r\n", (
unsigned int)ctx->
CFSR, (
unsigned int)ctx->
HFSR, (
unsigned int)ctx->
AFSR);
302 printf(
"MMFAR: 0x%08X (%s)\r\n", (
unsigned int)ctx->
MMFAR, ctx->
mmfar_valid ?
"VALID" :
"INVALID");
303 printf(
"BFAR: 0x%08X (%s)\r\n\r\n", (
unsigned int)ctx->
BFAR, ctx->
bfar_valid ?
"VALID" :
"INVALID");
304 printf(
"CONTROL: 0x%08X (nPRIV=%u)\r\n", (
unsigned int)ctx->
CONTROL, (
unsigned int)(ctx->
CONTROL & 1U));
309 #if STK_ARCH_ARMV8_M && STK_TZ_SECURE
311 PrintMpuConfig(
"Non-Secure", ctx->mpu_ns);
315 printf(
"=====================================================\r\n");
343 tz::sec::SetKernel(0, &kernel);
375 #if (KERNEL_TYPE == KERNEL_STATIC)
#define __stk_tz_ns_call
ARM TrustZone: attribute for calling Non-Secure functions from Secure state.
#define __stk_tz_nsc_entry
ARM TrustZone: attribute for Non-Secure callable gateway functions.
#define STK_ARCH_ARMV8_M
ARMv8-M platform (Cortex-M23, Cortex-M33, Cortex-M55, Cortex-M85).
Top-level STK include. Provides the Kernel class template and all built-in task-switching strategies.
#define STK_TZ_SECURE
ARM TrustZone: Defines Secure (1) build.
#define STK_ASSERT(e)
Runtime assertion. Halts execution if the expression e evaluates to false.
static void __stk_debug_break()
Collection of synchronization primitives (stk::sync namespace).
Collection of time-related primitives (stk::time namespace).
Namespace of STK package.
uintptr_t Word
Native processor word type.
EHwException
Hardware exception id (see IPlatform::IEventOverrider::OnException).
@ HW_EXCEPT_MEMACCESS
MemManage on ARM / Page Fault or PMP violation on RISC-V.
Word TId
Task (thread) id.
@ KERNEL_TICKLESS
Tickless mode. To use this mode STK_TICKLESS_IDLE must be defined to 1 in stk_config....
@ KERNEL_SYNC
Synchronization support (see Event).
bool IsPrivilegedContext()
Check if caller context is Privileged.
ARMv7-M/ARMv8-M system fault exception context state capture.
Word BFAR
BusFault Address Register (BFAR).
Word AFSR
Auxiliary Fault Status Register (AFSR).
Word HFSR
HardFault Status Register (HFSR).
hw::ExceptionFrame frame
Saved hardware exception stack frame.
Word MMFAR
Memory Management Fault Address Register (MMFAR).
Word CFSR
Configurable Fault Status Register (CFSR: MemManage, BusFault, UsageFault).
Word CONTROL
Core CONTROL register state snapshot.
bool mmfar_valid
Flag indicating validity of MMFAR address value (derived from CFSR.MMARVALID).
Word EXC_RETURN
Exception return magic value (EXC_RETURN).
bool bfar_valid
Flag indicating validity of BFAR address value (derived from CFSR.BFARVALID).
Concrete implementation of IKernel.
EAddResult AddTask(ITask *user_task) override
Register task for a soft real-time (SRT) scheduling.
IPlatform * GetPlatform() override
Get platform driver instance owned by this kernel.
void Initialize(uint32_t resolution_us=PERIODICITY_DEFAULT) override
Initialize kernel.
virtual void SetEventOverrider(IEventOverrider *overrider, bool non_secure=false)=0
Set platform event overrider.
Interface for a platform event overrider.
Partial implementation of the user task.
Thread-safe, type-safe FIFO communication pipe with internal storage.
void Run() override
Entry point of the user task.
SecureHwCommandQueueTask(stk::Word *stack, size_t stack_size)
bool OnException(stk::EHwException exc_id, stk::TId tid, const struct stk::FaultContext *const ctx) override
static void InitAll(bool init_state)
static void SwitchOnExclusive(Id led)
void pico_get_unique_board_id(pico_unique_board_id_t *id_out)
static jmp_buf s_NsExitEnv
__stk_tz_nsc_entry uint32_t NSC_GetKey(uint8_t key[], uint32_t size)
static void CreateKernel()
__stk_tz_nsc_entry void NSC_GetBoardUID(pico_unique_board_id_t *id_out)
static void InvokeNonSecureState()
static sync::PipeT< HwCommand, 4 > s_HwCmdQueue
static void Configure_SAU(void)
__stk_tz_nsc_entry void NSC_OnExitNs(void)
static void ConfigureSecureState()
__stk_tz_nsc_entry void NSC_bsp_Led_SwitchOnExclusive(bsp::Led::Id led)
static STK_MPU_SHARED_DATA_SECTION stk::sync::PipeT< HwCommand, 4 > s_HwCmdQueue