Lee Kai Xuan / mbed-os

Fork of mbed-os by erkin yucel

Committer:
xuaner
Date:
Thu Jul 20 14:26:57 2017 +0000
Revision:
1:3deb71413561
Parent:
0:f269e3021894
mbed_os

Who changed what in which revision?

UserRevisionLine numberNew contents of line
elessair 0:f269e3021894 1 /*
elessair 0:f269e3021894 2 * Copyright (c) 2015, Freescale Semiconductor, Inc.
elessair 0:f269e3021894 3 * All rights reserved.
elessair 0:f269e3021894 4 *
elessair 0:f269e3021894 5 * Redistribution and use in source and binary forms, with or without modification,
elessair 0:f269e3021894 6 * are permitted provided that the following conditions are met:
elessair 0:f269e3021894 7 *
elessair 0:f269e3021894 8 * o Redistributions of source code must retain the above copyright notice, this list
elessair 0:f269e3021894 9 * of conditions and the following disclaimer.
elessair 0:f269e3021894 10 *
elessair 0:f269e3021894 11 * o Redistributions in binary form must reproduce the above copyright notice, this
elessair 0:f269e3021894 12 * list of conditions and the following disclaimer in the documentation and/or
elessair 0:f269e3021894 13 * other materials provided with the distribution.
elessair 0:f269e3021894 14 *
elessair 0:f269e3021894 15 * o Neither the name of Freescale Semiconductor, Inc. nor the names of its
elessair 0:f269e3021894 16 * contributors may be used to endorse or promote products derived from this
elessair 0:f269e3021894 17 * software without specific prior written permission.
elessair 0:f269e3021894 18 *
elessair 0:f269e3021894 19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
elessair 0:f269e3021894 20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
elessair 0:f269e3021894 21 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
elessair 0:f269e3021894 22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
elessair 0:f269e3021894 23 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
elessair 0:f269e3021894 24 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
elessair 0:f269e3021894 25 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
elessair 0:f269e3021894 26 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
elessair 0:f269e3021894 27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
elessair 0:f269e3021894 28 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
elessair 0:f269e3021894 29 */
elessair 0:f269e3021894 30
elessair 0:f269e3021894 31 #include "fsl_common.h"
elessair 0:f269e3021894 32 /* This is not needed for mbed */
elessair 0:f269e3021894 33 #if 0
elessair 0:f269e3021894 34 #include "fsl_debug_console.h"
elessair 0:f269e3021894 35
elessair 0:f269e3021894 36 #ifndef NDEBUG
elessair 0:f269e3021894 37 #if (defined(__CC_ARM)) || (defined(__ICCARM__))
elessair 0:f269e3021894 38 void __aeabi_assert(const char *failedExpr, const char *file, int line)
elessair 0:f269e3021894 39 {
elessair 0:f269e3021894 40 PRINTF("ASSERT ERROR \" %s \": file \"%s\" Line \"%d\" \n", failedExpr, file, line);
elessair 0:f269e3021894 41 for (;;)
elessair 0:f269e3021894 42 {
elessair 0:f269e3021894 43 __asm("bkpt #0");
elessair 0:f269e3021894 44 }
elessair 0:f269e3021894 45 }
elessair 0:f269e3021894 46 #elif(defined(__GNUC__))
elessair 0:f269e3021894 47 void __assert_func(const char *file, int line, const char *func, const char *failedExpr)
elessair 0:f269e3021894 48 {
elessair 0:f269e3021894 49 PRINTF("ASSERT ERROR \" %s \": file \"%s\" Line \"%d\" function name \"%s\" \n", failedExpr, file, line, func);
elessair 0:f269e3021894 50 for (;;)
elessair 0:f269e3021894 51 {
elessair 0:f269e3021894 52 __asm("bkpt #0");
elessair 0:f269e3021894 53 }
elessair 0:f269e3021894 54 }
elessair 0:f269e3021894 55 #endif /* (defined(__CC_ARM)) || (defined (__ICCARM__)) */
elessair 0:f269e3021894 56 #endif /* NDEBUG */
elessair 0:f269e3021894 57 #endif
elessair 0:f269e3021894 58 void InstallIRQHandler(IRQn_Type irq, uint32_t irqHandler)
elessair 0:f269e3021894 59 {
elessair 0:f269e3021894 60 /* Addresses for VECTOR_TABLE and VECTOR_RAM come from the linker file */
elessair 0:f269e3021894 61 #if defined(__CC_ARM)
elessair 0:f269e3021894 62 extern uint32_t Image$$VECTOR_ROM$$Base[];
elessair 0:f269e3021894 63 extern uint32_t Image$$VECTOR_RAM$$Base[];
elessair 0:f269e3021894 64 extern uint32_t Image$$RW_m_data$$Base[];
elessair 0:f269e3021894 65
elessair 0:f269e3021894 66 #define __VECTOR_TABLE Image$$VECTOR_ROM$$Base
elessair 0:f269e3021894 67 #define __VECTOR_RAM Image$$VECTOR_RAM$$Base
elessair 0:f269e3021894 68 #define __RAM_VECTOR_TABLE_SIZE (((uint32_t)Image$$RW_m_data$$Base - (uint32_t)Image$$VECTOR_RAM$$Base))
elessair 0:f269e3021894 69 #elif defined(__ICCARM__)
elessair 0:f269e3021894 70 extern uint32_t __RAM_VECTOR_TABLE_SIZE[];
elessair 0:f269e3021894 71 extern uint32_t __VECTOR_TABLE[];
elessair 0:f269e3021894 72 extern uint32_t __VECTOR_RAM[];
elessair 0:f269e3021894 73 #elif defined(__GNUC__)
elessair 0:f269e3021894 74 extern uint32_t __VECTOR_TABLE[];
elessair 0:f269e3021894 75 extern uint32_t __VECTOR_RAM[];
elessair 0:f269e3021894 76 extern uint32_t __RAM_VECTOR_TABLE_SIZE_BYTES[];
elessair 0:f269e3021894 77 uint32_t __RAM_VECTOR_TABLE_SIZE = (uint32_t)(__RAM_VECTOR_TABLE_SIZE_BYTES);
elessair 0:f269e3021894 78 #endif /* defined(__CC_ARM) */
elessair 0:f269e3021894 79 uint32_t n;
elessair 0:f269e3021894 80 uint32_t interrupts_disabled;
elessair 0:f269e3021894 81
elessair 0:f269e3021894 82 interrupts_disabled = __get_PRIMASK();
elessair 0:f269e3021894 83 __disable_irq();
elessair 0:f269e3021894 84 if (SCB->VTOR != (uint32_t)__VECTOR_RAM)
elessair 0:f269e3021894 85 {
elessair 0:f269e3021894 86 /* Copy the vector table from ROM to RAM */
elessair 0:f269e3021894 87 for (n = 0; n < ((uint32_t)__RAM_VECTOR_TABLE_SIZE) / sizeof(uint32_t); n++)
elessair 0:f269e3021894 88 {
elessair 0:f269e3021894 89 __VECTOR_RAM[n] = __VECTOR_TABLE[n];
elessair 0:f269e3021894 90 }
elessair 0:f269e3021894 91 /* Point the VTOR to the position of vector table */
elessair 0:f269e3021894 92 SCB->VTOR = (uint32_t)__VECTOR_RAM;
elessair 0:f269e3021894 93 }
elessair 0:f269e3021894 94
elessair 0:f269e3021894 95 /* make sure the __VECTOR_RAM is noncachable */
elessair 0:f269e3021894 96 __VECTOR_RAM[irq + 16] = irqHandler;
elessair 0:f269e3021894 97
elessair 0:f269e3021894 98 if (!interrupts_disabled) {
elessair 0:f269e3021894 99 __enable_irq();
elessair 0:f269e3021894 100 }
elessair 0:f269e3021894 101 }