1 files changed, 75 insertions, 45 deletions

diff --git a/tools/idevicedebugserverproxy.c b/tools/idevicedebugserverproxy.c
index 2209abc..fc1ead9 100644
--- a/tools/idevicedebugserverproxy.c
+++ b/tools/idevicedebugserverproxy.c
@@ -38,33 +38,25 @@ static int debug_mode = 0;
 static int quit_flag = 0;
 
 typedef struct {
-	int server_fd;
 	int client_fd;
-	uint16_t local_port;
 	idevice_t device;
 	debugserver_client_t debugserver_client;
 	volatile int stop_ctod;
 	volatile int stop_dtoc;
 } socket_info_t;
 
-static socket_info_t global_socket_info;
+struct thread_info {
+	thread_t th;
+	struct thread_info *next;
+};
+
+typedef struct thread_info thread_info_t;
+
 
 static void clean_exit(int sig)
 {
-	if (quit_flag == 0)
-		fprintf(stderr, "Setting quit status. Cancel again to quit server.\n");
-	else
-		fprintf(stderr, "Exiting...\n");
-
+	fprintf(stderr, "Exiting...\n");
 	quit_flag++;
-
-	/* shutdown server socket if we have to terminate to unblock the server loop */
-	if (quit_flag > 1) {
-		if (global_socket_info.server_fd > 0) {
-			socket_shutdown(global_socket_info.server_fd, SHUT_RDWR);
-			socket_close(global_socket_info.server_fd);
-		}
-	}
 }
 
 static void print_usage(int argc, char **argv)
