diff options
author | Kinsey Moore <kinsey.moore@oarcorp.com> | 2021-05-18 07:56:54 -0500 |
---|---|---|
committer | Joel Sherrill <joel@rtems.org> | 2021-05-27 14:09:00 -0500 |
commit | 12ec459f4a40608d1ab03dec0e14a970e04dc242 (patch) | |
tree | 303d5089d940b0fd646f8e44924ae4faf8840182 | |
parent | bsps/aarch64: Break out system registers (diff) | |
download | rtems-12ec459f4a40608d1ab03dec0e14a970e04dc242.tar.bz2 |
bsps/aarch64: Align MVAs consistently
This fixes a bug where addresses were not being aligned correctly.
Addresses used in cache functions are now aligned consistently using
RTEMS_ALIGN_DOWN.
-rw-r--r-- | bsps/aarch64/shared/cache/cache.c | 13 |
1 files changed, 5 insertions, 8 deletions
diff --git a/bsps/aarch64/shared/cache/cache.c b/bsps/aarch64/shared/cache/cache.c index ce2e130abe..47722c21e4 100644 --- a/bsps/aarch64/shared/cache/cache.c +++ b/bsps/aarch64/shared/cache/cache.c @@ -39,11 +39,9 @@ #include <bsp/utility.h> #include <rtems/score/aarch64-system-registers.h> -#define AARCH64_CACHE_L1_CPU_DATA_ALIGNMENT ((size_t)64) -#define AARCH64_CACHE_L1_DATA_LINE_MASK \ - ( AARCH64_CACHE_L1_CPU_DATA_ALIGNMENT - 1 ) -#define AARCH64_CACHE_PREPARE_MVA(mva) \ - ((const void *) (((size_t) (mva)) & AARCH64_CACHE_L1_DATA_LINE_MASK)) +#define AARCH64_CACHE_L1_CPU_DATA_ALIGNMENT ( (size_t) 64 ) +#define AARCH64_CACHE_PREPARE_MVA(mva) (const void *) \ + RTEMS_ALIGN_DOWN ( (size_t) mva, AARCH64_CACHE_L1_CPU_DATA_ALIGNMENT ) static inline void AArch64_data_cache_clean_and_invalidate_line(const void *d_addr) @@ -75,7 +73,7 @@ _CPU_cache_flush_data_range( { _AARCH64_Data_synchronization_barrier(); if ( n_bytes != 0 ) { - size_t adx = (size_t) d_addr & ~AARCH64_CACHE_L1_DATA_LINE_MASK; + size_t adx = (size_t) AARCH64_CACHE_PREPARE_MVA ( d_addr ); const size_t ADDR_LAST = (size_t) d_addr + n_bytes - 1; for (; adx <= ADDR_LAST; adx += AARCH64_CACHE_L1_CPU_DATA_ALIGNMENT ) { @@ -116,8 +114,7 @@ _CPU_cache_invalidate_data_range( ) { if ( n_bytes != 0 ) { - size_t adx = (size_t) d_addr - & ~AARCH64_CACHE_L1_DATA_LINE_MASK; + size_t adx = (size_t) AARCH64_CACHE_PREPARE_MVA ( d_addr ); const size_t end = (size_t)d_addr + n_bytes -1; /* Back starting address up to start of a line and invalidate until end */ |