Debian Codegraph @

test/piggie/piggie.c

raw
1 #define _GNU_SOURCE
2 #include <stdio.h>
3 #include <unistd.h>
4 #include <sys/mman.h>
5 #include <stdlib.h>
6 #include <signal.h>
7 #include <sched.h>
8 #include <fcntl.h>
9 #include <stdbool.h>
10 #include <string.h>
11 #include <arpa/inet.h>
12 #include <sys/prctl.h>
13
14 #define STKS (4*4096)
15
16 #ifndef CLONE_NEWPID
17 #define CLONE_NEWPID 0x20000000
18 #endif
19
20 #define SERVER_IP "127.0.0.1"
21 #define PORT 5000
22 #define MAX_BUFFER_SIZE 1024
23
24 typedef struct {
25 char *log_file;
26 bool use_tcp_socket;
27 } opts_t;
28
29 void run_tcp_server(void)
30 {
31 int server_socket, client_socket, ret;
32 struct sockaddr_in server_address, client_address;
33 char buffer[MAX_BUFFER_SIZE];
34 const int enable = 1;
35
36 ret = fork();
37 if (ret < 0) {
38 perror("tcp-server: fork failed");
39 return;
40 }
41
42 if (ret > 0) {
43 return;
44 }
45
46 prctl(PR_SET_NAME, "tcp-server");
47
48 server_socket = socket(AF_INET, SOCK_STREAM, 0);
49 if (server_socket == -1) {
50 perror("tcp-server: Socket creation failed");
51 exit(EXIT_FAILURE);
52 }
53
54 setsockopt(server_socket, SOL_SOCKET, SO_REUSEADDR, &(int){1}, sizeof(int));
55 setsockopt(server_socket, SOL_SOCKET, SO_REUSEPORT, &(int){1}, sizeof(int));
56
57 server_address.sin_family = AF_INET;
58 server_address.sin_addr.s_addr = INADDR_ANY;
59 server_address.sin_port = htons(PORT);
60
61 if (bind(server_socket, (struct sockaddr*)&server_address, sizeof(server_address)) == -1) {
62 perror("tcp-server: Socket bind failed");
63 exit(EXIT_FAILURE);
64 }
65
66 if (listen(server_socket, 5) == -1) {
67 perror("tcp-server: Listen failed");
68 exit(EXIT_FAILURE);
69 }
70
71 socklen_t client_address_len = sizeof(client_address);
72 client_socket = accept(server_socket, (struct sockaddr*)&client_address, &client_address_len);
73 if (client_socket == -1) {
74 perror("tcp-server: Accept failed");
75 exit(EXIT_FAILURE);
76 }
77
78 while (1) {
79 memset(buffer, 0, sizeof(buffer));
80 recv(client_socket, buffer, sizeof(buffer), 0);
81 }
82
83 close(server_socket);
84 close(client_socket);
85 exit(0);
86 }
87
88 void run_tcp_client(void)
89 {
90 int client_socket, max_connection_tries = 5;
91 struct sockaddr_in server_address;
92 char buffer[MAX_BUFFER_SIZE];
93 bool connected = false, ret;
94
95 ret = fork();
96 if (ret < 0) {
97 perror("tcp-client: fork failed");
98 return;
99 }
100
101 if (ret > 0) {
102 return;
103 }
104
105 prctl(PR_SET_NAME, "tcp-client");
106
107 client_socket = socket(AF_INET, SOCK_STREAM, 0);
108 if (client_socket == -1) {
109 perror("Socket creation failed");
110 exit(EXIT_FAILURE);
111 }
112
113 server_address.sin_family = AF_INET;
114 server_address.sin_port = htons(PORT);
115
116 if (inet_pton(AF_INET, SERVER_IP, &server_address.sin_addr) <= 0) {
117 perror("tcp-client: Invalid address");
118 exit(EXIT_FAILURE);
119 }
120
121 while (!connected) {
122 if (connect(client_socket, (struct sockaddr*)&server_address, sizeof(server_address)) == -1) {
123 if (max_connection_tries > 0) {
124 max_connection_tries--;
125 continue;
126 }
127
128 perror("tcp-client: Connection failed");
129 exit(EXIT_FAILURE);
130 }
131 connected = true;
132 }
133
134 while (1) {
135 send(client_socket, "ping", 5, 0);
136 /* Send messages every second */
137 sleep(1);
138 }
139
140 close(client_socket);
141 exit(0);
142 }
143
144 static int do_test(void *opts_ptr)
145 {
146 opts_t *opts = opts_ptr;
147 int fd, ret, i = 0;
148
149 setsid();
150
151 close(0);
152 close(1);
153 close(2);
154
155 fd = open("/dev/null", O_RDONLY);
156 if (fd != 0) {
157 dup2(fd, 0);
158 close(fd);
159 }
160
161 if (opts->log_file) {
162 fd = open(opts->log_file, O_WRONLY | O_TRUNC | O_CREAT, 0600);
163 dup2(fd, 1);
164 dup2(fd, 2);
165 if (fd != 1 && fd != 2)
166 close(fd);
167 }
168
169 if (opts->use_tcp_socket) {
170 if (unshare(CLONE_NEWNET))
171 return 1;
172 if (system("ip link set up dev lo"))
173 return 1;
174 run_tcp_server();
175 run_tcp_client();
176 }
177
178 while (1) {
179 sleep(1);
180 printf("%d\n", i++);
181 fflush(stdout);
182 }
183
184 return 0;
185 }
186
187 static int parse_options(int argc, char **argv, bool *usage_error, opts_t *opts)
188 {
189 int i = 1, exit_code = -1;
190
191 while (i < argc) {
192 if ((!strcmp(argv[i], "--help")) || (!strcmp(argv[i], "-h"))) {
193 *usage_error = false;
194 return 1;
195 }
196
197 if ((!strcmp(argv[i], "--log-file")) || (!strcmp(argv[i], "-o"))) {
198 opts->log_file = argv[i + 1];
199 i += 2;
200 continue;
201 }
202
203 if ((!strcmp(argv[i], "--tcp-socket")) || (!strcmp(argv[i], "-t"))) {
204 opts->use_tcp_socket = true;
205 i++;
206 continue;
207 }
208
209 printf("Unknown option: %s\n", argv[i]);
210 *usage_error = true;
211 goto out;
212 }
213
214 exit_code = 0;
215 out:
216 return exit_code;
217 }
218
219 int main(int argc, char **argv) {
220 void *stk;
221 int i, pid, log_fd, option;
222 bool usage_error = false;
223 opts_t opts = {NULL};
224 int ret;
225
226 ret = parse_options(argc, argv, &usage_error, &opts);
227 if (ret) {
228 fprintf(stderr, "Usage: %s -o/--log-file <log_file> [-t/--tcp-socket]\n", argv[0]);
229 return (usage_error != false);
230 }
231
232 stk = mmap(NULL, STKS, PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANON | MAP_GROWSDOWN, 0, 0);
233 pid = clone(do_test, stk + STKS, SIGCHLD | CLONE_NEWPID, (void*)&opts);
234 if (pid < 0) {
235 fprintf(stderr, "clone() failed: %m\n");
236 return 1;
237 }
238
239 /* Wait for TCP sockets to be created if requested */
240 if (opts.use_tcp_socket) {
241 sleep(3);
242 }
243 printf("%d\n", pid);
244
245 if (opts.log_file) {
246 log_fd = open(opts.log_file, O_WRONLY | O_CREAT | O_TRUNC, 0666);
247 if (log_fd == -1) {
248 perror("Error opening log file");
249 return 1;
250 }
251
252 dup2(log_fd, STDOUT_FILENO);
253 dup2(log_fd, STDERR_FILENO);
254
255 close(log_fd);
256 }
257
258 return 0;
259 }