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