diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2013-04-30 15:23:45 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2013-05-03 17:30:55 +0200 |
commit | 88cf23f8c943b6af35a5ac11f3c75ba67ee891b5 (patch) | |
tree | 817f3a9876b0476d01eba32ac7d03b61394cac23 /c | |
parent | bsps/arm: Add arm_cp15_set_trans*_table_entries() (diff) | |
download | rtems-88cf23f8c943b6af35a5ac11f3c75ba67ee891b5.tar.bz2 |
bsps/arm: Add arm_cp15_set_exception_handler()
Diffstat (limited to 'c')
-rw-r--r-- | c/src/lib/libbsp/arm/shared/arm-cp15-set-exception-handler.c | 49 | ||||
-rw-r--r-- | c/src/lib/libcpu/arm/shared/include/arm-cp15.h | 6 |
2 files changed, 55 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/arm/shared/arm-cp15-set-exception-handler.c b/c/src/lib/libbsp/arm/shared/arm-cp15-set-exception-handler.c new file mode 100644 index 0000000000..3df68ec9ba --- /dev/null +++ b/c/src/lib/libbsp/arm/shared/arm-cp15-set-exception-handler.c @@ -0,0 +1,49 @@ +/* + * Copyright (c) 2013 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Dornierstr. 4 + * 82178 Puchheim + * Germany + * <info@embedded-brains.de> + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.com/license/LICENSE. + */ + +#include <libcpu/arm-cp15.h> + +#include <bsp/linker-symbols.h> + +void arm_cp15_set_exception_handler( + Arm_symbolic_exception_name exception, + void (*handler)(void), + uint32_t section_flags_for_mirror_table_access +) +{ + if ((unsigned) exception < MAX_EXCEPTIONS) { + uint32_t *cpu_table = (uint32_t *) 0 + MAX_EXCEPTIONS; + uint32_t *mirror_table = (uint32_t *) bsp_vector_table_begin + MAX_EXCEPTIONS; + uint32_t current_handler = mirror_table[exception]; + + if (current_handler != (uint32_t) handler) { + size_t table_size = MAX_EXCEPTIONS * sizeof(uint32_t); + uint32_t cls = arm_cp15_get_min_cache_line_size(); + uint32_t ctrl; + rtems_interrupt_level level; + + rtems_interrupt_disable(level); + + ctrl = arm_cp15_mmu_disable(cls); + + mirror_table[exception] = (uint32_t) handler; + rtems_cache_flush_multiple_data_lines(mirror_table, table_size); + rtems_cache_invalidate_multiple_instruction_lines(cpu_table, table_size); + + arm_cp15_set_control(ctrl); + + rtems_interrupt_enable(level); + } + } +} diff --git a/c/src/lib/libcpu/arm/shared/include/arm-cp15.h b/c/src/lib/libcpu/arm/shared/include/arm-cp15.h index ebf07862a2..203d105d8e 100644 --- a/c/src/lib/libcpu/arm/shared/include/arm-cp15.h +++ b/c/src/lib/libcpu/arm/shared/include/arm-cp15.h @@ -785,6 +785,12 @@ uint32_t arm_cp15_set_translation_table_entries( uint32_t section_flags ); +void arm_cp15_set_exception_handler( + Arm_symbolic_exception_name exception, + void (*handler)(void), + uint32_t section_flags_for_mirror_table_access +); + /** @} */ #ifdef __cplusplus |