diff options
author | Alexander Osipenko <sipych@gmail.com> | 2012-06-08 23:21:31 +0400 |
---|---|---|
committer | Freddie Chopin <freddie.chopin@gmail.com> | 2012-08-01 21:19:53 +0000 |
commit | f1e9cef4101a6c9aba2eb65ec99404b44a5a00fc (patch) | |
tree | 8611e9de95eb9cbf58ef3a338070b71d7dafdbef /src | |
parent | 63687807ccad246754e2fc32518bf27d1ab02d6b (diff) |
arm946e: cp15 command returns value to the script
Not just print it.
This enables scripts to analyze valuable config options of
arm946e-s cores, do internal BIST memory tests and more.
Be careful to flush caches before disabling it.
Do not forget that BIST test overwrites memory.
- cp15 rewritten from COMMAND_HANDLER to jim_handler.
Change-Id: I734da0be6db0a3127c2daa94ed75efef94da8ceb
Signed-off-by: Alexander Osipenko <sipych@gmail.com>
Reviewed-on: http://openocd.zylin.com/694
Tested-by: jenkins
Reviewed-by: Freddie Chopin <freddie.chopin@gmail.com>
Diffstat (limited to 'src')
-rw-r--r-- | src/target/arm946e.c | 102 |
1 files changed, 65 insertions, 37 deletions
diff --git a/src/target/arm946e.c b/src/target/arm946e.c index 2a71f2d3..a7a57b74 100644 --- a/src/target/arm946e.c +++ b/src/target/arm946e.c @@ -112,6 +112,16 @@ static int arm946e_verify_pointer(struct command_context *cmd_ctx, } /* + * Update cp15_control_reg, saved on debug_entry. + */ +static void arm946e_update_cp15_caches(struct target *target, uint32_t value) +{ + struct arm946e_common *arm946e = target_to_arm946(target); + arm946e->cp15_control_reg = (arm946e->cp15_control_reg & ~(CP15_CTL_DCACHE|CP15_CTL_ICACHE)) + | (value & (CP15_CTL_DCACHE|CP15_CTL_ICACHE)); +} + +/* * REVISIT: The "read_cp15" and "write_cp15" commands could hook up * to eventual mrc() and mcr() routines ... the reg_addr values being * constructed (for CP15 only) from Opcode_1, Opcode_2, and CRn values. @@ -541,61 +551,79 @@ int arm946e_read_memory(struct target *target, uint32_t address, return ERROR_OK; } - -COMMAND_HANDLER(arm946e_handle_cp15_command) +static int jim_arm946e_cp15(Jim_Interp *interp, int argc, Jim_Obj * const *argv) { - int retval; - struct target *target = get_current_target(CMD_CTX); - struct arm946e_common *arm946e = target_to_arm946(target); + /* one or two arguments, access a single register (write if second argument is given) */ + if (argc < 2 || argc > 3) { + Jim_WrongNumArgs(interp, 1, argv, "addr [value]"); + return JIM_ERR; + } + + struct command_context *cmd_ctx = current_command_context(interp); + assert(cmd_ctx != NULL); - retval = arm946e_verify_pointer(CMD_CTX, arm946e); + struct target *target = get_current_target(cmd_ctx); + if (target == NULL) { + LOG_ERROR("arm946e: no current target"); + return JIM_ERR; + } + + struct arm946e_common *arm946e = target_to_arm946(target); + int retval = arm946e_verify_pointer(cmd_ctx, arm946e); if (retval != ERROR_OK) - return retval; + return JIM_ERR; if (target->state != TARGET_HALTED) { - command_print(CMD_CTX, "target must be stopped for \"%s\" command", CMD_NAME); - return ERROR_OK; + command_print(cmd_ctx, "target %s must be stopped for \"cp15\" command", target_name(target)); + return JIM_ERR; } - /* one or more argument, access a single register (write if second argument is given */ - if (CMD_ARGC >= 1) { - uint32_t address; - COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], address); - - if (CMD_ARGC == 1) { - uint32_t value; - retval = arm946e_read_cp15(target, address, &value); - if (retval != ERROR_OK) { - command_print(CMD_CTX, "couldn't access reg %" PRIi32, address); - return ERROR_OK; - } - retval = jtag_execute_queue(); - if (retval != ERROR_OK) - return retval; + long l; + uint32_t address; + retval = Jim_GetLong(interp, argv[1], &l); + address = l; + if (JIM_OK != retval) + return retval; - command_print(CMD_CTX, "%" PRIi32 ": %8.8" PRIx32, address, value); - } else if (CMD_ARGC == 2) { - uint32_t value; - COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], value); - retval = arm946e_write_cp15(target, address, value); - if (retval != ERROR_OK) { - command_print(CMD_CTX, "couldn't access reg %" PRIi32, address); - return ERROR_OK; - } - command_print(CMD_CTX, "%" PRIi32 ": %8.8" PRIx32, address, value); + if (argc == 2) { + uint32_t value; + retval = arm946e_read_cp15(target, address, &value); + if (retval != ERROR_OK) { + command_print(cmd_ctx, "%s cp15 reg %" PRIi32 " access failed", target_name(target), address); + return JIM_ERR; } + retval = jtag_execute_queue(); + if (retval != ERROR_OK) + return JIM_ERR; + char buf[20]; + sprintf(buf, "0x%08x", value); + /* Return value in hex format */ + Jim_SetResultString(interp, buf, -1); + } else if (argc == 3) { + uint32_t value; + retval = Jim_GetLong(interp, argv[2], &l); + value = l; + if (JIM_OK != retval) + return retval; + retval = arm946e_write_cp15(target, address, value); + if (retval != ERROR_OK) { + command_print(cmd_ctx, "%s cp15 reg %" PRIi32 " access failed", target_name(target), address); + return JIM_ERR; + } + if (address == CP15_CTL) + arm946e_update_cp15_caches(target, value); } - return ERROR_OK; + return JIM_OK; } static const struct command_registration arm946e_exec_command_handlers[] = { { .name = "cp15", - .handler = arm946e_handle_cp15_command, + .jim_handler = jim_arm946e_cp15, .mode = COMMAND_EXEC, .usage = "regnum [value]", - .help = "display/modify cp15 register", + .help = "read/modify cp15 register", }, COMMAND_REGISTRATION_DONE }; |