1 files changed, 375 insertions, 0 deletions

diff --git a/tools/idevicedebugserverproxy.c b/tools/idevicedebugserverproxy.c
new file mode 100644
index 0000000..fb082b3
--- /dev/null
+++ b/tools/idevicedebugserverproxy.c
@@ -0,0 +1,375 @@
+/*
+ * idevicedebugserverproxy.c
+ * Proxy a debugserver connection from device for remote debugging
+ *
+ * Copyright (c) 2021 Nikias Bassen, All Rights Reserved.
+ * Copyright (c) 2012 Martin Szulecki All Rights Reserved.
+ *
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ *
+ * This library 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
+ * Lesser General Public License for more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#define TOOL_NAME "idevicedebugserverproxy"
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <getopt.h>
+#include <errno.h>
+#include <signal.h>
+#ifdef _WIN32
+#include <winsock2.h>
+#include <windows.h>
+#else
+#include <sys/select.h>
+#endif
+
+#include <libimobiledevice/libimobiledevice.h>
+#include <libimobiledevice/debugserver.h>
+
+#include <libimobiledevice-glue/socket.h>
+#include <libimobiledevice-glue/thread.h>
+
+#ifndef ETIMEDOUT
+#define ETIMEDOUT 138
+#endif
+
+#define info(...) fprintf(stdout, __VA_ARGS__); fflush(stdout)
+#define debug(...) if(debug_mode) fprintf(stdout, __VA_ARGS__)
+
+static int support_lldb = 0;
+static int debug_mode = 0;
+static int quit_flag = 0;
+static uint16_t local_port = 0;
+
+typedef struct {
+        int client_fd;
+        idevice_t device;
+        debugserver_client_t debugserver_client;
+} socket_info_t;
+
+struct thread_info {
+        THREAD_T th;
+        int client_fd;
+        struct thread_info *next;
+};
+
+typedef struct thread_info thread_info_t;
+
+
+static void clean_exit(int sig)
+{
+        fprintf(stderr, "Exiting...\n");
+        quit_flag++;
+}
+
+static void print_usage(int argc, char **argv, int is_error)
+{
+        char *name = strrchr(argv[0], '/');
+        fprintf(is_error ? stderr : stdout, "Usage: %s [OPTIONS] [PORT]\n", (name ? name + 1: argv[0]));
+        fprintf(is_error ? stderr : stdout,
+                "\n"
+                "Proxy debugserver connection from device to a local socket at PORT.\n"
+                "If PORT is omitted, the next available port will be used and printed\n"
+                "to stdout.\n"
+                "\n"
+                "OPTIONS:\n"
+                "  -u, --udid UDID       target specific device by UDID\n"
+                "  -n, --network         connect to network device\n"
+                "  -d, --debug           enable communication debugging\n"
+                "  -l, --lldb            enable lldb support\n"
+                "  -h, --help            prints usage information\n"
+                "  -v, --version         prints version information\n"
+                "\n"
+                "Homepage:    <" PACKAGE_URL ">\n"
+                "Bug Reports: <" PACKAGE_BUGREPORT ">\n"
+        );
+}
+
+static int intercept_packet(char *packet, ssize_t *packet_len) {
+        static const char kReqLaunchServer[] = "$qLaunchGDBServer;#4b";
+
+        char buffer[64] = {0};
+        if (*packet_len == (ssize_t)(sizeof(kReqLaunchServer) - 1)
+                && memcmp(packet, kReqLaunchServer, sizeof(kReqLaunchServer) - 1) == 0) {
+                sprintf(buffer, "port:%d;", local_port);
+        } else {
+                return 0;
+        }
+        int sum = 0;
+        for (size_t i = 0; i < strlen(buffer); i++) {
+                sum += buffer[i];
+        }
+        sum = sum & 255;
+        sprintf(packet, "$%s#%02x", buffer, sum);
+        *packet_len = strlen(packet);
+        return 1;
+}
+
+static void* connection_handler(void* data)
+{
+        debugserver_error_t derr = DEBUGSERVER_E_SUCCESS;
+        socket_info_t* socket_info = (socket_info_t*)data;
+        const int bufsize = 65536;
+        char* buf;
+
+        int client_fd = socket_info->client_fd;
+
+        debug("%s: client_fd = %d\n", __func__, client_fd);
+
+        derr = debugserver_client_start_service(socket_info->device, &socket_info->debugserver_client, TOOL_NAME);
+        if (derr != DEBUGSERVER_E_SUCCESS) {
+                fprintf(stderr, "Could not start debugserver on device!\nPlease make sure to mount a developer disk image first.\n");
+                return NULL;
+        }
+
+        buf = malloc(bufsize);
+        if (!buf) {
+                fprintf(stderr, "Failed to allocate buffer\n");
+                return NULL;
+        }
+
+        fd_set fds;
+        FD_ZERO(&fds);
+        FD_SET(client_fd, &fds);
+
+        int dtimeout = 1;
+
+        while (!quit_flag) {
+                ssize_t n = socket_receive_timeout(client_fd, buf, bufsize, 0, 1);
+                if (n != -ETIMEDOUT) {
+                        if (n < 0) {
+                                fprintf(stderr, "Failed to read from client fd: %s\n", strerror(-n));
+                                break;
+                        } else if (n == 0) {
+                                fprintf(stderr, "connection closed\n");
+                                break;
+                        }
+                        if (support_lldb && intercept_packet(buf, &n)) {
+                                socket_send(client_fd, buf, n);
+                                continue;
+                        }
+                        uint32_t sent = 0;
+                        debugserver_client_send(socket_info->debugserver_client, buf, n, &sent);
+                }
+                do {
+                        uint32_t r = 0;
+                        derr = debugserver_client_receive_with_timeout(socket_info->debugserver_client, buf, bufsize, &r, dtimeout);
+                        if (r > 0) {
+                                socket_send(client_fd, buf, r);
+                                dtimeout = 1;
+                        } else if (derr == DEBUGSERVER_E_TIMEOUT) {
+                                dtimeout = 5;
+                                break;
+                        } else {
+                                fprintf(stderr, "debugserver connection closed\n");
+                                break;
+                        }
+                } while (derr == DEBUGSERVER_E_SUCCESS);
+                if (derr != DEBUGSERVER_E_TIMEOUT && derr != DEBUGSERVER_E_SUCCESS) {
+                        break;
+                }
+        }
+        free(buf);
+
+        debug("%s: shutting down...\n", __func__);
+
+        debugserver_client_free(socket_info->debugserver_client);
+        socket_info->debugserver_client = NULL;
+
+        /* shutdown client socket */
+        socket_shutdown(socket_info->client_fd, SHUT_RDWR);
+        socket_close(socket_info->client_fd);
+
+        return NULL;
+}
+
+int main(int argc, char *argv[])
+{
+        idevice_error_t ret = IDEVICE_E_UNKNOWN_ERROR;
+        idevice_t device = NULL;
+        thread_info_t *thread_list = NULL;
+        const char* udid = NULL;
+        int use_network = 0;
+        int server_fd;
+        int result = EXIT_SUCCESS;
+        int c = 0;
+        const struct option longopts[] = {
+                { "debug", no_argument, NULL, 'd' },
+                { "help", no_argument, NULL, 'h' },
+                { "udid", required_argument, NULL, 'u' },
+                { "network", no_argument, NULL, 'n' },
+                { "lldb", no_argument, NULL, 'l' },
+                { "version", no_argument, NULL, 'v' },
+                { NULL, 0, NULL, 0}
+        };
+
+#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);
+#endif
+
+        /* parse cmdline arguments */
+        while ((c = getopt_long(argc, argv, "dhu:nv", longopts, NULL)) != -1) {
+                switch (c) {
+                case 'd':
+                        debug_mode = 1;
+                        idevice_set_debug_level(1);
+                        socket_set_verbose(3);
+                        break;
+                case 'u':
+                        if (!*optarg) {
+                                fprintf(stderr, "ERROR: UDID argument must not be empty!\n");
+                                print_usage(argc, argv, 1);
+                                return 2;
+                        }
+                        udid = optarg;
+                        break;
+                case 'n':
+                        use_network = 1;
+                        break;
+                case 'l':
+                        support_lldb = 1;
+                        break;
+                case 'h':
+                        print_usage(argc, argv, 0);
+                        return 0;
+                case 'v':
+                        printf("%s %s\n", TOOL_NAME, PACKAGE_VERSION);
+                        return 0;
+                default:
+                        print_usage(argc, argv, 1);
+                        return 2;
+                }
+        }
+        argc -= optind;
+        argv += optind;
+
+        if (argv[0] && (atoi(argv[0]) > 0)) {
+                local_port = atoi(argv[0]);
+        }
+
+        /* start services and connect to device */
+        ret = idevice_new_with_options(&device, udid, (use_network) ? IDEVICE_LOOKUP_NETWORK : IDEVICE_LOOKUP_USBMUX);
+        if (ret != IDEVICE_E_SUCCESS) {
+                if (udid) {
+                        fprintf(stderr, "No device found with udid %s.\n", udid);
+                } else {
+                        fprintf(stderr, "No device found.\n");
+                }
+                result = EXIT_FAILURE;
+                goto leave_cleanup;
+        }
+
+        /* create local socket */
+        server_fd = socket_create("127.0.0.1", local_port);
+        if (server_fd < 0) {
+                fprintf(stderr, "Could not create socket\n");
+                result = EXIT_FAILURE;
+                goto leave_cleanup;
+        }
+
+        if (local_port == 0) {
+                /* The user asked for any available port. Report the actual port. */
+                uint16_t port;
+                if (0 > socket_get_socket_port(server_fd, &port)) {
+                        fprintf(stderr, "Could not determine socket port\n");
+                        result = EXIT_FAILURE;
+                        goto leave_cleanup;
+                }
+                printf("Listening on port %d\n", port);
+        }
+
+        while (!quit_flag) {
+                debug("%s: Waiting for connection on local port %d\n", __func__, local_port);
+
+                /* wait for client */
+                int client_fd = socket_accept(server_fd, local_port);
+                if (client_fd < 0) {
+                        continue;
+                }
+
+                debug("%s: Handling new client connection...\n", __func__);
+
+                thread_info_t *el = (thread_info_t*)malloc(sizeof(thread_info_t));
+                if (!el) {
+                        fprintf(stderr, "Out of memory\n");
+                        exit(EXIT_FAILURE);
+                }
+                el->client_fd = client_fd;
+                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(server_fd, SHUT_RDWR);
+                        socket_close(server_fd);
+                        break;
+                }
+        }
+
+        debug("%s: Shutting down debugserver proxy...\n", __func__);
+
+        /* join and clean up threads */
+        while (thread_list) {
+                thread_info_t *el = thread_list;
+                socket_shutdown(el->client_fd, SHUT_RDWR);
+                socket_close(el->client_fd);
+                thread_join(el->th);
+                thread_free(el->th);
+                thread_list = el->next;
+                free(el);
+        }
+
+leave_cleanup:
+        if (device) {
+                idevice_free(device);
+        }
+
+        return result;
+}