zy1000: removed JTAG master TCP/IP server

Move ZY1000 OpenOCD driver more in the direction of being
a client to simplify code.

Signed-off-by: Øyvind Harboe <oyvind.harboe@zylin.com>

1 files changed, 2 insertions, 125 deletions

diff --git a/src/jtag/zy1000/zy1000.c b/src/jtag/zy1000/zy1000.c
index f2db47b..ee61003 100644
--- a/src/jtag/zy1000/zy1000.c
+++ b/src/jtag/zy1000/zy1000.c
@@ -1036,6 +1036,8 @@ static const struct command_registration zy1000_commands[] = {
 };
 
 
+#if !BUILD_ZY1000_MASTER
+
 static int tcp_ip = -1;
 
 /* Write large packets if we can */
@@ -1116,9 +1118,6 @@ enum ZY1000_CMD
 	ZY1000_CMD_WAITIDLE = 2
 };
 
-
-#if !BUILD_ZY1000_MASTER
-
 #include <sys/socket.h> /* for socket(), connect(), send(), and recv() */
 #include <arpa/inet.h>  /* for sockaddr_in and inet_addr() */
 
@@ -1363,132 +1362,12 @@ static void writeShiftValue(uint8_t *data, int bits)
 
 #if BUILD_ZY1000_MASTER
 
-pthread_t thread;
-
 #if BUILD_ECOSBOARD
 static char watchdog_stack[2048];
 static cyg_thread watchdog_thread_object;
 static cyg_handle_t watchdog_thread_handle;
 #endif
 
-/* Infinite loop peeking & poking */
-static void tcpipserver(void)
-{
-	for (;;)
-	{
-		uint32_t address;
-		if (!readLong(&address))
-			return;
-		enum ZY1000_CMD c = (address >> 24) & 0xff;
-		address &= 0xffffff;
-		switch (c)
-		{
-			case ZY1000_CMD_POKE:
-			{
-				uint32_t data;
-				if (!readLong(&data))
-					return;
-				address &= ~0x80000000;
-				ZY1000_POKE(address + ZY1000_JTAG_BASE, data);
-				break;
-			}
-			case ZY1000_CMD_PEEK:
-			{
-				uint32_t data;
-				ZY1000_PEEK(address + ZY1000_JTAG_BASE, data);
-				if (!writeLong(data))
-					return;
-				break;
-			}
-			case ZY1000_CMD_SLEEP:
-			{
-				uint32_t data;
-				if (!readLong(&data))
-					return;
-				/* Wait for some us */
-				usleep(data);
-				break;
-			}
-			case ZY1000_CMD_WAITIDLE:
-			{
-				waitIdle();
-				break;
-			}
-			default:
-				return;
-		}
-	}
-}
-
-
-static void *tcpip_server(void *data)
-{
-	int so_reuseaddr_option = 1;
-
-	int fd;
-	if ((fd = socket(AF_INET, SOCK_STREAM, 0)) == -1)
-	{
-		LOG_ERROR("error creating socket: %s", strerror(errno));
-		exit(-1);
-	}
-
-	setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (void*) &so_reuseaddr_option,
-			sizeof(int));
-
-	struct sockaddr_in sin;
-	unsigned int address_size;
-	address_size = sizeof(sin);
-	memset(&sin, 0, sizeof(sin));
-	sin.sin_family = AF_INET;
-	sin.sin_addr.s_addr = INADDR_ANY;
-	sin.sin_port = htons(7777);
-
-	if (bind(fd, (struct sockaddr *) &sin, sizeof(sin)) == -1)
-	{
-		LOG_ERROR("couldn't bind to socket: %s", strerror(errno));
-		exit(-1);
-	}
-
-	if (listen(fd, 1) == -1)
-	{
-		LOG_ERROR("couldn't listen on socket: %s", strerror(errno));
-		exit(-1);
-	}
-
-
-	for (;;)
-	{
-		tcp_ip = accept(fd, (struct sockaddr *) &sin, &address_size);
-		if (tcp_ip < 0)
-		{
-			continue;
-		}
-
-		int flag = 1;
-		setsockopt(tcp_ip,	/* socket affected */
-				IPPROTO_TCP,		/* set option at TCP level */
-				TCP_NODELAY,		/* name of option */
-				(char *)&flag,		/* the cast is historical cruft */
-				sizeof(int));		/* length of option value */
-
-		bool save_poll = jtag_poll_get_enabled();
-
-		/* polling will screw up the "connection" */
-		jtag_poll_set_enabled(false);
-
-		tcpipserver();
-
-		jtag_poll_set_enabled(save_poll);
-
-		close(tcp_ip);
-
-	}
-	/* Never reached actually */
-	close(fd);
-
-	return NULL;
-}
-
 #ifdef WATCHDOG_BASE
 /* If we connect to port 8888 we must send a char every 10s or the board resets itself */
 static void watchdog_server(cyg_addrword_t data)
@@ -1628,8 +1507,6 @@ int zy1000_init(void)
 	zy1000_speed(jtag_speed_var);
 
 #if BUILD_ZY1000_MASTER
-	pthread_create(&thread, NULL, tcpip_server, NULL);
-
 #if BUILD_ECOSBOARD
 #ifdef WATCHDOG_BASE
 	cyg_thread_create(1, watchdog_server, (cyg_addrword_t) 0, "watchdog tcip/ip server",