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