Handle channel closure during a receive callback when the ringbuffer wraps.
[utcp] / test.c
1 #define _GNU_SOURCE
2
3 #include <stdio.h>
4 #include <stdlib.h>
5 #include <stdarg.h>
6 #include <string.h>
7 #include <time.h>
8 #include <errno.h>
9 #include <sys/types.h>
10 #include <sys/socket.h>
11 #include <netdb.h>
12 #include <poll.h>
13
14
15 #include "utcp.h"
16
17 #define DIR_READ 1
18 #define DIR_WRITE 2
19
20 static struct utcp_connection *c;
21 static int dir = DIR_READ | DIR_WRITE;
22 static long inpktno;
23 static long outpktno;
24 static long dropfrom;
25 static long dropto;
26 static double reorder;
27 static long reorder_dist = 10;
28 static double dropin;
29 static double dropout;
30 static long total_out;
31 static long total_in;
32 static FILE *reference;
33 static long mtu;
34 static long bufsize;
35
36 static char *reorder_data;
37 static size_t reorder_len;
38 static int reorder_countdown;
39
40 #if UTCP_DEBUG
41 static void debug(const char *format, ...) {
42         struct timespec tv;
43         char buf[1024];
44         int len;
45
46         clock_gettime(CLOCK_REALTIME, &tv);
47         len = snprintf(buf, sizeof(buf), "%ld.%06lu ", (long)tv.tv_sec, tv.tv_nsec / 1000);
48         va_list ap;
49         va_start(ap, format);
50         len += vsnprintf(buf + len, sizeof(buf) - len, format, ap);
51         va_end(ap);
52
53         if(len > 0 && (size_t)len < sizeof(buf)) {
54                 fwrite(buf, len, 1, stderr);
55         }
56 }
57 #else
58 #define debug(...) do {} while(0)
59 #endif
60
61 static ssize_t do_recv(struct utcp_connection *c, const void *data, size_t len) {
62         (void)c;
63
64         if(!data || !len) {
65                 if(errno) {
66                         debug("Error: %s\n", strerror(errno));
67                         dir = 0;
68                 } else {
69                         dir &= ~DIR_WRITE;
70                         debug("Connection closed by peer\n");
71                 }
72
73                 return -1;
74         }
75
76         if(reference) {
77                 char buf[len];
78
79                 if(fread(buf, len, 1, reference) != 1) {
80                         debug("Error reading reference\n");
81                         abort();
82                 }
83
84                 if(memcmp(buf, data, len)) {
85                         debug("Received data differs from reference\n");
86                         abort();
87                 }
88         }
89
90         return write(1, data, len);
91 }
92
93 static void do_accept(struct utcp_connection *nc, uint16_t port) {
94         (void)port;
95         utcp_accept(nc, do_recv, NULL);
96         c = nc;
97
98         if(bufsize) {
99                 utcp_set_sndbuf(c, bufsize);
100                 utcp_set_rcvbuf(c, bufsize);
101         }
102
103         utcp_set_accept_cb(c->utcp, NULL, NULL);
104 }
105
106 static ssize_t do_send(struct utcp *utcp, const void *data, size_t len) {
107         int s = *(int *)utcp->priv;
108         outpktno++;
109
110         if(outpktno >= dropfrom && outpktno < dropto) {
111                 if(drand48() < dropout) {
112                         debug("Dropped outgoing packet\n");
113                         return len;
114                 }
115
116                 if(!reorder_data && drand48() < reorder) {
117                         reorder_data = malloc(len);
118
119                         if(!reorder_data) {
120                                 debug("Out of memory\n");
121                                 return len;
122                         }
123
124                         reorder_len = len;
125                         memcpy(reorder_data, data, len);
126                         reorder_countdown = 1 + drand48() * reorder_dist;
127                         return len;
128                 }
129         }
130
131         if(reorder_data) {
132                 if(--reorder_countdown < 0) {
133                         total_out += reorder_len;
134                         send(s, reorder_data, reorder_len, MSG_DONTWAIT);
135                         free(reorder_data);
136                         reorder_data = NULL;
137                 }
138         }
139
140         total_out += len;
141         ssize_t result = send(s, data, len, MSG_DONTWAIT);
142
143         if(result <= 0) {
144                 debug("Error sending UDP packet: %s\n", strerror(errno));
145         }
146
147         return result;
148 }
149
150 static void set_mtu(struct utcp *u, int s) {
151         if(!mtu) {
152                 socklen_t optlen = sizeof(mtu);
153                 getsockopt(s, IPPROTO_IP, IP_MTU, &mtu, &optlen);
154         }
155
156         if(!mtu || mtu == 65535) {
157                 mtu = 1500;
158         }
159
160         debug("Using MTU %lu\n", mtu);
161
162         utcp_set_mtu(u, mtu ? mtu - 28 : 1300);
163 }
164
165 int main(int argc, char *argv[]) {
166         srand(time(NULL));
167         srand48(time(NULL));
168
169         if(argc < 2 || argc > 3) {
170                 return 1;
171         }
172
173         bool server = argc == 2;
174         bool connected = false;
175         uint32_t flags = UTCP_TCP;
176         size_t read_size = 102400;
177
178         if(getenv("DROPIN")) {
179                 dropin = atof(getenv("DROPIN"));
180         }
181
182         if(getenv("DROPOUT")) {
183                 dropout = atof(getenv("DROPOUT"));
184         }
185
186         if(getenv("DROPFROM")) {
187                 dropfrom = atoi(getenv("DROPFROM"));
188         }
189
190         if(getenv("DROPTO")) {
191                 dropto = atoi(getenv("DROPTO"));
192         }
193
194         if(getenv("REORDER")) {
195                 reorder = atof(getenv("REORDER"));
196         }
197
198         if(getenv("REORDER_DIST")) {
199                 reorder_dist = atoi(getenv("REORDER_DIST"));
200         }
201
202         if(getenv("FLAGS")) {
203                 flags = atoi(getenv("FLAGS"));
204         }
205
206         if(getenv("READ_SIZE")) {
207                 read_size = atoi(getenv("READ_SIZE"));
208         }
209
210         if(getenv("MTU")) {
211                 mtu = atoi(getenv("MTU"));
212         }
213
214         if(getenv("BUFSIZE")) {
215                 bufsize = atoi(getenv("BUFSIZE"));
216         }
217
218         char *reference_filename = getenv("REFERENCE");
219
220         if(reference_filename) {
221                 reference = fopen(reference_filename, "r");
222         }
223
224         if(dropto < dropfrom) {
225                 dropto = 1 << 30;
226         }
227
228         struct addrinfo *ai;
229
230         struct addrinfo hint = {
231                 .ai_flags = server ? AI_PASSIVE : 0,
232                 .ai_socktype = SOCK_DGRAM,
233         };
234
235         getaddrinfo(server ? NULL : argv[1], server ? argv[1] : argv[2], &hint, &ai);
236
237         if(!ai) {
238                 debug("Could not lookup address: %s\n", strerror(errno));
239                 return 1;
240         }
241
242         int s = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol);
243
244         if(s == -1) {
245                 debug("Could not create socket: %s\n", strerror(errno));
246                 return 1;
247         }
248
249         static const int one = 1;
250         setsockopt(s, SOL_SOCKET, SO_REUSEADDR, &one, sizeof one);
251
252         if(server) {
253                 if(bind(s, ai->ai_addr, ai->ai_addrlen)) {
254                         debug("Could not bind: %s\n", strerror(errno));
255                         return 1;
256                 }
257         } else {
258                 if(connect(s, ai->ai_addr, ai->ai_addrlen)) {
259                         debug("Could not connect: %s\n", strerror(errno));
260                         return 1;
261                 }
262
263                 connected = true;
264         }
265
266         freeaddrinfo(ai);
267
268         struct utcp *u = utcp_init(server ? do_accept : NULL, NULL, do_send, &s);
269
270         if(!u) {
271                 debug("Could not initialize UTCP\n");
272                 return 1;
273         }
274
275         utcp_set_user_timeout(u, 10);
276
277         if(!server) {
278                 set_mtu(u, s);
279                 c = utcp_connect_ex(u, 1, do_recv, NULL, flags);
280
281                 if(bufsize) {
282                         utcp_set_sndbuf(c, bufsize);
283                         utcp_set_rcvbuf(c, bufsize);
284                 }
285         }
286
287         struct pollfd fds[2] = {
288                 {.fd = 0, .events = POLLIN | POLLERR | POLLHUP},
289                 {.fd = s, .events = POLLIN | POLLERR | POLLHUP},
290         };
291
292         char buf[102400];
293
294         struct timespec timeout = utcp_timeout(u);
295
296         while(!connected || utcp_is_active(u)) {
297                 size_t max = c ? utcp_get_sndbuf_free(c) : 0;
298
299                 if(max > sizeof(buf)) {
300                         max = sizeof(buf);
301                 }
302
303                 if(max > read_size) {
304                         max = read_size;
305                 }
306
307                 int timeout_ms = timeout.tv_sec * 1000 + timeout.tv_nsec / 1000000 + 1;
308
309                 debug("polling, dir = %d, timeout = %d\n", dir, timeout_ms);
310
311                 if((dir & DIR_READ) && max) {
312                         poll(fds, 2, timeout_ms);
313                 } else {
314                         poll(fds + 1, 1, timeout_ms);
315                 }
316
317                 if(fds[0].revents) {
318                         fds[0].revents = 0;
319                         ssize_t len = read(0, buf, max);
320                         debug("stdin %zd\n", len);
321
322                         if(len <= 0) {
323                                 fds[0].fd = -1;
324                                 dir &= ~DIR_READ;
325
326                                 if(c) {
327                                         utcp_shutdown(c, SHUT_WR);
328                                 }
329
330                                 if(len == -1) {
331                                         break;
332                                 } else {
333                                         continue;
334                                 }
335                         }
336
337                         if(c) {
338                                 ssize_t sent = utcp_send(c, buf, len);
339
340                                 if(sent != len) {
341                                         debug("Short send: %zd != %zd\n", sent, len);
342                                 }
343                         }
344                 }
345
346                 if(fds[1].revents) {
347                         fds[1].revents = 0;
348                         struct sockaddr_storage ss;
349                         socklen_t sl = sizeof(ss);
350                         int len = recvfrom(s, buf, sizeof(buf), MSG_DONTWAIT, (struct sockaddr *)&ss, &sl);
351                         debug("netin %zu\n", len);
352
353                         if(len <= 0) {
354                                 debug("Error receiving UDP packet: %s\n", strerror(errno));
355                                 break;
356                         }
357
358                         if(!connected) {
359                                 if(!connect(s, (struct sockaddr *)&ss, sl)) {
360                                         connected = true;
361                                         set_mtu(u, s);
362                                 }
363                         }
364
365                         inpktno++;
366
367                         if(inpktno >= dropto || inpktno < dropfrom || drand48() >= dropin) {
368                                 total_in += len;
369
370                                 if(utcp_recv(u, buf, len) == -1) {
371                                         debug("Error receiving UTCP packet: %s\n", strerror(errno));
372                                 }
373                         } else {
374                                 debug("Dropped incoming packet\n");
375                         }
376                 }
377
378                 timeout = utcp_timeout(u);
379         };
380
381         utcp_close(c);
382
383         utcp_exit(u);
384
385         free(reorder_data);
386
387         debug("Total bytes in: %ld, out: %ld\n", total_in, total_out);
388
389         return 0;
390 }