radsecproxy.c 133 KB
Newer Older
venaas's avatar
 
venaas committed
1
/*
2
 * Copyright (C) 2006-2008 Stig Venaas <venaas@uninett.no>
venaas's avatar
 
venaas committed
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 */

/* For UDP there is one server instance consisting of udpserverrd and udpserverth
 *              rd is responsible for init and launching wr
 * For TLS there is a server instance that launches tlsserverrd for each TLS peer
 *          each tlsserverrd launches tlsserverwr
 * For each UDP/TLS peer there is clientrd and clientwr, clientwr is responsible
 *          for init and launching rd
 *
 * serverrd will receive a request, processes it and puts it in the requestq of
 *          the appropriate clientwr
 * clientwr monitors its requestq and sends requests
 * clientrd looks for responses, processes them and puts them in the replyq of
 *          the peer the request came from
 * serverwr monitors its reply and sends replies
 *
 * In addition to the main thread, we have:
 * If UDP peers are configured, there will be 2 + 2 * #peers UDP threads
 * If TLS peers are configured, there will initially be 2 * #peers TLS threads
 * For each TLS peer connecting to us there will be 2 more TLS threads
 *       This is only for connected peers
 * Example: With 3 UDP peer and 30 TLS peers, there will be a max of
 *          1 + (2 + 2 * 3) + (2 * 30) + (2 * 30) = 129 threads
*/

venaas's avatar
venaas committed
32
/* Bugs:
33
 * TCP accounting not yet supported
venaas's avatar
venaas committed
34
35
36
 * We are not removing client requests from dynamic servers, see removeclientrqs()
 */

venaas's avatar
venaas committed
37
#include <signal.h>
venaas's avatar
venaas committed
38
39
#include <sys/socket.h>
#include <netinet/in.h>
venaas's avatar
 
venaas committed
40
#include <netdb.h>
venaas's avatar
venaas committed
41
#include <string.h>
venaas's avatar
 
venaas committed
42
#include <unistd.h>
venaas's avatar
venaas committed
43
#include <limits.h>
venaas's avatar
venaas committed
44
45
46
#ifdef SYS_SOLARIS9
#include <fcntl.h>
#endif
venaas's avatar
venaas committed
47
#include <sys/time.h>
48
#include <sys/types.h>
49
#include <sys/select.h>
50
#include <ctype.h>
51
#include <sys/wait.h>
52
#include <arpa/inet.h>
venaas's avatar
venaas committed
53
#include <regex.h>
venaas's avatar
venaas committed
54
#include <libgen.h>
venaas's avatar
 
venaas committed
55
56
57
58
59
#include <pthread.h>
#include <openssl/ssl.h>
#include <openssl/rand.h>
#include <openssl/err.h>
#include <openssl/md5.h>
venaas's avatar
venaas committed
60
#include <openssl/hmac.h>
61
#include <openssl/x509v3.h>
venaas's avatar
venaas committed
62
#include "debug.h"
venaas's avatar
venaas committed
63
#include "list.h"
64
65
#include "util.h"
#include "gconfig.h"
venaas's avatar
venaas committed
66
#include "radsecproxy.h"
venaas's avatar
 
venaas committed
67

68
static struct options options;
69
struct list *clconfs, *srvconfs, *realms, *tlsconfs, *rewriteconfs;
70

venaas's avatar
venaas committed
71
static struct addrinfo *srcprotores[3] = { NULL, NULL, NULL };
72

73
static struct queue *udp_server_replyq = NULL;
74
75
static int udp_client4_sock = -1;
static int udp_client6_sock = -1;
venaas's avatar
venaas committed
76
77
static pthread_mutex_t tlsconfs_lock;
static pthread_mutex_t *ssl_locks = NULL;
venaas's avatar
 
venaas committed
78
79
80
81
static long *ssl_lock_count;
extern int optind;
extern char *optarg;

venaas's avatar
venaas committed
82
83
/* minimum required declarations to avoid reordering code */
void adddynamicrealmserver(struct realm *realm, struct clsrvconf *conf, char *id);
84
int dynamicconfig(struct server *server);
85
int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val);
86
87
void freerealm(struct realm *realm);
void freeclsrvconf(struct clsrvconf *conf);
88
void freerqdata(struct request *rq);
89
90
91
void *udpserverrd(void *arg);
void *tlslistener(void *arg);
void *tcplistener(void *arg);
venaas's avatar
venaas committed
92
int tlsconnect(struct server *server, struct timeval *when, int timeout, char *text);
93
94
int dtlsconnect(struct server *server, struct timeval *when, int timeout, char *text);
void *dtlsservernew(void *arg);
venaas's avatar
venaas committed
95
96
97
int tcpconnect(struct server *server, struct timeval *when, int timeout, char *text);
void *udpclientrd(void *arg);
void *tlsclientrd(void *arg);
98
void *dtlsclientrd(void *arg);
venaas's avatar
venaas committed
99
100
101
void *tcpclientrd(void *arg);
int clientradputudp(struct server *server, unsigned char *rad);
int clientradputtls(struct server *server, unsigned char *rad);
102
int clientradputdtls(struct server *server, unsigned char *rad);
venaas's avatar
venaas committed
103
int clientradputtcp(struct server *server, unsigned char *rad);
104
105
106
X509 *verifytlscert(SSL *ssl);
int radsrv(struct request *rq);

