arm946e: don't use global variables for context

Global variables 'dc' 'ic' had been used in the code
to keep target's state of D-cache and I-cache
on debug entry.

This may lead to incorrect operation in configurations
with multiple cores and unequal cache states.

Fix: move cache state to the appropriate bits of the
'cp15_control_reg' field (already present but unused).
Vaule of cp15 control register stored here on
arm946e_post_debug_entry(), and analyzed later
in arm946e_write_memory().

Change-Id: I71ef82be00c21d6fffb3726cec4974d1ece70dfe
Signed-off-by: Alexander Osipenko <sipych@gmail.com>
Reviewed-on: http://openocd.zylin.com/692
Tested-by: jenkins
Reviewed-by: Freddie Chopin <freddie.chopin@gmail.com>
This commit is contained in:
Alexander Osipenko 2012-07-31 03:50:09 +04:00 committed by Freddie Chopin
parent ee8df96b2b
commit 9c9c06b8ae
1 changed files with 25 additions and 26 deletions

View File

@ -40,8 +40,9 @@
#define NB_CACHE_WAYS 4 #define NB_CACHE_WAYS 4
static uint32_t dc; #define CP15_CTL 0x02
static uint32_t ic; #define CP15_CTL_DCACHE (1<<2)
#define CP15_CTL_ICACHE (1<<12)
/** /**
* flag to give info about cache manipulation during debug : * flag to give info about cache manipulation during debug :
@ -294,32 +295,34 @@ int arm946e_post_debug_entry(struct target *target)
{ {
uint32_t ctr_reg = 0x0; uint32_t ctr_reg = 0x0;
uint32_t retval = ERROR_OK; uint32_t retval = ERROR_OK;
struct arm946e_common *arm946e = target_to_arm946(target);
/* See if CACHES are enabled, and save that info /* See if CACHES are enabled, and save that info
* in the global vars, so that arm946e_pre_restore_context() can use them */ * in the context bits, so that arm946e_pre_restore_context() can use them */
arm946e_read_cp15(target, 0x02, (uint32_t *) &ctr_reg); arm946e_read_cp15(target, CP15_CTL, (uint32_t *) &ctr_reg);
dc = (ctr_reg >> 2) & 0x01;
ic = (ctr_reg >> 12) & 0x01; /* Save control reg in the context */
arm946e->cp15_control_reg = ctr_reg;
if (arm946e_preserve_cache) { if (arm946e_preserve_cache) {
if (dc == 1) { if (ctr_reg & CP15_CTL_DCACHE) {
/* Clean and flush D$ */ /* Clean and flush D$ */
arm946e_invalidate_whole_dcache(target); arm946e_invalidate_whole_dcache(target);
/* Disable D$ */ /* Disable D$ */
ctr_reg &= ~(1 << 2); ctr_reg &= ~CP15_CTL_DCACHE;
} }
if (ic == 1) { if (ctr_reg & CP15_CTL_ICACHE) {
/* Flush I$ */ /* Flush I$ */
arm946e_invalidate_whole_icache(target); arm946e_invalidate_whole_icache(target);
/* Disable I$ */ /* Disable I$ */
ctr_reg &= ~(1 << 12); ctr_reg &= ~CP15_CTL_ICACHE;
} }
/* Write the new configuration */ /* Write the new configuration */
retval = arm946e_write_cp15(target, 0x02, ctr_reg); retval = arm946e_write_cp15(target, CP15_CTL, ctr_reg);
if (retval != ERROR_OK) { if (retval != ERROR_OK) {
LOG_DEBUG("ERROR disabling cache"); LOG_DEBUG("ERROR disabling cache");
return retval; return retval;
@ -335,25 +338,20 @@ void arm946e_pre_restore_context(struct target *target)
uint32_t retval; uint32_t retval;
if (arm946e_preserve_cache) { if (arm946e_preserve_cache) {
struct arm946e_common *arm946e = target_to_arm946(target);
/* Get the contents of the CTR reg */ /* Get the contents of the CTR reg */
arm946e_read_cp15(target, 0x02, (uint32_t *) &ctr_reg); arm946e_read_cp15(target, CP15_CTL, (uint32_t *) &ctr_reg);
/** /**
* Read-modify-write CP15 test state register * Read-modify-write CP15 control
* to reenable I/D-cache linefills * to reenable I/D-cache operation
* NOTE: It is not possible to disable cache by CP15.
* if arm946e_preserve_cache debugging flag enabled.
*/ */
if (dc == 1) { ctr_reg |= arm946e->cp15_control_reg & (CP15_CTL_DCACHE|CP15_CTL_ICACHE);
/* Enable D$ */
ctr_reg |= 1 << 2;
}
if (ic == 1) {
/* Enable I$ */
ctr_reg |= 1 << 12;
}
/* Write the new configuration */ /* Write the new configuration */
retval = arm946e_write_cp15(target, 0x02, ctr_reg); retval = arm946e_write_cp15(target, CP15_CTL, ctr_reg);
if (retval != ERROR_OK) if (retval != ERROR_OK)
LOG_DEBUG("ERROR enabling cache"); LOG_DEBUG("ERROR enabling cache");
} /* if preserve_cache */ } /* if preserve_cache */
@ -488,8 +486,9 @@ int arm946e_write_memory(struct target *target, uint32_t address,
LOG_DEBUG("-"); LOG_DEBUG("-");
struct arm946e_common *arm946e = target_to_arm946(target);
/* Invalidate D$ if it is ON */ /* Invalidate D$ if it is ON */
if (!arm946e_preserve_cache && dc == 1) if (!arm946e_preserve_cache && (arm946e->cp15_control_reg & CP15_CTL_DCACHE))
arm946e_invalidate_dcache(target, address, size, count); arm946e_invalidate_dcache(target, address, size, count);
/** /**
@ -521,7 +520,7 @@ int arm946e_write_memory(struct target *target, uint32_t address,
* the cache write policy is write-through. * the cache write policy is write-through.
* If the data is not in the cache, the controller writes to main memory only. * If the data is not in the cache, the controller writes to main memory only.
*/ */
if (!arm946e_preserve_cache && ic == 1) if (!arm946e_preserve_cache && (arm946e->cp15_control_reg & CP15_CTL_ICACHE))
arm946e_invalidate_icache(target, address, size, count); arm946e_invalidate_icache(target, address, size, count);
return ERROR_OK; return ERROR_OK;