diff --git a/server.c b/server.c index 29399180..41618835 100755 --- a/server.c +++ b/server.c @@ -97,6 +97,7 @@ struct remote *connect_to_remote(char *remote_host, char *remote_port, struct ti memset(&hints, 0, sizeof hints); hints.ai_family = AF_UNSPEC; hints.ai_socktype = SOCK_STREAM; + int err = getaddrinfo(remote_host, remote_port, &hints, &res); if (err) { perror("getaddrinfo"); @@ -146,119 +147,125 @@ static void server_recv_cb (EV_P_ ev_io *w, int revents) { buf_len = &remote->buf_len; } - ssize_t r = recv(server->fd, buf, BUF_SIZE, 0); + while (1) { - if (r == 0) { - // connection closed - *buf_len = 0; - close_and_free_remote(EV_A_ remote); - close_and_free_server(EV_A_ server); - return; - } else if(r < 0) { - if (errno == EAGAIN || errno == EWOULDBLOCK) { - // no data - // continue to wait for recv - return; - } else { - perror("server recv"); + ssize_t r = recv(server->fd, buf, BUF_SIZE, 0); + + if (r == 0) { + // connection closed + *buf_len = 0; close_and_free_remote(EV_A_ remote); close_and_free_server(EV_A_ server); return; + } else if(r < 0) { + if (errno == EAGAIN || errno == EWOULDBLOCK) { + // no data + // continue to wait for recv + return; + } else { + perror("server recv"); + close_and_free_remote(EV_A_ remote); + close_and_free_server(EV_A_ server); + return; + } } - } - - decrypt_ctx(buf, r, server->d_ctx); - // handshake and transmit data - if (server->stage == 5) { - int w = send(remote->fd, remote->buf, r, 0); - if(w == -1) { - if (errno == EAGAIN || errno == EWOULDBLOCK) { - // no data, wait for send - remote->buf_len = r; + decrypt_ctx(buf, r, server->d_ctx); + + // handshake and transmit data + if (server->stage == 5) { + int w = send(remote->fd, remote->buf, r, 0); + if(w == -1) { + if (errno == EAGAIN || errno == EWOULDBLOCK) { + // no data, wait for send + remote->buf_len = r; + ev_io_stop(EV_A_ &server_recv_ctx->io); + ev_io_start(EV_A_ &remote->send_ctx->io); + return; + } else { + perror("server_recv_send"); + close_and_free_remote(EV_A_ remote); + close_and_free_server(EV_A_ server); + return; + } + } else if(w < r) { + char *pt = remote->buf; + char *et = pt + r; + while (pt + w < et) { + *pt = *(pt + w); + pt++; + } + remote->buf_len = r - w; + assert(remote->buf_len >= 0); ev_io_stop(EV_A_ &server_recv_ctx->io); ev_io_start(EV_A_ &remote->send_ctx->io); return; + } + } else if (server->stage == 0) { + + /* + * Shadowsocks Protocol: + * + * +------+----------+----------+ + * | ATYP | DST.ADDR | DST.PORT | + * +------+----------+----------+ + * | 1 | Variable | 2 | + * +------+----------+----------+ + */ + + int offset = 0; + char atyp = server->buf[offset++]; + char host[256]; + memset(host, 0, 256); + int port = 0; + + // get remote addr and port + if (atyp == 1) { + // IP V4 + size_t in_addr_len = sizeof(struct in_addr); + char *a = inet_ntoa(*(struct in_addr*)(server->buf + offset)); + memcpy(host, a, strlen(a)); + offset += in_addr_len; + + } else if (atyp == 3) { + // Domain name + uint8_t name_len = *(uint8_t *)(server->buf + offset); + memcpy(host, server->buf + offset + 1, name_len); + offset += name_len + 1; + } else { - perror("server_recv_send"); + LOGE("unsupported addrtype: %d\n", atyp); close_and_free_remote(EV_A_ remote); close_and_free_server(EV_A_ server); return; } - } else if(w < r) { - char *pt = remote->buf; - char *et = pt + r; - while (pt + w < et) { - *pt = *(pt + w); - pt++; - } - remote->buf_len = r - w; - assert(remote->buf_len >= 0); - ev_io_stop(EV_A_ &server_recv_ctx->io); - ev_io_start(EV_A_ &remote->send_ctx->io); - return; - } - } else if (server->stage == 0) { - - /* - * Shadowsocks Protocol: - * - * +------+----------+----------+ - * | ATYP | DST.ADDR | DST.PORT | - * +------+----------+----------+ - * | 1 | Variable | 2 | - * +------+----------+----------+ - */ - - int offset = 0; - char atyp = server->buf[offset++]; - char host[256]; - memset(host, 0, 256); - int port = 0; - - // get remote addr and port - if (atyp == 1) { - // IP V4 - size_t in_addr_len = sizeof(struct in_addr); - char *a = inet_ntoa(*(struct in_addr*)(server->buf + offset)); - memcpy(host, a, strlen(a)); - offset += in_addr_len; - - } else if (atyp == 3) { - // Domain name - uint8_t name_len = *(uint8_t *)(server->buf + offset); - memcpy(host, server->buf + offset + 1, name_len); - offset += name_len + 1; - } else { - LOGE("unsupported addrtype: %d\n", atyp); - close_and_free_remote(EV_A_ remote); - close_and_free_server(EV_A_ server); - return; - } + port += *(uint8_t *)(server->buf + offset++) << 8; + port += *(uint8_t *)(server->buf + offset); - port += *(uint8_t *)(server->buf + offset++) << 8; - port += *(uint8_t *)(server->buf + offset); + if (verbose) { + LOGD("connect to: %s:%s\n", host, itoa(port)); + } - if (verbose) { - LOGD("connect to: %s:%s\n", host, itoa(port)); - } + struct remote *remote = connect_to_remote(host, itoa(port), server->timeout); + if (remote == NULL) { + close_and_free_server(EV_A_ server); + return; + } - struct remote *remote = connect_to_remote(host, itoa(port), server->timeout); - if (remote == NULL) { - close_and_free_server(EV_A_ server); - return; - } + // listen to remote connected event + ev_io_stop(EV_A_ &server->recv_ctx->io); + ev_io_start(EV_A_ &remote->send_ctx->io); + ev_timer_start(EV_A_ &remote->send_ctx->watcher); - // listen to remote connected event - ev_io_stop(EV_A_ &server->recv_ctx->io); - ev_io_start(EV_A_ &remote->send_ctx->io); - ev_timer_start(EV_A_ &remote->send_ctx->watcher); + remote->server = server; + server->remote = remote; - remote->server = server; - server->remote = remote; + server->buf_len = 0; - server->stage = 5; + server->stage = 5; + return; + } } } @@ -300,6 +307,7 @@ static void server_send_cb (EV_P_ ev_io *w, int revents) { if (remote != NULL) { ev_io_start(EV_A_ &remote->recv_ctx->io); } else { + LOGE("invalid remote."); close_and_free_remote(EV_A_ remote); close_and_free_server(EV_A_ server); return; @@ -319,10 +327,6 @@ static void remote_timeout_cb(EV_P_ ev_timer *watcher, int revents) { ev_timer_stop(EV_A_ watcher); - if (server == NULL) { - close_and_free_remote(EV_A_ remote); - return; - } close_and_free_remote(EV_A_ remote); close_and_free_server(EV_A_ server); } @@ -332,10 +336,13 @@ static void remote_recv_cb (EV_P_ ev_io *w, int revents) { struct remote *remote = remote_recv_ctx->remote; struct server *server = remote->server; if (server == NULL) { + LOGE("invalid server.\n"); close_and_free_remote(EV_A_ remote); return; } + while (1) { + ssize_t r = recv(remote->fd, server->buf, BUF_SIZE, 0); if (r == 0) { @@ -348,7 +355,7 @@ static void remote_recv_cb (EV_P_ ev_io *w, int revents) { if (errno == EAGAIN || errno == EWOULDBLOCK) { // no data // continue to wait for recv - break; + return; } else { perror("remote recv"); close_and_free_remote(EV_A_ remote); @@ -356,33 +363,34 @@ static void remote_recv_cb (EV_P_ ev_io *w, int revents) { return; } } + encrypt_ctx(server->buf, r, server->e_ctx); - int w = send(server->fd, server->buf, r, 0); - if(w == -1) { + int s = send(server->fd, server->buf, r, 0); + + if (s == -1) { if (errno == EAGAIN || errno == EWOULDBLOCK) { // no data, wait for send server->buf_len = r; ev_io_stop(EV_A_ &remote_recv_ctx->io); ev_io_start(EV_A_ &server->send_ctx->io); - break; } else { perror("remote_recv_send"); close_and_free_remote(EV_A_ remote); close_and_free_server(EV_A_ server); - return; } - } else if(w < r) { + return; + } else if (s < r) { char *pt = server->buf; char *et = pt + r; - while (pt + w < et) { - *pt = *(pt + w); + while (pt + s < et) { + *pt = *(pt + s); pt++; } - server->buf_len = r - w; + server->buf_len = r - s; assert(server->buf_len >= 0); ev_io_stop(EV_A_ &remote_recv_ctx->io); ev_io_start(EV_A_ &server->send_ctx->io); - break; + return; } } } @@ -398,10 +406,15 @@ static void remote_send_cb (EV_P_ ev_io *w, int revents) { socklen_t len = sizeof addr; int r = getpeername(remote->fd, (struct sockaddr*)&addr, &len); if (r == 0) { + if (verbose) { + LOGD("remote connected.\n"); + } remote_send_ctx->connected = 1; ev_io_stop(EV_A_ &remote_send_ctx->io); ev_timer_stop(EV_A_ &remote_send_ctx->watcher); ev_io_start(EV_A_ &server->recv_ctx->io); + + //ev_io_stop(EV_A_ &server->send_ctx->io); ev_io_start(EV_A_ &remote->recv_ctx->io); return; } else { @@ -447,6 +460,7 @@ static void remote_send_cb (EV_P_ ev_io *w, int revents) { if (server != NULL) { ev_io_start(EV_A_ &server->recv_ctx->io); } else { + LOGE("invalid server.\n"); close_and_free_remote(EV_A_ remote); close_and_free_server(EV_A_ server); return;