107
static const struct protodefs protodefs[] = {
venaas's avatar
venaas committed
108
109
    {   "udp", /* UDP, assuming RAD_UDP defined as 0 */
	NULL, /* secretdefault */
venaas's avatar
venaas committed
110
111
	SOCK_DGRAM, /* socktype */
	"1812", /* portdefault */
112
113
114
	REQUEST_RETRY_COUNT, /* retrycountdefault */
	10, /* retrycountmax */
	REQUEST_RETRY_INTERVAL, /* retryintervaldefault */
115
	60, /* retryintervalmax */
venaas's avatar
venaas committed
116
117
118
119
120
	udpserverrd, /* listener */
	&options.sourceudp, /* srcaddrport */
	NULL, /* connecter */
	udpclientrd, /* clientreader */
	clientradputudp /* clientradput */
121
    },
venaas's avatar
venaas committed
122
123
    {   "tls", /* TLS, assuming RAD_TLS defined as 1 */
	"mysecret", /* secretdefault */
venaas's avatar
venaas committed
124
125
	SOCK_STREAM, /* socktype */
	"2083", /* portdefault */
venaas's avatar
venaas committed
126
127
128
	0, /* retrycountdefault */
	0, /* retrycountmax */
	REQUEST_RETRY_INTERVAL * REQUEST_RETRY_COUNT, /* retryintervaldefault */
129
	60, /* retryintervalmax */
venaas's avatar
venaas committed
130
131
132
133
134
	tlslistener, /* listener */
	&options.sourcetls, /* srcaddrport */
	tlsconnect, /* connecter */
	tlsclientrd, /* clientreader */
	clientradputtls /* clientradput */
venaas's avatar
venaas committed
135
136
137
    },
    {   "tcp", /* TCP, assuming RAD_TCP defined as 2 */
	NULL, /* secretdefault */
venaas's avatar
venaas committed
138
139
	SOCK_STREAM, /* socktype */
	"1812", /* portdefault */
140
141
142
	0, /* retrycountdefault */
	0, /* retrycountmax */
	REQUEST_RETRY_INTERVAL * REQUEST_RETRY_COUNT, /* retryintervaldefault */
143
	60, /* retryintervalmax */
venaas's avatar
venaas committed
144
145
146
147
148
	tcplistener, /* listener */
	&options.sourcetcp, /* srcaddrport */
	tcpconnect, /* connecter */
	tcpclientrd, /* clientreader */
	clientradputtcp /* clientradput */
venaas's avatar
venaas committed
149
    },
venaas's avatar
venaas committed
150
151
152
153
154
155
156
157
    {   "dtls", /* DTLS, assuming RAD_DTLS defined as 3 */
	NULL, /* secretdefault */
	SOCK_DGRAM, /* socktype */
	"1812", /* portdefault */
	REQUEST_RETRY_COUNT, /* retrycountdefault */
	10, /* retrycountmax */
	REQUEST_RETRY_INTERVAL, /* retryintervaldefault */
	60, /* retryintervalmax */
158
	NULL, /* listener */
venaas's avatar
venaas committed
159
	&options.sourceudp, /* srcaddrport */
160
	dtlsconnect, /* connecter */
161
162
	dtlsclientrd, /* clientreader */
	clientradputdtls /* clientradput */
venaas's avatar
venaas committed
163
    },
venaas's avatar
venaas committed
164
    {   NULL
165
166
167
    }
};

venaas's avatar
venaas committed
168
169
170
171
172
173
174
uint8_t protoname2int(const char *name) {
    int i;

    for (i = 0; protodefs[i].name && strcasecmp(protodefs[i].name, name); i++);
    return i;
}
    
venaas's avatar
 
venaas committed
175
176
177
/* callbacks for making OpenSSL thread safe */
unsigned long ssl_thread_id() {
        return (unsigned long)pthread_self();
venaas's avatar
venaas committed
178
}
venaas's avatar
 
venaas committed
179
180
181
182
183
184
185
186
187

void ssl_locking_callback(int mode, int type, const char *file, int line) {
    if (mode & CRYPTO_LOCK) {
	pthread_mutex_lock(&ssl_locks[type]);
	ssl_lock_count[type]++;
    } else
	pthread_mutex_unlock(&ssl_locks[type]);
}

venaas's avatar
venaas committed
188
189
190
191
192
193
194
195
static int pem_passwd_cb(char *buf, int size, int rwflag, void *userdata) {
    int pwdlen = strlen(userdata);
    if (rwflag != 0 || pwdlen > size) /* not for decryption or too large */
	return 0;
    memcpy(buf, userdata, pwdlen);
    return pwdlen;
}

196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
static int verify_cb(int ok, X509_STORE_CTX *ctx) {
  char buf[256];
  X509 *err_cert;
  int err, depth;

  err_cert = X509_STORE_CTX_get_current_cert(ctx);
  err = X509_STORE_CTX_get_error(ctx);
  depth = X509_STORE_CTX_get_error_depth(ctx);

  if (depth > MAX_CERT_DEPTH) {
      ok = 0;
      err = X509_V_ERR_CERT_CHAIN_TOO_LONG;
      X509_STORE_CTX_set_error(ctx, err);
  }

  if (!ok) {
      X509_NAME_oneline(X509_get_subject_name(err_cert), buf, 256);
213
      debug(DBG_WARN, "verify error: num=%d:%s:depth=%d:%s", err, X509_verify_cert_error_string(err), depth, buf);
214
215
216
217

      switch (err) {
      case X509_V_ERR_UNABLE_TO_GET_ISSUER_CERT:
	  X509_NAME_oneline(X509_get_issuer_name(ctx->current_cert), buf, 256);
218
	  debug(DBG_WARN, "\tIssuer=%s", buf);
219
220
221
	  break;
      case X509_V_ERR_CERT_NOT_YET_VALID:
      case X509_V_ERR_ERROR_IN_CERT_NOT_BEFORE_FIELD:
222
	  debug(DBG_WARN, "\tCertificate not yet valid");
223
224
	  break;
      case X509_V_ERR_CERT_HAS_EXPIRED:
225
	  debug(DBG_WARN, "Certificate has expired");
226
227
	  break;
      case X509_V_ERR_ERROR_IN_CERT_NOT_AFTER_FIELD:
228
	  debug(DBG_WARN, "Certificate no longer valid (after notAfter)");
229
230
231
	  break;
      }
  }
232
233
234
#ifdef DEBUG  
  printf("certificate verify returns %d\n", ok);
#endif  
235
236
237
  return ok;
}

