+ 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 JIM_ERR;
+
+ if (target->state != TARGET_HALTED) {
+ command_print(cmd_ctx, "target %s must be stopped for \"cp15\" command", target_name(target));
+ return JIM_ERR;
+ }
+
+ long l;
+ uint32_t address;
+ retval = Jim_GetLong(interp, argv[1], &l);
+ address = l;
+ if (JIM_OK != retval)
+ return retval;
+
+ 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 JIM_OK;
+}
+
+COMMAND_HANDLER(arm946e_handle_idcache)