| 40 |
#include <arpa/inet.h> |
#include <arpa/inet.h> |
| 41 |
#include <netinet/in.h> |
#include <netinet/in.h> |
| 42 |
#include <systemd/sd-daemon.h> |
#include <systemd/sd-daemon.h> |
|
#include <libssh/server.h> |
|
| 43 |
|
|
| 44 |
struct process_sockaddr_t |
struct process_sockaddr_t |
| 45 |
{ |
{ |
| 50 |
|
|
| 51 |
static PROCESS_SOCKADDR process_sockaddr_pool[MAX_CLIENT_LIMIT]; |
static PROCESS_SOCKADDR process_sockaddr_pool[MAX_CLIENT_LIMIT]; |
| 52 |
|
|
| 53 |
int net_server(const char *hostaddr, in_port_t port) |
int net_server(const char *hostaddr, in_port_t port[]) |
| 54 |
{ |
{ |
| 55 |
ssh_bind sshbind; |
unsigned int addrlen; |
|
unsigned int namelen; |
|
| 56 |
int ret; |
int ret; |
| 57 |
int flags; |
int flags[2]; |
| 58 |
struct sockaddr_in sin; |
struct sockaddr_in sin; |
| 59 |
struct epoll_event ev, events[MAX_EVENTS]; |
struct epoll_event ev, events[MAX_EVENTS]; |
| 60 |
int nfds, epollfd; |
int nfds, epollfd; |
| 78 |
ssh_bind_free(sshbind); |
ssh_bind_free(sshbind); |
| 79 |
return -1; |
return -1; |
| 80 |
} |
} |
|
|
|
|
socket_server = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP); |
|
| 81 |
|
|
| 82 |
if (socket_server < 0) |
epollfd = epoll_create1(0); |
| 83 |
|
if (epollfd < 0) |
| 84 |
{ |
{ |
| 85 |
log_error("Create socket failed\n"); |
log_error("epoll_create1() error (%d)\n", errno); |
| 86 |
return -1; |
return -1; |
| 87 |
} |
} |
| 88 |
|
|
| 89 |
sin.sin_family = AF_INET; |
// Server socket |
| 90 |
sin.sin_addr.s_addr = (hostaddr[0] != '\0' ? inet_addr(hostaddr) : INADDR_ANY); |
for (i = 0; i < 2; i++) |
|
sin.sin_port = htons(port); |
|
|
|
|
|
// Reuse address and port |
|
|
flags = 1; |
|
|
if (setsockopt(socket_server, SOL_SOCKET, SO_REUSEADDR, &flags, sizeof(flags)) < 0) |
|
|
{ |
|
|
log_error("setsockopt SO_REUSEADDR error (%d)\n", errno); |
|
|
} |
|
|
if (setsockopt(socket_server, SOL_SOCKET, SO_REUSEPORT, &flags, sizeof(flags)) < 0) |
|
|
{ |
|
|
log_error("setsockopt SO_REUSEPORT error (%d)\n", errno); |
|
|
} |
|
|
|
|
|
if (bind(socket_server, (struct sockaddr *)&sin, sizeof(sin)) < 0) |
|
| 91 |
{ |
{ |
| 92 |
log_error("Bind address %s:%u failed (%d)\n", |
socket_server[i] = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP); |
|
inet_ntoa(sin.sin_addr), ntohs(sin.sin_port), errno); |
|
|
return -1; |
|
|
} |
|
| 93 |
|
|
| 94 |
if (listen(socket_server, 10) < 0) |
if (socket_server[i] < 0) |
| 95 |
{ |
{ |
| 96 |
log_error("Socket listen failed (%d)\n", errno); |
log_error("Create socket_server error (%d)\n", errno); |
| 97 |
return -1; |
return -1; |
| 98 |
} |
} |
| 99 |
|
|
| 100 |
strncpy(hostaddr_server, inet_ntoa(sin.sin_addr), sizeof(hostaddr_server) - 1); |
sin.sin_family = AF_INET; |
| 101 |
hostaddr_server[sizeof(hostaddr_server) - 1] = '\0'; |
sin.sin_addr.s_addr = (hostaddr[0] != '\0' ? inet_addr(hostaddr) : INADDR_ANY); |
| 102 |
|
sin.sin_port = htons(port[i]); |
| 103 |
|
|
| 104 |
|
// Reuse address and port |
| 105 |
|
flags[i] = 1; |
| 106 |
|
if (setsockopt(socket_server[i], SOL_SOCKET, SO_REUSEADDR, &flags[i], sizeof(flags[i])) < 0) |
| 107 |
|
{ |
| 108 |
|
log_error("setsockopt SO_REUSEADDR error (%d)\n", errno); |
| 109 |
|
} |
| 110 |
|
if (setsockopt(socket_server[i], SOL_SOCKET, SO_REUSEPORT, &flags[i], sizeof(flags[i])) < 0) |
| 111 |
|
{ |
| 112 |
|
log_error("setsockopt SO_REUSEPORT error (%d)\n", errno); |
| 113 |
|
} |
| 114 |
|
|
| 115 |
port_server = ntohs(sin.sin_port); |
if (bind(socket_server[i], (struct sockaddr *)&sin, sizeof(sin)) < 0) |
| 116 |
namelen = sizeof(sin); |
{ |
| 117 |
|
log_error("Bind address %s:%u error (%d)\n", |
| 118 |
|
inet_ntoa(sin.sin_addr), ntohs(sin.sin_port), errno); |
| 119 |
|
return -1; |
| 120 |
|
} |
| 121 |
|
|
| 122 |
log_common("Listening at %s:%d\n", hostaddr_server, port_server); |
if (listen(socket_server[i], 10) < 0) |
| 123 |
|
{ |
| 124 |
|
log_error("Telnet socket listen error (%d)\n", errno); |
| 125 |
|
return -1; |
| 126 |
|
} |
| 127 |
|
|
| 128 |
epollfd = epoll_create1(0); |
log_common("Listening at %s:%u\n", inet_ntoa(sin.sin_addr), ntohs(sin.sin_port)); |
|
if (epollfd < 0) |
|
|
{ |
|
|
log_error("epoll_create1() error (%d)\n", errno); |
|
|
return -1; |
|
|
} |
|
| 129 |
|
|
| 130 |
ev.events = EPOLLIN; |
ev.events = EPOLLIN; |
| 131 |
ev.data.fd = socket_server; |
ev.data.fd = socket_server[i]; |
| 132 |
if (epoll_ctl(epollfd, EPOLL_CTL_ADD, socket_server, &ev) == -1) |
if (epoll_ctl(epollfd, EPOLL_CTL_ADD, socket_server[i], &ev) == -1) |
|
{ |
|
|
log_error("epoll_ctl(socket_server) error (%d)\n", errno); |
|
|
if (close(epollfd) < 0) |
|
| 133 |
{ |
{ |
| 134 |
log_error("close(epoll) error (%d)\n"); |
log_error("epoll_ctl(socket_server[%d]) error (%d)\n", i, errno); |
| 135 |
|
if (close(epollfd) < 0) |
| 136 |
|
{ |
| 137 |
|
log_error("close(epoll) error (%d)\n"); |
| 138 |
|
} |
| 139 |
|
return -1; |
| 140 |
} |
} |
|
return -1; |
|
|
} |
|
| 141 |
|
|
| 142 |
flags = fcntl(socket_server, F_GETFL, 0); |
flags[i] = fcntl(socket_server[i], F_GETFL, 0); |
| 143 |
fcntl(socket_server, F_SETFL, flags | O_NONBLOCK); |
fcntl(socket_server[i], F_SETFL, flags[i] | O_NONBLOCK); |
| 144 |
|
} |
| 145 |
|
|
| 146 |
// Startup complete |
// Startup complete |
| 147 |
sd_notifyf(0, "READY=1\n" |
sd_notifyf(0, "READY=1\n" |
| 148 |
"STATUS=Listening at %s:%d\n" |
"STATUS=Listening at %s:%d (Telnet) and %s:%d (SSH2)\n" |
| 149 |
"MAINPID=%d", |
"MAINPID=%d", |
| 150 |
hostaddr_server, port_server, getpid()); |
hostaddr, port[0], hostaddr, port[1], getpid()); |
| 151 |
|
|
| 152 |
while (!SYS_server_exit || SYS_child_process_count > 0) |
while (!SYS_server_exit || SYS_child_process_count > 0) |
| 153 |
{ |
{ |
| 294 |
|
|
| 295 |
for (int i = 0; i < nfds; i++) |
for (int i = 0; i < nfds; i++) |
| 296 |
{ |
{ |
| 297 |
if (events[i].data.fd == socket_server) |
if (events[i].data.fd == socket_server[0] || events[i].data.fd == socket_server[1]) |
| 298 |
{ |
{ |
| 299 |
|
SSH_v2 = (events[i].data.fd == socket_server[1] ? 1 : 0); |
| 300 |
|
|
| 301 |
while (!SYS_server_exit) // Accept all incoming connections until error |
while (!SYS_server_exit) // Accept all incoming connections until error |
| 302 |
{ |
{ |
| 303 |
socket_client = accept(socket_server, (struct sockaddr *)&sin, &namelen); |
addrlen = sizeof(sin); |
| 304 |
|
socket_client = accept(socket_server[SSH_v2], (struct sockaddr *)&sin, &addrlen); |
| 305 |
if (socket_client < 0) |
if (socket_client < 0) |
| 306 |
{ |
{ |
| 307 |
if (errno == EAGAIN || errno == EWOULDBLOCK) |
if (errno == EAGAIN || errno == EWOULDBLOCK) |
| 324 |
|
|
| 325 |
port_client = ntohs(sin.sin_port); |
port_client = ntohs(sin.sin_port); |
| 326 |
|
|
| 327 |
log_common("Accept connection from %s:%d\n", hostaddr_client, port_client); |
log_common("Accept %sconnection from %s:%d\n", (SSH_v2 ? "" : "SSH2 "), hostaddr_client, port_client); |
| 328 |
|
|
| 329 |
if (SYS_child_process_count - 1 < BBS_max_client) |
if (SYS_child_process_count - 1 < BBS_max_client) |
| 330 |
{ |
{ |
| 344 |
|
|
| 345 |
if (j < BBS_max_client_per_ip) |
if (j < BBS_max_client_per_ip) |
| 346 |
{ |
{ |
| 347 |
if ((pid = fork_server(sshbind)) < 0) |
if ((pid = fork_server()) < 0) |
| 348 |
{ |
{ |
| 349 |
log_error("fork_server() error\n"); |
log_error("fork_server() error\n"); |
| 350 |
} |
} |
| 390 |
log_error("close(epoll) error (%d)\n"); |
log_error("close(epoll) error (%d)\n"); |
| 391 |
} |
} |
| 392 |
|
|
| 393 |
fcntl(socket_server, F_SETFL, flags); |
for (i = 0; i < 2; i++) |
|
|
|
|
if (close(socket_server) == -1) |
|
| 394 |
{ |
{ |
| 395 |
log_error("Close server socket failed\n"); |
fcntl(socket_server[i], F_SETFL, flags[i]); |
| 396 |
|
|
| 397 |
|
if (close(socket_server[i]) == -1) |
| 398 |
|
{ |
| 399 |
|
log_error("Close server socket failed\n"); |
| 400 |
|
} |
| 401 |
} |
} |
| 402 |
|
|
| 403 |
ssh_bind_free(sshbind); |
ssh_bind_free(sshbind); |