dtls.c

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