mirror of
https://github.com/hufrea/byedpi.git
synced 2024-11-25 16:25:32 +03:00
933 lines
23 KiB
C
933 lines
23 KiB
C
#define _GNU_SOURCE
|
|
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <signal.h>
|
|
#include <time.h>
|
|
|
|
#include <proxy.h>
|
|
#include <params.h>
|
|
#include <conev.h>
|
|
#include <desync.h>
|
|
#include <error.h>
|
|
|
|
#ifdef _WIN32
|
|
#include <winsock2.h>
|
|
#include <ws2tcpip.h>
|
|
|
|
#define close(fd) closesocket(fd)
|
|
#ifndef TCP_MAXRT
|
|
#define TCP_MAXRT 5
|
|
#endif
|
|
#else
|
|
#include <errno.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
|
|
#include <sys/socket.h>
|
|
#include <arpa/inet.h>
|
|
#include <netinet/tcp.h>
|
|
#include <netdb.h>
|
|
#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);
|
|
}
|
|
|