RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

bsps/arm: Clear SCTLR[M, I, A, C] in start.S

Browse Source 
Initialize the data and unified cache levels.  Invalidate the
instruction cache levels.

Update #4202.
This commit is contained in:
Sebastian Huber
2020-12-18 22:00:54 +01:00
parent b32fd22732
commit e164df5e33
5 changed files with 43 additions and 119 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
bsps/arm/altera-cyclone-v/start/bspstarthooks.c
View File

@@ -35,8 +35,6 @@
BSP_START_TEXT_SECTION void bsp_start_hook_0( void ) BSP_START_TEXT_SECTION void bsp_start_hook_0( void )
{ {
arm_cp15_instruction_cache_invalidate();
arm_cp15_data_cache_invalidate_all_levels();
arm_a9mpcore_start_hook_0(); arm_a9mpcore_start_hook_0();
} }

47
bsps/arm/raspberrypi/start/bspstarthooks.c
View File

@@ -67,57 +67,14 @@ raspberrypi_mmu_config_table[] = {
void BSP_START_TEXT_SECTION bsp_start_hook_0(void) void BSP_START_TEXT_SECTION bsp_start_hook_0(void)
{ {
uint32_t sctlr_val;
#ifdef RTEMS_SMP
uint32_t cpu_index_self = _SMP_Get_current_processor();
#endif /* RTEMS_SMP */
sctlr_val = arm_cp15_get_control();
/*
* Current U-boot loader seems to start kernel image
* with I and D caches on and MMU enabled.
* If RTEMS application image finds that cache is on
* during startup then disable caches.
*/
if (sctlr_val & (ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M)) {
if (sctlr_val & (ARM_CP15_CTRL_C | ARM_CP15_CTRL_M)) {
/*
* If the data cache is on then ensure that it is clean
* before switching off to be extra carefull.
*/
#ifdef RTEMS_SMP
if (cpu_index_self != 0) {
arm_cp15_data_cache_clean_level(0);
arm_cp15_cache_invalidate_level(0, 0);
} else
#endif /* RTEMS_SMP */
{
rtems_cache_flush_entire_data();
rtems_cache_invalidate_entire_data();
}
}
arm_cp15_flush_prefetch_buffer();
sctlr_val &= ~(ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M | ARM_CP15_CTRL_A);
arm_cp15_set_control(sctlr_val);
}
#ifdef RTEMS_SMP
if (cpu_index_self != 0) {
arm_cp15_cache_invalidate_level(0, 0);
} else
#endif /* RTEMS_SMP */
{
rtems_cache_invalidate_entire_data();
}
rtems_cache_invalidate_entire_instruction();
arm_cp15_tlb_invalidate(); arm_cp15_tlb_invalidate();
arm_cp15_flush_prefetch_buffer(); _ARM_Instruction_synchronization_barrier();
/* Clear Translation Table Base Control Register */ /* Clear Translation Table Base Control Register */
arm_cp15_set_translation_table_base_control_register(0); arm_cp15_set_translation_table_base_control_register(0);
#ifdef RTEMS_SMP #ifdef RTEMS_SMP
if (cpu_index_self == 0) { if (_SMP_Get_current_processor() == 0) {
rpi_ipi_initialize(); rpi_ipi_initialize();
} else { } else {
rpi_start_rtems_on_secondary_processor(); rpi_start_rtems_on_secondary_processor();

37
bsps/arm/shared/start/start.S
View File

@@ -31,6 +31,8 @@
#include <bspopts.h> #include <bspopts.h>
#include <bsp/irq.h> #include <bsp/irq.h>
#include <dev/cache/arm-data-cache-loop-set-way.h>
/* Global symbols */ /* Global symbols */
.globl _start .globl _start
.globl bsp_start_hook_0_done .globl bsp_start_hook_0_done
@@ -390,15 +392,46 @@ _start:
#if (__ARM_ARCH >= 7 && __ARM_ARCH_PROFILE == 'A') || __ARM_ARCH >= 8 #if (__ARM_ARCH >= 7 && __ARM_ARCH_PROFILE == 'A') || __ARM_ARCH >= 8
/* /*
* Set VBAR to the vector table in the start section and make sure * Set VBAR to the vector table in the start section and make sure
* SCTLR[V] is cleared. Afterwards, exceptions are handled by RTEMS. * SCTLR[M, I, A, C, V] are cleared. Afterwards, exceptions are
* handled by RTEMS.
*/ */
ldr r0, =bsp_start_vector_table_begin ldr r0, =bsp_start_vector_table_begin
dsb dsb
mcr p15, 0, r0, c12, c0, 0 mcr p15, 0, r0, c12, c0, 0
mrc p15, 0, r0, c1, c0, 0 mrc p15, 0, r0, c1, c0, 0
bic r1, r0, #0x2000 bic r1, r0, #0x2800
bic r1, r1, #0x7
mcr p15, 0, r1, c1, c0, 0 mcr p15, 0, r1, c1, c0, 0
isb isb
/* Check previous SCTLR[C] and initialize data caches */
tst r0, #0x4
bne .Lclean_invalidate_data_caches
/*
* Invalidate the sets and ways of all data or unified cache levels
* using DCISW (Data Cache line Invalidate by Set/Way).
*/
ARM_DATA_CACHE_LOOP_SET_WAY c6
b .Ldata_caches_initialized
.Lclean_invalidate_data_caches:
/*
* Clean and invalidate the sets and ways of all data or unified cache
* levels using DCCISW (Data Cache line Clean and Invalidate by
* Set/Way).
*/
ARM_DATA_CACHE_LOOP_SET_WAY c14
.Ldata_caches_initialized:
/*
* Invalidate the instruction cache levels using ICIALLU (Instruction
* Cache Invalidate All to PoU).
*/
mov r0, #0
mcr p15, 0, r0, c7, c5, 0
#endif #endif
/* /*

37
bsps/arm/xilinx-zynq/start/bspstarthooks.c
View File

@@ -29,45 +29,14 @@
#include <bsp.h> #include <bsp.h>
#include <bsp/start.h> #include <bsp/start.h>
#include <bsp/arm-cp15-start.h>
#include <bsp/arm-a9mpcore-start.h> #include <bsp/arm-a9mpcore-start.h>
#include <libcpu/arm-cp15.h>
BSP_START_TEXT_SECTION void bsp_start_hook_0(void) BSP_START_TEXT_SECTION void bsp_start_hook_0(void)
{ {
uint32_t sctlr_val;
sctlr_val = arm_cp15_get_control();
/*
* Current U-boot loader seems to start kernel image
* with I and D caches on and MMU enabled.
* If RTEMS application image finds that cache is on
* during startup then disable caches.
*/
if ( sctlr_val & (ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M ) ) {
if ( sctlr_val & (ARM_CP15_CTRL_C | ARM_CP15_CTRL_M ) ) {
/*
* If the data cache is on then ensure that it is clean
* before switching off to be extra carefull.
*/
arm_cp15_data_cache_clean_all_levels();
}
arm_cp15_flush_prefetch_buffer();
sctlr_val &= ~ ( ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M | ARM_CP15_CTRL_A );
arm_cp15_set_control( sctlr_val );
}
arm_cp15_instruction_cache_invalidate();
/*
* The care should be taken there that no shared levels
* are invalidated by secondary CPUs in SMP case.
* It is not problem on Zynq because level of coherency
* is L1 only and higher level is not maintained and seen
* by CP15. So no special care to limit levels on the secondary
* are required there.
*/
arm_cp15_data_cache_invalidate_all_levels();
arm_cp15_tlb_invalidate(); arm_cp15_tlb_invalidate();
arm_cp15_flush_prefetch_buffer(); _ARM_Instruction_synchronization_barrier()
arm_a9mpcore_start_hook_0(); arm_a9mpcore_start_hook_0();
} }

39
bsps/arm/xilinx-zynqmp/start/bspstarthooks.c
View File

@@ -34,46 +34,13 @@
#include <bsp.h> #include <bsp.h>
#include <bsp/start.h> #include <bsp/start.h>
#include <bsp/arm-cp15-start.h>
#include <libcpu/arm-cp15.h>
BSP_START_TEXT_SECTION void bsp_start_hook_0(void) BSP_START_TEXT_SECTION void bsp_start_hook_0(void)
{ {
uint32_t sctlr_val;
sctlr_val = arm_cp15_get_control();
sctlr_val |= ARM_CP15_CTRL_CP15BEN;
arm_cp15_set_control( sctlr_val );
/*
* Current U-boot loader seems to start kernel image
* with I and D caches on and MMU enabled.
* If RTEMS application image finds that cache is on
* during startup then disable caches.
*/
if ( sctlr_val & (ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M ) ) {
if ( sctlr_val & (ARM_CP15_CTRL_C | ARM_CP15_CTRL_M ) ) {
/*
* If the data cache is on then ensure that it is clean
* before switching off to be extra carefull.
*/
arm_cp15_data_cache_clean_all_levels();
}
arm_cp15_flush_prefetch_buffer();
sctlr_val &= ~ ( ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M | ARM_CP15_CTRL_A );
arm_cp15_set_control( sctlr_val );
}
arm_cp15_instruction_cache_invalidate();
/*
* The care should be taken there that no shared levels
* are invalidated by secondary CPUs in SMP case.
* It is not problem on Zynq because level of coherency
* is L1 only and higher level is not maintained and seen
* by CP15. So no special care to limit levels on the secondary
* are required there.
*/
arm_cp15_data_cache_invalidate_all_levels();
arm_cp15_tlb_invalidate(); arm_cp15_tlb_invalidate();
arm_cp15_flush_prefetch_buffer(); _ARM_Instruction_synchronization_barrier();
} }
BSP_START_TEXT_SECTION void bsp_start_hook_1(void) BSP_START_TEXT_SECTION void bsp_start_hook_1(void)