#define _GNU_SOURCE #include #include #include #include #include #include #include #include #include #include #include #ifdef _WIN32 #include #include #define close(fd) closesocket(fd) #ifndef TCP_MAXRT #define TCP_MAXRT 5 #endif #else #include #include #include #include #include #include #include #endif int NOT_EXIT = 1; static void on_cancel(int sig) { NOT_EXIT = 0; } void map_fix(struct sockaddr_ina *addr, char f6) { struct { uint64_t o64; uint16_t o16; uint16_t t16; uint32_t o32; } *ipv6m = (void *)&addr->in6.sin6_addr; if (addr->sa.sa_family == AF_INET && f6) { addr->sa.sa_family = AF_INET6; ipv6m->o32 = *(uint32_t *)(&addr->in.sin_addr); ipv6m->o64 = 0; ipv6m->o16 = 0; ipv6m->t16 = 0xffff; } else if (!ipv6m->o64 && !ipv6m->o16 && ipv6m->t16 == 0xffff && !f6) { addr->sa.sa_family = AF_INET; addr->in.sin_addr = *(struct in_addr *)(&ipv6m->o32); } } static inline int nb_socket(int domain, int type) { #ifdef __linux__ int fd = socket(domain, type | SOCK_NONBLOCK, 0); #else int fd = socket(domain, type, 0); #endif if (fd < 0) { uniperror("socket"); return -1; } #ifdef _WIN32 unsigned long mode = 1; if (ioctlsocket(fd, FIONBIO, &mode) < 0) { uniperror("ioctlsocket"); close(fd); return -1; } #else #ifndef __linux__ if (fcntl(fd, F_SETFL, O_NONBLOCK) < 0) { uniperror("fcntl"); close(fd); return -1; } #endif #endif return fd; } int set_timeout(int fd, unsigned int s) { #ifdef __linux__ if (setsockopt(fd, IPPROTO_TCP, TCP_USER_TIMEOUT, (char *)&s, sizeof(s))) { uniperror("setsockopt TCP_USER_TIMEOUT"); return -1; } #else #ifdef _WIN32 if (setsockopt(fd, IPPROTO_TCP, TCP_MAXRT, (char *)&s, sizeof(s))) { uniperror("setsockopt TCP_MAXRT"); return -1; } #endif #endif return 0; } int resolve(char *host, int len, struct sockaddr_ina *addr) { struct addrinfo hints = {0}, *res = 0; hints.ai_socktype = SOCK_STREAM; hints.ai_flags = AI_ADDRCONFIG; hints.ai_family = params.ipv6 ? AF_UNSPEC : AF_INET; char rchar = host[len]; host[len] = '\0'; if (getaddrinfo(host, 0, &hints, &res) || !res) { host[len] = rchar; return -1; } if (res->ai_addr->sa_family == AF_INET6) addr->in6 = *(struct sockaddr_in6 *)res->ai_addr; else addr->in = *(struct sockaddr_in *)res->ai_addr; freeaddrinfo(res); host[len] = rchar; return 0; } int auth_socks5(int fd, char *buffer, ssize_t n) { if (n <= 2 || (uint8_t)buffer[1] != (n - 2)) { return -1; } uint8_t c = S_AUTH_BAD; for (long i = 2; i < n; i++) if (buffer[i] == S_AUTH_NONE) { c = S_AUTH_NONE; break; } buffer[1] = c; if (send(fd, buffer, 2, 0) < 0) { uniperror("send"); return -1; } return c != S_AUTH_BAD ? 0 : -1; } int resp_s5_error(int fd, int e) { struct s5_rep s5r = { .ver = 0x05, .code = (uint8_t )e, .atp = S_ATP_I4 }; return send(fd, (char *)&s5r, sizeof(s5r), 0); } int resp_error(int fd, int e, int flag) { if (flag == FLAG_S4) { struct s4_req s4r = { .cmd = e ? S4_ER : S4_OK }; return send(fd, (char *)&s4r, sizeof(s4r), 0); } else if (flag == FLAG_S5) { switch (unie(e)) { case 0: e = S_ER_OK; break; case ECONNREFUSED: e = S_ER_CONN; break; case EHOSTUNREACH: case ETIMEDOUT: e = S_ER_HOST; break; case ENETUNREACH: e = S_ER_NET; break; default: e = S_ER_GEN; } return resp_s5_error(fd, e); } return 0; } int s4_get_addr(char *buff, size_t n, struct sockaddr_ina *dst) { if (n < sizeof(struct s4_req) + 1) { return -1; } struct s4_req *r = (struct s4_req *)buff; if (r->cmd != S_CMD_CONN) { return -1; } if (ntohl(r->i4.s_addr) <= 255) { if (!params.resolve || buff[n - 1] != 0) { return -1; } char *id_end = strchr(buff + sizeof(*r), 0); if (!id_end) { return -1; } int len = (buff + n - id_end) - 2; if (len < 3 || len > 255) { return -1; } if (resolve(id_end + 1, len, dst)) { LOG(LOG_E, "not resolved: %.*s\n", len, id_end + 1); return -1; } } else { dst->in.sin_family = AF_INET; dst->in.sin_addr = r->i4; } dst->in.sin_port = r->port; return 0; } int s5_get_addr(char *buffer, ssize_t n, struct sockaddr_ina *addr) { if (n < S_SIZE_MIN) { LOG(LOG_E, "ss: request to small\n"); return -1; } struct s5_req *r = (struct s5_req *)buffer; int o = (r->atp == S_ATP_I4 ? S_SIZE_I4 : (r->atp == S_ATP_ID ? r->id.len + S_SIZE_ID : (r->atp == S_ATP_I6 ? S_SIZE_I6 : 0))); if (n < o) { LOG(LOG_E, "ss: bad request\n"); return S_ER_GEN; } if (r->cmd != S_CMD_CONN) { LOG(LOG_E, "ss: unsupported cmd: 0x%x\n", r->cmd); return S_ER_CMD; } switch (r->atp) { case S_ATP_I4: addr->in.sin_family = AF_INET; addr->in.sin_addr = r->i4; break; case S_ATP_ID: if (!params.resolve) { return S_ER_ATP; } if (r->id.len < 3 || resolve(r->id.domain, r->id.len, addr)) { LOG(LOG_E, "not resolved: %.*s\n", r->id.len, r->id.domain); return S_ER_HOST; } break; case S_ATP_I6: if (!params.ipv6) return S_ER_ATP; else { addr->in6.sin6_family = AF_INET6; addr->in6.sin6_addr = r->i6; } } addr->in.sin_port = *(uint16_t *)&buffer[o - 2]; return 0; } int create_conn(struct poolhd *pool, struct eval *val, struct sockaddr_ina *dst, int next, int mss) { struct sockaddr_ina addr = *dst; if (params.baddr.sin6_family == AF_INET6) { map_fix(&addr, 6); } else { map_fix(&addr, 0); } if (addr.sa.sa_family != params.baddr.sin6_family) { LOG(LOG_E, "different addresses family\n"); return -1; } int sfd = nb_socket(addr.sa.sa_family, SOCK_STREAM); if (sfd < 0) { uniperror("socket"); return -1; } if (addr.sa.sa_family == AF_INET6) { int no = 0; if (setsockopt(sfd, IPPROTO_IPV6, IPV6_V6ONLY, (char *)&no, sizeof(no))) { uniperror("setsockopt IPV6_V6ONLY"); close(sfd); return -1; } } if (bind(sfd, (struct sockaddr *)¶ms.baddr, sizeof(params.baddr)) < 0) { uniperror("bind"); close(sfd); return -1; } #ifdef __linux__ int syn_count = 1; if (setsockopt(sfd, IPPROTO_TCP, TCP_SYNCNT, (char *)&syn_count, sizeof(syn_count))) { uniperror("setsockopt TCP_SYNCNT"); close(sfd); return -1; } if (mss && setsockopt(sfd, IPPROTO_TCP, TCP_MAXSEG, (char *)&mss, sizeof(mss))) { uniperror("setsockopt TCP_MAXSEG"); close(sfd); return -1; } #ifdef TCP_FASTOPEN_CONNECT int yes = 1; if (params.tfo && setsockopt(sfd, IPPROTO_TCP, TCP_FASTOPEN_CONNECT, (char *)&yes, sizeof(yes))) { uniperror("setsockopt TCP_FASTOPEN_CONNECT"); close(sfd); return -1; } #endif #endif int one = 1; if (setsockopt(sfd, IPPROTO_TCP, TCP_NODELAY, (char *)&one, sizeof(one))) { uniperror("setsockopt TCP_NODELAY"); close(sfd); return -1; } int status = connect(sfd, &addr.sa, sizeof(addr)); if (status == 0 && params.tfo) { LOG(LOG_S, "TFO supported!\n"); } if (status < 0 && get_e() != EINPROGRESS && get_e() != EAGAIN) { uniperror("connect"); close(sfd); return -1; } struct eval *pair = add_event(pool, next, sfd, POLLOUT); if (!pair) { close(sfd); return -1; } val->pair = pair; pair->pair = val; pair->in6 = dst->in6; pair->flag = FLAG_CONN; return 0; } static inline int on_accept(struct poolhd *pool, struct eval *val) { struct sockaddr_ina client; struct eval *rval; while (1) { socklen_t len = sizeof(client); #ifdef __linux__ int c = accept4(val->fd, &client.sa, &len, SOCK_NONBLOCK); #else int c = accept(val->fd, &client.sa, &len); #endif if (c < 0) { if (get_e() == EAGAIN || get_e() == EINPROGRESS) break; uniperror("accept"); return -1; } #ifndef __linux__ #ifdef _WIN32 unsigned long mode = 1; if (ioctlsocket(c, FIONBIO, &mode) < 0) { uniperror("ioctlsocket"); #else if (fcntl(c, F_SETFL, O_NONBLOCK) < 0) { uniperror("fcntl"); #endif close(c); continue; } #endif int one = 1; if (setsockopt(c, IPPROTO_TCP, TCP_NODELAY, (char *)&one, sizeof(one))) { uniperror("setsockopt TCP_NODELAY"); close(c); continue; } if (!(rval = add_event(pool, EV_REQUEST, c, 0))) { close(c); continue; } rval->in6 = client.in6; } return 0; } static inline int on_tunnel(struct poolhd *pool, struct eval *val, char *buffer, size_t bfsize, int out) { ssize_t n = 0; struct eval *pair = val->pair; if (pair->buff.size && out) { pair = val; val = val->pair; n = val->buff.size - val->buff.offset; ssize_t sn = send(pair->fd, val->buff.data + val->buff.offset, n, 0); if (sn != n) { if (sn < 0 && get_e() != EAGAIN) { uniperror("send"); return -1; } if (sn > 0) val->buff.offset += sn; return 0; } free(val->buff.data); val->buff.data = 0; val->buff.size = 0; if (mod_etype(pool, val, POLLIN, 1) || mod_etype(pool, pair, POLLOUT, 0)) { uniperror("mod_etype"); return -1; } } do { n = recv(val->fd, buffer, bfsize, 0); if (n < 0 && get_e() == EAGAIN) break; if (n < 1) { if (n) uniperror("recv"); return -1; } val->recv_count += n; ssize_t sn = send(pair->fd, buffer, n, 0); if (sn != n) { if (sn < 0) { if (get_e() != EAGAIN) { uniperror("send"); return -1; } sn = 0; } LOG(LOG_S, "EAGAIN, set POLLOUT (fd: %d)\n", pair->fd); val->buff.size = n - sn; if (!(val->buff.data = malloc(val->buff.size))) { uniperror("malloc"); return -1; } memcpy(val->buff.data, buffer + sn, val->buff.size); if (mod_etype(pool, val, POLLIN, 0) || mod_etype(pool, pair, POLLOUT, 1)) { uniperror("mod_etype"); return -1; } break; } } while (n == bfsize); return 0; } int mode_add_get(struct sockaddr_ina *dst, int m) { // m < 0: get, m > 0: set, m == 0: delete char *data; int len; time_t t; struct elem *val; if (dst->sa.sa_family == AF_INET) { data = (char *)(&dst->in.sin_addr); len = sizeof(dst->in.sin_addr); } else { data = (char *)(&dst->in6.sin6_addr); len = sizeof(dst->in6.sin6_addr); } int i = mem_index(params.mempool, data, len); if (m == 0 && i >= 0) { mem_delete(params.mempool, i); return 0; } else if (m > 0) { time(&t); val = mem_add(params.mempool, data, len, i); if (!val) { uniperror("mem_add"); return -1; } val->m = m; val->time = t; return 0; } if (i < 0) { return -1; } val = params.mempool->values[i]; time(&t); if (t > val->time + params.cache_ttl) { LOG(LOG_S, "time=%ld, now=%ld, ignore\n", val->time, t); return 0; } return val->m; } static inline int on_request(struct poolhd *pool, struct eval *val, char *buffer, size_t bfsize) { struct sockaddr_ina dst = {0}; ssize_t n = recv(val->fd, buffer, bfsize, 0); if (n < 1) { if (n) uniperror("ss recv"); return -1; } int error = 0; if (*buffer == S_VER5) { if (val->flag != FLAG_S5) { if (auth_socks5(val->fd, buffer, n)) { return -1; } val->flag = FLAG_S5; return 0; } error = s5_get_addr(buffer, n, &dst); } else if (*buffer == S_VER4) { val->flag = FLAG_S4; error = s4_get_addr(buffer, n, &dst); } else { LOG(LOG_E, "ss: invalid version: 0x%x (%lu)\n", *buffer, n); return -1; } if (error) { if ((val->flag == FLAG_S4 && resp_error(val->fd, error, FLAG_S4) < 0) || (resp_s5_error(val->fd, error) < 0)) { uniperror("send"); } return -1; } int m = mode_add_get(&dst, -1); struct desync_params dp = params.dp[m < 0 ? 0 : m]; error = create_conn(pool, val, &dst, EV_CONNECT, dp.mss); if (error) { int en = get_e(); if (resp_error(val->fd, en ? en : error, val->flag) < 0) uniperror("send"); return -1; } if (m >= 0) { val->attempt = m; } val->pair->attempt = m; val->type = EV_IGNORE; return 0; } int try_again(struct poolhd *pool, struct eval *val, char data) { struct eval *client = val->pair; int m = client->attempt + 1; if (!data) for (; m < params.dp_count; m++) { struct desync_params dp = params.dp[m]; if (!dp.spos_n) break; } if (m >= params.dp_count) { mode_add_get( (struct sockaddr_ina *)&val->in6, 0); return -1; } struct desync_params dp = params.dp[m]; if (create_conn(pool, client, (struct sockaddr_ina *)&val->in6, EV_DESYNC, dp.mss)) { return -1; } val->pair = 0; del_event(pool, val); client->type = EV_IGNORE; client->attempt++; return 0; } int find_bad_data(char *buffer, ssize_t n, int m) { for (; m < params.dp_count; m++) { struct desync_params dp = params.dp[m]; for (int i = 0; i < dp.spos_n; i++) { struct spos bad_data = dp.spos[i]; if (bad_data.start >= n) { continue; } ssize_t end = n; if (bad_data.end && bad_data.end < n) { end = bad_data.end; } char *found = memmem(buffer + bad_data.start, end - bad_data.start, bad_data.data, bad_data.size); if (found) { return m; } } } return 0; } int on_tunnel_check(struct poolhd *pool, struct eval *val, char *buffer, size_t bfsize, int out) { if (out) { return on_tunnel(pool, val, buffer, bfsize, out); } ssize_t n = recv(val->fd, buffer, bfsize, 0); if (n < 1) { uniperror("recv"); switch (get_e()) { case ECONNRESET: case ETIMEDOUT: break; default: return -1; } return try_again(pool, val, 0); } // int d = find_bad_data(buffer, n, val->pair->attempt + 1); if (d) { val->pair->attempt = d - 1; return try_again(pool, val, 1); } struct eval *pair = val->pair; ssize_t sn = send(pair->fd, buffer, n, 0); if (n != sn) { uniperror("send"); return -1; } val->type = EV_TUNNEL; pair->type = EV_TUNNEL; free(pair->buff.data); pair->buff.data = 0; pair->buff.size = 0; if (params.timeout && set_timeout(val->fd, 0)) { return -1; } int m = pair->attempt; if ((m == 0 && val->attempt < 0) || (m && m == val->attempt)) { return 0; } if (m == 0) { LOG(LOG_S, "delete ip: m=%d\n", m); } else { LOG(LOG_S, "save ip: m=%d\n", m); } return mode_add_get( (struct sockaddr_ina *)&val->in6, m); } int on_desync(struct poolhd *pool, struct eval *val, char *buffer, size_t bfsize) { if (val->flag == FLAG_CONN) { if (mod_etype(pool, val, POLLOUT, 0)) { uniperror("mod_etype"); return -1; } val = val->pair; } ssize_t n; int m = val->attempt; LOG((m ? LOG_S : LOG_L), "desync params index: %d\n", m); if (!val->buff.data) { n = recv(val->fd, buffer, bfsize, 0); if (n <= 0) { if (n) uniperror("recv data"); return -1; } val->buff.size = n; val->recv_count += n; if (!(val->buff.data = malloc(n))) { uniperror("malloc"); return -1; } memcpy(val->buff.data, buffer, n); } else { n = val->buff.size; memcpy(buffer, val->buff.data, n); } if (params.timeout && set_timeout(val->pair->fd, params.timeout)) { return -1; } ssize_t sn = desync(val->pair->fd, buffer, bfsize, n, val->buff.offset, (struct sockaddr *)&val->pair->in6, m); if (sn < 0) { return -1; } if (sn < n) { val->buff.offset = sn; if (mod_etype(pool, val->pair, POLLOUT, 1)) { uniperror("mod_etype"); return -1; } val->pair->type = EV_DESYNC; return 0; } val->type = EV_TUNNEL; val->pair->type = EV_PRE_TUNNEL; return 0; } static inline int on_connect(struct poolhd *pool, struct eval *val, int e) { int error = 0; socklen_t len = sizeof(error); if (e) { if (getsockopt(val->fd, SOL_SOCKET, SO_ERROR, (char *)&error, &len)) { uniperror("getsockopt SO_ERROR"); return -1; } } else { if (mod_etype(pool, val, POLLOUT, 0)) { uniperror("mod_etype"); return -1; } val->type = EV_TUNNEL; val->pair->type = EV_DESYNC; } if (resp_error(val->pair->fd, error, val->pair->flag) < 0) { uniperror("send"); return -1; } return e ? -1 : 0; } int event_loop(int srvfd) { size_t bfsize = params.bfsize; struct poolhd *pool = init_pool(params.max_open * 2 + 1); if (!pool) { uniperror("init pool"); close(srvfd); return -1; } if (!add_event(pool, EV_ACCEPT, srvfd, 0)) { uniperror("add event"); destroy_pool(pool); close(srvfd); return -1; } char *buffer = malloc(params.bfsize); if (!buffer) { uniperror("malloc"); destroy_pool(pool); return -1; } struct eval *val; int i = -1, etype; while (NOT_EXIT) { val = next_event(pool, &i, &etype); if (!val) { if (get_e() == EINTR) continue; uniperror("(e)poll"); break; } LOG(LOG_L, "new event: fd: %d, evt: %s\n", val->fd, eid_name[val->type]); if (!val->fd) { continue; } switch (val->type) { case EV_ACCEPT: if ((etype & POLLHUP) || on_accept(pool, val)) NOT_EXIT = 0; continue; case EV_REQUEST: if ((etype & POLLHUP) || on_request(pool, val, buffer, bfsize)) del_event(pool, val); continue; case EV_PRE_TUNNEL: if (on_tunnel_check(pool, val, buffer, bfsize, etype & POLLOUT)) del_event(pool, val); continue; case EV_TUNNEL: if (on_tunnel(pool, val, buffer, bfsize, etype & POLLOUT)) del_event(pool, val); continue; case EV_CONNECT: if (on_connect(pool, val, etype & POLLERR)) del_event(pool, val); continue; case EV_DESYNC: if (on_desync(pool, val, buffer, bfsize)) del_event(pool, val); continue; case EV_IGNORE: if (etype & (POLLHUP | POLLERR | POLLRDHUP)) del_event(pool, val); continue; default: LOG(LOG_E, "???\n"); NOT_EXIT = 0; } } LOG(LOG_S, "exit\n"); free(buffer); destroy_pool(pool); return 0; } int listen_socket(struct sockaddr_ina *srv) { int srvfd = nb_socket(srv->sa.sa_family, SOCK_STREAM); if (srvfd < 0) { uniperror("socket"); return -1; } int opt = 1; if (setsockopt(srvfd, SOL_SOCKET, SO_REUSEADDR, (char *)&opt, sizeof(opt)) == -1) { uniperror("setsockopt"); close(srvfd); return -1; } if (bind(srvfd, &srv->sa, sizeof(*srv)) < 0) { uniperror("bind"); close(srvfd); return -1; } if (listen(srvfd, 10)) { uniperror("listen"); close(srvfd); return -1; } return srvfd; } int run(struct sockaddr_ina *srv) { #ifdef SIGPIPE if (signal(SIGPIPE, SIG_IGN) == SIG_ERR) uniperror("signal SIGPIPE!"); #endif signal(SIGINT, on_cancel); int fd = listen_socket(srv); if (fd < 0) { return -1; } return event_loop(fd); }