diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2013-05-02 17:42:20 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2013-05-03 17:30:55 +0200 |
commit | 037e8ae50621d218679826170abb39dae254df9c (patch) | |
tree | 2bc1824a107f8a0dcc88e08eac7549b4d9dea96b /c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c | |
parent | bsps/arm: Add arm_cp15_mmu_disable() (diff) | |
download | rtems-037e8ae50621d218679826170abb39dae254df9c.tar.bz2 |
bsps/arm: Add arm_cp15_set_trans*_table_entries()
Diffstat (limited to 'c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c')
-rw-r--r-- | c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c | 62 |
1 files changed, 62 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c b/c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c new file mode 100644 index 0000000000..fc311a13e3 --- /dev/null +++ b/c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c @@ -0,0 +1,62 @@ +/* + * Copyright (c) 2010-2013 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Obere Lagerstr. 30 + * 82178 Puchheim + * Germany + * <rtems@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> + +static uint32_t set_translation_table_entries( + const void *begin, + const void *end, + uint32_t section_flags +) +{ + uint32_t cl_size = arm_cp15_get_min_cache_line_size(); + uint32_t *ttb = arm_cp15_get_translation_table_base(); + uint32_t i = ARM_MMU_SECT_GET_INDEX(begin); + uint32_t iend = ARM_MMU_SECT_GET_INDEX(ARM_MMU_SECT_MVA_ALIGN_UP(end)); + uint32_t ctrl; + uint32_t section_flags_of_first_entry; + + ctrl = arm_cp15_mmu_disable(cl_size); + arm_cp15_tlb_invalidate(); + section_flags_of_first_entry = ttb [i]; + + while (i < iend) { + uint32_t addr = i << ARM_MMU_SECT_BASE_SHIFT; + + ttb [i] = addr | section_flags; + + ++i; + } + + arm_cp15_set_control(ctrl); + + return section_flags_of_first_entry; +} + +uint32_t arm_cp15_set_translation_table_entries( + const void *begin, + const void *end, + uint32_t section_flags +) +{ + rtems_interrupt_level level; + uint32_t section_flags_of_first_entry; + + rtems_interrupt_disable(level); + section_flags_of_first_entry = + set_translation_table_entries(begin, end, section_flags); + rtems_interrupt_enable(level); + + return section_flags_of_first_entry; +} |