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