venaas's avatar
venaas committed
238
int resolvepeer(struct clsrvconf *conf, int ai_flags) {
239
    struct addrinfo hints, *addrinfo, *res;
240
    char *slash, *s;
venaas's avatar
venaas committed
241
    int plen = 0;
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261

    slash = conf->host ? strchr(conf->host, '/') : NULL;
    if (slash) {
	s = slash + 1;
	if (!*s) {
	    debug(DBG_WARN, "resolvepeer: prefix length must be specified after the / in %s", conf->host);
	    return 0;
	}
	for (; *s; s++)
	    if (*s < '0' || *s > '9') {
		debug(DBG_WARN, "resolvepeer: %s in %s is not a valid prefix length", slash + 1, conf->host);
		return 0;
	    }
	plen = atoi(slash + 1);
	if (plen < 0 || plen > 128) {
	    debug(DBG_WARN, "resolvepeer: %s in %s is not a valid prefix length", slash + 1, conf->host);
	    return 0;
	}
	*slash = '\0';
    }
venaas's avatar
 
venaas committed
262
    memset(&hints, 0, sizeof(hints));
venaas's avatar
venaas committed
263
    hints.ai_socktype = conf->pdef->socktype;
venaas's avatar
 
venaas committed
264
    hints.ai_family = AF_UNSPEC;
venaas's avatar
venaas committed
265
    hints.ai_flags = ai_flags;
266
267
    if (!conf->host && !conf->port) {
	/* getaddrinfo() doesn't like host and port to be NULL */
venaas's avatar
venaas committed
268
	if (getaddrinfo(conf->host, conf->pdef->portdefault, &hints, &addrinfo)) {
269
270
271
272
273
274
275
276
277
278
279
	    debug(DBG_WARN, "resolvepeer: can't resolve (null) port (null)");
	    return 0;
	}
	for (res = addrinfo; res; res = res->ai_next) {
	    switch (res->ai_family) {
	    case AF_INET:
		((struct sockaddr_in *)res->ai_addr)->sin_port = 0;
		break;
	    case AF_INET6:
		((struct sockaddr_in6 *)res->ai_addr)->sin6_port = 0;
		break;
280
	    }
281
282
283
284
285
	}
    } else {
	if (slash)
	    hints.ai_flags |= AI_NUMERICHOST;
	if (getaddrinfo(conf->host, conf->port, &hints, &addrinfo)) {
286
	    debug(DBG_WARN, "resolvepeer: can't resolve %s port %s", conf->host ? conf->host : "(null)", conf->port ? conf->port : "(null)");
287
288
	    return 0;
	}
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
	if (slash) {
	    *slash = '/';
	    switch (addrinfo->ai_family) {
	    case AF_INET:
		if (plen > 32) {
		    debug(DBG_WARN, "resolvepeer: prefix length must be <= 32 in %s", conf->host);
		    freeaddrinfo(addrinfo);
		    return 0;
		}
		break;
	    case AF_INET6:
		break;
	    default:
		debug(DBG_WARN, "resolvepeer: prefix must be IPv4 or IPv6 in %s", conf->host);
		freeaddrinfo(addrinfo);
		return 0;
	    }
	    conf->prefixlen = plen;
	} else
	    conf->prefixlen = 255;
    }
venaas's avatar
venaas committed
310
311
312
    if (conf->addrinfo)
	freeaddrinfo(conf->addrinfo);
    conf->addrinfo = addrinfo;
venaas's avatar
 
venaas committed
313
314
315
    return 1;
}	  

