mirror of https://github.com/ARMmbed/mbed-os.git
34 lines
1.1 KiB
C
34 lines
1.1 KiB
C
/* mbed Microcontroller Library - cmsis_nvic for TMPM066
|
|
* Copyright (c) 2011 ARM Limited. All rights reserved.
|
|
*
|
|
* CMSIS-style functionality to support dynamic vectors
|
|
*/
|
|
#include "cmsis_nvic.h"
|
|
|
|
#define NVIC_RAM_VECTOR_ADDRESS (0x20000000) // Location of vectors in RAM
|
|
#define NVIC_FLASH_VECTOR_ADDRESS (0x00000000) // Initial vector position in flash
|
|
|
|
void NVIC_SetVector(IRQn_Type IRQn, uint32_t vector)
|
|
{
|
|
static int vector_copied = 0;
|
|
uint32_t *vectors = (uint32_t *) NVIC_FLASH_VECTOR_ADDRESS;
|
|
uint32_t i;
|
|
|
|
// Copy and switch to dynamic vectors if the first time called
|
|
if (vector_copied == 0) {
|
|
uint32_t *old_vectors = vectors;
|
|
vectors = (uint32_t *) NVIC_RAM_VECTOR_ADDRESS;
|
|
for (i = 0; i < NVIC_NUM_VECTORS; i++) {
|
|
vectors[i] = old_vectors[i];
|
|
}
|
|
vector_copied = 1;
|
|
}
|
|
vectors[IRQn + NVIC_USER_IRQ_OFFSET] = vector;
|
|
}
|
|
|
|
uint32_t NVIC_GetVector(IRQn_Type IRQn)
|
|
{
|
|
uint32_t *vectors = (uint32_t *) NVIC_RAM_VECTOR_ADDRESS;
|
|
return vectors[IRQn + NVIC_USER_IRQ_OFFSET];
|
|
}
|