| 33 |
#include <sys/syscall.h> |
#include <sys/syscall.h> |
| 34 |
#include <sys/socket.h> |
#include <sys/socket.h> |
| 35 |
#include <sys/wait.h> |
#include <sys/wait.h> |
| 36 |
|
#include <sys/epoll.h> |
| 37 |
#include <arpa/inet.h> |
#include <arpa/inet.h> |
| 38 |
|
|
| 39 |
|
#define MAX_EVENTS 10 |
| 40 |
|
|
| 41 |
int net_server(const char *hostaddr, in_port_t port) |
int net_server(const char *hostaddr, in_port_t port) |
| 42 |
{ |
{ |
| 43 |
unsigned int namelen; |
unsigned int namelen; |
| 44 |
int ret; |
int ret; |
| 45 |
int flags; |
int flags; |
| 46 |
struct sockaddr_in sin; |
struct sockaddr_in sin; |
| 47 |
fd_set testfds; |
struct epoll_event ev, events[MAX_EVENTS]; |
| 48 |
struct timeval timeout; |
int nfds, epollfd; |
| 49 |
sigset_t nsigset; |
sigset_t nsigset; |
| 50 |
sigset_t osigset; |
sigset_t osigset; |
| 51 |
siginfo_t siginfo; |
siginfo_t siginfo; |
| 99 |
sigaddset(&nsigset, SIGCHLD); |
sigaddset(&nsigset, SIGCHLD); |
| 100 |
sigaddset(&nsigset, SIGTERM); |
sigaddset(&nsigset, SIGTERM); |
| 101 |
|
|
| 102 |
|
epollfd = epoll_create1(0); |
| 103 |
|
if (epollfd < 0) |
| 104 |
|
{ |
| 105 |
|
log_error("epoll_create1() error (%d)\n", errno); |
| 106 |
|
return -1; |
| 107 |
|
} |
| 108 |
|
|
| 109 |
|
ev.events = EPOLLIN; |
| 110 |
|
ev.data.fd = socket_server; |
| 111 |
|
if (epoll_ctl(epollfd, EPOLL_CTL_ADD, socket_server, &ev) == -1) |
| 112 |
|
{ |
| 113 |
|
log_error("epoll_ctl(socket_server) error (%d)\n", errno); |
| 114 |
|
return -1; |
| 115 |
|
} |
| 116 |
|
|
| 117 |
|
flags = fcntl(socket_server, F_GETFL, 0); |
| 118 |
|
fcntl(socket_server, F_SETFL, flags | O_NONBLOCK); |
| 119 |
|
|
| 120 |
while (!SYS_server_exit || SYS_child_process_count > 0) |
while (!SYS_server_exit || SYS_child_process_count > 0) |
| 121 |
{ |
{ |
| 122 |
sigprocmask(SIG_BLOCK, &nsigset, &osigset); |
sigprocmask(SIG_BLOCK, &nsigset, &osigset); |
| 166 |
|
|
| 167 |
sigprocmask(SIG_SETMASK, &osigset, NULL); |
sigprocmask(SIG_SETMASK, &osigset, NULL); |
| 168 |
|
|
| 169 |
FD_ZERO(&testfds); |
nfds = epoll_wait(epollfd, events, MAX_EVENTS, 100); // 0.1 second |
|
FD_SET(socket_server, &testfds); |
|
| 170 |
|
|
| 171 |
timeout.tv_sec = 0; |
if (nfds < 0) |
|
timeout.tv_usec = 100 * 1000; // 0.1 second |
|
|
|
|
|
ret = select(socket_server + 1, &testfds, NULL, NULL, &timeout); |
|
|
|
|
|
if (ret < 0) |
|
| 172 |
{ |
{ |
| 173 |
if (errno != EINTR) |
if (errno != EINTR) |
| 174 |
{ |
{ |
| 175 |
log_error("Accept connection error: %d\n", errno); |
log_error("epoll_wait() error (%d)\n", errno); |
| 176 |
|
break; |
| 177 |
} |
} |
| 178 |
continue; |
continue; |
| 179 |
} |
} |
|
else if (ret == 0) // timeout |
|
|
{ |
|
|
continue; |
|
|
} |
|
| 180 |
|
|
| 181 |
// Stop accept new connection on exit |
// Stop accept new connection on exit |
| 182 |
if (SYS_server_exit) |
if (SYS_server_exit) |
| 184 |
continue; |
continue; |
| 185 |
} |
} |
| 186 |
|
|
| 187 |
if (FD_ISSET(socket_server, &testfds)) |
for (int i = 0; i < nfds; i++) |
| 188 |
{ |
{ |
| 189 |
flags = fcntl(socket_server, F_GETFL, 0); |
if (events[i].data.fd == socket_server) |
|
fcntl(socket_server, F_SETFL, flags | O_NONBLOCK); |
|
|
|
|
|
while ((socket_client = |
|
|
accept(socket_server, (struct sockaddr *)&sin, &namelen)) < 0) |
|
| 190 |
{ |
{ |
| 191 |
if (errno != EWOULDBLOCK && errno != ECONNABORTED && errno != EINTR) |
while (1) // Accept all incoming connections until error |
| 192 |
{ |
{ |
| 193 |
log_error("Accept connection error\n"); |
socket_client = accept(socket_server, (struct sockaddr *)&sin, &namelen); |
| 194 |
break; |
if (socket_client < 0) |
| 195 |
|
{ |
| 196 |
|
if (errno != EAGAIN && errno != EWOULDBLOCK && errno != ECONNABORTED && errno != EINTR) |
| 197 |
|
{ |
| 198 |
|
log_error("accept(socket_server) error (%d)\n", errno); |
| 199 |
|
} |
| 200 |
|
break; |
| 201 |
|
} |
| 202 |
|
|
| 203 |
|
strncpy(hostaddr_client, inet_ntoa(sin.sin_addr), sizeof(hostaddr_client) - 1); |
| 204 |
|
hostaddr_client[sizeof(hostaddr_client) - 1] = '\0'; |
| 205 |
|
|
| 206 |
|
port_client = ntohs(sin.sin_port); |
| 207 |
|
|
| 208 |
|
log_std("Accept connection from %s:%d\n", hostaddr_client, port_client); |
| 209 |
|
|
| 210 |
|
if (fork_server() < 0) |
| 211 |
|
{ |
| 212 |
|
log_error("fork_server() error\n"); |
| 213 |
|
} |
| 214 |
|
|
| 215 |
|
if (close(socket_client) == -1) |
| 216 |
|
{ |
| 217 |
|
log_error("close(socket_lient) error (%d)\n", errno); |
| 218 |
|
} |
| 219 |
} |
} |
| 220 |
} |
} |
|
|
|
|
fcntl(socket_server, F_SETFL, flags); |
|
|
} |
|
|
|
|
|
if (socket_client < 0) |
|
|
{ |
|
|
log_error("Accept connection error\n"); |
|
|
continue; |
|
|
} |
|
|
|
|
|
strncpy(hostaddr_client, inet_ntoa(sin.sin_addr), sizeof(hostaddr_client) - 1); |
|
|
hostaddr_client[sizeof(hostaddr_client) - 1] = '\0'; |
|
|
|
|
|
port_client = ntohs(sin.sin_port); |
|
|
|
|
|
log_std("Accept connection from %s:%d\n", hostaddr_client, |
|
|
port_client); |
|
|
|
|
|
if (fork_server() < 0) |
|
|
{ |
|
|
log_error("Fork error\n"); |
|
|
} |
|
|
|
|
|
if (close(socket_client) == -1) |
|
|
{ |
|
|
log_error("Close client socket failed\n"); |
|
| 221 |
} |
} |
| 222 |
} |
} |
| 223 |
|
|
| 224 |
|
fcntl(socket_server, F_SETFL, flags); |
| 225 |
|
|
| 226 |
if (close(socket_server) == -1) |
if (close(socket_server) == -1) |
| 227 |
{ |
{ |
| 228 |
log_error("Close server socket failed\n"); |
log_error("Close server socket failed\n"); |