1 // SPDX-License-Identifier: GPL-2.0-only
10 #include <linux/err.h>
12 #include <linux/in6.h>
15 #include "network_helpers.h"
17 #define clean_errno() (errno == 0 ? "None" : strerror(errno))
18 #define log_err(MSG, ...) ({ \
20 fprintf(stderr, "(%s:%d: errno: %s) " MSG "\n", \
21 __FILE__, __LINE__, clean_errno(), \
26 struct ipv4_packet pkt_v4 = {
27 .eth.h_proto = __bpf_constant_htons(ETH_P_IP),
29 .iph.protocol = IPPROTO_TCP,
30 .iph.tot_len = __bpf_constant_htons(MAGIC_BYTES),
35 struct ipv6_packet pkt_v6 = {
36 .eth.h_proto = __bpf_constant_htons(ETH_P_IPV6),
37 .iph.nexthdr = IPPROTO_TCP,
38 .iph.payload_len = __bpf_constant_htons(MAGIC_BYTES),
43 int settimeo(int fd, int timeout_ms)
45 struct timeval timeout = { .tv_sec = 3 };
48 timeout.tv_sec = timeout_ms / 1000;
49 timeout.tv_usec = (timeout_ms % 1000) * 1000;
52 if (setsockopt(fd, SOL_SOCKET, SO_RCVTIMEO, &timeout,
54 log_err("Failed to set SO_RCVTIMEO");
58 if (setsockopt(fd, SOL_SOCKET, SO_SNDTIMEO, &timeout,
60 log_err("Failed to set SO_SNDTIMEO");
67 #define save_errno_close(fd) ({ int __save = errno; close(fd); errno = __save; })
69 static int __start_server(int type, const struct sockaddr *addr,
70 socklen_t addrlen, int timeout_ms, bool reuseport)
75 fd = socket(addr->sa_family, type, 0);
77 log_err("Failed to create server socket");
81 if (settimeo(fd, timeout_ms))
85 setsockopt(fd, SOL_SOCKET, SO_REUSEPORT, &on, sizeof(on))) {
86 log_err("Failed to set SO_REUSEPORT");
90 if (bind(fd, addr, addrlen) < 0) {
91 log_err("Failed to bind socket");
95 if (type == SOCK_STREAM) {
96 if (listen(fd, 1) < 0) {
97 log_err("Failed to listed on socket");
105 save_errno_close(fd);
109 int start_server(int family, int type, const char *addr_str, __u16 port,
112 struct sockaddr_storage addr;
115 if (make_sockaddr(family, addr_str, port, &addr, &addrlen))
118 return __start_server(type, (struct sockaddr *)&addr,
119 addrlen, timeout_ms, false);
122 int *start_reuseport_server(int family, int type, const char *addr_str,
123 __u16 port, int timeout_ms, unsigned int nr_listens)
125 struct sockaddr_storage addr;
126 unsigned int nr_fds = 0;
133 if (make_sockaddr(family, addr_str, port, &addr, &addrlen))
136 fds = malloc(sizeof(*fds) * nr_listens);
140 fds[0] = __start_server(type, (struct sockaddr *)&addr, addrlen,
146 if (getsockname(fds[0], (struct sockaddr *)&addr, &addrlen))
149 for (; nr_fds < nr_listens; nr_fds++) {
150 fds[nr_fds] = __start_server(type, (struct sockaddr *)&addr,
151 addrlen, timeout_ms, true);
152 if (fds[nr_fds] == -1)
159 free_fds(fds, nr_fds);
163 void free_fds(int *fds, unsigned int nr_close_fds)
167 close(fds[--nr_close_fds]);
172 int fastopen_connect(int server_fd, const char *data, unsigned int data_len,
175 struct sockaddr_storage addr;
176 socklen_t addrlen = sizeof(addr);
177 struct sockaddr_in *addr_in;
180 if (getsockname(server_fd, (struct sockaddr *)&addr, &addrlen)) {
181 log_err("Failed to get server addr");
185 addr_in = (struct sockaddr_in *)&addr;
186 fd = socket(addr_in->sin_family, SOCK_STREAM, 0);
188 log_err("Failed to create client socket");
192 if (settimeo(fd, timeout_ms))
195 ret = sendto(fd, data, data_len, MSG_FASTOPEN, (struct sockaddr *)&addr,
197 if (ret != data_len) {
198 log_err("sendto(data, %u) != %d\n", data_len, ret);
205 save_errno_close(fd);
209 static int connect_fd_to_addr(int fd,
210 const struct sockaddr_storage *addr,
213 if (connect(fd, (const struct sockaddr *)addr, addrlen)) {
214 log_err("Failed to connect to server");
221 static const struct network_helper_opts default_opts;
223 int connect_to_fd_opts(int server_fd, const struct network_helper_opts *opts)
225 struct sockaddr_storage addr;
226 struct sockaddr_in *addr_in;
227 socklen_t addrlen, optlen;
231 opts = &default_opts;
233 optlen = sizeof(type);
234 if (getsockopt(server_fd, SOL_SOCKET, SO_TYPE, &type, &optlen)) {
235 log_err("getsockopt(SOL_TYPE)");
239 addrlen = sizeof(addr);
240 if (getsockname(server_fd, (struct sockaddr *)&addr, &addrlen)) {
241 log_err("Failed to get server addr");
245 addr_in = (struct sockaddr_in *)&addr;
246 fd = socket(addr_in->sin_family, type, 0);
248 log_err("Failed to create client socket");
252 if (settimeo(fd, opts->timeout_ms))
255 if (opts->cc && opts->cc[0] &&
256 setsockopt(fd, SOL_TCP, TCP_CONGESTION, opts->cc,
257 strlen(opts->cc) + 1))
260 if (connect_fd_to_addr(fd, &addr, addrlen))
266 save_errno_close(fd);
270 int connect_to_fd(int server_fd, int timeout_ms)
272 struct network_helper_opts opts = {
273 .timeout_ms = timeout_ms,
276 return connect_to_fd_opts(server_fd, &opts);
279 int connect_fd_to_fd(int client_fd, int server_fd, int timeout_ms)
281 struct sockaddr_storage addr;
282 socklen_t len = sizeof(addr);
284 if (settimeo(client_fd, timeout_ms))
287 if (getsockname(server_fd, (struct sockaddr *)&addr, &len)) {
288 log_err("Failed to get server addr");
292 if (connect_fd_to_addr(client_fd, &addr, len))
298 int make_sockaddr(int family, const char *addr_str, __u16 port,
299 struct sockaddr_storage *addr, socklen_t *len)
301 if (family == AF_INET) {
302 struct sockaddr_in *sin = (void *)addr;
304 memset(addr, 0, sizeof(*sin));
305 sin->sin_family = AF_INET;
306 sin->sin_port = htons(port);
308 inet_pton(AF_INET, addr_str, &sin->sin_addr) != 1) {
309 log_err("inet_pton(AF_INET, %s)", addr_str);
315 } else if (family == AF_INET6) {
316 struct sockaddr_in6 *sin6 = (void *)addr;
318 memset(addr, 0, sizeof(*sin6));
319 sin6->sin6_family = AF_INET6;
320 sin6->sin6_port = htons(port);
322 inet_pton(AF_INET6, addr_str, &sin6->sin6_addr) != 1) {
323 log_err("inet_pton(AF_INET6, %s)", addr_str);
327 *len = sizeof(*sin6);
333 char *ping_command(int family)
335 if (family == AF_INET6) {
336 /* On some systems 'ping' doesn't support IPv6, so use ping6 if it is present. */
337 if (!system("which ping6 >/dev/null 2>&1"))