X-Git-Url: https://review.openocd.org/gitweb?p=openocd.git;a=blobdiff_plain;f=src%2Fjtag%2Fhla%2Fhla_interface.c;h=62a8f59477f8b30c1438ffca7a655973a125098d;hp=44a7fc69f8917b821a0ed5a3a10beb1d6a637b88;hb=31c58c139d85;hpb=1f8518fef4f959dca96e9ce5bcff273222a427a8 diff --git a/src/jtag/hla/hla_interface.c b/src/jtag/hla/hla_interface.c index 44a7fc69f8..62a8f59477 100644 --- a/src/jtag/hla/hla_interface.c +++ b/src/jtag/hla/hla_interface.c @@ -16,9 +16,7 @@ * GNU General Public License for more details. * * * * You should have received a copy of the GNU General Public License * - * along with this program; if not, write to the * - * Free Software Foundation, Inc., * - * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. * + * along with this program. If not, see . * ***************************************************************************/ #ifdef HAVE_CONFIG_H @@ -37,7 +35,7 @@ #include -static struct hl_interface_s hl_if = { {0, 0, 0, 0, 0, HL_TRANSPORT_UNKNOWN, false, NULL, 0}, 0, 0 }; +static struct hl_interface_s hl_if = { {0, 0, { 0 }, { 0 }, 0, HL_TRANSPORT_UNKNOWN, false, -1}, 0, 0 }; int hl_interface_open(enum hl_transports tr) { @@ -118,11 +116,8 @@ static int hl_interface_quit(void) { LOG_DEBUG("hl_interface_quit"); - if (hl_if.param.trace_f) { - fclose(hl_if.param.trace_f); - hl_if.param.trace_f = NULL; - } - hl_if.param.trace_source_hz = 0; + if (hl_if.layout->api->close) + hl_if.layout->api->close(hl_if.handle); return ERROR_OK; } @@ -148,20 +143,34 @@ int hl_interface_init_reset(void) return ERROR_OK; } -static int dummy_khz(int khz, int *jtag_speed) +static int hl_interface_khz(int khz, int *jtag_speed) { - *jtag_speed = khz; + if (hl_if.layout->api->speed == NULL) + return ERROR_OK; + + *jtag_speed = hl_if.layout->api->speed(hl_if.handle, khz, true); return ERROR_OK; } -static int dummy_speed_div(int speed, int *khz) +static int hl_interface_speed_div(int speed, int *khz) { *khz = speed; return ERROR_OK; } -static int dummy_speed(int speed) +static int hl_interface_speed(int speed) { + if (hl_if.layout->api->speed == NULL) + return ERROR_OK; + + if (hl_if.handle == NULL) { + /* pass speed as initial param as interface not open yet */ + hl_if.param.initial_interface_speed = speed; + return ERROR_OK; + } + + hl_if.layout->api->speed(hl_if.handle, speed, false); + return ERROR_OK; } @@ -177,6 +186,28 @@ int hl_interface_override_target(const char **targetname) return ERROR_FAIL; } +int hl_interface_config_trace(bool enabled, enum tpio_pin_protocol pin_protocol, + uint32_t port_size, unsigned int *trace_freq) +{ + if (hl_if.layout->api->config_trace) + return hl_if.layout->api->config_trace(hl_if.handle, enabled, pin_protocol, + port_size, trace_freq); + else if (enabled) { + LOG_ERROR("The selected interface does not support tracing"); + return ERROR_FAIL; + } + + return ERROR_OK; +} + +int hl_interface_poll_trace(uint8_t *buf, size_t *size) +{ + if (hl_if.layout->api->poll_trace) + return hl_if.layout->api->poll_trace(hl_if.handle, buf, size); + + return ERROR_FAIL; +} + COMMAND_HANDLER(hl_interface_handle_device_desc_command) { LOG_DEBUG("hl_interface_handle_device_desc_command"); @@ -233,40 +264,27 @@ COMMAND_HANDLER(hl_interface_handle_layout_command) COMMAND_HANDLER(hl_interface_handle_vid_pid_command) { - LOG_DEBUG("hl_interface_handle_vid_pid_command"); - - if (CMD_ARGC != 2) { - LOG_WARNING("ignoring extra IDs in hl_vid_pid (maximum is 1 pair)"); - return ERROR_COMMAND_SYNTAX_ERROR; + if (CMD_ARGC > HLA_MAX_USB_IDS * 2) { + LOG_WARNING("ignoring extra IDs in hla_vid_pid " + "(maximum is %d pairs)", HLA_MAX_USB_IDS); + CMD_ARGC = HLA_MAX_USB_IDS * 2; } - - COMMAND_PARSE_NUMBER(u16, CMD_ARGV[0], hl_if.param.vid); - COMMAND_PARSE_NUMBER(u16, CMD_ARGV[1], hl_if.param.pid); - - return ERROR_OK; -} - -COMMAND_HANDLER(interface_handle_trace_command) -{ - FILE *f = NULL; - unsigned source_hz; - - if ((CMD_ARGC < 1) || (CMD_ARGC > 2)) - return ERROR_COMMAND_SYNTAX_ERROR; - - COMMAND_PARSE_NUMBER(uint, CMD_ARGV[0], source_hz); - if (source_hz == 0) { + if (CMD_ARGC < 2 || (CMD_ARGC & 1)) { + LOG_WARNING("incomplete hla_vid_pid configuration directive"); return ERROR_COMMAND_SYNTAX_ERROR; } - if (CMD_ARGC == 2) { - f = fopen(CMD_ARGV[1], "a"); - if (!f) - return ERROR_COMMAND_SYNTAX_ERROR; + unsigned i; + for (i = 0; i < CMD_ARGC; i += 2) { + COMMAND_PARSE_NUMBER(u16, CMD_ARGV[i], hl_if.param.vid[i / 2]); + COMMAND_PARSE_NUMBER(u16, CMD_ARGV[i + 1], hl_if.param.pid[i / 2]); } - hl_if.param.trace_f = f; - hl_if.param.trace_source_hz = source_hz; + /* + * Explicitly terminate, in case there are multiple instances of + * hla_vid_pid. + */ + hl_if.param.vid[i / 2] = hl_if.param.pid[i / 2] = 0; return ERROR_OK; } @@ -316,13 +334,6 @@ static const struct command_registration hl_interface_command_handlers[] = { .usage = "(vid pid)* ", }, { - .name = "trace", - .handler = &interface_handle_trace_command, - .mode = COMMAND_CONFIG, - .help = "configure trace reception", - .usage = "source_lock_hz [destination_path]", - }, - { .name = "hla_command", .handler = &interface_handle_hla_command, .mode = COMMAND_EXEC, @@ -340,7 +351,9 @@ struct jtag_interface hl_interface = { .init = hl_interface_init, .quit = hl_interface_quit, .execute_queue = hl_interface_execute_queue, - .speed = &dummy_speed, - .khz = &dummy_khz, - .speed_div = &dummy_speed_div, + .speed = &hl_interface_speed, + .khz = &hl_interface_khz, + .speed_div = &hl_interface_speed_div, + .config_trace = &hl_interface_config_trace, + .poll_trace = &hl_interface_poll_trace, };