X-Git-Url: https://review.openocd.org/gitweb?p=openocd.git;a=blobdiff_plain;f=src%2Ftarget%2Foocd_trace.c;h=c2e13618fbd8a42741f6c44252f6654038dd73e0;hp=3964f9a8eb97055d955f7bc88d70f62fe7a31a99;hb=98723c4ecdbe06f90c66f3abec27b792c3b38e34;hpb=86173cdbddde781b19ac630602f2d450a59b32b5 diff --git a/src/target/oocd_trace.c b/src/target/oocd_trace.c index 3964f9a8eb..c2e13618fb 100644 --- a/src/target/oocd_trace.c +++ b/src/target/oocd_trace.c @@ -21,8 +21,8 @@ #include "config.h" #endif +#include "armv4_5.h" #include "oocd_trace.h" -#include "arm7_9_common.h" /* * This is "proof of concept" code, for prototype hardware: @@ -30,9 +30,9 @@ */ -static int oocd_trace_register_commands(struct command_context_s *cmd_ctx); +static int oocd_trace_register_commands(struct command_context *cmd_ctx); -static int oocd_trace_read_reg(oocd_trace_t *oocd_trace, int reg, u32 *value) +static int oocd_trace_read_reg(struct oocd_trace *oocd_trace, int reg, uint32_t *value) { size_t bytes_written, bytes_read, bytes_to_read; uint8_t cmd; @@ -52,7 +52,7 @@ static int oocd_trace_read_reg(oocd_trace_t *oocd_trace, int reg, u32 *value) return ERROR_OK; } -static int oocd_trace_write_reg(oocd_trace_t *oocd_trace, int reg, u32 value) +static int oocd_trace_write_reg(struct oocd_trace *oocd_trace, int reg, uint32_t value) { size_t bytes_written; uint8_t data[5]; @@ -69,7 +69,7 @@ static int oocd_trace_write_reg(oocd_trace_t *oocd_trace, int reg, u32 value) return ERROR_OK; } -static int oocd_trace_read_memory(oocd_trace_t *oocd_trace, uint8_t *data, u32 address, u32 size) +static int oocd_trace_read_memory(struct oocd_trace *oocd_trace, uint8_t *data, uint32_t address, uint32_t size) { size_t bytes_written, bytes_to_read; ssize_t bytes_read; @@ -96,15 +96,15 @@ static int oocd_trace_read_memory(oocd_trace_t *oocd_trace, uint8_t *data, u32 a return ERROR_OK; } -static int oocd_trace_init(etm_context_t *etm_ctx) +static int oocd_trace_init(struct etm_context *etm_ctx) { uint8_t trash[256]; - oocd_trace_t *oocd_trace = etm_ctx->capture_driver_priv; + struct oocd_trace *oocd_trace = etm_ctx->capture_driver_priv; size_t bytes_read; oocd_trace->tty_fd = open(oocd_trace->tty, O_RDWR | O_NOCTTY | O_NONBLOCK); - if(oocd_trace->tty_fd < 0) + if (oocd_trace->tty_fd < 0) { LOG_ERROR("can't open tty"); return ERROR_ETM_CAPTURE_INIT_FAILED; @@ -143,10 +143,10 @@ static int oocd_trace_init(etm_context_t *etm_ctx) return ERROR_OK; } -static trace_status_t oocd_trace_status(etm_context_t *etm_ctx) +static trace_status_t oocd_trace_status(struct etm_context *etm_ctx) { - oocd_trace_t *oocd_trace = etm_ctx->capture_driver_priv; - u32 status; + struct oocd_trace *oocd_trace = etm_ctx->capture_driver_priv; + uint32_t status; oocd_trace_read_reg(oocd_trace, OOCD_TRACE_STATUS, &status); @@ -175,14 +175,14 @@ static trace_status_t oocd_trace_status(etm_context_t *etm_ctx) return etm_ctx->capture_status; } -static int oocd_trace_read_trace(etm_context_t *etm_ctx) +static int oocd_trace_read_trace(struct etm_context *etm_ctx) { - oocd_trace_t *oocd_trace = etm_ctx->capture_driver_priv; - u32 status, address; - u32 first_frame = 0x0; - u32 num_frames = 1048576; + struct oocd_trace *oocd_trace = etm_ctx->capture_driver_priv; + uint32_t status, address; + uint32_t first_frame = 0x0; + uint32_t num_frames = 1048576; uint8_t *trace_data; - u32 i; + uint32_t i; oocd_trace_read_reg(oocd_trace, OOCD_TRACE_STATUS, &status); oocd_trace_read_reg(oocd_trace, OOCD_TRACE_ADDRESS, &address); @@ -197,7 +197,7 @@ static int oocd_trace_read_trace(etm_context_t *etm_ctx) num_frames = address; /* read data into temporary array for unpacking - * one frame from OpenOCD+trace corresponds to 16 trace cycles + * one frame from OpenOCD + trace corresponds to 16 trace cycles */ trace_data = malloc(sizeof(uint8_t) * num_frames * 16); oocd_trace_read_memory(oocd_trace, trace_data, first_frame, num_frames); @@ -208,7 +208,7 @@ static int oocd_trace_read_trace(etm_context_t *etm_ctx) } etm_ctx->trace_depth = num_frames * 16; - etm_ctx->trace_data = malloc(sizeof(etmv1_trace_data_t) * etm_ctx->trace_depth); + etm_ctx->trace_data = malloc(sizeof(struct etmv1_trace_data) * etm_ctx->trace_depth); for (i = 0; i < num_frames * 16; i++) { @@ -233,16 +233,16 @@ static int oocd_trace_read_trace(etm_context_t *etm_ctx) return ERROR_OK; } -static int oocd_trace_start_capture(etm_context_t *etm_ctx) +static int oocd_trace_start_capture(struct etm_context *etm_ctx) { - oocd_trace_t *oocd_trace = etm_ctx->capture_driver_priv; - u32 control = 0x1; /* 0x1: enabled */ - u32 trigger_count; + struct oocd_trace *oocd_trace = etm_ctx->capture_driver_priv; + uint32_t control = 0x1; /* 0x1: enabled */ + uint32_t trigger_count; if (((etm_ctx->portmode & ETM_PORT_MODE_MASK) != ETM_PORT_NORMAL) || ((etm_ctx->portmode & ETM_PORT_WIDTH_MASK) != ETM_PORT_4BIT)) { - LOG_DEBUG("OpenOCD+trace only supports normal 4-bit ETM mode"); + LOG_DEBUG("OpenOCD + trace only supports normal 4-bit ETM mode"); return ERROR_ETM_PORTMODE_NOT_SUPPORTED; } @@ -251,7 +251,7 @@ static int oocd_trace_start_capture(etm_context_t *etm_ctx) control |= 0x2; /* half rate clock, capture at twice the clock rate */ } - /* OpenOCD+trace holds up to 16 million samples, + /* OpenOCD + trace holds up to 16 million samples, * but trigger counts is set in multiples of 16 */ trigger_count = (1048576 * etm_ctx->trigger_percent) / 100; @@ -266,9 +266,9 @@ static int oocd_trace_start_capture(etm_context_t *etm_ctx) return ERROR_OK; } -static int oocd_trace_stop_capture(etm_context_t *etm_ctx) +static int oocd_trace_stop_capture(struct etm_context *etm_ctx) { - oocd_trace_t *oocd_trace = etm_ctx->capture_driver_priv; + struct oocd_trace *oocd_trace = etm_ctx->capture_driver_priv; /* trace stopped, just clear running flag, but preserve others */ etm_ctx->capture_status &= ~TRACE_RUNNING; @@ -278,7 +278,7 @@ static int oocd_trace_stop_capture(etm_context_t *etm_ctx) return ERROR_OK; } -etm_capture_driver_t oocd_trace_capture_driver = +struct etm_capture_driver oocd_trace_capture_driver = { .name = "oocd_trace", .register_commands = oocd_trace_register_commands, @@ -289,73 +289,72 @@ etm_capture_driver_t oocd_trace_capture_driver = .read_trace = oocd_trace_read_trace, }; -static int handle_oocd_trace_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc) +COMMAND_HANDLER(handle_oocd_trace_config_command) { - target_t *target; - armv4_5_common_t *armv4_5; - arm7_9_common_t *arm7_9; + struct target *target; + struct arm *arm; if (argc != 2) { LOG_ERROR("incomplete 'oocd_trace config ' command"); - exit(-1); + return ERROR_FAIL; } target = get_current_target(cmd_ctx); - - if (arm7_9_get_arch_pointers(target, &armv4_5, &arm7_9) != ERROR_OK) + arm = target_to_arm(target); + if (!is_arm(arm)) { - command_print(cmd_ctx, "current target isn't an ARM7/ARM9 target"); - return ERROR_OK; + command_print(cmd_ctx, "current target isn't an ARM"); + return ERROR_FAIL; } - if (arm7_9->etm_ctx) + if (arm->etm) { - oocd_trace_t *oocd_trace = malloc(sizeof(oocd_trace_t)); + struct oocd_trace *oocd_trace = malloc(sizeof(struct oocd_trace)); - arm7_9->etm_ctx->capture_driver_priv = oocd_trace; - oocd_trace->etm_ctx = arm7_9->etm_ctx; + arm->etm->capture_driver_priv = oocd_trace; + oocd_trace->etm_ctx = arm->etm; - /* copy name of TTY device used to communicate with OpenOCD+trace */ + /* copy name of TTY device used to communicate with OpenOCD + trace */ oocd_trace->tty = strndup(args[1], 256); } else { - LOG_ERROR("target has no ETM defined, OpenOCD+trace left unconfigured"); + LOG_ERROR("target has no ETM defined, OpenOCD + trace left unconfigured"); } return ERROR_OK; } -static int handle_oocd_trace_status_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc) +COMMAND_HANDLER(handle_oocd_trace_status_command) { - target_t *target; - armv4_5_common_t *armv4_5; - arm7_9_common_t *arm7_9; - oocd_trace_t *oocd_trace; - u32 status; + struct target *target; + struct arm *arm; + struct oocd_trace *oocd_trace; + uint32_t status; target = get_current_target(cmd_ctx); - if (arm7_9_get_arch_pointers(target, &armv4_5, &arm7_9) != ERROR_OK) + arm = target_to_arm(target); + if (!is_arm(arm)) { - command_print(cmd_ctx, "current target isn't an ARM7/ARM9 target"); - return ERROR_OK; + command_print(cmd_ctx, "current target isn't an ARM"); + return ERROR_FAIL; } - if (!arm7_9->etm_ctx) + if (!arm->etm) { command_print(cmd_ctx, "current target doesn't have an ETM configured"); - return ERROR_OK; + return ERROR_FAIL; } - if (strcmp(arm7_9->etm_ctx->capture_driver->name, "oocd_trace") != 0) + if (strcmp(arm->etm->capture_driver->name, "oocd_trace") != 0) { command_print(cmd_ctx, "current target's ETM capture driver isn't 'oocd_trace'"); - return ERROR_OK; + return ERROR_FAIL; } - oocd_trace = (oocd_trace_t*)arm7_9->etm_ctx->capture_driver_priv; + oocd_trace = (struct oocd_trace*)arm->etm->capture_driver_priv; oocd_trace_read_reg(oocd_trace, OOCD_TRACE_STATUS, &status); @@ -367,36 +366,36 @@ static int handle_oocd_trace_status_command(struct command_context_s *cmd_ctx, c return ERROR_OK; } -static int handle_oocd_trace_resync_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc) +COMMAND_HANDLER(handle_oocd_trace_resync_command) { - target_t *target; - armv4_5_common_t *armv4_5; - arm7_9_common_t *arm7_9; - oocd_trace_t *oocd_trace; + struct target *target; + struct arm *arm; + struct oocd_trace *oocd_trace; size_t bytes_written; uint8_t cmd_array[1]; target = get_current_target(cmd_ctx); - if (arm7_9_get_arch_pointers(target, &armv4_5, &arm7_9) != ERROR_OK) + arm = target_to_arm(target); + if (!is_arm(arm)) { - command_print(cmd_ctx, "current target isn't an ARM7/ARM9 target"); - return ERROR_OK; + command_print(cmd_ctx, "current target isn't an ARM"); + return ERROR_FAIL; } - if (!arm7_9->etm_ctx) + if (!arm->etm) { command_print(cmd_ctx, "current target doesn't have an ETM configured"); - return ERROR_OK; + return ERROR_FAIL; } - if (strcmp(arm7_9->etm_ctx->capture_driver->name, "oocd_trace") != 0) + if (strcmp(arm->etm->capture_driver->name, "oocd_trace") != 0) { command_print(cmd_ctx, "current target's ETM capture driver isn't 'oocd_trace'"); - return ERROR_OK; + return ERROR_FAIL; } - oocd_trace = (oocd_trace_t*)arm7_9->etm_ctx->capture_driver_priv; + oocd_trace = (struct oocd_trace*)arm->etm->capture_driver_priv; cmd_array[0] = 0xf0; @@ -408,16 +407,16 @@ static int handle_oocd_trace_resync_command(struct command_context_s *cmd_ctx, c return ERROR_OK; } -int oocd_trace_register_commands(struct command_context_s *cmd_ctx) +int oocd_trace_register_commands(struct command_context *cmd_ctx) { command_t *oocd_trace_cmd; - oocd_trace_cmd = register_command(cmd_ctx, NULL, "oocd_trace", NULL, COMMAND_ANY, "OpenOCD+trace"); + oocd_trace_cmd = register_command(cmd_ctx, NULL, "oocd_trace", NULL, COMMAND_ANY, "OpenOCD + trace"); register_command(cmd_ctx, oocd_trace_cmd, "config", handle_oocd_trace_config_command, COMMAND_CONFIG, NULL); - register_command(cmd_ctx, oocd_trace_cmd, "status", handle_oocd_trace_status_command, COMMAND_EXEC, "display OpenOCD+trace status"); - register_command(cmd_ctx, oocd_trace_cmd, "resync", handle_oocd_trace_resync_command, COMMAND_EXEC, "resync OpenOCD+trace capture clock"); + register_command(cmd_ctx, oocd_trace_cmd, "status", handle_oocd_trace_status_command, COMMAND_EXEC, "display OpenOCD + trace status"); + register_command(cmd_ctx, oocd_trace_cmd, "resync", handle_oocd_trace_resync_command, COMMAND_EXEC, "resync OpenOCD + trace capture clock"); return ERROR_OK; }