ST-LINK USB initial release

ST-Link USB support added.

Change-Id: I2812646f2895b1529ff3f911edbdce7fa0051c8f
Signed-off-by: Mathias K <kesmtp@freenet.de>
Reviewed-on: http://openocd.zylin.com/261
Tested-by: jenkins
Reviewed-by: Spencer Oliver <spen@spen-soft.co.uk>

1 files changed, 225 insertions, 0 deletions

diff --git a/src/jtag/stlink/stlink_interface.c b/src/jtag/stlink/stlink_interface.c
new file mode 100644
index 00000000..a2ac99f7
--- /dev/null
+++ b/src/jtag/stlink/stlink_interface.c
@@ -0,0 +1,225 @@
+/***************************************************************************
+ *   Copyright (C) 2011 by Mathias Kuester                                 *
+ *   Mathias Kuester <kesmtp@freenet.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.                          *
+ *                                                                         *
+ *   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.,                                       *
+ *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
+ ***************************************************************************/
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+/* project specific includes */
+#include <jtag/interface.h>
+#include <transport/transport.h>
+#include <helper/time_support.h>
+
+#include <jtag/stlink/stlink_tcl.h>
+#include <jtag/stlink/stlink_layout.h>
+#include <jtag/stlink/stlink_interface.h>
+
+#include <target/target.h>
+
+static struct stlink_interface_s stlink_if = { {0, 0, 0, 0}, 0, 0 };
+
+int stlink_interface_open(void)
+{
+	LOG_DEBUG("stlink_interface_open");
+
+	return stlink_if.layout->open(&stlink_if);
+}
+
+int stlink_interface_init_target(struct target *t)
+{
+	int res;
+
+	/* this is the interface for the current target and we
+	 * can setup the private pointer in the tap structure
+	 * if the interface match the tap idcode
+	 */
+	res = stlink_if.layout->api->idcode(stlink_if.fd, &t->tap->idcode);
+
+	if (res != ERROR_OK)
+		return res;
+
+	unsigned ii, limit = t->tap->expected_ids_cnt;
+	int found = 0;
+
+	for (ii = 0; ii < limit; ii++) {
+		uint32_t expected = t->tap->expected_ids[ii];
+
+		if (t->tap->idcode == expected) {
+			found = 1;
+			break;
+		}
+	}
+
+	if (found == 0) {
+		LOG_ERROR
+		    ("stlink_interface_init_target: target not found: idcode: %x ",
+		     t->tap->idcode);
+		return ERROR_FAIL;
+	}
+
+	t->tap->priv = &stlink_if;
+	t->tap->hasidcode = 1;
+
+	return ERROR_OK;
+}
+
+static int stlink_interface_init(void)
+{
+	LOG_DEBUG("stlink_interface_init");
+
+	/* here we can initialize the layout */
+	return stlink_layout_init(&stlink_if);
+}
+
+static int stlink_interface_quit(void)
+{
+	LOG_DEBUG("stlink_interface_quit");
+
+	return ERROR_OK;
+}
+
+static int stlink_interface_speed(int speed)
+{
+	LOG_DEBUG("stlink_interface_speed: ignore speed %d", speed);
+
+	return ERROR_OK;
+}
+
+static int stlink_interface_execute_queue(void)
+{
+	LOG_DEBUG("stlink_interface_execute_queue: ignored");
+
+	return ERROR_OK;
+}
+
+COMMAND_HANDLER(stlink_interface_handle_device_desc_command)
+{
+	LOG_DEBUG("stlink_interface_handle_device_desc_command");
+
+	if (CMD_ARGC == 1) {
+		stlink_if.param.device_desc = strdup(CMD_ARGV[0]);
+	} else {
+		LOG_ERROR
+		    ("expected exactly one argument to stlink_device_desc <description>");
+	}
+
+	return ERROR_OK;
+}
+
+COMMAND_HANDLER(stlink_interface_handle_serial_command)
+{
+	LOG_DEBUG("stlink_interface_handle_serial_command");
+
+	if (CMD_ARGC == 1) {
+		stlink_if.param.serial = strdup(CMD_ARGV[0]);
+	} else {
+		LOG_ERROR
+		    ("expected exactly one argument to stlink_serial <serial-number>");
+	}
+
+	return ERROR_OK;
+}
+
+COMMAND_HANDLER(stlink_interface_handle_layout_command)
+{
+	LOG_DEBUG("stlink_interface_handle_layout_command");
+
+	if (CMD_ARGC != 1) {
+		LOG_ERROR("Need exactly one argument to stlink_layout");
+		return ERROR_COMMAND_SYNTAX_ERROR;
+	}
+
+	if (stlink_if.layout) {
+		LOG_ERROR("already specified stlink_layout %s",
+			  stlink_if.layout->name);
+		return (strcmp(stlink_if.layout->name, CMD_ARGV[0]) != 0)
+		    ? ERROR_FAIL : ERROR_OK;
+	}
+
+	for (const struct stlink_layout *l = stlink_layout_get_list(); l->name;
+	     l++) {
+		if (strcmp(l->name, CMD_ARGV[0]) == 0) {
+			stlink_if.layout = l;
+			return ERROR_OK;
+		}
+	}
+
+	LOG_ERROR("No STLINK layout '%s' found", CMD_ARGV[0]);
+	return ERROR_FAIL;
+}
+
+COMMAND_HANDLER(stlink_interface_handle_vid_pid_command)
+{
+	LOG_DEBUG("stlink_interface_handle_vid_pid_command");
+
+	if (CMD_ARGC != 2) {
+		LOG_WARNING
+		    ("ignoring extra IDs in stlink_vid_pid (maximum is 1 pair)");
+		return ERROR_COMMAND_SYNTAX_ERROR;
+	}
+
+	COMMAND_PARSE_NUMBER(u16, CMD_ARGV[0], stlink_if.param.vid);
+	COMMAND_PARSE_NUMBER(u16, CMD_ARGV[1], stlink_if.param.pid);
+
+	return ERROR_OK;
+}
+
+static const struct command_registration stlink_interface_command_handlers[] = {
+	{
+	 .name = "stlink_device_desc",
+	 .handler = &stlink_interface_handle_device_desc_command,
+	 .mode = COMMAND_CONFIG,
+	 .help = "set the stlink device description of the STLINK device",
+	 .usage = "description_string",
+	 },
+	{
+	 .name = "stlink_serial",
+	 .handler = &stlink_interface_handle_serial_command,
+	 .mode = COMMAND_CONFIG,
+	 .help = "set the serial number of the STLINK device",
+	 .usage = "serial_string",
+	 },
+	{
+	 .name = "stlink_layout",
+	 .handler = &stlink_interface_handle_layout_command,
+	 .mode = COMMAND_CONFIG,
+	 .help = "set the layout of the STLINK to usb or sg",
+	 .usage = "layout_name",
+	 },
+	{
+	 .name = "stlink_vid_pid",
+	 .handler = &stlink_interface_handle_vid_pid_command,
+	 .mode = COMMAND_CONFIG,
+	 .help = "the vendor and product ID of the STLINK device",
+	 .usage = "(vid pid)* ",
+	 },
+	COMMAND_REGISTRATION_DONE
+};
+
+struct jtag_interface stlink_interface = {
+	.name = "stlink",
+	.supported = 0,
+	.commands = stlink_interface_command_handlers,
+	.transports = stlink_transports,
+
+	.init = stlink_interface_init,
+	.quit = stlink_interface_quit,
+	.speed = stlink_interface_speed,
+	.execute_queue = stlink_interface_execute_queue,
+};