Rahul Dahiya / Mbed OS STM32F7 Ethernet
Committer:
rahul_dahiya
Date:
Wed Jan 15 15:57:15 2020 +0530
Revision:
0:fb8047b156bb
STM32F7 LWIP

Who changed what in which revision?

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