ADIv5 share DAP command support
Get rid of needless and undesirable code duplication for all the DAP commands (resolving a FIXME) ... there's no need for coreas to have private copies of that stuff. Stick a pointer to the DAP in "struct arm", letting common code get to it. Also rename the "swjdp_info" symbol; just call it "dap". This is an overall code shrink. Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
This commit is contained in:
parent
57ebf6d3de
commit
d33a81c549
|
@ -167,6 +167,12 @@ struct arm {
|
|||
uint32_t value);
|
||||
|
||||
void *arch_info;
|
||||
|
||||
/** For targets conforming to ARM Debug Interface v5,
|
||||
* this handle references the Debug Access Port (DAP)
|
||||
* used to make requests to the target.
|
||||
*/
|
||||
struct adiv5_dap *dap;
|
||||
};
|
||||
|
||||
/** Convert target handle to generic ARM target state handle. */
|
||||
|
|
|
@ -69,6 +69,7 @@
|
|||
#include "config.h"
|
||||
#endif
|
||||
|
||||
#include "arm.h"
|
||||
#include "arm_adi_v5.h"
|
||||
#include <helper/time_support.h>
|
||||
|
||||
|
@ -1352,7 +1353,7 @@ is_dap_cid_ok(uint32_t cid3, uint32_t cid2, uint32_t cid1, uint32_t cid0)
|
|||
&& ((cid1 & 0x0f) == 0) && cid0 == 0x0d;
|
||||
}
|
||||
|
||||
int dap_info_command(struct command_context *cmd_ctx,
|
||||
static int dap_info_command(struct command_context *cmd_ctx,
|
||||
struct adiv5_dap *swjdp, int apsel)
|
||||
{
|
||||
int retval;
|
||||
|
@ -1711,15 +1712,40 @@ int dap_info_command(struct command_context *cmd_ctx,
|
|||
return ERROR_OK;
|
||||
}
|
||||
|
||||
DAP_COMMAND_HANDLER(dap_baseaddr_command)
|
||||
COMMAND_HANDLER(handle_dap_info_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct arm *arm = target_to_arm(target);
|
||||
struct adiv5_dap *dap = arm->dap;
|
||||
uint32_t apsel;
|
||||
|
||||
switch (CMD_ARGC) {
|
||||
case 0:
|
||||
apsel = dap->apsel;
|
||||
break;
|
||||
case 1:
|
||||
COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
|
||||
break;
|
||||
default:
|
||||
return ERROR_COMMAND_SYNTAX_ERROR;
|
||||
}
|
||||
|
||||
return dap_info_command(CMD_CTX, dap, apsel);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(dap_baseaddr_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct arm *arm = target_to_arm(target);
|
||||
struct adiv5_dap *dap = arm->dap;
|
||||
|
||||
uint32_t apsel, apselsave, baseaddr;
|
||||
int retval;
|
||||
|
||||
apselsave = swjdp->apsel;
|
||||
apselsave = dap->apsel;
|
||||
switch (CMD_ARGC) {
|
||||
case 0:
|
||||
apsel = swjdp->apsel;
|
||||
apsel = dap->apsel;
|
||||
break;
|
||||
case 1:
|
||||
COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
|
||||
|
@ -1732,33 +1758,37 @@ DAP_COMMAND_HANDLER(dap_baseaddr_command)
|
|||
}
|
||||
|
||||
if (apselsave != apsel)
|
||||
dap_ap_select(swjdp, apsel);
|
||||
dap_ap_select(dap, apsel);
|
||||
|
||||
/* NOTE: assumes we're talking to a MEM-AP, which
|
||||
* has a base address. There are other kinds of AP,
|
||||
* though they're not common for now. This should
|
||||
* use the ID register to verify it's a MEM-AP.
|
||||
*/
|
||||
retval = dap_queue_ap_read(swjdp, AP_REG_BASE, &baseaddr);
|
||||
retval = dap_run(swjdp);
|
||||
retval = dap_queue_ap_read(dap, AP_REG_BASE, &baseaddr);
|
||||
retval = dap_run(dap);
|
||||
if (retval != ERROR_OK)
|
||||
return retval;
|
||||
|
||||
command_print(CMD_CTX, "0x%8.8" PRIx32, baseaddr);
|
||||
|
||||
if (apselsave != apsel)
|
||||
dap_ap_select(swjdp, apselsave);
|
||||
dap_ap_select(dap, apselsave);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
DAP_COMMAND_HANDLER(dap_memaccess_command)
|
||||
COMMAND_HANDLER(dap_memaccess_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct arm *arm = target_to_arm(target);
|
||||
struct adiv5_dap *dap = arm->dap;
|
||||
|
||||
uint32_t memaccess_tck;
|
||||
|
||||
switch (CMD_ARGC) {
|
||||
case 0:
|
||||
memaccess_tck = swjdp->memaccess_tck;
|
||||
memaccess_tck = dap->memaccess_tck;
|
||||
break;
|
||||
case 1:
|
||||
COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], memaccess_tck);
|
||||
|
@ -1766,16 +1796,20 @@ DAP_COMMAND_HANDLER(dap_memaccess_command)
|
|||
default:
|
||||
return ERROR_COMMAND_SYNTAX_ERROR;
|
||||
}
|
||||
swjdp->memaccess_tck = memaccess_tck;
|
||||
dap->memaccess_tck = memaccess_tck;
|
||||
|
||||
command_print(CMD_CTX, "memory bus access delay set to %" PRIi32 " tck",
|
||||
swjdp->memaccess_tck);
|
||||
dap->memaccess_tck);
|
||||
|
||||
return ERROR_OK;
|
||||
}
|
||||
|
||||
DAP_COMMAND_HANDLER(dap_apsel_command)
|
||||
COMMAND_HANDLER(dap_apsel_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct arm *arm = target_to_arm(target);
|
||||
struct adiv5_dap *dap = arm->dap;
|
||||
|
||||
uint32_t apsel, apid;
|
||||
int retval;
|
||||
|
||||
|
@ -1793,9 +1827,9 @@ DAP_COMMAND_HANDLER(dap_apsel_command)
|
|||
return ERROR_COMMAND_SYNTAX_ERROR;
|
||||
}
|
||||
|
||||
dap_ap_select(swjdp, apsel);
|
||||
retval = dap_queue_ap_read(swjdp, AP_REG_IDR, &apid);
|
||||
retval = dap_run(swjdp);
|
||||
dap_ap_select(dap, apsel);
|
||||
retval = dap_queue_ap_read(dap, AP_REG_IDR, &apid);
|
||||
retval = dap_run(dap);
|
||||
if (retval != ERROR_OK)
|
||||
return retval;
|
||||
|
||||
|
@ -1805,15 +1839,19 @@ DAP_COMMAND_HANDLER(dap_apsel_command)
|
|||
return retval;
|
||||
}
|
||||
|
||||
DAP_COMMAND_HANDLER(dap_apid_command)
|
||||
COMMAND_HANDLER(dap_apid_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct arm *arm = target_to_arm(target);
|
||||
struct adiv5_dap *dap = arm->dap;
|
||||
|
||||
uint32_t apsel, apselsave, apid;
|
||||
int retval;
|
||||
|
||||
apselsave = swjdp->apsel;
|
||||
apselsave = dap->apsel;
|
||||
switch (CMD_ARGC) {
|
||||
case 0:
|
||||
apsel = swjdp->apsel;
|
||||
apsel = dap->apsel;
|
||||
break;
|
||||
case 1:
|
||||
COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
|
||||
|
@ -1826,20 +1864,75 @@ DAP_COMMAND_HANDLER(dap_apid_command)
|
|||
}
|
||||
|
||||
if (apselsave != apsel)
|
||||
dap_ap_select(swjdp, apsel);
|
||||
dap_ap_select(dap, apsel);
|
||||
|
||||
retval = dap_queue_ap_read(swjdp, AP_REG_IDR, &apid);
|
||||
retval = dap_run(swjdp);
|
||||
retval = dap_queue_ap_read(dap, AP_REG_IDR, &apid);
|
||||
retval = dap_run(dap);
|
||||
if (retval != ERROR_OK)
|
||||
return retval;
|
||||
|
||||
command_print(CMD_CTX, "0x%8.8" PRIx32, apid);
|
||||
if (apselsave != apsel)
|
||||
dap_ap_select(swjdp, apselsave);
|
||||
dap_ap_select(dap, apselsave);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
static const struct command_registration dap_commands[] = {
|
||||
{
|
||||
.name = "info",
|
||||
.handler = handle_dap_info_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "display ROM table for MEM-AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "apsel",
|
||||
.handler = dap_apsel_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "Set the currently selected AP (default 0) "
|
||||
"and display the result",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "apid",
|
||||
.handler = dap_apid_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "return ID register from AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "baseaddr",
|
||||
.handler = dap_baseaddr_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "return debug base address from MEM-AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "memaccess",
|
||||
.handler = dap_memaccess_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "set/get number of extra tck for MEM-AP memory "
|
||||
"bus access [0-255]",
|
||||
.usage = "[cycles]",
|
||||
},
|
||||
COMMAND_REGISTRATION_DONE
|
||||
};
|
||||
|
||||
const struct command_registration dap_command_handlers[] = {
|
||||
{
|
||||
.name = "dap",
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "DAP command group",
|
||||
.chain = dap_commands,
|
||||
},
|
||||
COMMAND_REGISTRATION_DONE
|
||||
};
|
||||
|
||||
|
||||
/*
|
||||
* This represents the bits which must be sent out on TMS/SWDIO to
|
||||
* switch a DAP implemented using an SWJ-DP module into SWD mode.
|
||||
|
|
|
@ -378,17 +378,6 @@ int mem_ap_write_buf_u32(struct adiv5_dap *swjdp,
|
|||
int ahbap_debugport_init(struct adiv5_dap *swjdp);
|
||||
|
||||
|
||||
/* Commands for user dap access */
|
||||
int dap_info_command(struct command_context *cmd_ctx,
|
||||
struct adiv5_dap *swjdp, int apsel);
|
||||
|
||||
#define DAP_COMMAND_HANDLER(name) \
|
||||
COMMAND_HELPER(name, struct adiv5_dap *swjdp)
|
||||
DAP_COMMAND_HANDLER(dap_baseaddr_command);
|
||||
DAP_COMMAND_HANDLER(dap_memaccess_command);
|
||||
DAP_COMMAND_HANDLER(dap_apsel_command);
|
||||
DAP_COMMAND_HANDLER(dap_apid_command);
|
||||
|
||||
struct target;
|
||||
|
||||
/* Put debug link into SWD mode */
|
||||
|
@ -397,4 +386,6 @@ int dap_to_swd(struct target *target);
|
|||
/* Put debug link into JTAG mode */
|
||||
int dap_to_jtag(struct target *target);
|
||||
|
||||
extern const struct command_registration dap_command_handlers[];
|
||||
|
||||
#endif
|
||||
|
|
|
@ -117,115 +117,9 @@ int armv7a_arch_state(struct target *target)
|
|||
}
|
||||
|
||||
|
||||
COMMAND_HANDLER(handle_dap_baseaddr_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_baseaddr_command, swjdp);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(handle_dap_memaccess_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_memaccess_command, swjdp);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(handle_dap_apsel_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_apsel_command, swjdp);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(handle_dap_apid_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_apid_command, swjdp);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(handle_dap_info_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
uint32_t apsel;
|
||||
|
||||
switch (CMD_ARGC) {
|
||||
case 0:
|
||||
apsel = swjdp->apsel;
|
||||
break;
|
||||
case 1:
|
||||
COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
|
||||
break;
|
||||
default:
|
||||
return ERROR_COMMAND_SYNTAX_ERROR;
|
||||
}
|
||||
|
||||
return dap_info_command(CMD_CTX, swjdp, apsel);
|
||||
}
|
||||
|
||||
/* FIXME this table should be part of generic DAP support, and
|
||||
* be shared by the ARMv7-A/R and ARMv7-M support ...
|
||||
*/
|
||||
static const struct command_registration armv7a_exec_command_handlers[] = {
|
||||
{
|
||||
.name = "info",
|
||||
.handler = handle_dap_info_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "display ROM table for MEM-AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "apsel",
|
||||
.handler = handle_dap_apsel_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "Set the currently selected AP (default 0) "
|
||||
"and display the result",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "apid",
|
||||
.handler = handle_dap_apid_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "return ID register from AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "baseaddr",
|
||||
.handler = handle_dap_baseaddr_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "return debug base address from MEM-AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "memaccess",
|
||||
.handler = handle_dap_memaccess_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "set/get number of extra tck for MEM-AP memory "
|
||||
"bus access [0-255]",
|
||||
.usage = "[cycles]",
|
||||
},
|
||||
COMMAND_REGISTRATION_DONE
|
||||
};
|
||||
const struct command_registration armv7a_command_handlers[] = {
|
||||
{
|
||||
.name = "dap",
|
||||
.mode = COMMAND_ANY,
|
||||
.help = "Cortex DAP command group",
|
||||
.chain = armv7a_exec_command_handlers,
|
||||
.chain = dap_command_handlers,
|
||||
},
|
||||
COMMAND_REGISTRATION_DONE
|
||||
};
|
||||
|
|
|
@ -50,8 +50,7 @@ struct armv7a_common
|
|||
int common_magic;
|
||||
struct reg_cache *core_cache;
|
||||
|
||||
/* arm adp debug port */
|
||||
struct adiv5_dap swjdp_info;
|
||||
struct adiv5_dap dap;
|
||||
|
||||
/* Core Debug Unit */
|
||||
struct arm_dpm dpm;
|
||||
|
|
|
@ -739,160 +739,12 @@ int armv7m_maybe_skip_bkpt_inst(struct target *target, bool *inst_found)
|
|||
return ERROR_OK;
|
||||
}
|
||||
|
||||
/*--------------------------------------------------------------------------*/
|
||||
|
||||
/*
|
||||
* Only stuff below this line should need to verify that its target
|
||||
* is an ARMv7-M node.
|
||||
*/
|
||||
|
||||
|
||||
/*
|
||||
* Return the debug ap baseaddress in hexadecimal;
|
||||
* no extra output to simplify script processing
|
||||
*/
|
||||
COMMAND_HANDLER(handle_dap_baseaddr_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
|
||||
if (!is_armv7m(armv7m)) {
|
||||
command_print(CMD_CTX, "current target isn't an ARM7-M");
|
||||
return ERROR_TARGET_INVALID;
|
||||
}
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_baseaddr_command, swjdp);
|
||||
}
|
||||
|
||||
/*
|
||||
* Return the debug ap id in hexadecimal;
|
||||
* no extra output to simplify script processing
|
||||
*/
|
||||
COMMAND_HANDLER(handle_dap_apid_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
|
||||
if (!is_armv7m(armv7m)) {
|
||||
command_print(CMD_CTX, "current target isn't an ARM7-M");
|
||||
return ERROR_TARGET_INVALID;
|
||||
}
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_apid_command, swjdp);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(handle_dap_apsel_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
|
||||
if (!is_armv7m(armv7m)) {
|
||||
command_print(CMD_CTX, "current target isn't an ARM7-M");
|
||||
return ERROR_TARGET_INVALID;
|
||||
}
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_apsel_command, swjdp);
|
||||
}
|
||||
|
||||
COMMAND_HANDLER(handle_dap_memaccess_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
|
||||
if (!is_armv7m(armv7m)) {
|
||||
command_print(CMD_CTX, "current target isn't an ARM7-M");
|
||||
return ERROR_TARGET_INVALID;
|
||||
}
|
||||
|
||||
return CALL_COMMAND_HANDLER(dap_memaccess_command, swjdp);
|
||||
}
|
||||
|
||||
|
||||
COMMAND_HANDLER(handle_dap_info_command)
|
||||
{
|
||||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
uint32_t apsel;
|
||||
|
||||
if (!is_armv7m(armv7m)) {
|
||||
command_print(CMD_CTX, "current target isn't an ARM7-M");
|
||||
return ERROR_TARGET_INVALID;
|
||||
}
|
||||
|
||||
switch (CMD_ARGC) {
|
||||
case 0:
|
||||
apsel = swjdp->apsel;
|
||||
break;
|
||||
case 1:
|
||||
COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
|
||||
break;
|
||||
default:
|
||||
return ERROR_COMMAND_SYNTAX_ERROR;
|
||||
}
|
||||
|
||||
return dap_info_command(CMD_CTX, swjdp, apsel);
|
||||
}
|
||||
|
||||
/* FIXME this table should be part of generic DAP support, and
|
||||
* be shared by the ARMv7-A/R and ARMv7-M support ...
|
||||
*/
|
||||
static const struct command_registration armv7m_exec_command_handlers[] = {
|
||||
{
|
||||
.name = "info",
|
||||
.handler = handle_dap_info_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "display ROM table for MEM-AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "apsel",
|
||||
.handler = handle_dap_apsel_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "Set the currently selected AP (default 0) "
|
||||
"and display the result",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "apid",
|
||||
.handler = handle_dap_apid_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "return ID register from AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "baseaddr",
|
||||
.handler = handle_dap_baseaddr_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "return debug base address from MEM-AP "
|
||||
"(default currently selected AP)",
|
||||
.usage = "[ap_num]",
|
||||
},
|
||||
{
|
||||
.name = "memaccess",
|
||||
.handler = handle_dap_memaccess_command,
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "set/get number of extra tck for MEM-AP memory "
|
||||
"bus access [0-255]",
|
||||
.usage = "[cycles]",
|
||||
},
|
||||
COMMAND_REGISTRATION_DONE
|
||||
};
|
||||
const struct command_registration armv7m_command_handlers[] = {
|
||||
{
|
||||
.chain = arm_command_handlers,
|
||||
},
|
||||
{
|
||||
.name = "dap",
|
||||
.mode = COMMAND_EXEC,
|
||||
.help = "Cortex DAP command group",
|
||||
.chain = armv7m_exec_command_handlers,
|
||||
.chain = dap_command_handlers,
|
||||
},
|
||||
COMMAND_REGISTRATION_DONE
|
||||
};
|
||||
|
|
|
@ -106,7 +106,7 @@ struct armv7m_common
|
|||
struct reg_cache *core_cache;
|
||||
enum armv7m_mode core_mode;
|
||||
int exception_number;
|
||||
struct adiv5_dap swjdp_info;
|
||||
struct adiv5_dap dap;
|
||||
|
||||
uint32_t demcr;
|
||||
|
||||
|
|
|
@ -67,7 +67,7 @@ static int cortex_a8_dap_write_coreregister_u32(struct target *target,
|
|||
static int cortex_a8_init_debug_access(struct target *target)
|
||||
{
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
int retval;
|
||||
uint32_t dummy;
|
||||
|
@ -103,7 +103,7 @@ static int cortex_a8_exec_opcode(struct target *target,
|
|||
uint32_t dscr;
|
||||
int retval;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
dscr = dscr_p ? *dscr_p : 0;
|
||||
|
||||
|
@ -150,7 +150,7 @@ static int cortex_a8_read_regs_through_mem(struct target *target, uint32_t addre
|
|||
{
|
||||
int retval = ERROR_OK;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
cortex_a8_dap_read_coreregister_u32(target, regfile, 0);
|
||||
cortex_a8_dap_write_coreregister_u32(target, address, 0);
|
||||
|
@ -169,7 +169,7 @@ static int cortex_a8_dap_read_coreregister_u32(struct target *target,
|
|||
uint8_t reg = regnum&0xFF;
|
||||
uint32_t dscr = 0;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
if (reg > 17)
|
||||
return retval;
|
||||
|
@ -221,7 +221,7 @@ static int cortex_a8_dap_write_coreregister_u32(struct target *target,
|
|||
uint8_t Rd = regnum&0xFF;
|
||||
uint32_t dscr;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
LOG_DEBUG("register %i, value 0x%08" PRIx32, regnum, value);
|
||||
|
||||
|
@ -284,7 +284,7 @@ static int cortex_a8_dap_write_memap_register_u32(struct target *target, uint32_
|
|||
{
|
||||
int retval;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
retval = mem_ap_write_atomic_u32(swjdp, address, value);
|
||||
|
||||
|
@ -310,14 +310,14 @@ static inline struct cortex_a8_common *dpm_to_a8(struct arm_dpm *dpm)
|
|||
static int cortex_a8_write_dcc(struct cortex_a8_common *a8, uint32_t data)
|
||||
{
|
||||
LOG_DEBUG("write DCC 0x%08" PRIx32, data);
|
||||
return mem_ap_write_u32(&a8->armv7a_common.swjdp_info,
|
||||
return mem_ap_write_u32(&a8->armv7a_common.dap,
|
||||
a8->armv7a_common.debug_base + CPUDBG_DTRRX, data);
|
||||
}
|
||||
|
||||
static int cortex_a8_read_dcc(struct cortex_a8_common *a8, uint32_t *data,
|
||||
uint32_t *dscr_p)
|
||||
{
|
||||
struct adiv5_dap *swjdp = &a8->armv7a_common.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &a8->armv7a_common.dap;
|
||||
uint32_t dscr = DSCR_INSTR_COMP;
|
||||
int retval;
|
||||
|
||||
|
@ -344,7 +344,7 @@ static int cortex_a8_read_dcc(struct cortex_a8_common *a8, uint32_t *data,
|
|||
static int cortex_a8_dpm_prepare(struct arm_dpm *dpm)
|
||||
{
|
||||
struct cortex_a8_common *a8 = dpm_to_a8(dpm);
|
||||
struct adiv5_dap *swjdp = &a8->armv7a_common.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &a8->armv7a_common.dap;
|
||||
uint32_t dscr;
|
||||
int retval;
|
||||
|
||||
|
@ -562,7 +562,7 @@ static int cortex_a8_poll(struct target *target)
|
|||
uint32_t dscr;
|
||||
struct cortex_a8_common *cortex_a8 = target_to_cortex_a8(target);
|
||||
struct armv7a_common *armv7a = &cortex_a8->armv7a_common;
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
enum target_state prev_target_state = target->state;
|
||||
uint8_t saved_apsel = dap_ap_get_select(swjdp);
|
||||
|
||||
|
@ -626,7 +626,7 @@ static int cortex_a8_halt(struct target *target)
|
|||
int retval = ERROR_OK;
|
||||
uint32_t dscr;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
uint8_t saved_apsel = dap_ap_get_select(swjdp);
|
||||
dap_ap_select(swjdp, swjdp_debugap);
|
||||
|
||||
|
@ -664,7 +664,7 @@ static int cortex_a8_resume(struct target *target, int current,
|
|||
{
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct arm *armv4_5 = &armv7a->armv4_5_common;
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
// struct breakpoint *breakpoint = NULL;
|
||||
uint32_t resume_pc, dscr;
|
||||
|
@ -788,7 +788,7 @@ static int cortex_a8_debug_entry(struct target *target)
|
|||
struct cortex_a8_common *cortex_a8 = target_to_cortex_a8(target);
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct arm *armv4_5 = &armv7a->armv4_5_common;
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
struct reg *reg;
|
||||
|
||||
LOG_DEBUG("dscr = 0x%08" PRIx32, cortex_a8->cpudbg_dscr);
|
||||
|
@ -1276,7 +1276,7 @@ static int cortex_a8_read_memory(struct target *target, uint32_t address,
|
|||
uint32_t size, uint32_t count, uint8_t *buffer)
|
||||
{
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
int retval = ERROR_INVALID_ARGUMENTS;
|
||||
|
||||
/* cortex_a8 handles unaligned memory access */
|
||||
|
@ -1304,7 +1304,7 @@ static int cortex_a8_write_memory(struct target *target, uint32_t address,
|
|||
uint32_t size, uint32_t count, uint8_t *buffer)
|
||||
{
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
int retval = ERROR_INVALID_ARGUMENTS;
|
||||
|
||||
// ??? dap_ap_select(swjdp, swjdp_memoryap);
|
||||
|
@ -1413,7 +1413,7 @@ static int cortex_a8_handle_target_request(void *priv)
|
|||
{
|
||||
struct target *target = priv;
|
||||
struct armv7a_common *armv7a = target_to_armv7a(target);
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
|
||||
if (!target_was_examined(target))
|
||||
return ERROR_OK;
|
||||
|
@ -1455,7 +1455,7 @@ static int cortex_a8_examine_first(struct target *target)
|
|||
{
|
||||
struct cortex_a8_common *cortex_a8 = target_to_cortex_a8(target);
|
||||
struct armv7a_common *armv7a = &cortex_a8->armv7a_common;
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7a->dap;
|
||||
int i;
|
||||
int retval = ERROR_OK;
|
||||
uint32_t didr, ctypr, ttypr, cpuid;
|
||||
|
@ -1562,7 +1562,9 @@ static int cortex_a8_init_arch_info(struct target *target,
|
|||
{
|
||||
struct armv7a_common *armv7a = &cortex_a8->armv7a_common;
|
||||
struct arm *armv4_5 = &armv7a->armv4_5_common;
|
||||
struct adiv5_dap *swjdp = &armv7a->swjdp_info;
|
||||
struct adiv5_dap *dap = &armv7a->dap;
|
||||
|
||||
armv7a->armv4_5_common.dap = dap;
|
||||
|
||||
/* Setup struct cortex_a8_common */
|
||||
cortex_a8->common_magic = CORTEX_A8_COMMON_MAGIC;
|
||||
|
@ -1573,11 +1575,11 @@ static int cortex_a8_init_arch_info(struct target *target,
|
|||
cortex_a8->jtag_info.scann_size = 4;
|
||||
|
||||
/* Leave (only) generic DAP stuff for debugport_init() */
|
||||
swjdp->jtag_info = &cortex_a8->jtag_info;
|
||||
swjdp->memaccess_tck = 80;
|
||||
dap->jtag_info = &cortex_a8->jtag_info;
|
||||
dap->memaccess_tck = 80;
|
||||
|
||||
/* Number of bits for tar autoincrement, impl. dep. at least 10 */
|
||||
swjdp->tar_autoincr_block = (1 << 10);
|
||||
dap->tar_autoincr_block = (1 << 10);
|
||||
|
||||
cortex_a8->fast_reg_read = 0;
|
||||
|
||||
|
|
|
@ -129,7 +129,7 @@ static int cortex_m3_write_debug_halt_mask(struct target *target,
|
|||
uint32_t mask_on, uint32_t mask_off)
|
||||
{
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
|
||||
/* mask off status bits */
|
||||
cortex_m3->dcb_dhcsr &= ~((0xFFFF << 16) | mask_off);
|
||||
|
@ -142,7 +142,7 @@ static int cortex_m3_write_debug_halt_mask(struct target *target,
|
|||
static int cortex_m3_clear_halt(struct target *target)
|
||||
{
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
|
||||
/* clear step if any */
|
||||
cortex_m3_write_debug_halt_mask(target, C_HALT, C_STEP);
|
||||
|
@ -160,7 +160,7 @@ static int cortex_m3_clear_halt(struct target *target)
|
|||
static int cortex_m3_single_step_core(struct target *target)
|
||||
{
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
uint32_t dhcsr_save;
|
||||
|
||||
/* backup dhcsr reg */
|
||||
|
@ -191,7 +191,7 @@ static int cortex_m3_endreset_event(struct target *target)
|
|||
uint32_t dcb_demcr;
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct armv7m_common *armv7m = &cortex_m3->armv7m;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
struct cortex_m3_fp_comparator *fp_list = cortex_m3->fp_comparator_list;
|
||||
struct cortex_m3_dwt_comparator *dwt_list = cortex_m3->dwt_comparator_list;
|
||||
|
||||
|
@ -286,7 +286,7 @@ static int cortex_m3_examine_exception_reason(struct target *target)
|
|||
{
|
||||
uint32_t shcsr, except_sr, cfsr = -1, except_ar = -1;
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
int retval;
|
||||
|
||||
mem_ap_read_u32(swjdp, NVIC_SHCSR, &shcsr);
|
||||
|
@ -360,7 +360,7 @@ static int cortex_m3_debug_entry(struct target *target)
|
|||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct armv7m_common *armv7m = &cortex_m3->armv7m;
|
||||
struct arm *arm = &armv7m->arm;
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
struct reg *r;
|
||||
|
||||
LOG_DEBUG(" ");
|
||||
|
@ -452,7 +452,7 @@ static int cortex_m3_poll(struct target *target)
|
|||
int retval;
|
||||
enum target_state prev_target_state = target->state;
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
|
||||
/* Read from Debug Halting Control and Status Register */
|
||||
retval = mem_ap_read_atomic_u32(swjdp, DCB_DHCSR, &cortex_m3->dcb_dhcsr);
|
||||
|
@ -587,7 +587,7 @@ static int cortex_m3_halt(struct target *target)
|
|||
static int cortex_m3_soft_reset_halt(struct target *target)
|
||||
{
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
uint32_t dcb_dhcsr = 0;
|
||||
int retval, timeout = 0;
|
||||
|
||||
|
@ -761,7 +761,7 @@ static int cortex_m3_step(struct target *target, int current,
|
|||
{
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct armv7m_common *armv7m = &cortex_m3->armv7m;
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
struct breakpoint *breakpoint = NULL;
|
||||
struct reg *pc = armv7m->arm.pc;
|
||||
bool bkpt_inst_found = false;
|
||||
|
@ -826,7 +826,7 @@ static int cortex_m3_step(struct target *target, int current,
|
|||
static int cortex_m3_assert_reset(struct target *target)
|
||||
{
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
int assert_srst = 1;
|
||||
|
||||
LOG_DEBUG("target->state: %s",
|
||||
|
@ -1376,7 +1376,7 @@ static int cortex_m3_load_core_reg_u32(struct target *target,
|
|||
{
|
||||
int retval;
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
|
||||
/* NOTE: we "know" here that the register identifiers used
|
||||
* in the v7m header match the Cortex-M3 Debug Core Register
|
||||
|
@ -1440,7 +1440,7 @@ static int cortex_m3_store_core_reg_u32(struct target *target,
|
|||
int retval;
|
||||
uint32_t reg;
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
|
||||
#ifdef ARMV7_GDB_HACKS
|
||||
/* If the LR register is being modified, make sure it will put us
|
||||
|
@ -1518,7 +1518,7 @@ static int cortex_m3_read_memory(struct target *target, uint32_t address,
|
|||
uint32_t size, uint32_t count, uint8_t *buffer)
|
||||
{
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
int retval = ERROR_INVALID_ARGUMENTS;
|
||||
|
||||
/* cortex_m3 handles unaligned memory access */
|
||||
|
@ -1543,7 +1543,7 @@ static int cortex_m3_write_memory(struct target *target, uint32_t address,
|
|||
uint32_t size, uint32_t count, uint8_t *buffer)
|
||||
{
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
int retval = ERROR_INVALID_ARGUMENTS;
|
||||
|
||||
if (count && buffer) {
|
||||
|
@ -1724,7 +1724,7 @@ static int cortex_m3_examine(struct target *target)
|
|||
uint32_t cpuid, fpcr;
|
||||
int i;
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.swjdp_info;
|
||||
struct adiv5_dap *swjdp = &cortex_m3->armv7m.dap;
|
||||
|
||||
if ((retval = ahbap_debugport_init(swjdp)) != ERROR_OK)
|
||||
return retval;
|
||||
|
@ -1798,7 +1798,7 @@ static int cortex_m3_target_request_data(struct target *target,
|
|||
uint32_t size, uint8_t *buffer)
|
||||
{
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
uint8_t data;
|
||||
uint8_t ctrl;
|
||||
uint32_t i;
|
||||
|
@ -1818,7 +1818,7 @@ static int cortex_m3_handle_target_request(void *priv)
|
|||
if (!target_was_examined(target))
|
||||
return ERROR_OK;
|
||||
struct armv7m_common *armv7m = target_to_armv7m(target);
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
|
||||
if (!target->dbg_msg_enabled)
|
||||
return ERROR_OK;
|
||||
|
@ -1862,11 +1862,13 @@ static int cortex_m3_init_arch_info(struct target *target,
|
|||
cortex_m3->jtag_info.tap = tap;
|
||||
cortex_m3->jtag_info.scann_size = 4;
|
||||
|
||||
armv7m->arm.dap = &armv7m->dap;
|
||||
|
||||
/* Leave (only) generic DAP stuff for debugport_init(); */
|
||||
armv7m->swjdp_info.jtag_info = &cortex_m3->jtag_info;
|
||||
armv7m->swjdp_info.memaccess_tck = 8;
|
||||
armv7m->dap.jtag_info = &cortex_m3->jtag_info;
|
||||
armv7m->dap.memaccess_tck = 8;
|
||||
/* Cortex-M3 has 4096 bytes autoincrement range */
|
||||
armv7m->swjdp_info.tar_autoincr_block = (1 << 12);
|
||||
armv7m->dap.tar_autoincr_block = (1 << 12);
|
||||
|
||||
/* register arch-specific functions */
|
||||
armv7m->examine_debug_reason = cortex_m3_examine_debug_reason;
|
||||
|
@ -1936,7 +1938,7 @@ COMMAND_HANDLER(handle_cortex_m3_vector_catch_command)
|
|||
struct target *target = get_current_target(CMD_CTX);
|
||||
struct cortex_m3_common *cortex_m3 = target_to_cm3(target);
|
||||
struct armv7m_common *armv7m = &cortex_m3->armv7m;
|
||||
struct adiv5_dap *swjdp = &armv7m->swjdp_info;
|
||||
struct adiv5_dap *swjdp = &armv7m->dap;
|
||||
uint32_t demcr = 0;
|
||||
int retval;
|
||||
|
||||
|
|
Loading…
Reference in New Issue