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