@@ -83,7 +75,7 @@ static void print_usage(int argc, char **argv)
 static void *thread_device_to_client(void *data)
 {
 	socket_info_t* socket_info = (socket_info_t*)data;
-	idevice_error_t res = IDEVICE_E_UNKNOWN_ERROR;
+	debugserver_error_t res = DEBUGSERVER_E_UNKNOWN_ERROR;
 
 	int recv_len;
 	int sent;
@@ -92,15 +84,14 @@ static void *thread_device_to_client(void *data)
 	debug("%s: started thread...\n", __func__);
 
 	debug("%s: client_fd = %d\n", __func__, socket_info->client_fd);
-	debug("%s: server fd = %d\n", __func__, socket_info->server_fd);
 
-	while (!quit_flag && !socket_info->stop_dtoc && socket_info->client_fd > 0 && socket_info->server_fd > 0) {
+	while (!quit_flag && !socket_info->stop_dtoc && socket_info->client_fd > 0) {
 		debug("%s: receiving data from device...\n", __func__);
 
 		res = debugserver_client_receive_with_timeout(socket_info->debugserver_client, buffer, sizeof(buffer), (uint32_t*)&recv_len, 5000);
 
 		if (recv_len <= 0) {
-			if (recv_len == 0 && res == IDEVICE_E_SUCCESS) {
+			if (recv_len == 0 && res == DEBUGSERVER_E_SUCCESS) {
 				// try again
 				continue;
 			} else {
@@ -139,7 +130,7 @@ static void *thread_device_to_client(void *data)
 static void *thread_client_to_device(void *data)
 {
 	socket_info_t* socket_info = (socket_info_t*)data;
-	idevice_error_t res = IDEVICE_E_UNKNOWN_ERROR;
+	debugserver_error_t res = DEBUGSERVER_E_UNKNOWN_ERROR;
 
 	int recv_len;
 	int sent;
@@ -149,7 +140,6 @@ static void *thread_client_to_device(void *data)
 	debug("%s: started thread...\n", __func__);
 
 	debug("%s: client_fd = %d\n", __func__, socket_info->client_fd);
-	debug("%s: server_fd = %d\n", __func__, socket_info->server_fd);
 
 	/* spawn server to client thread */
 	socket_info->stop_dtoc = 0;
@@ -157,7 +147,7 @@ static void *thread_client_to_device(void *data)
 		fprintf(stderr, "Failed to start device to client thread...\n");
 	}
 
-	while (!quit_flag && !socket_info->stop_ctod && socket_info->client_fd > 0 && socket_info->server_fd > 0) {
+	while (!quit_flag && !socket_info->stop_ctod && socket_info->client_fd > 0) {
 		debug("%s: receiving data from client...\n", __func__);
 
 		/* attempt to read incoming data from client */
@@ -177,7 +167,7 @@ static void *thread_client_to_device(void *data)
 			debug("%s: sending data to device...\n", __func__);
 			res = debugserver_client_send(socket_info->debugserver_client, buffer, recv_len, (uint32_t*)&sent);
 
-			if (sent < recv_len || res != IDEVICE_E_SUCCESS) {
+			if (sent < recv_len || res != DEBUGSERVER_E_SUCCESS) {
 				if (sent <= 0) {
 					fprintf(stderr, "send failed: %s\n", strerror(errno));
 					break;
@@ -245,18 +235,34 @@ static void* connection_handler(void* data)
 int main(int argc, char *argv[])
 {
 	idevice_error_t ret = IDEVICE_E_UNKNOWN_ERROR;
-	thread_t th;
+	idevice_t device = NULL;
+	thread_info_t *thread_list = NULL;
 	const char* udid = NULL;
 	uint16_t local_port = 0;
+	int server_fd;
 	int result = EXIT_SUCCESS;
 	int i;
 
+#ifndef WIN32
+	struct sigaction sa;
+	struct sigaction si;
+	memset(&sa, '\0', sizeof(struct sigaction));
+	memset(&si, '\0', sizeof(struct sigaction));
+
+	sa.sa_handler = clean_exit;
+	sigemptyset(&sa.sa_mask);
+
+	si.sa_handler = SIG_IGN;
+	sigemptyset(&si.sa_mask);
+
+	sigaction(SIGINT, &sa, NULL);
+	sigaction(SIGTERM, &sa, NULL);
+	sigaction(SIGQUIT, &sa, NULL);
+	sigaction(SIGPIPE, &si, NULL);
+#else
 	/* bind signals */
 	signal(SIGINT, clean_exit);
 	signal(SIGTERM, clean_exit);
-#ifndef WIN32
-	signal(SIGQUIT, clean_exit);
-	signal(SIGPIPE, SIG_IGN);
 #endif
 
 	/* parse cmdline arguments */
@@ -297,11 +303,8 @@ int main(int argc, char *argv[])
 		goto leave_cleanup;
 	}
 
-	/* setup and create socket endpoint */
-	global_socket_info.local_port = local_port;
-
 	/* start services and connect to device */
-	ret = idevice_new(&global_socket_info.device, udid);
+	ret = idevice_new(&device, udid);
 	if (ret != IDEVICE_E_SUCCESS) {
 		if (udid) {
 			fprintf(stderr, "No device found with udid %s, is it plugged in?\n", udid);
@@ -313,40 +316,67 @@ int main(int argc, char *argv[])
 	}
 
 	/* create local socket */
-	global_socket_info.server_fd = socket_create(global_socket_info.local_port);
-	if (global_socket_info.server_fd < 0) {
+	server_fd = socket_create(local_port);
+	if (server_fd < 0) {
 		fprintf(stderr, "Could not create socket\n");
 		result = EXIT_FAILURE;
 		goto leave_cleanup;
 	}
 
 	while (!quit_flag) {
-		debug("%s: Waiting for connection on local port %d\n", __func__, global_socket_info.local_port);
+		debug("%s: Waiting for connection on local port %d\n", __func__, local_port);
 
 		/* wait for client */
-		global_socket_info.client_fd = socket_accept(global_socket_info.server_fd, global_socket_info.local_port);
-		if (global_socket_info.client_fd < 0) {
+		int client_fd = socket_accept(server_fd, local_port);
+		if (client_fd < 0) {
 			continue;
 		}
 
 		debug("%s: Handling new client connection...\n", __func__);
 
-		if (thread_new(&th, connection_handler, (void*)&global_socket_info) != 0) {
+		thread_info_t *el = (thread_info_t*)malloc(sizeof(thread_info_t));
+		if (!el) {
+			fprintf(stderr, "Out of memory\n");
+			exit(EXIT_FAILURE);
+		}
+		el->next = NULL;
+
+		if (thread_list) {
+			thread_list->next = el;
+		} else {
+			thread_list = el;
+		}
+
+		socket_info_t *sinfo = (socket_info_t*)malloc(sizeof(socket_info_t));
+		if (!sinfo) {
+			fprintf(stderr, "Out of memory\n");
+			exit(EXIT_FAILURE);
+		}
+		sinfo->client_fd = client_fd;
+		sinfo->device = device;
+
+		if (thread_new(&(el->th), connection_handler, (void*)sinfo) != 0) {
 			fprintf(stderr, "Could not start connection handler.\n");
-			socket_shutdown(global_socket_info.server_fd, SHUT_RDWR);
-			socket_close(global_socket_info.server_fd);
+			socket_shutdown(server_fd, SHUT_RDWR);
+			socket_close(server_fd);
 			continue;
 		}
-
-		/* we do not need it anymore */
-		thread_free(th);
 	}
 
 	debug("%s: Shutting down debugserver proxy...\n", __func__);
 
+	/* join and clean up threads */
+	while (thread_list) {
+		thread_info_t *el = thread_list;
+		thread_join(el->th);
+		thread_free(el->th);
+		thread_list = el->next;
+		free(el);
+	}
+
 leave_cleanup:
-	if (global_socket_info.device) {
-		idevice_free(global_socket_info.device);
+	if (device) {
+		idevice_free(device);
 	}
 
 	return result;