dtls.c

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