From: Franck Jullien Date: Mon, 9 Jun 2014 19:31:47 +0000 (+0200) Subject: openrisc: restore current JTAG module while polling the CPU X-Git-Tag: v0.9.0-rc1~375 X-Git-Url: https://review.openocd.org/gitweb?p=openocd.git;a=commitdiff_plain;h=fd9f27bfac1dd9a661913c31774edf4f8cd0798c openrisc: restore current JTAG module while polling the CPU Change-Id: I93827afaa164d23a93bdddbfa864624b18473f45 Signed-off-by: Franck Jullien Reviewed-on: http://openocd.zylin.com/2163 Tested-by: jenkins Reviewed-by: Spencer Oliver --- diff --git a/src/target/openrisc/or1k_du_adv.c b/src/target/openrisc/or1k_du_adv.c index f497a869d4..8a5562f097 100644 --- a/src/target/openrisc/or1k_du_adv.c +++ b/src/target/openrisc/or1k_du_adv.c @@ -50,6 +50,7 @@ #define DBG_MODULE_SELECT_REG_SIZE 2 #define DBG_MAX_MODULES 4 +#define DC_NONE -1 #define DC_WISHBONE 0 #define DC_CPU0 1 #define DC_CPU1 2 @@ -173,7 +174,7 @@ static int or1k_adv_jtag_init(struct or1k_jtag *jtag_info) jtag_info->or1k_jtag_inited = 1; /* TAP reset - not sure what state debug module chain is in now */ - jtag_info->or1k_jtag_module_selected = -1; + jtag_info->or1k_jtag_module_selected = DC_NONE; jtag_info->current_reg_idx = malloc(DBG_MAX_MODULES * sizeof(uint8_t)); memset(jtag_info->current_reg_idx, 0, DBG_MAX_MODULES * sizeof(uint8_t)); @@ -781,6 +782,8 @@ static int or1k_adv_is_cpu_running(struct or1k_jtag *jtag_info, int *running) return retval; } + int current = jtag_info->or1k_jtag_module_selected; + retval = adbg_select_module(jtag_info, DC_CPU0); if (retval != ERROR_OK) return retval; @@ -795,6 +798,12 @@ static int or1k_adv_is_cpu_running(struct or1k_jtag *jtag_info, int *running) else *running = 1; + if (current != DC_NONE) { + retval = adbg_select_module(jtag_info, current); + if (retval != ERROR_OK) + return retval; + } + return ERROR_OK; }