From cd440bd32a120a9b4c2d703d3d16dd52f16edab2 Mon Sep 17 00:00:00 2001 From: Oleksij Rempel Date: Thu, 23 Apr 2015 07:49:13 +0200 Subject: add armv7a_cache handlers This patch introduces, new command set and handlers for l1 and l2x caches. Patch set 10 folded the following changes into this one: Ib1a2a1fc1b929dc49532ac13a78e8eb796ab4415 If8d87a03281d0f4ad402909998e7834eb4837e79 I0749f129fa74e04f4e9c20d143a744f09ef750d8 Change-Id: I849f4d1f20610087885eeddefa81d976f77cf199 Signed-off-by: Oleksij Rempel Signed-off-by: Matthias Welwarsky Reviewed-on: http://openocd.zylin.com/2800 Tested-by: jenkins Reviewed-by: Paul Fertser --- src/target/armv7a_cache.c | 541 ++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 541 insertions(+) create mode 100644 src/target/armv7a_cache.c (limited to 'src/target/armv7a_cache.c') diff --git a/src/target/armv7a_cache.c b/src/target/armv7a_cache.c new file mode 100644 index 00000000..984dc7c5 --- /dev/null +++ b/src/target/armv7a_cache.c @@ -0,0 +1,541 @@ +/*************************************************************************** + * Copyright (C) 2015 by Oleksij Rempel * + * linux@rempel-privat.de * + * * + * This program is free software; you can redistribute it and/or modify * + * it under the terms of the GNU General Public License as published by * + * the Free Software Foundation; either version 2 of the License, or * + * (at your option) any later version. * + * * + * This program is distributed in the hope that it will be useful, * + * but WITHOUT ANY WARRANTY; without even the implied warranty of * + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * + * GNU General Public License for more details. * + ***************************************************************************/ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include "jtag/interface.h" +#include "arm.h" +#include "armv7a.h" +#include "armv7a_cache.h" +#include +#include "arm_opcodes.h" + +static int armv7a_l1_d_cache_sanity_check(struct target *target) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + + if (target->state != TARGET_HALTED) { + LOG_ERROR("%s: target not halted", __func__); + return ERROR_TARGET_NOT_HALTED; + } + + /* check that cache data is on at target halt */ + if (!armv7a->armv7a_mmu.armv7a_cache.d_u_cache_enabled) { + LOG_DEBUG("l1 data cache is not enabled"); + return ERROR_TARGET_INVALID; + } + + return ERROR_OK; +} + +static int armv7a_l1_i_cache_sanity_check(struct target *target) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + + if (target->state != TARGET_HALTED) { + LOG_ERROR("%s: target not halted", __func__); + return ERROR_TARGET_NOT_HALTED; + } + + /* check that cache data is on at target halt */ + if (!armv7a->armv7a_mmu.armv7a_cache.i_cache_enabled) { + LOG_DEBUG("l1 data cache is not enabled"); + return ERROR_TARGET_INVALID; + } + + return ERROR_OK; +} + +static int armv7a_l1_d_cache_clean_inval_all(struct target *target) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + struct arm_dpm *dpm = armv7a->arm.dpm; + struct armv7a_cachesize *d_u_size = + &(armv7a->armv7a_mmu.armv7a_cache.d_u_size); + int32_t c_way, c_index = d_u_size->index; + int retval; + + retval = armv7a_l1_d_cache_sanity_check(target); + if (retval != ERROR_OK) + return retval; + + retval = dpm->prepare(dpm); + if (retval != ERROR_OK) + goto done; + + do { + c_way = d_u_size->way; + do { + uint32_t value = (c_index << d_u_size->index_shift) + | (c_way << d_u_size->way_shift); + /* + * DCCISW - Clean and invalidate data cache + * line by Set/Way. + */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 14, 2), + value); + if (retval != ERROR_OK) + goto done; + c_way -= 1; + } while (c_way >= 0); + c_index -= 1; + } while (c_index >= 0); + + return retval; + +done: + LOG_ERROR("clean invalidate failed"); + dpm->finish(dpm); + + return retval; +} + +int armv7a_cache_auto_flush_all_data(struct target *target) +{ + int retval = ERROR_FAIL; + struct armv7a_common *armv7a = target_to_armv7a(target); + + if (!armv7a->armv7a_mmu.armv7a_cache.auto_cache_enabled) + return ERROR_OK; + + if (target->smp) { + struct target_list *head; + struct target *curr; + head = target->head; + while (head != (struct target_list *)NULL) { + curr = head->target; + if (curr->state == TARGET_HALTED) + retval = armv7a_l1_d_cache_clean_inval_all(curr); + + head = head->next; + } + } else + retval = armv7a_l1_d_cache_clean_inval_all(target); + + /* FIXME: do l2x flushing here */ + + return retval; +} + + +static int armv7a_l1_d_cache_inval_virt(struct target *target, uint32_t virt, + uint32_t size) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + struct arm_dpm *dpm = armv7a->arm.dpm; + struct armv7a_cache_common *armv7a_cache = &armv7a->armv7a_mmu.armv7a_cache; + uint32_t i, linelen = armv7a_cache->dminline; + int retval; + + retval = armv7a_l1_d_cache_sanity_check(target); + if (retval != ERROR_OK) + return retval; + + retval = dpm->prepare(dpm); + if (retval != ERROR_OK) + goto done; + + for (i = 0; i < size; i += linelen) { + uint32_t offs = virt + i; + + /* DCIMVAC - Clean and invalidate data cache line by VA to PoC. */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 6, 1), offs); + if (retval != ERROR_OK) + goto done; + } + return retval; + +done: + LOG_ERROR("d-cache invalidate failed"); + dpm->finish(dpm); + + return retval; +} + +int armv7a_l1_d_cache_clean_virt(struct target *target, uint32_t virt, + unsigned int size) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + struct arm_dpm *dpm = armv7a->arm.dpm; + struct armv7a_cache_common *armv7a_cache = &armv7a->armv7a_mmu.armv7a_cache; + uint32_t i, linelen = armv7a_cache->dminline; + int retval; + + retval = armv7a_l1_d_cache_sanity_check(target); + if (retval != ERROR_OK) + return retval; + + retval = dpm->prepare(dpm); + if (retval != ERROR_OK) + goto done; + + for (i = 0; i < size; i += linelen) { + uint32_t offs = virt + i; + + /* FIXME: do we need DCCVAC or DCCVAU */ + /* FIXME: in both cases it is not enough for i-cache */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 10, 1), offs); + if (retval != ERROR_OK) + goto done; + } + return retval; + +done: + LOG_ERROR("d-cache invalidate failed"); + dpm->finish(dpm); + + return retval; +} + +int armv7a_l1_i_cache_inval_all(struct target *target) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + struct arm_dpm *dpm = armv7a->arm.dpm; + int retval; + + retval = armv7a_l1_i_cache_sanity_check(target); + if (retval != ERROR_OK) + return retval; + + retval = dpm->prepare(dpm); + if (retval != ERROR_OK) + goto done; + + if (target->smp) { + /* ICIALLUIS */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 1, 0), 0); + } else { + /* ICIALLU */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 5, 0), 0); + } + + if (retval != ERROR_OK) + goto done; + + dpm->finish(dpm); + return retval; + +done: + LOG_ERROR("i-cache invalidate failed"); + dpm->finish(dpm); + + return retval; +} + +int armv7a_l1_i_cache_inval_virt(struct target *target, uint32_t virt, + uint32_t size) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + struct arm_dpm *dpm = armv7a->arm.dpm; + struct armv7a_cache_common *armv7a_cache = + &armv7a->armv7a_mmu.armv7a_cache; + uint32_t linelen = armv7a_cache->iminline; + uint32_t va_line, va_end; + int retval; + + retval = armv7a_l1_i_cache_sanity_check(target); + if (retval != ERROR_OK) + return retval; + + retval = dpm->prepare(dpm); + if (retval != ERROR_OK) + goto done; + + va_line = virt & (-linelen); + va_end = virt + size; + + while (va_line < va_end) { + /* ICIMVAU - Invalidate instruction cache by VA to PoU. */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 5, 1), va_line); + if (retval != ERROR_OK) + goto done; + /* BPIMVA */ + retval = dpm->instr_write_data_r0(dpm, + ARMV4_5_MCR(15, 0, 0, 7, 5, 7), va_line); + if (retval != ERROR_OK) + goto done; + va_line += linelen; + } + return retval; + +done: + LOG_ERROR("i-cache invalidate failed"); + dpm->finish(dpm); + + return retval; +} + + +/* + * We assume that target core was chosen correctly. It means if same data + * was handled by two cores, other core will loose the changes. Since it + * is impossible to know (FIXME) which core has correct data, keep in mind + * that some kind of data lost or korruption is possible. + * Possible scenario: + * - core1 loaded and changed data on 0x12345678 + * - we halted target and modified same data on core0 + * - data on core1 will be lost. + */ +int armv7a_cache_auto_flush_on_write(struct target *target, uint32_t virt, + uint32_t size) +{ + struct armv7a_common *armv7a = target_to_armv7a(target); + int retval = ERROR_OK; + + if (!armv7a->armv7a_mmu.armv7a_cache.auto_cache_enabled) + return ERROR_OK; + + armv7a_l1_d_cache_clean_virt(target, virt, size); + armv7a_l2x_cache_flush_virt(target, virt, size); + + if (target->smp) { + struct target_list *head; + struct target *curr; + head = target->head; + while (head != (struct target_list *)NULL) { + curr = head->target; + if (curr->state == TARGET_HALTED) { + retval = armv7a_l1_i_cache_inval_all(curr); + if (retval != ERROR_OK) + return retval; + retval = armv7a_l1_d_cache_inval_virt(target, + virt, size); + if (retval != ERROR_OK) + return retval; + } + head = head->next; + } + } else { + retval = armv7a_l1_i_cache_inval_all(target); + if (retval != ERROR_OK) + return retval; + retval = armv7a_l1_d_cache_inval_virt(target, virt, size); + if (retval != ERROR_OK) + return retval; + } + + return retval; +} + +COMMAND_HANDLER(arm7a_l1_cache_info_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + struct armv7a_common *armv7a = target_to_armv7a(target); + + return armv7a_handle_cache_info_command(CMD_CTX, + &armv7a->armv7a_mmu.armv7a_cache); +} + +COMMAND_HANDLER(armv7a_l1_d_cache_clean_inval_all_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + + armv7a_l1_d_cache_clean_inval_all(target); + + return 0; +} + +COMMAND_HANDLER(arm7a_l1_d_cache_inval_virt_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + uint32_t virt, size; + + if (CMD_ARGC == 0 || CMD_ARGC > 2) + return ERROR_COMMAND_SYNTAX_ERROR; + + if (CMD_ARGC == 2) + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], size); + else + size = 1; + + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], virt); + + return armv7a_l1_d_cache_inval_virt(target, virt, size); +} + +COMMAND_HANDLER(arm7a_l1_d_cache_clean_virt_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + uint32_t virt, size; + + if (CMD_ARGC == 0 || CMD_ARGC > 2) + return ERROR_COMMAND_SYNTAX_ERROR; + + if (CMD_ARGC == 2) + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], size); + else + size = 1; + + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], virt); + + return armv7a_l1_d_cache_clean_virt(target, virt, size); +} + +COMMAND_HANDLER(armv7a_i_cache_clean_inval_all_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + + armv7a_l1_i_cache_inval_all(target); + + return 0; +} + +COMMAND_HANDLER(arm7a_l1_i_cache_inval_virt_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + uint32_t virt, size; + + if (CMD_ARGC == 0 || CMD_ARGC > 2) + return ERROR_COMMAND_SYNTAX_ERROR; + + if (CMD_ARGC == 2) + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], size); + else + size = 1; + + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], virt); + + return armv7a_l1_i_cache_inval_virt(target, virt, size); +} + +COMMAND_HANDLER(arm7a_cache_disable_auto_cmd) +{ + struct target *target = get_current_target(CMD_CTX); + struct armv7a_common *armv7a = target_to_armv7a(target); + + if (CMD_ARGC == 0) { + command_print(CMD_CTX, "auto cache is %s", + armv7a->armv7a_mmu.armv7a_cache.auto_cache_enabled ? "enabled" : "disabled"); + return ERROR_OK; + } + + if (CMD_ARGC == 1) { + uint32_t set; + + COMMAND_PARSE_ENABLE(CMD_ARGV[0], set); + armv7a->armv7a_mmu.armv7a_cache.auto_cache_enabled = !!set; + return ERROR_OK; + } + + return ERROR_COMMAND_SYNTAX_ERROR; +} + +static const struct command_registration arm7a_l1_d_cache_commands[] = { + { + .name = "flush_all", + .handler = armv7a_l1_d_cache_clean_inval_all_cmd, + .mode = COMMAND_ANY, + .help = "flush (clean and invalidate) complete l1 d-cache", + .usage = "", + }, + { + .name = "inval", + .handler = arm7a_l1_d_cache_inval_virt_cmd, + .mode = COMMAND_ANY, + .help = "invalidate l1 d-cache by virtual address offset and range size", + .usage = " [size]", + }, + { + .name = "clean", + .handler = arm7a_l1_d_cache_clean_virt_cmd, + .mode = COMMAND_ANY, + .help = "clean l1 d-cache by virtual address address offset and range size", + .usage = " [size]", + }, + COMMAND_REGISTRATION_DONE +}; + +static const struct command_registration arm7a_l1_i_cache_commands[] = { + { + .name = "inval_all", + .handler = armv7a_i_cache_clean_inval_all_cmd, + .mode = COMMAND_ANY, + .help = "invalidate complete l1 i-cache", + .usage = "", + }, + { + .name = "inval", + .handler = arm7a_l1_i_cache_inval_virt_cmd, + .mode = COMMAND_ANY, + .help = "invalidate l1 i-cache by virtual address offset and range size", + .usage = " [size]", + }, + COMMAND_REGISTRATION_DONE +}; + +const struct command_registration arm7a_l1_di_cache_group_handlers[] = { + { + .name = "info", + .handler = arm7a_l1_cache_info_cmd, + .mode = COMMAND_ANY, + .help = "print cache realted information", + .usage = "", + }, + { + .name = "d", + .mode = COMMAND_ANY, + .help = "l1 d-cache command group", + .usage = "", + .chain = arm7a_l1_d_cache_commands, + }, + { + .name = "i", + .mode = COMMAND_ANY, + .help = "l1 i-cache command group", + .usage = "", + .chain = arm7a_l1_i_cache_commands, + }, + COMMAND_REGISTRATION_DONE +}; + +const struct command_registration arm7a_cache_group_handlers[] = { + { + .name = "auto", + .handler = arm7a_cache_disable_auto_cmd, + .mode = COMMAND_ANY, + .help = "disable or enable automatic cache handling.", + .usage = "(1|0)", + }, + { + .name = "l1", + .mode = COMMAND_ANY, + .help = "l1 cache command group", + .usage = "", + .chain = arm7a_l1_di_cache_group_handlers, + }, + { + .chain = arm7a_l2x_cache_command_handler, + }, + COMMAND_REGISTRATION_DONE +}; + +const struct command_registration arm7a_cache_command_handlers[] = { + { + .name = "cache", + .mode = COMMAND_ANY, + .help = "cache command group", + .usage = "", + .chain = arm7a_cache_group_handlers, + }, + COMMAND_REGISTRATION_DONE +}; -- cgit v1.2.3-18-g5258