git.sur5r.net Git - freertos/blob - FreeRTOS/Source/portable/ARMv8M/secure/context/portable/GCC/ARM_CM23/secure_context_port.c

   1 /*\r
   2  * FreeRTOS Kernel V10.3.0\r
   3  * Copyright (C) 2020 Amazon.com, Inc. or its affiliates.  All Rights Reserved.\r
   4  *\r
   5  * Permission is hereby granted, free of charge, to any person obtaining a copy of\r
   6  * this software and associated documentation files (the "Software"), to deal in\r
   7  * the Software without restriction, including without limitation the rights to\r
   8  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of\r
   9  * the Software, and to permit persons to whom the Software is furnished to do so,\r
  10  * subject to the following conditions:\r
  11  *\r
  12  * The above copyright notice and this permission notice shall be included in all\r
  13  * copies or substantial portions of the Software.\r
  14  *\r
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS\r
  17  * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR\r
  18  * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r
  19  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
  20  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r
  21  *\r
  22  * http://www.FreeRTOS.org\r
  23  * http://aws.amazon.com/freertos\r
  24  *\r
  25  * 1 tab == 4 spaces!\r
  26  */\r
  27 \r
  28 /* Secure context includes. */\r
  29 #include "secure_context.h"\r
  30 \r
  31 /* Secure port macros. */\r
  32 #include "secure_port_macros.h"\r
  33 \r
  34 #if( configENABLE_FPU == 1 )\r
  35         #error Cortex-M23 does not have a Floating Point Unit (FPU) and therefore configENABLE_FPU must be set to 0.\r
  36 #endif\r
  37 \r
  38 secureportNON_SECURE_CALLABLE void SecureContext_LoadContext( SecureContextHandle_t xSecureContextHandle )\r
  39 {\r
  40         /* xSecureContextHandle value is in r0. */\r
  41         __asm volatile\r
  42         (\r
  43         "       .syntax unified                                                 \n"\r
  44         "                                                                                       \n"\r
  45         "       mrs r1, ipsr                                                    \n" /* r1 = IPSR. */\r
  46         "       cbz r1, load_ctx_therad_mode                    \n" /* Do nothing if the processor is running in the Thread Mode. */\r
  47         "       ldmia r0!, {r1, r2}                                             \n" /* r1 = xSecureContextHandle->pucCurrentStackPointer, r2 = xSecureContextHandle->pucStackLimit. */\r
  48         #if( configENABLE_MPU == 1 )\r
  49         "       ldmia r1!, {r3}                                                 \n" /* Read CONTROL register value from task's stack. r3 = CONTROL. */\r
  50         "       msr control, r3                                                 \n" /* CONTROL = r3. */\r
  51         #endif /* configENABLE_MPU */\r
  52         "       msr psplim, r2                                                  \n" /* PSPLIM = r2. */\r
  53         "       msr psp, r1                                                             \n" /* PSP = r1. */\r
  54         "                                                                                       \n"\r
  55         " load_ctx_therad_mode:                                         \n"\r
  56         "       nop                                                                             \n"\r
  57         "                                                                                       \n"\r
  58         :::"r0", "r1", "r2"\r
  59         );\r
  60 }\r
  61 /*-----------------------------------------------------------*/\r
  62 \r
  63 secureportNON_SECURE_CALLABLE void SecureContext_SaveContext( SecureContextHandle_t xSecureContextHandle )\r
  64 {\r
  65         /* xSecureContextHandle value is in r0. */\r
  66         __asm volatile\r
  67         (\r
  68         "       .syntax unified                                                 \n"\r
  69         "                                                                                       \n"\r
  70         "       mrs r1, ipsr                                                    \n" /* r1 = IPSR. */\r
  71         "       cbz r1, save_ctx_therad_mode                    \n" /* Do nothing if the processor is running in the Thread Mode. */\r
  72         "       mrs r1, psp                                                             \n" /* r1 = PSP. */\r
  73         #if( configENABLE_MPU == 1 )\r
  74         "       mrs r2, control                                                 \n" /* r2 = CONTROL. */\r
  75         "       subs r1, r1, #4                                                 \n" /* Make space for the CONTROL value on the stack. */\r
  76         "       str r1, [r0]                                                    \n" /* Save the top of stack in context. xSecureContextHandle->pucCurrentStackPointer = r1. */\r
  77         "       stmia r1!, {r2}                                                 \n" /* Store CONTROL value on the stack. */\r
  78         #else /* configENABLE_MPU */\r
  79         "       str r1, [r0]                                                    \n" /* Save the top of stack in context. xSecureContextHandle->pucCurrentStackPointer = r1. */\r
  80         #endif /* configENABLE_MPU */\r
  81         "       movs r1, %0                                                             \n" /* r1 = securecontextNO_STACK. */\r
  82         "       msr psplim, r1                                                  \n" /* PSPLIM = securecontextNO_STACK. */\r
  83         "       msr psp, r1                                                             \n" /* PSP = securecontextNO_STACK i.e. No stack for thread mode until next task's context is loaded. */\r
  84         "                                                                                       \n"\r
  85         " save_ctx_therad_mode:                                         \n"\r
  86         "       nop                                                                             \n"\r
  87         "                                                                                       \n"\r
  88         :: "i" ( securecontextNO_STACK ) : "r1", "memory"\r
  89         );\r
  90 }\r
  91 /*-----------------------------------------------------------*/\r