Gan likun / mbed-dev

00

platform/mbed_application.c@0:13413ea9a877, 2022-06-12 (annotated)

Committer:
ganlikun
Date:
Sun Jun 12 14:02:44 2022 +0000
Revision:
0:13413ea9a877
00

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ganlikun 0:13413ea9a877 1 /* mbed Microcontroller Library
ganlikun 0:13413ea9a877 2 * Copyright (c) 2017-2017 ARM Limited
ganlikun 0:13413ea9a877 3 *
ganlikun 0:13413ea9a877 4 * Licensed under the Apache License, Version 2.0 (the "License");
ganlikun 0:13413ea9a877 5 * you may not use this file except in compliance with the License.
ganlikun 0:13413ea9a877 6 * You may obtain a copy of the License at
ganlikun 0:13413ea9a877 7 *
ganlikun 0:13413ea9a877 8 * http://www.apache.org/licenses/LICENSE-2.0
ganlikun 0:13413ea9a877 9 *
ganlikun 0:13413ea9a877 10 * Unless required by applicable law or agreed to in writing, software
ganlikun 0:13413ea9a877 11 * distributed under the License is distributed on an "AS IS" BASIS,
ganlikun 0:13413ea9a877 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
ganlikun 0:13413ea9a877 13 * See the License for the specific language governing permissions and
ganlikun 0:13413ea9a877 14 * limitations under the License.
ganlikun 0:13413ea9a877 15 */
ganlikun 0:13413ea9a877 16
ganlikun 0:13413ea9a877 17 #include <stdlib.h>
ganlikun 0:13413ea9a877 18 #include <stdarg.h>
ganlikun 0:13413ea9a877 19 #include "device.h"
ganlikun 0:13413ea9a877 20 #include "platform/mbed_application.h"
ganlikun 0:13413ea9a877 21
ganlikun 0:13413ea9a877 22 #if MBED_APPLICATION_SUPPORT
ganlikun 0:13413ea9a877 23
ganlikun 0:13413ea9a877 24 static void powerdown_nvic(void);
ganlikun 0:13413ea9a877 25 static void powerdown_scb(uint32_t vtor);
ganlikun 0:13413ea9a877 26 static void start_new_application(void *sp, void *pc);
ganlikun 0:13413ea9a877 27
ganlikun 0:13413ea9a877 28 void mbed_start_application(uintptr_t address)
ganlikun 0:13413ea9a877 29 {
ganlikun 0:13413ea9a877 30 void *sp;
ganlikun 0:13413ea9a877 31 void *pc;
ganlikun 0:13413ea9a877 32
ganlikun 0:13413ea9a877 33 // Interrupts are re-enabled in start_new_application
ganlikun 0:13413ea9a877 34 __disable_irq();
ganlikun 0:13413ea9a877 35
ganlikun 0:13413ea9a877 36 SysTick->CTRL = 0x00000000;
ganlikun 0:13413ea9a877 37 powerdown_nvic();
ganlikun 0:13413ea9a877 38 powerdown_scb(address);
ganlikun 0:13413ea9a877 39
ganlikun 0:13413ea9a877 40 sp = *((void**)address + 0);
ganlikun 0:13413ea9a877 41 pc = *((void**)address + 1);
ganlikun 0:13413ea9a877 42 start_new_application(sp, pc);
ganlikun 0:13413ea9a877 43 }
ganlikun 0:13413ea9a877 44
ganlikun 0:13413ea9a877 45 static void powerdown_nvic()
ganlikun 0:13413ea9a877 46 {
ganlikun 0:13413ea9a877 47 int isr_groups_32;
ganlikun 0:13413ea9a877 48 int i;
ganlikun 0:13413ea9a877 49 int j;
ganlikun 0:13413ea9a877 50
ganlikun 0:13413ea9a877 51 isr_groups_32 = ((SCnSCB->ICTR & SCnSCB_ICTR_INTLINESNUM_Msk) >> SCnSCB_ICTR_INTLINESNUM_Pos) + 1;
ganlikun 0:13413ea9a877 52 for (i = 0; i < isr_groups_32; i++) {
ganlikun 0:13413ea9a877 53 NVIC->ICER[i] = 0xFFFFFFFF;
ganlikun 0:13413ea9a877 54 NVIC->ICPR[i] = 0xFFFFFFFF;
ganlikun 0:13413ea9a877 55 for (j = 0; j < 8; j++) {
ganlikun 0:13413ea9a877 56 NVIC->IP[i * 8 + j] = 0x00000000;
ganlikun 0:13413ea9a877 57 }
ganlikun 0:13413ea9a877 58 }
ganlikun 0:13413ea9a877 59 }
ganlikun 0:13413ea9a877 60
ganlikun 0:13413ea9a877 61 static void powerdown_scb(uint32_t vtor)
ganlikun 0:13413ea9a877 62 {
ganlikun 0:13413ea9a877 63 int i;
ganlikun 0:13413ea9a877 64
ganlikun 0:13413ea9a877 65 // SCB->CPUID - Read only CPU ID register
ganlikun 0:13413ea9a877 66 SCB->ICSR = SCB_ICSR_PENDSVCLR_Msk | SCB_ICSR_PENDSTCLR_Msk;
ganlikun 0:13413ea9a877 67 SCB->VTOR = vtor;
ganlikun 0:13413ea9a877 68 SCB->AIRCR = 0x05FA | 0x0000;
ganlikun 0:13413ea9a877 69 SCB->SCR = 0x00000000;
ganlikun 0:13413ea9a877 70 // SCB->CCR - Implementation defined value
ganlikun 0:13413ea9a877 71 for (i = 0; i < 12; i++) {
ganlikun 0:13413ea9a877 72 #if defined(__CORTEX_M7)
ganlikun 0:13413ea9a877 73 SCB->SHPR[i] = 0x00;
ganlikun 0:13413ea9a877 74 #else
ganlikun 0:13413ea9a877 75 SCB->SHP[i] = 0x00;
ganlikun 0:13413ea9a877 76 #endif
ganlikun 0:13413ea9a877 77 }
ganlikun 0:13413ea9a877 78 SCB->SHCSR = 0x00000000;
ganlikun 0:13413ea9a877 79 SCB->CFSR = 0xFFFFFFFF;
ganlikun 0:13413ea9a877 80 SCB->HFSR = SCB_HFSR_DEBUGEVT_Msk | SCB_HFSR_FORCED_Msk | SCB_HFSR_VECTTBL_Msk;
ganlikun 0:13413ea9a877 81 SCB->DFSR = SCB_DFSR_EXTERNAL_Msk | SCB_DFSR_VCATCH_Msk |
ganlikun 0:13413ea9a877 82 SCB_DFSR_DWTTRAP_Msk | SCB_DFSR_BKPT_Msk | SCB_DFSR_HALTED_Msk;
ganlikun 0:13413ea9a877 83 // SCB->MMFAR - Implementation defined value
ganlikun 0:13413ea9a877 84 // SCB->BFAR - Implementation defined value
ganlikun 0:13413ea9a877 85 // SCB->AFSR - Implementation defined value
ganlikun 0:13413ea9a877 86 // SCB->PFR - Read only processor feature register
ganlikun 0:13413ea9a877 87 // SCB->DFR - Read only debug feature registers
ganlikun 0:13413ea9a877 88 // SCB->ADR - Read only auxiliary feature registers
ganlikun 0:13413ea9a877 89 // SCB->MMFR - Read only memory model feature registers
ganlikun 0:13413ea9a877 90 // SCB->ISAR - Read only instruction set attribute registers
ganlikun 0:13413ea9a877 91 // SCB->CPACR - Implementation defined value
ganlikun 0:13413ea9a877 92 }
ganlikun 0:13413ea9a877 93
ganlikun 0:13413ea9a877 94 #if defined (__CC_ARM)
ganlikun 0:13413ea9a877 95
ganlikun 0:13413ea9a877 96 __asm static void start_new_application(void *sp, void *pc)
ganlikun 0:13413ea9a877 97 {
ganlikun 0:13413ea9a877 98 MOV R2, #0
ganlikun 0:13413ea9a877 99 MSR CONTROL, R2 // Switch to main stack
ganlikun 0:13413ea9a877 100 MOV SP, R0
ganlikun 0:13413ea9a877 101 MSR PRIMASK, R2 // Enable interrupts
ganlikun 0:13413ea9a877 102 BX R1
ganlikun 0:13413ea9a877 103 }
ganlikun 0:13413ea9a877 104
ganlikun 0:13413ea9a877 105 #elif defined (__GNUC__) || defined (__ICCARM__)
ganlikun 0:13413ea9a877 106
ganlikun 0:13413ea9a877 107 void start_new_application(void *sp, void *pc)
ganlikun 0:13413ea9a877 108 {
ganlikun 0:13413ea9a877 109 __asm volatile (
ganlikun 0:13413ea9a877 110 "mov r2, #0 \n"
ganlikun 0:13413ea9a877 111 "msr control, r2 \n" // Switch to main stack
ganlikun 0:13413ea9a877 112 "mov sp, %0 \n"
ganlikun 0:13413ea9a877 113 "msr primask, r2 \n" // Enable interrupts
ganlikun 0:13413ea9a877 114 "bx %1 \n"
ganlikun 0:13413ea9a877 115 :
ganlikun 0:13413ea9a877 116 : "l" (sp), "l" (pc)
ganlikun 0:13413ea9a877 117 : "r2", "cc", "memory"
ganlikun 0:13413ea9a877 118 );
ganlikun 0:13413ea9a877 119 }
ganlikun 0:13413ea9a877 120
ganlikun 0:13413ea9a877 121 #else
ganlikun 0:13413ea9a877 122
ganlikun 0:13413ea9a877 123 #error "Unsupported toolchain"
ganlikun 0:13413ea9a877 124
ganlikun 0:13413ea9a877 125 #endif
ganlikun 0:13413ea9a877 126
ganlikun 0:13413ea9a877 127 #endif /* MBED_APPLICATION_SUPPORT */
ganlikun 0:13413ea9a877 128