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(...)
  51 #endif
  52
  53 ssize_t do_recv(struct utcp_connection *c, const void *data, size_t len) {
  54         if(!data || !len) {
  55                 if(errno) {
  56                         debug("Error: %s\n", strerror(errno));
  57                         dir = 0;
  58                 } else {
  59                         dir &= ~DIR_WRITE;
  60                         debug("Connection closed by peer\n");
  61                 }
  62                 return -1;
  63         }
  64         if(reference) {
  65                 char buf[len];
  66                 if(fread(buf, len, 1, reference) != 1) {
  67                         debug("Error reading reference\n");
  68                         abort();
  69                 }
  70                 if(memcmp(buf, data, len)) {
  71                         debug("Received data differs from reference\n");
  72                         abort();
  73                 }
  74         }
  75         return write(1, data, len);
  76 }
  77
  78 void do_accept(struct utcp_connection *nc, uint16_t port) {
  79         utcp_accept(nc, do_recv, NULL);
  80         c = nc;
  81         utcp_set_accept_cb(c->utcp, NULL, NULL);
  82 }
  83
  84 ssize_t do_send(struct utcp *utcp, const void *data, size_t len) {
  85         int s = *(int *)utcp->priv;
  86         outpktno++;
  87         if(outpktno >= dropfrom && outpktno < dropto) {
  88                 if(drand48() < dropout) {
  89                         debug("Dropped outgoing packet\n");
  90                         return len;
  91                 }
  92                 if(!reorder_data && drand48() < reorder) {
  93                         reorder_data = malloc(len);
  94                         if(!reorder_data) {
  95                                 debug("Out of memory\n");
  96                                 return len;
  97                         }
  98                         reorder_len = len;
  99                         memcpy(reorder_data, data, len);
 100                         reorder_countdown = 1 + drand48() * reorder_dist;
 101                         return len;
 102                 }
 103         }
 104
 105         if(reorder_data) {
 106                 if(--reorder_countdown < 0) {
 107                         total_out += reorder_len;
 108                         send(s, reorder_data, reorder_len, MSG_DONTWAIT);
 109                         free(reorder_data);
 110                         reorder_data = NULL;
 111                 }
 112         }
 113
 114         total_out += len;
 115         ssize_t result = send(s, data, len, MSG_DONTWAIT);
 116         if(result <= 0)
 117                 debug("Error sending UDP packet: %s\n", strerror(errno));
 118         return result;
 119 }
 120
 121 int main(int argc, char *argv[]) {
 122         srand(time(NULL));
 123         srand48(time(NULL));
 124
 125         if(argc < 2 || argc > 3)
 126                 return 1;
 127
 128         bool server = argc == 2;
 129         bool connected = false;
 130
 131         if(getenv("DROPIN")) dropin = atof(getenv("DROPIN"));
 132         if(getenv("DROPOUT")) dropout = atof(getenv("DROPOUT"));
 133         if(getenv("DROPFROM")) dropfrom = atoi(getenv("DROPFROM"));
 134         if(getenv("DROPTO")) dropto = atoi(getenv("DROPTO"));
 135         if(getenv("REORDER")) reorder = atof(getenv("REORDER"));
 136         if(getenv("REORDER_DIST")) reorder_dist = atoi(getenv("REORDER_DIST"));
 137
 138         char *reference_filename = getenv("REFERENCE");
 139         if(reference_filename)
 140                 reference = fopen(reference_filename, "r");
 141
 142         if(dropto < dropfrom)
 143                 dropto = 1 << 30;
 144
 145         struct addrinfo *ai;
 146         struct addrinfo hint = {
 147                 .ai_flags = server ? AI_PASSIVE : 0,
 148                 .ai_socktype = SOCK_DGRAM,
 149         };
 150
 151         getaddrinfo(server ? NULL : argv[1], server ? argv[1] : argv[2], &hint, &ai);
 152         if(!ai)
 153                 return 1;
 154
 155         int s = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol);
 156         if(s == -1)
 157                 return 1;
 158
 159         if(server) {
 160                 if(bind(s, ai->ai_addr, ai->ai_addrlen))
 161                         return 1;
 162         } else {
 163                 if(connect(s, ai->ai_addr, ai->ai_addrlen))
 164                         return 1;
 165                 connected = true;
 166         }
 167
 168         freeaddrinfo(ai);
 169
 170         struct utcp *u = utcp_init(server ? do_accept : NULL, NULL, do_send, &s);
 171         if(!u)
 172                 return 1;
 173
 174         utcp_set_mtu(u, 1300);
 175         utcp_set_user_timeout(u, 10);
 176
 177         if(!server)
 178                 c = utcp_connect(u, 1, do_recv, NULL);
 179
 180         struct pollfd fds[2] = {
 181                 {.fd = 0, .events = POLLIN | POLLERR | POLLHUP},
 182                 {.fd = s, .events = POLLIN | POLLERR | POLLHUP},
 183         };
 184
 185         char buf[102400];
 186         struct timeval timeout = utcp_timeout(u);
 187
 188         while(!connected || utcp_is_active(u)) {
 189                 size_t max = c ? utcp_get_sndbuf_free(c) : 0;
 190                 if(max > sizeof buf)
 191                         max = sizeof buf;
 192
 193                 int timeout_ms = timeout.tv_sec * 1000 + timeout.tv_usec / 1000 + 1;
 194
 195                 debug("polling, dir = %d, timeout = %d\n", dir, timeout_ms);
 196                 if((dir & DIR_READ) && max)
 197                         poll(fds, 2, timeout_ms);
 198                 else
 199                         poll(fds + 1, 1, timeout_ms);
 200
 201                 if(fds[0].revents) {
 202                         fds[0].revents = 0;
 203                         debug("stdin\n");
 204                         ssize_t len = read(0, buf, max);
 205                         if(len <= 0) {
 206                                 fds[0].fd = -1;
 207                                 dir &= ~DIR_READ;
 208                                 if(c)
 209                                         utcp_shutdown(c, SHUT_WR);
 210                                 if(len == -1)
 211                                         break;
 212                                 else
 213                                         continue;
 214                         }
 215                         if(c) {
 216                                 ssize_t sent = utcp_send(c, buf, len);
 217                                 if(sent != len)
 218                                         debug("Short send: %zd != %zd\n", sent, len);
 219                         }
 220                 }
 221
 222                 if(fds[1].revents) {
 223                         fds[1].revents = 0;
 224                         debug("netin\n");
 225                         struct sockaddr_storage ss;
 226                         socklen_t sl = sizeof ss;
 227                         int len = recvfrom(s, buf, sizeof buf, MSG_DONTWAIT, (struct sockaddr *)&ss, &sl);
 228                         if(len <= 0) {
 229                                 debug("Error receiving UDP packet: %s\n", strerror(errno));
 230                                 break;
 231                         }
 232                         if(!connected)
 233                                 if(!connect(s, (struct sockaddr *)&ss, sl))
 234                                         connected = true;
 235                         inpktno++;
 236                         if(inpktno >= dropto || inpktno < dropfrom || drand48() >= dropin) {
 237                                 total_in += len;
 238                                 if(utcp_recv(u, buf, len) == -1)
 239                                         debug("Error receiving UTCP packet: %s\n", strerror(errno));
 240                         } else {
 241                                 debug("Dropped incoming packet\n");
 242                         }
 243                 }
 244
 245                 timeout = utcp_timeout(u);
 246         };
 247
 248         utcp_close(c);
 249         utcp_exit(u);
 250         free(reorder_data);
 251
 252         debug("Total bytes in: %ld, out: %ld\n", total_in, total_out);
 253
 254         return 0;
 255 }