316
317
int bindtoaddr(struct addrinfo *addrinfo, int family, int reuse, int v6only) {
    int s, on = 1;
venaas's avatar
 
venaas committed
318
    struct addrinfo *res;
319
    
320
    for (res = addrinfo; res; res = res->ai_next) {
321
322
	if (family != AF_UNSPEC && family != res->ai_family)
	    continue;
venaas's avatar
 
venaas committed
323
324
        s = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
        if (s < 0) {
325
            debug(DBG_WARN, "bindtoaddr: socket failed");
venaas's avatar
 
venaas committed
326
327
            continue;
        }
328
329
330
331
332
333
334
335
336
337
	if (reuse)
	    setsockopt(s, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
#ifdef IPV6_V6ONLY
	if (v6only)
	    setsockopt(s, IPPROTO_IPV6, IPV6_V6ONLY, &on, sizeof(on));
#endif		

	if (!bind(s, res->ai_addr, res->ai_addrlen))
	    return s;
	debug(DBG_WARN, "bindtoaddr: bind failed");
venaas's avatar
 
venaas committed
338
339
        close(s);
    }
340
    return -1;
venaas's avatar
 
venaas committed
341
342
}	  

343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
char *parsehostport(char *s, struct clsrvconf *conf, char *default_port) {
    char *p, *field;
    int ipv6 = 0;

    p = s;
    /* allow literal addresses and port, e.g. [2001:db8::1]:1812 */
    if (*p == '[') {
	p++;
	field = p;
	for (; *p && *p != ']' && *p != ' ' && *p != '\t' && *p != '\n'; p++);
	if (*p != ']')
	    debugx(1, DBG_ERR, "no ] matching initial [");
	ipv6 = 1;
    } else {
	field = p;
	for (; *p && *p != ':' && *p != ' ' && *p != '\t' && *p != '\n'; p++);
    }
    if (field == p)
	debugx(1, DBG_ERR, "missing host/address");

    conf->host = stringcopy(field, p - field);
    if (ipv6) {
	p++;
	if (*p && *p != ':' && *p != ' ' && *p != '\t' && *p != '\n')
	    debugx(1, DBG_ERR, "unexpected character after ]");
    }
    if (*p == ':') {
	    /* port number or service name is specified */;
	    field = ++p;
	    for (; *p && *p != ' ' && *p != '\t' && *p != '\n'; p++);
	    if (field == p)
		debugx(1, DBG_ERR, "syntax error, : but no following port");
	    conf->port = stringcopy(field, p - field);
    } else
	conf->port = default_port ? stringcopy(default_port, 0) : NULL;
    return p;
}

venaas's avatar
venaas committed
381
struct clsrvconf *resolve_hostport(uint8_t type, char *lconf, char *default_port) {
382
383
384
385
386
387
388
    struct clsrvconf *conf;

    conf = malloc(sizeof(struct clsrvconf));
    if (!conf)
	debugx(1, DBG_ERR, "malloc failed");
    memset(conf, 0, sizeof(struct clsrvconf));
    conf->type = type;
venaas's avatar
venaas committed
389
    conf->pdef = &protodefs[conf->type];
390
391
392
393
394
395
396
397
398
    if (lconf) {
	parsehostport(lconf, conf, default_port);
	if (!strcmp(conf->host, "*")) {
	    free(conf->host);
	    conf->host = NULL;
	}
    } else
	conf->port = default_port ? stringcopy(default_port, 0) : NULL;
    if (!resolvepeer(conf, AI_PASSIVE))
399
	debugx(1, DBG_ERR, "failed to resolve host %s port %s, exiting", conf->host ? conf->host : "(null)", conf->port ? conf->port : "(null)");
400
401
402
    return conf;
}

403
404
405
406
407
408
409
410
void freeclsrvres(struct clsrvconf *res) {
    free(res->host);
    free(res->port);
    if (res->addrinfo)
	freeaddrinfo(res->addrinfo);
    free(res);
}

venaas's avatar
venaas committed
411
int connecttcp(struct addrinfo *addrinfo, struct addrinfo *src) {
412
    int s;
venaas's avatar
venaas committed
413
    struct addrinfo *res;
414
415

    s = -1;
venaas's avatar
venaas committed
416
    for (res = addrinfo; res; res = res->ai_next) {
venaas's avatar
venaas committed
417
	s = bindtoaddr(src, res->ai_family, 1, 1);
venaas's avatar
venaas committed
418
        if (s < 0) {
419
            debug(DBG_WARN, "connecttoserver: socket failed");
venaas's avatar
venaas committed
420
421
            continue;
        }
422
423
424
        if (connect(s, res->ai_addr, res->ai_addrlen) == 0)
            break;
        debug(DBG_WARN, "connecttoserver: connect failed");
venaas's avatar
venaas committed
425
        close(s);
426
        s = -1;
venaas's avatar
venaas committed
427
    }
428
    return s;
venaas's avatar
venaas committed
429
430
}	  

431
432
433
434
435
436
437
438
439
440
441
442
/* returns 1 if the len first bits are equal, else 0 */
int prefixmatch(void *a1, void *a2, uint8_t len) {
    static uint8_t mask[] = { 0, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe };
    int r, l = len / 8;
    if (l && memcmp(a1, a2, l))
	return 0;
    r = len % 8;
    if (!r)
	return 1;
    return (((uint8_t *)a1)[l] & mask[r]) == (((uint8_t *)a2)[l] & mask[r]);
}

443
/* returns next config with matching address, or NULL */
venaas's avatar
venaas committed
444
struct clsrvconf *find_conf(uint8_t type, struct sockaddr *addr, struct list *confs, struct list_node **cur) {
445
446
447
448
449
450
451
452
453
454
455
456
457
458
    struct sockaddr_in6 *sa6 = NULL;
    struct in_addr *a4 = NULL;
    struct addrinfo *res;
    struct list_node *entry;
    struct clsrvconf *conf;
    
    if (addr->sa_family == AF_INET6) {
        sa6 = (struct sockaddr_in6 *)addr;
        if (IN6_IS_ADDR_V4MAPPED(&sa6->sin6_addr)) {
            a4 = (struct in_addr *)&sa6->sin6_addr.s6_addr[12];
	    sa6 = NULL;
	}
    } else
	a4 = &((struct sockaddr_in *)addr)->sin_addr;
venaas's avatar
venaas committed
459

venaas's avatar
venaas committed
460
    for (entry = (cur && *cur ? list_next(*cur) : list_first(confs)); entry; entry = list_next(entry)) {
venaas's avatar
venaas committed
461
	conf = (struct clsrvconf *)entry->data;
462
463
464
465
466
467
	if (conf->type == type) {
	    if (conf->prefixlen == 255) {
		for (res = conf->addrinfo; res; res = res->ai_next)
		    if ((a4 && res->ai_family == AF_INET &&
			 !memcmp(a4, &((struct sockaddr_in *)res->ai_addr)->sin_addr, 4)) ||
			(sa6 && res->ai_family == AF_INET6 &&
468
469
470
			 !memcmp(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, 16))) {
			if (cur)
			    *cur = entry;
471
			return conf;
472
		    }
473
474
475
476
477
478
	    } else {
		res = conf->addrinfo;
		if (res &&
		    ((a4 && res->ai_family == AF_INET &&
		      prefixmatch(a4, &((struct sockaddr_in *)res->ai_addr)->sin_addr, conf->prefixlen)) ||
		     (sa6 && res->ai_family == AF_INET6 &&
479
480
481
		      prefixmatch(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, conf->prefixlen)))) {
		    if (cur)
			*cur = entry;
venaas's avatar
venaas committed
482
		    return conf;
483
		}
484
485
	    }
	}
venaas's avatar
venaas committed
486
    }    
venaas's avatar
venaas committed
487
488
489
    return NULL;
}

venaas's avatar
venaas committed
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
/* returns next config of given type, or NULL */
struct clsrvconf *find_conf_type(uint8_t type, struct list *confs, struct list_node **cur) {
    struct list_node *entry;
    struct clsrvconf *conf;
    
    for (entry = (cur && *cur ? list_next(*cur) : list_first(confs)); entry; entry = list_next(entry)) {
	conf = (struct clsrvconf *)entry->data;
	if (conf->type == type) {
	    if (cur)
		*cur = entry;
	    return conf;
	}
    }    
    return NULL;
}

506
507
struct queue *newqueue() {
    struct queue *q;
508
    
509
510
    q = malloc(sizeof(struct queue));
    if (!q)
511
	debugx(1, DBG_ERR, "malloc failed");
512
513
    q->entries = list_create();
    if (!q->entries)
514
	debugx(1, DBG_ERR, "malloc failed");
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
    pthread_mutex_init(&q->mutex, NULL);
    pthread_cond_init(&q->cond, NULL);
    return q;
}

void removequeue(struct queue *q) {
    struct list_node *entry;
    
    pthread_mutex_lock(&q->mutex);
    for (entry = list_first(q->entries); entry; entry = list_next(entry))
	free(((struct reply *)entry)->buf);
    list_destroy(q->entries);
    pthread_cond_destroy(&q->cond);
    pthread_mutex_unlock(&q->mutex);
    pthread_mutex_destroy(&q->mutex);
}

void freebios(struct queue *q) {
    BIO *bio;
    
    pthread_mutex_lock(&q->mutex);
    while ((bio = (BIO *)list_shift(q->entries)))
	BIO_free(bio);
    pthread_mutex_unlock(&q->mutex);
    removequeue(q);
540
541
}

542
543
544
545
546
547
struct client *addclient(struct clsrvconf *conf) {
    struct client *new = malloc(sizeof(struct client));
    
    if (!new) {
	debug(DBG_ERR, "malloc failed");
	return NULL;
548
549
    }
    if (!conf->clients) {
550
551
552
553
554
	conf->clients = list_create();
	if (!conf->clients) {
	    debug(DBG_ERR, "malloc failed");
	    return NULL;
	}
555
    }
556
557
558
    
    memset(new, 0, sizeof(struct client));
    new->conf = conf;
559
560
561
    new->replyq = conf->type == RAD_UDP ? udp_server_replyq : newqueue();
    if (conf->type == RAD_DTLS)
	new->rbios = newqueue();
562
563
564
565
566
567
568
    list_push(conf->clients, new);
    return new;
}

void removeclient(struct client *client) {
    if (!client || !client->conf->clients)
	return;
569
570
571
    removequeue(client->replyq);
    if (client->rbios)
	freebios(client->rbios);
572
573
    list_removedata(client->conf->clients, client);
    free(client);
574
575
}

576
577
578
579
580
581
582
583
void removeclientrqs(struct client *client) {
    struct list_node *entry;
    struct server *server;
    struct request *rq;
    int i;
    
    for (entry = list_first(srvconfs); entry; entry = list_next(entry)) {
	server = ((struct clsrvconf *)entry->data)->servers;
584
585
	if (!server)
	    continue;
586
587
588
589
590
591
592
593
594
	pthread_mutex_lock(&server->newrq_mutex);
	for (i = 0; i < MAX_REQUESTS; i++) {
	    rq = server->requests + i;
	    if (rq->from == client)
		rq->from = NULL;
	}
	pthread_mutex_unlock(&server->newrq_mutex);
    }
}
venaas's avatar
venaas committed
595
596

void freeserver(struct server *server, uint8_t destroymutex) {
597
598
    struct request *rq, *end;

venaas's avatar
venaas committed
599
600
    if (!server)
	return;
601

602
    if (server->requests) {
603
604
605
606
607
	rq = server->requests;
	for (end = rq + MAX_REQUESTS; rq < end; rq++)
	    freerqdata(rq);
	free(server->requests);
    }
608
609
    if (server->rbios)
	freebios(server->rbios);
610
    free(server->dynamiclookuparg);
venaas's avatar
venaas committed
611
612
613
614
615
616
617
618
619
620
    if (destroymutex) {
	pthread_mutex_destroy(&server->lock);
	pthread_cond_destroy(&server->newrq_cond);
	pthread_mutex_destroy(&server->newrq_mutex);
    }
    free(server);
}

int addserver(struct clsrvconf *conf) {
    struct clsrvconf *res;
venaas's avatar
venaas committed
621
    uint8_t type;
622
    
venaas's avatar
venaas committed
623
624
625
626
    if (conf->servers) {
	debug(DBG_ERR, "addserver: currently works with just one server per conf");
	return 0;
    }
627
    conf->servers = malloc(sizeof(struct server));
venaas's avatar
venaas committed
628
629
630
631
    if (!conf->servers) {
	debug(DBG_ERR, "malloc failed");
	return 0;
    }
632
633
634
    memset(conf->servers, 0, sizeof(struct server));
    conf->servers->conf = conf;

venaas's avatar
venaas committed
635
    type = conf->type;
636
637
    if (type == RAD_DTLS) {
	conf->servers->rbios = newqueue();
venaas's avatar
venaas committed
638
	type = RAD_UDP;
639
    }
venaas's avatar
venaas committed
640
641
642
643
    
    if (!srcprotores[type]) {
	res = resolve_hostport(type, *conf->pdef->srcaddrport, NULL);
	srcprotores[type] = res->addrinfo;
venaas's avatar
venaas committed
644
645
646
647
	res->addrinfo = NULL;
	freeclsrvres(res);
    }

venaas's avatar
venaas committed
648
    if (type == RAD_UDP) {
649
650
651
	switch (conf->addrinfo->ai_family) {
	case AF_INET:
	    if (udp_client4_sock < 0) {
venaas's avatar
venaas committed
652
		udp_client4_sock = bindtoaddr(srcprotores[RAD_UDP], AF_INET, 0, 1);
653
654
655
656
		if (udp_client4_sock < 0)
		    debugx(1, DBG_ERR, "addserver: failed to create client socket for server %s", conf->host);
	    }
	    conf->servers->sock = udp_client4_sock;
657
	    break;
658
659
	case AF_INET6:
	    if (udp_client6_sock < 0) {
venaas's avatar
venaas committed
660
		udp_client6_sock = bindtoaddr(srcprotores[RAD_UDP], AF_INET6, 0, 1);
661
662
663
664
		if (udp_client6_sock < 0)
		    debugx(1, DBG_ERR, "addserver: failed to create client socket for server %s", conf->host);
	    }
	    conf->servers->sock = udp_client6_sock;
665
	    break;
666
667
668
669
	default:
	    debugx(1, DBG_ERR, "addserver: unsupported address family");
	}
	
venaas's avatar
venaas committed
670
    } else
671
672
	conf->servers->sock = -1;
    
673
    conf->servers->requests = calloc(MAX_REQUESTS, sizeof(struct request));
venaas's avatar
venaas committed
674
675
676
677
678
679
680
681
    if (!conf->servers->requests) {
	debug(DBG_ERR, "malloc failed");
	goto errexit;
    }
    if (pthread_mutex_init(&conf->servers->lock, NULL)) {
	debug(DBG_ERR, "mutex init failed");
	goto errexit;
    }
682
    conf->servers->newrq = 0;
venaas's avatar
venaas committed
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
    if (pthread_mutex_init(&conf->servers->newrq_mutex, NULL)) {
	debug(DBG_ERR, "mutex init failed");
	pthread_mutex_destroy(&conf->servers->lock);
	goto errexit;
    }
    if (pthread_cond_init(&conf->servers->newrq_cond, NULL)) {
	debug(DBG_ERR, "mutex init failed");
	pthread_mutex_destroy(&conf->servers->newrq_mutex);
	pthread_mutex_destroy(&conf->servers->lock);
	goto errexit;
    }

    return 1;
    
 errexit:
    freeserver(conf->servers, 0);
    conf->servers = NULL;
    return 0;
701
702
}

703
704
705
706
707
708
int udp2bio(int s, struct queue *q, int cnt) {
    unsigned char *buf;
    BIO *rbio;

    if (cnt < 1)
	return 0;
709
710
711
    
    buf = malloc(cnt);
    if (!buf) {
712
713
714
715
	debug(DBG_ERR, "udp2bio: malloc failed");
	/* is this ok? */
	recv(s, NULL, 0, 0);
	return 0;
716
717
718
    }

    cnt = recv(s, buf, cnt, 0);
719
720
    if (cnt < 1) {
	debug(DBG_WARN, "udp2bio: recv failed");
721
	free(buf);
722
	return 0;
723
724
725
726
727
    }

    rbio = BIO_new_mem_buf(buf, cnt);
    BIO_set_mem_eof_return(rbio, -1);

728
729
730
731
732
    pthread_mutex_lock(&q->mutex);
    if (!list_push(q->entries, rbio)) {
	BIO_free(rbio);
	pthread_mutex_unlock(&q->mutex);
	return 0;
733
    }
734
735
736
    pthread_cond_signal(&q->cond);
    pthread_mutex_unlock(&q->mutex);
    return 1;
737
738
}

739
/* exactly one of client and server must be non-NULL */
740
/* return who we received from in *client or *server */
venaas's avatar
 
venaas committed
741
/* return from in sa if not NULL */
742
unsigned char *radudpget(int s, struct client **client, struct server **server, struct sockaddr_storage *sa) {
743
    int cnt, len;
744
    unsigned char buf[4], *rad = NULL;
745
746
747
748
    struct sockaddr_storage from;
    socklen_t fromlen = sizeof(from);
    struct clsrvconf *p;
    struct list_node *node;
749
    fd_set readfds;
750
    pthread_t dtlsserverth;
751
752
    
    for (;;) {
753
754
755
756
	if (rad) {
	    free(rad);
	    rad = NULL;
	}
757
758
759
760
	FD_ZERO(&readfds);
        FD_SET(s, &readfds);
	if (select(s + 1, &readfds, NULL, NULL, NULL) < 1)
	    continue;
761
	cnt = recvfrom(s, buf, 4, MSG_PEEK | MSG_TRUNC, (struct sockaddr *)&from, &fromlen);
762
763
764
765
	if (cnt == -1) {
	    debug(DBG_WARN, "radudpget: recv failed");
	    continue;
	}
766
	
767
	if ((p = find_conf(RAD_UDP, (struct sockaddr *)&from, client ? clconfs : srvconfs, NULL))) {
768
769
770
	    if (cnt >= 20)
		len = RADLEN(buf);
	    if (cnt < 20 || len < 20) {
771
772
773
774
775
776
777
778
779
780
781
		debug(DBG_WARN, "radudpget: length too small");
		recv(s, buf, 4, 0);
		continue;
	    }
	    
	    rad = malloc(len);
	    if (!rad) {
		debug(DBG_ERR, "radudpget: malloc failed");
		recv(s, buf, 4, 0);
		continue;
	    }
782
	
783
784
	    cnt = recv(s, rad, len, MSG_TRUNC);
	    debug(DBG_DBG, "radudpget: got %d bytes from %s", cnt, addr2string((struct sockaddr *)&from, fromlen));
785

786
787
788
789
790
791
792
793
794
795
796
797
798
799
	    if (cnt < len) {
		debug(DBG_WARN, "radudpget: packet smaller than length field in radius header");
		continue;
	    }
	
	    if (cnt > len)
		debug(DBG_DBG, "radudpget: packet was padded with %d bytes", cnt - len);
	} else {
	    p = find_conf(RAD_DTLS, (struct sockaddr *)&from, client ? clconfs : srvconfs, NULL);
	    if (!p) {
		debug(DBG_WARN, "radudpget: got packet from wrong or unknown UDP peer %s, ignoring", addr2string((struct sockaddr *)&from, fromlen));
		recv(s, buf, 4, 0);
		continue;
	    }
800
801
	}
	
802
	if (client) {
803
	    node = list_first(p->clients);
804
805
806
807
	    switch (p->type) {
	    case RAD_UDP:
		*client = node ? (struct client *)node->data : addclient(p);
		if (!*client)
808
		    continue;
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
		break;
	    case RAD_DTLS:
		if (node)
		    *client = (struct client *)node->data;
		else {
		    *client = addclient(p);
		    if (!*client)
			continue;
		    (*client)->sock = s;
		    memcpy(&(*client)->addr, &from, fromlen);
		    if (pthread_create(&dtlsserverth, NULL, dtlsservernew, (void *)*client)) {
			debug(DBG_ERR, "radudpget: pthread_create failed");
			removeclient(*client);
			continue;
		    }
		    pthread_detach(dtlsserverth);
		}
		if (udp2bio(s, (*client)->rbios, cnt))
		    debug(DBG_DBG, "radudpget: got DTLS in UDP from %s", addr2string((struct sockaddr *)&from, fromlen));
		continue;
	    default:
		continue;
831
	    }
832
	} else if (server) {
833
	    *server = p->servers;
834
835
836
837
838
839
	    if (p->type == RAD_DTLS) {
		if (udp2bio(s, (*server)->rbios, cnt))
		    debug(DBG_DBG, "radudpget: got DTLS in UDP from %s", addr2string((struct sockaddr *)&from, fromlen));
		continue;
	    }
	}
840
841
842
843
844
845
846
	break;
    }
    if (sa)
	*sa = from;
    return rad;
}

847
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
int subjectaltnameaddr(X509 *cert, int family, struct in6_addr *addr) {
    int loc, i, l, n, r = 0;
    char *v;
    X509_EXTENSION *ex;
    STACK_OF(GENERAL_NAME) *alt;
    GENERAL_NAME *gn;
    
    debug(DBG_DBG, "subjectaltnameaddr");
    
    loc = X509_get_ext_by_NID(cert, NID_subject_alt_name, -1);
    if (loc < 0)
	return r;
    
    ex = X509_get_ext(cert, loc);
    alt = X509V3_EXT_d2i(ex);
    if (!alt)
	return r;
    
    n = sk_GENERAL_NAME_num(alt);
    for (i = 0; i < n; i++) {
	gn = sk_GENERAL_NAME_value(alt, i);
	if (gn->type != GEN_IPADD)
	    continue;
	r = -1;
	v = (char *)ASN1_STRING_data(gn->d.ia5);
	l = ASN1_STRING_length(gn->d.ia5);
	if (((family == AF_INET && l == sizeof(struct in_addr)) || (family == AF_INET6 && l == sizeof(struct in6_addr)))
	    && !memcmp(v, &addr, l)) {
	    r = 1;
	    break;
	}
    }
    GENERAL_NAMES_free(alt);
    return r;
}

venaas's avatar
venaas committed
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
int cnregexp(X509 *cert, char *exact, regex_t *regex) {
    int loc, l;
    char *v, *s;
    X509_NAME *nm;
    X509_NAME_ENTRY *e;
    ASN1_STRING *t;

    nm = X509_get_subject_name(cert);
    loc = -1;
    for (;;) {
	loc = X509_NAME_get_index_by_NID(nm, NID_commonName, loc);
	if (loc == -1)
	    break;
	e = X509_NAME_get_entry(nm, loc);
	t = X509_NAME_ENTRY_get_data(e);
	v = (char *) ASN1_STRING_data(t);
	l = ASN1_STRING_length(t);
	if (l < 0)
	    continue;
	if (exact) {
	    if (l == strlen(exact) && !strncasecmp(exact, v, l))
		return 1;
	} else {
	    s = stringcopy((char *)v, l);
	    if (!s) {
		debug(DBG_ERR, "malloc failed");
		continue;
	    }
	    if (regexec(regex, s, 0, NULL, 0)) {
		free(s);
		continue;
	    }
	    free(s);
	    return 1;
	}
    }
    return 0;
}

922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
int subjectaltnameregexp(X509 *cert, int type, char *exact,  regex_t *regex) {
    int loc, i, l, n, r = 0;
    char *s, *v;
    X509_EXTENSION *ex;
    STACK_OF(GENERAL_NAME) *alt;
    GENERAL_NAME *gn;
    
    debug(DBG_DBG, "subjectaltnameregexp");
    
    loc = X509_get_ext_by_NID(cert, NID_subject_alt_name, -1);
    if (loc < 0)
	return r;
    
    ex = X509_get_ext(cert, loc);
    alt = X509V3_EXT_d2i(ex);
    if (!alt)
	return r;
    
    n = sk_GENERAL_NAME_num(alt);
    for (i = 0; i < n; i++) {
	gn = sk_GENERAL_NAME_value(alt, i);
	if (gn->type != type)
	    continue;
	r = -1;
	v = (char *)ASN1_STRING_data(gn->d.ia5);
	l = ASN1_STRING_length(gn->d.ia5);
	if (l <= 0)
	    continue;
#ifdef DEBUG
	printfchars(NULL, gn->type == GEN_DNS ? "dns" : "uri", NULL, v, l);
#endif	
	if (exact) {
	    if (memcmp(v, exact, l))
		continue;
	} else {
	    s = stringcopy((char *)v, l);
	    if (!s) {
		debug(DBG_ERR, "malloc failed");
		continue;
	    }
	    if (regexec(regex, s, 0, NULL, 0)) {
		free(s);
		continue;
	    }
	    free(s);
	}
	r = 1;
	break;
    }
    GENERAL_NAMES_free(alt);
    return r;
}

venaas's avatar
venaas committed
975
X509 *verifytlscert(SSL *ssl) {
976
977
    X509 *cert;
    unsigned long error;
978
    
venaas's avatar
venaas committed
979
    if (SSL_get_verify_result(ssl) != X509_V_OK) {
venaas's avatar
venaas committed
980
	debug(DBG_ERR, "verifytlscert: basic validation failed");
981
	while ((error = ERR_get_error()))
venaas's avatar
venaas committed
982
983
	    debug(DBG_ERR, "verifytlscert: TLS: %s", ERR_error_string(error, NULL));
	return NULL;
984
    }
985

venaas's avatar
venaas committed
986
    cert = SSL_get_peer_certificate(ssl);
venaas's avatar
venaas committed
987
988
989
990
991
992
993
994
995
996
    if (!cert)
	debug(DBG_ERR, "verifytlscert: failed to obtain certificate");
    return cert;
}
    
int verifyconfcert(X509 *cert, struct clsrvconf *conf) {
    int r;
    uint8_t type = 0; /* 0 for DNS, AF_INET for IPv4, AF_INET6 for IPv6 */
    struct in6_addr addr;
    
997
    if (conf->certnamecheck && conf->prefixlen == 255) {
998
999
1000
1001
1002
1003
1004
1005
	if (inet_pton(AF_INET, conf->host, &addr))
	    type = AF_INET;
	else if (inet_pton(AF_INET6, conf->host, &addr))
	    type = AF_INET6;

	r = type ? subjectaltnameaddr(cert, type, &addr) : subjectaltnameregexp(cert, GEN_DNS, conf->host, NULL);
	if (r) {
	    if (r < 0) {
venaas's avatar
venaas committed
1006
		debug(DBG_WARN, "verifyconfcert: No subjectaltname matching %s %s", type ? "address" : "host", conf->host);
venaas's avatar
venaas committed
1007
		return 0;
1008
	    }
venaas's avatar
venaas committed
1009
	    debug(DBG_DBG, "verifyconfcert: Found subjectaltname matching %s %s", type ? "address" : "host", conf->host);
1010
	} else {
venaas's avatar
venaas committed
1011
	    if (!cnregexp(cert, conf->host, NULL)) {
venaas's avatar
venaas committed
1012
		debug(DBG_WARN, "verifyconfcert: cn not matching host %s", conf->host);
venaas's avatar
venaas committed
1013
		return 0;
venaas's avatar
venaas committed
1014
	    }		
venaas's avatar
venaas committed
1015
	    debug(DBG_DBG, "verifyconfcert: Found cn matching host %s", conf->host);
venaas's avatar
venaas committed
1016
1017
1018
1019
	}
    }
    if (conf->certcnregex) {
	if (cnregexp(cert, NULL, conf->certcnregex) < 1) {
venaas's avatar
venaas committed
1020
	    debug(DBG_WARN, "verifyconfcert: CN not matching regex");
venaas's avatar
venaas committed
1021
	    return 0;
1022
	}
venaas's avatar
venaas committed
1023
	debug(DBG_DBG, "verifyconfcert: CN matching regex");
1024
1025
    }
    if (conf->certuriregex) {
venaas's avatar
venaas committed
1026
	if (subjectaltnameregexp(cert, GEN_URI, NULL, conf->certuriregex) < 1) {
venaas's avatar
venaas committed
1027
	    debug(DBG_WARN, "verifyconfcert: subjectaltname URI not matching regex");
venaas's avatar
venaas committed
1028
	    return 0;
1029
	}
venaas's avatar
venaas committed
1030
	debug(DBG_DBG, "verifyconfcert: subjectaltname URI matching regex");
1031
    }
1032
    return 1;
1033
1034
}

1035
int tlsconnect(struct server *server, struct timeval *when, int timeout, char *text) {
venaas's avatar
venaas committed
1036
1037
    struct timeval now;
    time_t elapsed;
venaas's avatar
venaas committed
1038
    X509 *cert;
1039
    unsigned long error;
venaas's avatar
venaas committed
1040
    
venaas's avatar
venaas committed
1041
    debug(DBG_DBG, "tlsconnect: called from %s", text);
1042
1043
    pthread_mutex_lock(&server->lock);
    if (when && memcmp(&server->lastconnecttry, when, sizeof(struct timeval))) {
venaas's avatar
 
venaas committed
1044
	/* already reconnected, nothing to do */
venaas's avatar
venaas committed
1045
	debug(DBG_DBG, "tlsconnect(%s): seems already reconnected", text);
1046
	pthread_mutex_unlock(&server->lock);
1047
	return 1;
venaas's avatar
 
venaas committed
1048
1049
1050
    }

    for (;;) {
venaas's avatar
venaas committed
1051
	gettimeofday(&now, NULL);
1052
	elapsed = now.tv_sec - server->lastconnecttry.tv_sec;
1053
1054
1055
1056
1057
	if (timeout && server->lastconnecttry.tv_sec && elapsed > timeout) {
	    debug(DBG_DBG, "tlsconnect: timeout");
	    if (server->sock >= 0)
		close(server->sock);
	    SSL_free(server->ssl);
1058
	    server->ssl = NULL;
1059
1060
1061
	    pthread_mutex_unlock(&server->lock);
	    return 0;
	}
1062
1063
	if (server->connectionok) {
	    server->connectionok = 0;
1064
1065
1066
1067
	    sleep(2);
	} else if (elapsed < 1)
	    sleep(2);
	else if (elapsed < 60) {
venaas's avatar
venaas committed
1068
	    debug(DBG_INFO, "tlsconnect: sleeping %lds", elapsed);
venaas's avatar
venaas committed
1069
	    sleep(elapsed);
venaas's avatar
venaas committed
1070
	} else if (elapsed < 100000) {
1071
1072
	    debug(DBG_INFO, "tlsconnect: sleeping %ds", 60);
	    sleep(60);
venaas's avatar
venaas committed
1073
	} else
venaas's avatar
venaas committed
1074
	    server->lastconnecttry.tv_sec = now.tv_sec;  /* no sleep at startup */
venaas's avatar
venaas committed
1075
	debug(DBG_WARN, "tlsconnect: trying to open TLS connection to %s port %s", server->conf->host, server->conf->port);
1076
1077
	if (server->sock >= 0)
	    close(server->sock);
venaas's avatar
venaas committed
1078
	if ((server->sock = connecttcp(server->conf->addrinfo, srcprotores[RAD_TLS])) < 0) {
1079
	    debug(DBG_ERR, "tlsconnect: connecttcp failed");
venaas's avatar
venaas committed
1080
	    continue;
1081
1082
	}
	
venaas's avatar
venaas committed
1083
	SSL_free(server->ssl);
venaas's avatar
venaas committed
1084
	server->ssl = SSL_new(server->conf->ssl_ctx);
venaas's avatar
venaas committed
1085
	SSL_set_fd(server->ssl, server->sock);
1086
1087
1088
	if (SSL_connect(server->ssl) <= 0) {
	    while ((error = ERR_get_error()))
		debug(DBG_ERR, "tlsconnect: TLS: %s", ERR_error_string(error, NULL));
venaas's avatar
venaas committed
1089
	    continue;
1090
	}
venaas's avatar
venaas committed
1091
1092
1093
1094
1095
	cert = verifytlscert(server->ssl);
	if (!cert)
	    continue;
	if (verifyconfcert(cert, server->conf)) {
	    X509_free(cert);
venaas's avatar
 
venaas committed
1096
	    break;
venaas's avatar
venaas committed
1097
1098
	}
	X509_free(cert);
venaas's avatar
 
venaas committed
1099
    }
venaas's avatar
venaas committed
1100
    debug(DBG_WARN, "tlsconnect: TLS connection to %s port %s up", server->conf->host, server->conf->port);
venaas's avatar
venaas committed
1101
    gettimeofday(&server->lastconnecttry, NULL);
1102
    pthread_mutex_unlock(&server->lock);
1103
    return 1;
venaas's avatar
 
venaas committed
1104
1105
}

1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
void *dtlsserverwr(void *arg) {
    int cnt;
    unsigned long error;
    struct client *client = (struct client *)arg;
    struct queue *replyq;
    struct reply *reply;
    
    debug(DBG_DBG, "dtlsserverwr: starting for %s", client->conf->host);
    replyq = client->replyq;
    for (;;) {
	pthread_mutex_lock(&replyq->mutex);
	while (!list_first(replyq->entries)) {
	    if (client->ssl) {	    
		debug(DBG_DBG, "dtlsserverwr: waiting for signal");
		pthread_cond_wait(&replyq->cond, &replyq->mutex);
		debug(DBG_DBG, "dtlsserverwr: got signal");
	    }
	    if (!client->ssl) {
		/* ssl might have changed while waiting */
		pthread_mutex_unlock(&replyq->mutex);
		debug(DBG_DBG, "dtlsserverwr: exiting as requested");
		ERR_remove_state(0);
		pthread_exit(NULL);
	    }
	}
	reply = (struct reply *)list_shift(replyq->entries);
	pthread_mutex_unlock(&replyq->mutex);
	cnt = SSL_write(client->ssl, reply->buf, RADLEN(reply->buf));
	if (cnt > 0)
	    debug(DBG_DBG, "dtlsserverwr: sent %d bytes, Radius packet of length %d",
		  cnt, RADLEN(reply->buf));
	else
	    while ((error = ERR_get_error()))
		debug(DBG_ERR, "dtlsserverwr: SSL: %s", ERR_error_string(error, NULL));
	free(reply->buf);
	free(reply);
    }
}

BIO *getrbio(SSL *ssl, struct queue *q, int timeout) {
    BIO *rbio;
    struct timeval now;
    struct timespec to;

    pthread_mutex_lock(&q->mutex);
    if (!(rbio = (BIO *)list_shift(q->entries))) {
	if (timeout) {
	    gettimeofday(&now, NULL);
	    memset(&to, 0, sizeof(struct timespec));
	    to.tv_sec = now.tv_sec + timeout;
	    pthread_cond_timedwait(&q->cond, &q->mutex, &to);
	} else
	    pthread_cond_wait(&q->cond, &q->mutex);
	rbio = (BIO *)list_shift(q->entries);
    }
    pthread_mutex_unlock(&q->mutex);
    return rbio;
}

int dtlsread(SSL *ssl, struct queue *q, unsigned char *buf, int num) {
    int len, cnt;

    for (len = 0; len < num; len += cnt) {
	cnt = SSL_read(ssl, buf + len, num - len);
	if (cnt <= 0)
	    switch (cnt = SSL_get_error(ssl, cnt)) {
	    case SSL_ERROR_WANT_READ:
		BIO_free(ssl->rbio);		
		ssl->rbio = getrbio(ssl, q, 0);
		if (!ssl->rbio)
		    return -1;
		cnt = 0;
		continue;
	    case SSL_ERROR_WANT_WRITE:
		cnt = 0;
		continue;
	    case SSL_ERROR_ZERO_RETURN:
		/* remote end sent close_notify, send one back */
		SSL_shutdown(ssl);
		return -1;
	    default:
		return -1;
	    }
    }
    return num;
}

unsigned char *raddtlsget(SSL *ssl, struct queue *rbios) {
    int cnt, len;
    unsigned char buf[4], *rad;

    for (;;) {
        cnt = dtlsread(ssl, rbios, buf, 4);
        if (cnt < 1) {
            debug(DBG_DBG, "raddtlsget: connection lost");
            return NULL;
        }

	len = RADLEN(buf);
	rad = malloc(len);
	if (!rad) {
	    debug(DBG_ERR, "raddtlsget: malloc failed");
	    continue;
	}
	memcpy(rad, buf, 4);
	
	cnt = dtlsread(ssl, rbios, rad + 4, len - 4);
        if (cnt < 1) {
            debug(DBG_DBG, "raddtlsget: connection lost");
            free(rad);
            return NULL;
        }
        
        if (len >= 20)
            break;
	
        free(rad);
        debug(DBG_WARN, "raddtlsget: packet smaller than minimum radius size");
    }
1225
    
1226
1227
1228
1229
1230
1231
1232
    debug(DBG_DBG, "raddtlsget: got %d bytes", len);
    return rad;
}

void dtlsserverrd(struct client *client) {
    struct request rq;
    pthread_t dtlsserverwrth;
1233
    
1234
    debug(DBG_DBG, "dtlsserverrd: starting for %s", client->conf->host);
1235

1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261