Kev Mann / mbed-dev-OS5_10_4

RTC auf true

platform/mbed_application.c@2:7aab896b1a3b, 2019-03-13 (annotated)

Committer:
kevman
Date:
Wed Mar 13 11:03:24 2019 +0000
Revision:
2:7aab896b1a3b
Parent:
0:38ceb79fef03 
2019-03-13

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kevman 0:38ceb79fef03 1 /* mbed Microcontroller Library
kevman 0:38ceb79fef03 2 * Copyright (c) 2017-2017 ARM Limited
kevman 0:38ceb79fef03 3 *
kevman 0:38ceb79fef03 4 * Licensed under the Apache License, Version 2.0 (the "License");
kevman 0:38ceb79fef03 5 * you may not use this file except in compliance with the License.
kevman 0:38ceb79fef03 6 * You may obtain a copy of the License at
kevman 0:38ceb79fef03 7 *
kevman 0:38ceb79fef03 8 * http://www.apache.org/licenses/LICENSE-2.0
kevman 0:38ceb79fef03 9 *
kevman 0:38ceb79fef03 10 * Unless required by applicable law or agreed to in writing, software
kevman 0:38ceb79fef03 11 * distributed under the License is distributed on an "AS IS" BASIS,
kevman 0:38ceb79fef03 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kevman 0:38ceb79fef03 13 * See the License for the specific language governing permissions and
kevman 0:38ceb79fef03 14 * limitations under the License.
kevman 0:38ceb79fef03 15 */
kevman 0:38ceb79fef03 16
kevman 0:38ceb79fef03 17 #include <stdlib.h>
kevman 0:38ceb79fef03 18 #include <stdarg.h>
kevman 0:38ceb79fef03 19 #include "device.h"
kevman 0:38ceb79fef03 20 #include "platform/mbed_application.h"
kevman 0:38ceb79fef03 21
kevman 0:38ceb79fef03 22 #if MBED_APPLICATION_SUPPORT
kevman 0:38ceb79fef03 23
kevman 0:38ceb79fef03 24 #if defined(__CORTEX_A9)
kevman 0:38ceb79fef03 25
kevman 0:38ceb79fef03 26 static void powerdown_gic(void);
kevman 0:38ceb79fef03 27
kevman 0:38ceb79fef03 28 void mbed_start_application(uintptr_t address)
kevman 0:38ceb79fef03 29 {
kevman 0:38ceb79fef03 30 __disable_irq();
kevman 0:38ceb79fef03 31 powerdown_gic();
kevman 0:38ceb79fef03 32 __enable_irq();
kevman 0:38ceb79fef03 33 ((void(*)())address)();
kevman 0:38ceb79fef03 34 }
kevman 0:38ceb79fef03 35
kevman 0:38ceb79fef03 36 static void powerdown_gic()
kevman 0:38ceb79fef03 37 {
kevman 0:38ceb79fef03 38 int i;
kevman 0:38ceb79fef03 39 int j;
kevman 0:38ceb79fef03 40
kevman 0:38ceb79fef03 41 for (i = 0; i < 32; i++) {
kevman 0:38ceb79fef03 42 GICDistributor->ICENABLER[i] = 0xFFFFFFFF;
kevman 0:38ceb79fef03 43 GICDistributor->ICPENDR[i] = 0xFFFFFFFF;
kevman 0:38ceb79fef03 44 if (i < 4) {
kevman 0:38ceb79fef03 45 GICDistributor->CPENDSGIR[i] = 0xFFFFFFFF;
kevman 0:38ceb79fef03 46 }
kevman 0:38ceb79fef03 47 for (j = 0; j < 8; j++) {
kevman 0:38ceb79fef03 48 GICDistributor->IPRIORITYR[i*8+j] = 0x00000000;
kevman 0:38ceb79fef03 49 }
kevman 0:38ceb79fef03 50 }
kevman 0:38ceb79fef03 51 }
kevman 0:38ceb79fef03 52
kevman 0:38ceb79fef03 53 #else
kevman 0:38ceb79fef03 54
kevman 0:38ceb79fef03 55 static void powerdown_nvic(void);
kevman 0:38ceb79fef03 56 static void powerdown_scb(uint32_t vtor);
kevman 0:38ceb79fef03 57 static void start_new_application(void *sp, void *pc);
kevman 0:38ceb79fef03 58
kevman 0:38ceb79fef03 59 void mbed_start_application(uintptr_t address)
kevman 0:38ceb79fef03 60 {
kevman 0:38ceb79fef03 61 void *sp;
kevman 0:38ceb79fef03 62 void *pc;
kevman 0:38ceb79fef03 63
kevman 0:38ceb79fef03 64 // Interrupts are re-enabled in start_new_application
kevman 0:38ceb79fef03 65 __disable_irq();
kevman 0:38ceb79fef03 66
kevman 0:38ceb79fef03 67 SysTick->CTRL = 0x00000000;
kevman 0:38ceb79fef03 68 powerdown_nvic();
kevman 0:38ceb79fef03 69 powerdown_scb(address);
kevman 0:38ceb79fef03 70
kevman 0:38ceb79fef03 71 sp = *((void **)address + 0);
kevman 0:38ceb79fef03 72 pc = *((void **)address + 1);
kevman 0:38ceb79fef03 73 start_new_application(sp, pc);
kevman 0:38ceb79fef03 74 }
kevman 0:38ceb79fef03 75
kevman 0:38ceb79fef03 76 static void powerdown_nvic()
kevman 0:38ceb79fef03 77 {
kevman 0:38ceb79fef03 78 int isr_groups_32;
kevman 0:38ceb79fef03 79 int i;
kevman 0:38ceb79fef03 80 int j;
kevman 0:38ceb79fef03 81
kevman 0:38ceb79fef03 82 #if defined(__CORTEX_M23)
kevman 0:38ceb79fef03 83 // M23 doesn't support ICTR and supports up to 240 external interrupts.
kevman 0:38ceb79fef03 84 isr_groups_32 = 8;
kevman 0:38ceb79fef03 85 #else
kevman 0:38ceb79fef03 86 isr_groups_32 = ((SCnSCB->ICTR & SCnSCB_ICTR_INTLINESNUM_Msk) >> SCnSCB_ICTR_INTLINESNUM_Pos) + 1;
kevman 0:38ceb79fef03 87 #endif
kevman 0:38ceb79fef03 88 for (i = 0; i < isr_groups_32; i++) {
kevman 0:38ceb79fef03 89 NVIC->ICER[i] = 0xFFFFFFFF;
kevman 0:38ceb79fef03 90 NVIC->ICPR[i] = 0xFFFFFFFF;
kevman 0:38ceb79fef03 91 for (j = 0; j < 8; j++) {
kevman 0:38ceb79fef03 92 #if defined(__CORTEX_M23)
kevman 0:38ceb79fef03 93 NVIC->IPR[i * 8 + j] = 0x00000000;
kevman 0:38ceb79fef03 94 #else
kevman 0:38ceb79fef03 95 NVIC->IP[i * 8 + j] = 0x00000000;
kevman 0:38ceb79fef03 96 #endif
kevman 0:38ceb79fef03 97 }
kevman 0:38ceb79fef03 98 }
kevman 0:38ceb79fef03 99 }
kevman 0:38ceb79fef03 100
kevman 0:38ceb79fef03 101 static void powerdown_scb(uint32_t vtor)
kevman 0:38ceb79fef03 102 {
kevman 0:38ceb79fef03 103 int i;
kevman 0:38ceb79fef03 104
kevman 0:38ceb79fef03 105 // SCB->CPUID - Read only CPU ID register
kevman 0:38ceb79fef03 106 SCB->ICSR = SCB_ICSR_PENDSVCLR_Msk | SCB_ICSR_PENDSTCLR_Msk;
kevman 0:38ceb79fef03 107 SCB->VTOR = vtor;
kevman 0:38ceb79fef03 108 SCB->AIRCR = 0x05FA | 0x0000;
kevman 0:38ceb79fef03 109 SCB->SCR = 0x00000000;
kevman 0:38ceb79fef03 110 // SCB->CCR - Implementation defined value
kevman 0:38ceb79fef03 111 #if defined(__CORTEX_M23)
kevman 0:38ceb79fef03 112 for (i = 0; i < 2; i++) {
kevman 0:38ceb79fef03 113 SCB->SHPR[i] = 0x00;
kevman 0:38ceb79fef03 114 }
kevman 0:38ceb79fef03 115 #else
kevman 0:38ceb79fef03 116 for (i = 0; i < 12; i++) {
kevman 0:38ceb79fef03 117 #if defined(__CORTEX_M7)
kevman 0:38ceb79fef03 118 SCB->SHPR[i] = 0x00;
kevman 0:38ceb79fef03 119 #else
kevman 0:38ceb79fef03 120 SCB->SHP[i] = 0x00;
kevman 0:38ceb79fef03 121 #endif
kevman 0:38ceb79fef03 122 }
kevman 0:38ceb79fef03 123 #endif
kevman 0:38ceb79fef03 124 SCB->SHCSR = 0x00000000;
kevman 0:38ceb79fef03 125 #if defined(__CORTEX_M23)
kevman 0:38ceb79fef03 126 #else
kevman 0:38ceb79fef03 127 SCB->CFSR = 0xFFFFFFFF;
kevman 0:38ceb79fef03 128 SCB->HFSR = SCB_HFSR_DEBUGEVT_Msk | SCB_HFSR_FORCED_Msk | SCB_HFSR_VECTTBL_Msk;
kevman 0:38ceb79fef03 129 SCB->DFSR = SCB_DFSR_EXTERNAL_Msk | SCB_DFSR_VCATCH_Msk |
kevman 0:38ceb79fef03 130 SCB_DFSR_DWTTRAP_Msk | SCB_DFSR_BKPT_Msk | SCB_DFSR_HALTED_Msk;
kevman 0:38ceb79fef03 131 #endif
kevman 0:38ceb79fef03 132 // SCB->MMFAR - Implementation defined value
kevman 0:38ceb79fef03 133 // SCB->BFAR - Implementation defined value
kevman 0:38ceb79fef03 134 // SCB->AFSR - Implementation defined value
kevman 0:38ceb79fef03 135 // SCB->PFR - Read only processor feature register
kevman 0:38ceb79fef03 136 // SCB->DFR - Read only debug feature registers
kevman 0:38ceb79fef03 137 // SCB->ADR - Read only auxiliary feature registers
kevman 0:38ceb79fef03 138 // SCB->MMFR - Read only memory model feature registers
kevman 0:38ceb79fef03 139 // SCB->ISAR - Read only instruction set attribute registers
kevman 0:38ceb79fef03 140 // SCB->CPACR - Implementation defined value
kevman 0:38ceb79fef03 141 }
kevman 0:38ceb79fef03 142
kevman 0:38ceb79fef03 143 #if defined (__CC_ARM)
kevman 0:38ceb79fef03 144
kevman 0:38ceb79fef03 145 __asm static void start_new_application(void *sp, void *pc)
kevman 0:38ceb79fef03 146 {
kevman 0:38ceb79fef03 147 MOV R2, #0
kevman 0:38ceb79fef03 148 MSR CONTROL, R2 // Switch to main stack
kevman 0:38ceb79fef03 149 MOV SP, R0
kevman 0:38ceb79fef03 150 MSR PRIMASK, R2 // Enable interrupts
kevman 0:38ceb79fef03 151 BX R1
kevman 0:38ceb79fef03 152 }
kevman 0:38ceb79fef03 153
kevman 0:38ceb79fef03 154 #elif defined (__GNUC__) || defined (__ICCARM__)
kevman 0:38ceb79fef03 155
kevman 0:38ceb79fef03 156 void start_new_application(void *sp, void *pc)
kevman 0:38ceb79fef03 157 {
kevman 0:38ceb79fef03 158 __asm volatile(
kevman 0:38ceb79fef03 159 "movw r2, #0 \n" // Fail to compile "mov r2, #0" with ARMC6. Replace with MOVW.
kevman 0:38ceb79fef03 160 // We needn't "movt r2, #0" immediately following because MOVW
kevman 0:38ceb79fef03 161 // will zero-extend the 16-bit immediate.
kevman 0:38ceb79fef03 162 "msr control, r2 \n" // Switch to main stack
kevman 0:38ceb79fef03 163 "mov sp, %0 \n"
kevman 0:38ceb79fef03 164 "msr primask, r2 \n" // Enable interrupts
kevman 0:38ceb79fef03 165 "bx %1 \n"
kevman 0:38ceb79fef03 166 :
kevman 0:38ceb79fef03 167 : "l"(sp), "l"(pc)
kevman 0:38ceb79fef03 168 : "r2", "cc", "memory"
kevman 0:38ceb79fef03 169 );
kevman 0:38ceb79fef03 170 }
kevman 0:38ceb79fef03 171
kevman 0:38ceb79fef03 172 #else
kevman 0:38ceb79fef03 173
kevman 0:38ceb79fef03 174 #error "Unsupported toolchain"
kevman 0:38ceb79fef03 175
kevman 0:38ceb79fef03 176 #endif
kevman 0:38ceb79fef03 177
kevman 0:38ceb79fef03 178 #endif
kevman 0:38ceb79fef03 179
kevman 0:38ceb79fef03 180 #endif /* MBED_APPLICATION_SUPPORT */