From 7658d1e585e5f6da8895144c0c9ff132433eede9 Mon Sep 17 00:00:00 2001
From: Max Lv <max.c.lv@gmail.com>
Date: Wed, 1 Jan 2014 21:29:10 +0800
Subject: [PATCH] fix socks5 response header

---
 src/udprelay.c | 11 +++++++++--
 1 file changed, 9 insertions(+), 2 deletions(-)

diff --git a/src/udprelay.c b/src/udprelay.c
index 5ea08f7f..d3f0a889 100644
--- a/src/udprelay.c
+++ b/src/udprelay.c
@@ -478,11 +478,18 @@ static void remote_recv_cb (EV_P_ ev_io *w, int revents)
         // error in parse header
         goto CLEAN_UP;
     }
-    buf_len -= addr_header_len;
-    memmove(buf, buf + addr_header_len, buf_len);
+
+    // Construct packet
+    char *tmpbuf = malloc(buf_len + 3);
+    memset(tmpbuf, 0, 3);
+    memcpy(tmpbuf + 3, buf, buf_len);
+    free(buf);
+    buf = tmpbuf;
+    buf_len += 3;
 #endif
 
 #ifdef UDPRELAY_REMOTE
+    // Construct packet
     char *tmpbuf = malloc(buf_len + addr_header_len);
     memcpy(tmpbuf, remote_ctx->addr_header, addr_header_len);
     memcpy(tmpbuf + addr_header_len, buf, buf_len);