dtls.c

   1 /*
   2  * Copyright (C) 2008 Stig Venaas <venaas@uninett.no>
   3  *
   4  * Permission to use, copy, modify, and distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  */
   8
   9 #include <signal.h>
  10 #include <sys/socket.h>
  11 #include <netinet/in.h>
  12 #include <netdb.h>
  13 #include <string.h>
  14 #include <unistd.h>
  15 #include <limits.h>
  16 #ifdef SYS_SOLARIS9
  17 #include <fcntl.h>
  18 #endif
  19 #include <sys/time.h>
  20 #include <sys/types.h>
  21 #include <sys/select.h>
  22 #include <ctype.h>
  23 #include <sys/wait.h>
  24 #include <arpa/inet.h>
  25 #include <regex.h>
  26 #include <pthread.h>
  27 #include <openssl/ssl.h>
  28 #include <openssl/err.h>
  29 #include "debug.h"
  30 #include "list.h"
  31 #include "hash.h"
  32 #include "util.h"
  33 #include "radsecproxy.h"
  34
  35 static void setprotoopts(struct commonprotoopts *opts);
  36 static char **getlistenerargs();
  37 void *udpdtlsserverrd(void *arg);
  38 int dtlsconnect(struct server *server, struct timeval *when, int timeout, char *text);
  39 void *dtlsclientrd(void *arg);
  40 int clientradputdtls(struct server *server, unsigned char *rad);
  41 void addserverextradtls(struct clsrvconf *conf);
  42 void dtlssetsrcres();
  43 void initextradtls();
  44
  45 static const struct protodefs protodefs = {
  46     "dtls",
  47     "mysecret", /* secretdefault */
  48     SOCK_DGRAM, /* socktype */
  49     "2083", /* portdefault */
  50     REQUEST_RETRY_COUNT, /* retrycountdefault */
  51     10, /* retrycountmax */
  52     REQUEST_RETRY_INTERVAL, /* retryintervaldefault */
  53     60, /* retryintervalmax */
  54     DUPLICATE_INTERVAL, /* duplicateintervaldefault */
  55     setprotoopts, /* setprotoopts */
  56     getlistenerargs, /* getlistenerargs */
  57     udpdtlsserverrd, /* listener */
  58     dtlsconnect, /* connecter */
  59     dtlsclientrd, /* clientconnreader */
  60     clientradputdtls, /* clientradput */
  61     NULL, /* addclient */
  62     addserverextradtls, /* addserverextra */
  63     dtlssetsrcres, /* setsrcres */
  64     initextradtls /* initextra */
  65 };
  66
  67 static int client4_sock = -1;
  68 static int client6_sock = -1;
  69 static struct addrinfo *srcres = NULL;
  70 static uint8_t handle;
  71 static struct commonprotoopts *protoopts = NULL;
  72
  73 const struct protodefs *dtlsinit(uint8_t h) {
  74     handle = h;
  75     return &protodefs;
  76 }
  77
  78 static void setprotoopts(struct commonprotoopts *opts) {
  79     protoopts = opts;
  80 }
  81
  82 static char **getlistenerargs() {
  83     return protoopts ? protoopts->listenargs : NULL;
  84 }
  85
  86 struct sessioncacheentry {
  87     pthread_mutex_t mutex;
  88     struct queue *rbios;
  89     struct timeval expiry;
  90 };
  91
  92 struct dtlsservernewparams {
  93     struct sessioncacheentry *sesscache;
  94     int sock;
  95     struct sockaddr_storage addr;
  96 };
  97
  98 void dtlssetsrcres() {
  99     if (!srcres)
 100         srcres = resolve_hostport_addrinfo(handle, protoopts ? protoopts->sourcearg : NULL);
 101
 102 }
 103
 104 int udp2bio(int s, struct queue *q, int cnt) {
 105     unsigned char *buf;
 106     BIO *rbio;
 107
 108     if (cnt < 1)
 109         return 0;
 110
 111     buf = malloc(cnt);
 112     if (!buf) {
 113         unsigned char err;
 114         debug(DBG_ERR, "udp2bio: malloc failed");
 115         recv(s, &err, 1, 0);
 116         return 0;
 117     }
 118
 119     cnt = recv(s, buf, cnt, 0);
 120     if (cnt < 1) {
 121         debug(DBG_WARN, "udp2bio: recv failed");
 122         free(buf);
 123         return 0;
 124     }
 125
 126     rbio = BIO_new_mem_buf(buf, cnt);
 127     BIO_set_mem_eof_return(rbio, -1);
 128
 129     pthread_mutex_lock(&q->mutex);
 130     if (!list_push(q->entries, rbio)) {
 131         BIO_free(rbio);
 132         pthread_mutex_unlock(&q->mutex);
 133         return 0;
 134     }
 135     pthread_cond_signal(&q->cond);
 136     pthread_mutex_unlock(&q->mutex);
 137     return 1;
 138 }
 139
 140 BIO *getrbio(SSL *ssl, struct queue *q, int timeout) {
 141     BIO *rbio;
 142     struct timeval now;
 143     struct timespec to;
 144
 145     pthread_mutex_lock(&q->mutex);
 146     if (!(rbio = (BIO *)list_shift(q->entries))) {
 147         if (timeout) {
 148             gettimeofday(&now, NULL);
 149             memset(&to, 0, sizeof(struct timespec));
 150             to.tv_sec = now.tv_sec + timeout;
 151             pthread_cond_timedwait(&q->cond, &q->mutex, &to);
 152         } else
 153             pthread_cond_wait(&q->cond, &q->mutex);
 154         rbio = (BIO *)list_shift(q->entries);
 155     }
 156     pthread_mutex_unlock(&q->mutex);
 157     return rbio;
 158 }
 159
 160 int dtlsread(SSL *ssl, struct queue *q, unsigned char *buf, int num, int timeout) {
 161     int len, cnt;
 162     BIO *rbio;
 163
 164     for (len = 0; len < num; len += cnt) {
 165         cnt = SSL_read(ssl, buf + len, num - len);
 166         if (cnt <= 0)
 167             switch (cnt = SSL_get_error(ssl, cnt)) {
 168             case SSL_ERROR_WANT_READ:
 169                 rbio = getrbio(ssl, q, timeout);
 170                 if (!rbio)
 171                     return 0;
 172                 BIO_free(ssl->rbio);
 173                 ssl->rbio = rbio;
 174                 cnt = 0;
 175                 continue;
 176             case SSL_ERROR_WANT_WRITE:
 177                 cnt = 0;
 178                 continue;
 179             case SSL_ERROR_ZERO_RETURN:
 180                 /* remote end sent close_notify, send one back */
 181                 SSL_shutdown(ssl);
 182                 return -1;
 183             default:
 184                 return -1;
 185             }
 186     }
 187     return num;
 188 }
 189
 190 /* accept if acc == 1, else connect */
 191 SSL *dtlsacccon(uint8_t acc, SSL_CTX *ctx, int s, struct sockaddr *addr, struct queue *rbios) {
 192     SSL *ssl;
 193     int i, res;
 194     unsigned long error;
 195     BIO *mem0bio, *wbio;
 196
 197     ssl = SSL_new(ctx);
 198     if (!ssl)
 199         return NULL;
 200
 201     mem0bio = BIO_new(BIO_s_mem());
 202     BIO_set_mem_eof_return(mem0bio, -1);
 203     wbio = BIO_new_dgram(s, BIO_NOCLOSE);
 204     i = BIO_dgram_set_peer(wbio, addr); /* i just to avoid warning */
 205     SSL_set_bio(ssl, mem0bio, wbio);
 206
 207     for (i = 0; i < 5; i++) {
 208         res = acc ? SSL_accept(ssl) : SSL_connect(ssl);
 209         if (res > 0)
 210             return ssl;
 211         if (res == 0)
 212             break;
 213         if (SSL_get_error(ssl, res) == SSL_ERROR_WANT_READ) {
 214             BIO_free(ssl->rbio);
 215             ssl->rbio = getrbio(ssl, rbios, 5);
 216             if (!ssl->rbio)
 217                 break;
 218         }
 219         while ((error = ERR_get_error()))
 220             debug(DBG_ERR, "dtls%st: DTLS: %s", acc ? "accep" : "connec", ERR_error_string(error, NULL));
 221     }
 222
 223     SSL_free(ssl);
 224     return NULL;
 225 }
 226
 227 unsigned char *raddtlsget(SSL *ssl, struct queue *rbios, int timeout) {
 228     int cnt, len;
 229     unsigned char buf[4], *rad;
 230
 231     for (;;) {
 232         cnt = dtlsread(ssl, rbios, buf, 4, timeout);
 233         if (cnt < 1) {
 234             debug(DBG_DBG, cnt ? "raddtlsget: connection lost" : "raddtlsget: timeout");
 235             return NULL;
 236         }
 237
 238         len = RADLEN(buf);
 239         rad = malloc(len);
 240         if (!rad) {
 241             debug(DBG_ERR, "raddtlsget: malloc failed");
 242             continue;
 243         }
 244         memcpy(rad, buf, 4);
 245
 246         cnt = dtlsread(ssl, rbios, rad + 4, len - 4, timeout);
 247         if (cnt < 1) {
 248             debug(DBG_DBG, cnt ? "raddtlsget: connection lost" : "raddtlsget: timeout");
 249             free(rad);
 250             return NULL;
 251         }
 252
 253         if (len >= 20)
 254             break;
 255
 256         free(rad);
 257         debug(DBG_WARN, "raddtlsget: packet smaller than minimum radius size");
 258     }
 259
 260     debug(DBG_DBG, "raddtlsget: got %d bytes", len);
 261     return rad;
 262 }
 263
 264 void *dtlsserverwr(void *arg) {
 265     int cnt;
 266     unsigned long error;
 267     struct client *client = (struct client *)arg;
 268     struct queue *replyq;
 269     struct request *reply;
 270
 271     debug(DBG_DBG, "dtlsserverwr: starting for %s", addr2string(client->addr));
 272     replyq = client->replyq;
 273     for (;;) {
 274         pthread_mutex_lock(&replyq->mutex);
 275         while (!list_first(replyq->entries)) {
 276             if (client->ssl) {
 277                 debug(DBG_DBG, "dtlsserverwr: waiting for signal");
 278                 pthread_cond_wait(&replyq->cond, &replyq->mutex);
 279                 debug(DBG_DBG, "dtlsserverwr: got signal");
 280             }
 281             if (!client->ssl) {
 282                 /* ssl might have changed while waiting */
 283                 pthread_mutex_unlock(&replyq->mutex);
 284                 debug(DBG_DBG, "dtlsserverwr: exiting as requested");
 285                 ERR_remove_state(0);
 286                 pthread_exit(NULL);
 287             }
 288         }
 289         reply = (struct request *)list_shift(replyq->entries);
 290         pthread_mutex_unlock(&replyq->mutex);
 291         cnt = SSL_write(client->ssl, reply->replybuf, RADLEN(reply->replybuf));
 292         if (cnt > 0)
 293             debug(DBG_DBG, "dtlsserverwr: sent %d bytes, Radius packet of length %d to %s",
 294                   cnt, RADLEN(reply->replybuf), addr2string(client->addr));
 295         else
 296             while ((error = ERR_get_error()))
 297                 debug(DBG_ERR, "dtlsserverwr: SSL: %s", ERR_error_string(error, NULL));
 298         freerq(reply);
 299     }
 300 }
 301
 302 void dtlsserverrd(struct client *client) {
 303     struct request *rq;
 304     uint8_t *buf;
 305     pthread_t dtlsserverwrth;
 306
 307     debug(DBG_DBG, "dtlsserverrd: starting for %s", addr2string(client->addr));
 308
 309     if (pthread_create(&dtlsserverwrth, NULL, dtlsserverwr, (void *)client)) {
 310         debug(DBG_ERR, "dtlsserverrd: pthread_create failed");
 311         return;
 312     }
 313
 314     for (;;) {
 315         buf = raddtlsget(client->ssl, client->rbios, IDLE_TIMEOUT);
 316         if (!buf) {
 317             debug(DBG_ERR, "dtlsserverrd: connection from %s lost", addr2string(client->addr));
 318             break;
 319         }
 320         debug(DBG_DBG, "dtlsserverrd: got Radius message from %s", addr2string(client->addr));
 321         rq = newrequest();
 322         if (!rq) {
 323             free(buf);
 324             continue;
 325         }
 326         rq->buf = buf;
 327         rq->from = client;
 328         if (!radsrv(rq)) {
 329             debug(DBG_ERR, "dtlsserverrd: message authentication/validation failed, closing connection from %s", addr2string(client->addr));
 330             break;
 331         }
 332     }
 333
 334     /* stop writer by setting ssl to NULL and give signal in case waiting for data */
 335     client->ssl = NULL;
 336
 337     pthread_mutex_lock(&client->replyq->mutex);
 338     pthread_cond_signal(&client->replyq->cond);
 339     pthread_mutex_unlock(&client->replyq->mutex);
 340     debug(DBG_DBG, "dtlsserverrd: waiting for writer to end");
 341     pthread_join(dtlsserverwrth, NULL);
 342     debug(DBG_DBG, "dtlsserverrd: reader for %s exiting", addr2string(client->addr));
 343 }
 344
 345 void *dtlsservernew(void *arg) {
 346     struct dtlsservernewparams *params = (struct dtlsservernewparams *)arg;
 347     struct client *client;
 348     struct clsrvconf *conf;
 349     struct list_node *cur = NULL;
 350     SSL *ssl = NULL;
 351     X509 *cert = NULL;
 352     SSL_CTX *ctx = NULL;
 353     uint8_t delay = 60;
 354
 355     debug(DBG_DBG, "dtlsservernew: starting");
 356     conf = find_clconf(handle, (struct sockaddr *)&params->addr, NULL);
 357     if (conf) {
 358         ctx = tlsgetctx(handle, conf->tlsconf);
 359         if (!ctx)
 360             goto exit;
 361         ssl = dtlsacccon(1, ctx, params->sock, (struct sockaddr *)&params->addr, params->sesscache->rbios);
 362         if (!ssl)
 363             goto exit;
 364         cert = verifytlscert(ssl);
 365         if (!cert)
 366             goto exit;
 367     }
 368
 369     while (conf) {
 370         if (verifyconfcert(cert, conf)) {
 371             X509_free(cert);
 372             client = addclient(conf, 1);
 373             if (client) {
 374                 client->sock = params->sock;
 375                 client->addr = addr_copy((struct sockaddr *)&params->addr);
 376                 client->rbios = params->sesscache->rbios;
 377                 client->ssl = ssl;
 378                 dtlsserverrd(client);
 379                 removeclient(client);
 380                 delay = 0;
 381             } else {
 382                 debug(DBG_WARN, "dtlsservernew: failed to create new client instance");
 383             }
 384             goto exit;
 385         }
 386         conf = find_clconf(handle, (struct sockaddr *)&params->addr, &cur);
 387     }
 388     debug(DBG_WARN, "dtlsservernew: ignoring request, no matching TLS client");
 389
 390     if (cert)
 391         X509_free(cert);
 392
 393  exit:
 394     if (ssl) {
 395         SSL_shutdown(ssl);
 396         SSL_free(ssl);
 397     }
 398     pthread_mutex_lock(&params->sesscache->mutex);
 399     freebios(params->sesscache->rbios);
 400     params->sesscache->rbios = NULL;
 401     gettimeofday(&params->sesscache->expiry, NULL);
 402     params->sesscache->expiry.tv_sec += delay;
 403     pthread_mutex_unlock(&params->sesscache->mutex);
 404     free(params);
 405     ERR_remove_state(0);
 406     pthread_exit(NULL);
 407     debug(DBG_DBG, "dtlsservernew: exiting");
 408 }
 409
 410 void cacheexpire(struct hash *cache, struct timeval *last) {
 411     struct timeval now;
 412     struct hash_entry *he;
 413     struct sessioncacheentry *e;
 414
 415     gettimeofday(&now, NULL);
 416     if (now.tv_sec - last->tv_sec < 19)
 417         return;
 418
 419     for (he = hash_first(cache); he; he = hash_next(he)) {
 420         e = (struct sessioncacheentry *)he->data;
 421         pthread_mutex_lock(&e->mutex);
 422         if (!e->expiry.tv_sec || e->expiry.tv_sec > now.tv_sec) {
 423             pthread_mutex_unlock(&e->mutex);
 424             continue;
 425         }
 426         debug(DBG_DBG, "cacheexpire: freeing entry");
 427         hash_extract(cache, he->key, he->keylen);
 428         if (e->rbios) {
 429             freebios(e->rbios);
 430             e->rbios = NULL;
 431         }
 432         pthread_mutex_unlock(&e->mutex);
 433         pthread_mutex_destroy(&e->mutex);
 434     }
 435     last->tv_sec = now.tv_sec;
 436 }
 437
 438 void *udpdtlsserverrd(void *arg) {
 439     int ndesc, cnt, s = *(int *)arg;
 440     unsigned char buf[4];
 441     struct sockaddr_storage from;
 442     socklen_t fromlen = sizeof(from);
 443     struct dtlsservernewparams *params;
 444     fd_set readfds;
 445     struct timeval timeout, lastexpiry;
 446     pthread_t dtlsserverth;
 447     struct hash *sessioncache;
 448     struct sessioncacheentry *cacheentry;
 449
 450     sessioncache = hash_create();
 451     if (!sessioncache)
 452         debugx(1, DBG_ERR, "udpdtlsserverrd: malloc failed");
 453     gettimeofday(&lastexpiry, NULL);
 454
 455     for (;;) {
 456         FD_ZERO(&readfds);
 457         FD_SET(s, &readfds);
 458         memset(&timeout, 0, sizeof(struct timeval));
 459         timeout.tv_sec = 60;
 460         ndesc = select(s + 1, &readfds, NULL, NULL, &timeout);
 461         if (ndesc < 1) {
 462             cacheexpire(sessioncache, &lastexpiry);
 463             continue;
 464         }
 465         cnt = recvfrom(s, buf, 4, MSG_PEEK | MSG_TRUNC, (struct sockaddr *)&from, &fromlen);
 466         if (cnt == -1) {
 467             debug(DBG_WARN, "udpdtlsserverrd: recv failed");
 468             cacheexpire(sessioncache, &lastexpiry);
 469             continue;
 470         }
 471         cacheentry = hash_read(sessioncache, &from, fromlen);
 472         if (cacheentry) {
 473             debug(DBG_DBG, "udpdtlsserverrd: cache hit");
 474             pthread_mutex_lock(&cacheentry->mutex);
 475             if (cacheentry->rbios) {
 476                 if (udp2bio(s, cacheentry->rbios, cnt))
 477                     debug(DBG_DBG, "udpdtlsserverrd: got DTLS in UDP from %s", addr2string((struct sockaddr *)&from));
 478             } else
 479                 recv(s, buf, 1, 0);
 480             pthread_mutex_unlock(&cacheentry->mutex);
 481             cacheexpire(sessioncache, &lastexpiry);
 482             continue;
 483         }
 484
 485         /* from new source */
 486         debug(DBG_DBG, "udpdtlsserverrd: cache miss");
 487         params = malloc(sizeof(struct dtlsservernewparams));
 488         if (!params) {
 489             cacheexpire(sessioncache, &lastexpiry);
 490             recv(s, buf, 1, 0);
 491             continue;
 492         }
 493         memset(params, 0, sizeof(struct dtlsservernewparams));
 494         params->sesscache = malloc(sizeof(struct sessioncacheentry));
 495         if (!params->sesscache) {
 496             free(params);
 497             cacheexpire(sessioncache, &lastexpiry);
 498             recv(s, buf, 1, 0);
 499             continue;
 500         }
 501         memset(params->sesscache, 0, sizeof(struct sessioncacheentry));
 502         pthread_mutex_init(&params->sesscache->mutex, NULL);
 503         params->sesscache->rbios = newqueue();
 504         if (hash_insert(sessioncache, &from, fromlen, params->sesscache)) {
 505             params->sock = s;
 506             memcpy(&params->addr, &from, fromlen);
 507
 508             if (udp2bio(s, params->sesscache->rbios, cnt)) {
 509                 debug(DBG_DBG, "udpdtlsserverrd: got DTLS in UDP from %s", addr2string((struct sockaddr *)&from));
 510                 if (!pthread_create(&dtlsserverth, NULL, dtlsservernew, (void *)params)) {
 511                     pthread_detach(dtlsserverth);
 512                     cacheexpire(sessioncache, &lastexpiry);
 513                     continue;
 514                 }
 515                 debug(DBG_ERR, "udpdtlsserverrd: pthread_create failed");
 516             }
 517             hash_extract(sessioncache, &from, fromlen);
 518         }
 519         freebios(params->sesscache->rbios);
 520         pthread_mutex_destroy(&params->sesscache->mutex);
 521         free(params->sesscache);
 522         free(params);
 523         cacheexpire(sessioncache, &lastexpiry);
 524     }
 525 }
 526
 527 int dtlsconnect(struct server *server, struct timeval *when, int timeout, char *text) {
 528     struct timeval now;
 529     time_t elapsed;
 530     X509 *cert;
 531     SSL_CTX *ctx = NULL;
 532
 533     debug(DBG_DBG, "dtlsconnect: called from %s", text);
 534     pthread_mutex_lock(&server->lock);
 535     if (when && memcmp(&server->lastconnecttry, when, sizeof(struct timeval))) {
 536         /* already reconnected, nothing to do */
 537         debug(DBG_DBG, "dtlsconnect(%s): seems already reconnected", text);
 538         pthread_mutex_unlock(&server->lock);
 539         return 1;
 540     }
 541
 542     for (;;) {
 543         gettimeofday(&now, NULL);
 544         elapsed = now.tv_sec - server->lastconnecttry.tv_sec;
 545
 546         if (timeout && server->lastconnecttry.tv_sec && elapsed > timeout) {
 547             debug(DBG_DBG, "dtlsconnect: timeout");
 548             SSL_free(server->ssl);
 549             server->ssl = NULL;
 550             pthread_mutex_unlock(&server->lock);
 551             return 0;
 552         }
 553
 554         if (server->connectionok) {
 555             server->connectionok = 0;
 556             sleep(2);
 557         } else if (elapsed < 1)
 558             sleep(2);
 559         else if (elapsed < 60) {
 560             debug(DBG_INFO, "dtlsconnect: sleeping %lds", elapsed);
 561             sleep(elapsed);
 562         } else if (elapsed < 100000) {
 563             debug(DBG_INFO, "dtlsconnect: sleeping %ds", 60);
 564             sleep(60);
 565         } else
 566             server->lastconnecttry.tv_sec = now.tv_sec;  /* no sleep at startup */
 567         debug(DBG_WARN, "dtlsconnect: trying to open DTLS connection to %s port %s", server->conf->host, server->conf->port);
 568
 569         SSL_free(server->ssl);
 570         server->ssl = NULL;
 571         ctx = tlsgetctx(handle, server->conf->tlsconf);
 572         if (!ctx)
 573             continue;
 574         server->ssl = dtlsacccon(0, ctx, server->sock, server->conf->addrinfo->ai_addr, server->rbios);
 575         if (!server->ssl)
 576             continue;
 577         debug(DBG_DBG, "dtlsconnect: DTLS: ok");
 578
 579         cert = verifytlscert(server->ssl);
 580         if (!cert)
 581             continue;
 582
 583         if (verifyconfcert(cert, server->conf))
 584             break;
 585         X509_free(cert);
 586     }
 587     X509_free(cert);
 588     debug(DBG_WARN, "dtlsconnect: DTLS connection to %s port %s up", server->conf->host, server->conf->port);
 589     server->connectionok = 1;
 590     gettimeofday(&server->lastconnecttry, NULL);
 591     pthread_mutex_unlock(&server->lock);
 592     return 1;
 593 }
 594
 595 int clientradputdtls(struct server *server, unsigned char *rad) {
 596     int cnt;
 597     size_t len;
 598     unsigned long error;
 599     struct clsrvconf *conf = server->conf;
 600
 601     if (!server->connectionok)
 602         return 0;
 603     len = RADLEN(rad);
 604     if ((cnt = SSL_write(server->ssl, rad, len)) <= 0) {
 605         while ((error = ERR_get_error()))
 606             debug(DBG_ERR, "clientradputdtls: DTLS: %s", ERR_error_string(error, NULL));
 607         return 0;
 608     }
 609     debug(DBG_DBG, "clientradputdtls: Sent %d bytes, Radius packet of length %d to DTLS peer %s", cnt, len, conf->host);
 610     return 1;
 611 }
 612
 613 /* reads UDP containing DTLS and passes it on to dtlsclientrd */
 614 void *udpdtlsclientrd(void *arg) {
 615     int cnt, s = *(int *)arg;
 616     unsigned char buf[4];
 617     struct sockaddr_storage from;
 618     socklen_t fromlen = sizeof(from);
 619     struct clsrvconf *conf;
 620     fd_set readfds;
 621
 622     for (;;) {
 623         FD_ZERO(&readfds);
 624         FD_SET(s, &readfds);
 625         if (select(s + 1, &readfds, NULL, NULL, NULL) < 1)
 626             continue;
 627         cnt = recvfrom(s, buf, 4, MSG_PEEK | MSG_TRUNC, (struct sockaddr *)&from, &fromlen);
 628         if (cnt == -1) {
 629             debug(DBG_WARN, "udpdtlsclientrd: recv failed");
 630             continue;
 631         }
 632
 633         conf = find_srvconf(handle, (struct sockaddr *)&from, NULL);
 634         if (!conf) {
 635             debug(DBG_WARN, "udpdtlsclientrd: got packet from wrong or unknown DTLS peer %s, ignoring", addr2string((struct sockaddr *)&from));
 636             recv(s, buf, 4, 0);
 637             continue;
 638         }
 639         if (udp2bio(s, conf->servers->rbios, cnt))
 640             debug(DBG_DBG, "radudpget: got DTLS in UDP from %s", addr2string((struct sockaddr *)&from));
 641     }
 642 }
 643
 644 void *dtlsclientrd(void *arg) {
 645     struct server *server = (struct server *)arg;
 646     unsigned char *buf;
 647     struct timeval lastconnecttry;
 648     int secs;
 649
 650     for (;;) {
 651         /* yes, lastconnecttry is really necessary */
 652         lastconnecttry = server->lastconnecttry;
 653         for (secs = 0; !(buf = raddtlsget(server->ssl, server->rbios, 10)) && !server->lostrqs && secs < IDLE_TIMEOUT; secs += 10);
 654         if (!buf) {
 655             dtlsconnect(server, &lastconnecttry, 0, "dtlsclientrd");
 656             continue;
 657         }
 658         replyh(server, buf);
 659     }
 660     ERR_remove_state(0);
 661     server->clientrdgone = 1;
 662     return NULL;
 663 }
 664
 665 void addserverextradtls(struct clsrvconf *conf) {
 666     switch (conf->addrinfo->ai_family) {
 667     case AF_INET:
 668         if (client4_sock < 0) {
 669             client4_sock = bindtoaddr(srcres, AF_INET, 0, 1);
 670             if (client4_sock < 0)
 671                 debugx(1, DBG_ERR, "addserver: failed to create client socket for server %s", conf->host);
 672         }
 673         conf->servers->sock = client4_sock;
 674         break;
 675     case AF_INET6:
 676         if (client6_sock < 0) {
 677             client6_sock = bindtoaddr(srcres, AF_INET6, 0, 1);
 678             if (client6_sock < 0)
 679                 debugx(1, DBG_ERR, "addserver: failed to create client socket for server %s", conf->host);
 680         }
 681         conf->servers->sock = client6_sock;
 682         break;
 683     default:
 684         debugx(1, DBG_ERR, "addserver: unsupported address family");
 685     }
 686 }
 687
 688 void initextradtls() {
 689     pthread_t cl4th, cl6th;
 690
 691     if (srcres) {
 692         freeaddrinfo(srcres);
 693         srcres = NULL;
 694     }
 695
 696     if (client4_sock >= 0)
 697         if (pthread_create(&cl4th, NULL, udpdtlsclientrd, (void *)&client4_sock))
 698             debugx(1, DBG_ERR, "pthread_create failed");
 699     if (client6_sock >= 0)
 700         if (pthread_create(&cl6th, NULL, udpdtlsclientrd, (void *)&client6_sock))
 701             debugx(1, DBG_ERR, "pthread_create failed");
 702 }