lzbp li / mbed-src

mbed library sources

Fork of mbed-src by mbed official

targets/cmsis/TARGET_NXP/TARGET_LPC43XX/cmsis_nvic.c@636:b0d178e9fa10, 2016-07-07 (annotated)

Committer:
lzbpli
Date:
Thu Jul 07 06:48:59 2016 +0000
Revision:
636:b0d178e9fa10
Parent:
358:9d7ef901f004 
l053

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 358:9d7ef901f004 1 /* mbed Microcontroller Library
mbed_official 358:9d7ef901f004 2 * CMSIS-style functionality to support dynamic vectors
mbed_official 358:9d7ef901f004 3 *******************************************************************************
mbed_official 358:9d7ef901f004 4 * Copyright (c) 2011 ARM Limited. All rights reserved.
mbed_official 358:9d7ef901f004 5 * All rights reserved.
mbed_official 358:9d7ef901f004 6 *
mbed_official 358:9d7ef901f004 7 * Redistribution and use in source and binary forms, with or without
mbed_official 358:9d7ef901f004 8 * modification, are permitted provided that the following conditions are met:
bogdanm 20:4263a77256ae 9 *
mbed_official 358:9d7ef901f004 10 * 1. Redistributions of source code must retain the above copyright notice,
mbed_official 358:9d7ef901f004 11 * this list of conditions and the following disclaimer.
mbed_official 358:9d7ef901f004 12 * 2. Redistributions in binary form must reproduce the above copyright notice,
mbed_official 358:9d7ef901f004 13 * this list of conditions and the following disclaimer in the documentation
mbed_official 358:9d7ef901f004 14 * and/or other materials provided with the distribution.
mbed_official 358:9d7ef901f004 15 * 3. Neither the name of ARM Limited nor the names of its contributors
mbed_official 358:9d7ef901f004 16 * may be used to endorse or promote products derived from this software
mbed_official 358:9d7ef901f004 17 * without specific prior written permission.
mbed_official 358:9d7ef901f004 18 *
mbed_official 358:9d7ef901f004 19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
mbed_official 358:9d7ef901f004 20 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
mbed_official 358:9d7ef901f004 21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
mbed_official 358:9d7ef901f004 22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
mbed_official 358:9d7ef901f004 23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
mbed_official 358:9d7ef901f004 24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
mbed_official 358:9d7ef901f004 25 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
mbed_official 358:9d7ef901f004 26 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
mbed_official 358:9d7ef901f004 27 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
mbed_official 358:9d7ef901f004 28 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
mbed_official 358:9d7ef901f004 29 *******************************************************************************
mbed_official 358:9d7ef901f004 30 */
bogdanm 20:4263a77256ae 31 #include "cmsis_nvic.h"
bogdanm 20:4263a77256ae 32
bogdanm 20:4263a77256ae 33 #define NVIC_RAM_VECTOR_ADDRESS (0x10000000) // Location of vectors in RAM
bogdanm 20:4263a77256ae 34
bogdanm 20:4263a77256ae 35 // The LPC43xx can boot from multiple memories (internal Flash, external NOR,
bogdanm 20:4263a77256ae 36 // external SPIFI) so we don't know the initial value of VTOR. Thus we use
bogdanm 20:4263a77256ae 37 // a variable to keep track if the vector table was relocated or not
bogdanm 20:4263a77256ae 38 static unsigned char vtor_relocated;
bogdanm 20:4263a77256ae 39
bogdanm 20:4263a77256ae 40 void NVIC_SetVector(IRQn_Type IRQn, uint32_t vector) {
bogdanm 20:4263a77256ae 41 uint32_t *vectors = (uint32_t*)SCB->VTOR;
bogdanm 20:4263a77256ae 42 uint32_t i;
bogdanm 20:4263a77256ae 43
bogdanm 20:4263a77256ae 44 // Copy and switch to dynamic vectors if first time called
bogdanm 20:4263a77256ae 45 if (!vtor_relocated) {
bogdanm 20:4263a77256ae 46 uint32_t *old_vectors = vectors;
bogdanm 20:4263a77256ae 47 vectors = (uint32_t*)NVIC_RAM_VECTOR_ADDRESS;
bogdanm 20:4263a77256ae 48 for (i=0; i<NVIC_NUM_VECTORS; i++) {
bogdanm 20:4263a77256ae 49 vectors[i] = old_vectors[i];
bogdanm 20:4263a77256ae 50 }
bogdanm 20:4263a77256ae 51 SCB->VTOR = (uint32_t)NVIC_RAM_VECTOR_ADDRESS;
bogdanm 20:4263a77256ae 52 vtor_relocated = 1;
bogdanm 20:4263a77256ae 53 }
bogdanm 20:4263a77256ae 54 vectors[IRQn + 16] = vector;
bogdanm 20:4263a77256ae 55 }
bogdanm 20:4263a77256ae 56
bogdanm 20:4263a77256ae 57 uint32_t NVIC_GetVector(IRQn_Type IRQn) {
bogdanm 20:4263a77256ae 58 uint32_t *vectors = (uint32_t*)SCB->VTOR;
bogdanm 20:4263a77256ae 59 return vectors[IRQn + 16];
bogdanm 20:4263a77256ae 60 }
bogdanm 20:4263a77256ae 61