mbed library sources

Fork of mbed-src by mbed official

Committer:
moirans2
Date:
Wed Jan 14 20:53:08 2015 +0000
Revision:
445:9a3ffe6cfa19
Parent:
423:560d1a9f3083
internal clock stm32L051

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 130:1dec54e4aec3 1 /* mbed Microcontroller Library
mbed_official 130:1dec54e4aec3 2 * CMSIS-style functionality to support dynamic vectors
mbed_official 130:1dec54e4aec3 3 *******************************************************************************
mbed_official 130:1dec54e4aec3 4 * Copyright (c) 2014, STMicroelectronics
mbed_official 130:1dec54e4aec3 5 * All rights reserved.
mbed_official 130:1dec54e4aec3 6 *
mbed_official 130:1dec54e4aec3 7 * Redistribution and use in source and binary forms, with or without
mbed_official 130:1dec54e4aec3 8 * modification, are permitted provided that the following conditions are met:
mbed_official 130:1dec54e4aec3 9 *
mbed_official 130:1dec54e4aec3 10 * 1. Redistributions of source code must retain the above copyright notice,
mbed_official 130:1dec54e4aec3 11 * this list of conditions and the following disclaimer.
mbed_official 130:1dec54e4aec3 12 * 2. Redistributions in binary form must reproduce the above copyright notice,
mbed_official 130:1dec54e4aec3 13 * this list of conditions and the following disclaimer in the documentation
mbed_official 130:1dec54e4aec3 14 * and/or other materials provided with the distribution.
mbed_official 130:1dec54e4aec3 15 * 3. Neither the name of STMicroelectronics nor the names of its contributors
mbed_official 130:1dec54e4aec3 16 * may be used to endorse or promote products derived from this software
mbed_official 130:1dec54e4aec3 17 * without specific prior written permission.
mbed_official 130:1dec54e4aec3 18 *
mbed_official 130:1dec54e4aec3 19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
mbed_official 130:1dec54e4aec3 20 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
mbed_official 130:1dec54e4aec3 21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
mbed_official 130:1dec54e4aec3 22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
mbed_official 130:1dec54e4aec3 23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
mbed_official 130:1dec54e4aec3 24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
mbed_official 130:1dec54e4aec3 25 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
mbed_official 130:1dec54e4aec3 26 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
mbed_official 130:1dec54e4aec3 27 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
mbed_official 130:1dec54e4aec3 28 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
mbed_official 130:1dec54e4aec3 29 *******************************************************************************
mbed_official 130:1dec54e4aec3 30 */
mbed_official 130:1dec54e4aec3 31 #include "cmsis_nvic.h"
mbed_official 130:1dec54e4aec3 32
mbed_official 130:1dec54e4aec3 33 #define NVIC_RAM_VECTOR_ADDRESS (0x20000000) // Vectors positioned at start of RAM
mbed_official 130:1dec54e4aec3 34 #define NVIC_FLASH_VECTOR_ADDRESS (0x08000000) // Initial vector position in flash
mbed_official 130:1dec54e4aec3 35
mbed_official 130:1dec54e4aec3 36 static unsigned char vtor_remap = 0; // To keep track that the vectors remap is done
mbed_official 130:1dec54e4aec3 37
mbed_official 130:1dec54e4aec3 38 void NVIC_SetVector(IRQn_Type IRQn, uint32_t vector) {
mbed_official 130:1dec54e4aec3 39 int i;
mbed_official 130:1dec54e4aec3 40 // Space for dynamic vectors, initialised to allocate in R/W
mbed_official 130:1dec54e4aec3 41 static volatile uint32_t *vectors = (uint32_t *)NVIC_RAM_VECTOR_ADDRESS;
mbed_official 130:1dec54e4aec3 42
mbed_official 130:1dec54e4aec3 43 // Copy and switch to dynamic vectors if first time called
mbed_official 130:1dec54e4aec3 44 if (vtor_remap == 0) {
mbed_official 130:1dec54e4aec3 45 uint32_t *old_vectors = (uint32_t *)NVIC_FLASH_VECTOR_ADDRESS;
mbed_official 130:1dec54e4aec3 46 for (i = 0; i < NVIC_NUM_VECTORS; i++) {
mbed_official 130:1dec54e4aec3 47 vectors[i] = old_vectors[i];
mbed_official 130:1dec54e4aec3 48 }
mbed_official 130:1dec54e4aec3 49 SYSCFG->CFGR1 |= 0x03; // Embedded SRAM mapped at 0x00000000
mbed_official 130:1dec54e4aec3 50 vtor_remap = 1; // The vectors remap is done
mbed_official 130:1dec54e4aec3 51 }
mbed_official 130:1dec54e4aec3 52
mbed_official 130:1dec54e4aec3 53 // Set the vector
mbed_official 130:1dec54e4aec3 54 vectors[IRQn + 16] = vector;
mbed_official 130:1dec54e4aec3 55 }
mbed_official 130:1dec54e4aec3 56
mbed_official 130:1dec54e4aec3 57 uint32_t NVIC_GetVector(IRQn_Type IRQn) {
mbed_official 130:1dec54e4aec3 58 uint32_t *vectors = (uint32_t*)NVIC_RAM_VECTOR_ADDRESS;
mbed_official 130:1dec54e4aec3 59 // Return the vector
mbed_official 130:1dec54e4aec3 60 return vectors[IRQn + 16];
mbed_official 130:1dec54e4aec3 61 }