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

bsp/arm: Correct L2 cache flushing

Browse Source 
Correct misalignment handling and prepare for locking.
This commit is contained in:
Ralf Kirchner
2014-04-17 10:37:10 +02:00
committed by Sebastian Huber
parent cbd9e634ee
commit 92e2757b0b
1 changed files with 30 additions and 16 deletions
Download Patch File Download Diff File Expand all files Collapse all files

42
c/src/lib/libbsp/arm/shared/arm-l2c-310/cache_.h
View File

@@ -80,6 +80,9 @@ extern "C" {
#define CACHE_l2C_310_NUM_WAYS 8
#define CACHE_l2C_310_WAY_MASK ( ( 1 << CACHE_l2C_310_NUM_WAYS ) - 1 )
#define CACHE_MIN( a, b ) \
((a < b) ? (a) : (b))
/* RTL release number as can be read from cache_id register */
typedef enum {
@@ -1032,15 +1035,17 @@ cache_l2c_310_sync( void )
}
static inline void
cache_l2c_310_flush_1_line( const void *d_addr )
cache_l2c_310_flush_1_line(
const void *d_addr,
const bool is_errata_588369applicable
)
{
volatile L2CC *l2cc = (volatile L2CC *) BSP_ARM_L2CC_BASE;
if( l2c_310_cache_errata_is_applicable_588369() ) {
if( is_errata_588369applicable ) {
/*
* Errata 588369 says that clean + inv may keep the
* cache line if it was clean, the recommanded
* cache line if it was clean, the recommended
* workaround is to clean then invalidate the cache
* line, with write-back and cache linefill disabled.
*/
@@ -1050,26 +1055,35 @@ cache_l2c_310_flush_1_line( const void *d_addr )
} else {
l2cc->clean_inv_pa = (uint32_t) d_addr;
}
cache_l2c_310_sync();
}
static inline void
cache_l2c_310_flush_range( const void *addr, size_t n_bytes )
cache_l2c_310_flush_range( const void* d_addr, const size_t n_bytes )
{
if ( n_bytes != 0 ) {
uint32_t adx = (uint32_t) addr
/* Back starting address up to start of a line and invalidate until ADDR_LAST */
uint32_t adx = (uint32_t)d_addr
& ~CACHE_L2C_310_DATA_LINE_MASK;
const uint32_t ADDR_LAST =
( (uint32_t) addr + n_bytes - 1 ) & ~CACHE_L2C_310_DATA_LINE_MASK;
volatile L2CC *l2cc = (volatile L2CC *) BSP_ARM_L2CC_BASE;
(uint32_t)( (size_t)d_addr + n_bytes - 1 );
uint32_t block_end =
CACHE_MIN( ADDR_LAST, adx + CACHE_MAX_LOCKING_BYTES );
bool is_errata_588369_applicable =
l2c_310_cache_errata_is_applicable_588369();
for (; adx <= ADDR_LAST; adx += CPU_DATA_CACHE_ALIGNMENT ) {
l2cc->clean_pa = adx;
for (;
adx <= ADDR_LAST;
adx = block_end + 1,
block_end = CACHE_MIN( ADDR_LAST, adx + CACHE_MAX_LOCKING_BYTES )) {
for (; adx <= block_end; adx += CPU_DATA_CACHE_ALIGNMENT ) {
cache_l2c_310_flush_1_line( (void*)adx, is_errata_588369_applicable );
}
if( block_end < ADDR_LAST ) {
rtems_interrupt_lock_release( &l2c_310_cache_lock, &lock_context );
rtems_interrupt_lock_acquire( &l2c_310_cache_lock, &lock_context );
}
}
cache_l2c_310_sync();
}
}
static inline void
cache_l2c_310_flush_entire( void )