radsecproxy.c 98.1 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
 * We are not removing client requests from dynamic servers, see removeclientrqs()
35
36
 * Need to remove UDP clients when no activity for a while...
 * Remove expired stuff from clients request list?
venaas's avatar
venaas committed
37
38
 */

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

75
static struct options options;
venaas's avatar
venaas committed
76
static struct list *clconfs, *srvconfs;
venaas's avatar
venaas committed
77
78
struct list *realms;
struct hash *tlsconfs, *rewriteconfs;
79

80
static struct addrinfo *srcprotores[4] = { NULL, NULL, NULL, NULL };
81

venaas's avatar
venaas committed
82
static pthread_mutex_t *ssl_locks = NULL;
venaas's avatar
   
venaas committed
83
84
85
86
static long *ssl_lock_count;
extern int optind;
extern char *optarg;

venaas's avatar
venaas committed
87
88
/* minimum required declarations to avoid reordering code */
void adddynamicrealmserver(struct realm *realm, struct clsrvconf *conf, char *id);
89
int dynamicconfig(struct server *server);
90
int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val);
91
92
void freerealm(struct realm *realm);
void freeclsrvconf(struct clsrvconf *conf);
93
94
void freerq(struct request *rq);
void freerqoutdata(struct rqout *rqout);
venaas's avatar
venaas committed
95
void rmclientrq(struct request *rq, uint8_t id);
96

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

venaas's avatar
venaas committed
174
175
176
177
178
179
180
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
181
182
183
/* callbacks for making OpenSSL thread safe */
unsigned long ssl_thread_id() {
        return (unsigned long)pthread_self();
venaas's avatar
venaas committed
184
}
venaas's avatar
   
venaas committed
185
186
187
188
189
190
191
192
193

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
194
195
196
197
198
199
200
201
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;
}

202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
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);
219
      debug(DBG_WARN, "verify error: num=%d:%s:depth=%d:%s", err, X509_verify_cert_error_string(err), depth, buf);
220
221
222
223

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

venaas's avatar
venaas committed
244
245
246
247
struct addrinfo *getsrcprotores(uint8_t type) {
    return srcprotores[type];
}

venaas's avatar
venaas committed
248
int resolvepeer(struct clsrvconf *conf, int ai_flags) {
249
    struct addrinfo hints, *addrinfo, *res;
250
    char *slash, *s;
venaas's avatar
venaas committed
251
    int plen = 0;
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271

    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
272
    memset(&hints, 0, sizeof(hints));
venaas's avatar
venaas committed
273
    hints.ai_socktype = conf->pdef->socktype;
venaas's avatar
   
venaas committed
274
    hints.ai_family = AF_UNSPEC;
venaas's avatar
venaas committed
275
    hints.ai_flags = ai_flags;
276
277
    if (!conf->host && !conf->port) {
	/* getaddrinfo() doesn't like host and port to be NULL */
venaas's avatar
venaas committed
278
	if (getaddrinfo(conf->host, conf->pdef->portdefault, &hints, &addrinfo)) {
279
280
281
	    debug(DBG_WARN, "resolvepeer: can't resolve (null) port (null)");
	    return 0;
	}
venaas's avatar
venaas committed
282
283
	for (res = addrinfo; res; res = res->ai_next)
	    port_set(res->ai_addr, 0);
284
285
286
287
    } else {
	if (slash)
	    hints.ai_flags |= AI_NUMERICHOST;
	if (getaddrinfo(conf->host, conf->port, &hints, &addrinfo)) {
288
	    debug(DBG_WARN, "resolvepeer: can't resolve %s port %s", conf->host ? conf->host : "(null)", conf->port ? conf->port : "(null)");
289
290
	    return 0;
	}
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
	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
312
313
314
    if (conf->addrinfo)
	freeaddrinfo(conf->addrinfo);
    conf->addrinfo = addrinfo;
venaas's avatar
   
venaas committed
315
316
317
    return 1;
}	  

318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
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
356
struct clsrvconf *resolve_hostport(uint8_t type, char *lconf, char *default_port) {
357
358
359
360
361
362
363
    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
364
    conf->pdef = &protodefs[conf->type];
365
366
367
368
369
370
371
372
373
    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))
374
	debugx(1, DBG_ERR, "failed to resolve host %s port %s, exiting", conf->host ? conf->host : "(null)", conf->port ? conf->port : "(null)");
375
376
377
    return conf;
}

378
379
380
381
382
383
384
385
void freeclsrvres(struct clsrvconf *res) {
    free(res->host);
    free(res->port);
    if (res->addrinfo)
	freeaddrinfo(res->addrinfo);
    free(res);
}

386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
int bindtoaddr(struct addrinfo *addrinfo, int family, int reuse, int v6only) {
    int s, on = 1;
    struct addrinfo *res;

    for (res = addrinfo; res; res = res->ai_next) {
	if (family != AF_UNSPEC && family != res->ai_family)
	    continue;
	s = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
	if (s < 0) {
	    debug(DBG_WARN, "bindtoaddr: socket failed");
	    continue;
	}
	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");
	close(s);
    }
    return -1;
}
	
venaas's avatar
venaas committed
412
int connecttcp(struct addrinfo *addrinfo, struct addrinfo *src) {
413
    int s;
venaas's avatar
venaas committed
414
    struct addrinfo *res;
415
416

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

432
433
434
435
436
437
438
439
440
441
442
443
/* 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]);
}

444
/* returns next config with matching address, or NULL */
venaas's avatar
venaas committed
445
struct clsrvconf *find_conf(uint8_t type, struct sockaddr *addr, struct list *confs, struct list_node **cur) {
446
447
448
449
450
451
452
453
454
455
456
457
458
459
    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
460

venaas's avatar
venaas committed
461
    for (entry = (cur && *cur ? list_next(*cur) : list_first(confs)); entry; entry = list_next(entry)) {
venaas's avatar
venaas committed
462
	conf = (struct clsrvconf *)entry->data;
463
464
465
466
467
468
	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 &&
469
470
471
			 !memcmp(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, 16))) {
			if (cur)
			    *cur = entry;
472
			return conf;
473
		    }
474
475
476
477
478
479
	    } 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 &&
480
481
482
		      prefixmatch(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, conf->prefixlen)))) {
		    if (cur)
			*cur = entry;
venaas's avatar
venaas committed
483
		    return conf;
484
		}
485
486
	    }
	}
venaas's avatar
venaas committed
487
    }    
venaas's avatar
venaas committed
488
489
490
    return NULL;
}

venaas's avatar
venaas committed
491
492
493
494
495
496
497
498
struct clsrvconf *find_clconf(uint8_t type, struct sockaddr *addr, struct list_node **cur) {
    return find_conf(type, addr, clconfs, cur);
}

struct clsrvconf *find_srvconf(uint8_t type, struct sockaddr *addr, struct list_node **cur) {
    return find_conf(type, addr, srvconfs, cur);
}

venaas's avatar
venaas committed
499
/* returns next config of given type, or NULL */
venaas's avatar
venaas committed
500
struct clsrvconf *find_clconf_type(uint8_t type, struct list_node **cur) {
venaas's avatar
venaas committed
501
502
503
    struct list_node *entry;
    struct clsrvconf *conf;
    
venaas's avatar
venaas committed
504
    for (entry = (cur && *cur ? list_next(*cur) : list_first(clconfs)); entry; entry = list_next(entry)) {
venaas's avatar
venaas committed
505
506
507
508
509
510
511
512
513
514
	conf = (struct clsrvconf *)entry->data;
	if (conf->type == type) {
	    if (cur)
		*cur = entry;
	    return conf;
	}
    }    
    return NULL;
}

515
516
struct queue *newqueue() {
    struct queue *q;
517
    
518
519
    q = malloc(sizeof(struct queue));
    if (!q)
520
	debugx(1, DBG_ERR, "malloc failed");
521
522
    q->entries = list_create();
    if (!q->entries)
523
	debugx(1, DBG_ERR, "malloc failed");
524
525
526
527
528
529
530
    pthread_mutex_init(&q->mutex, NULL);
    pthread_cond_init(&q->cond, NULL);
    return q;
}

void removequeue(struct queue *q) {
    struct list_node *entry;
531
532
533

    if (!q)
	return;
534
535
    pthread_mutex_lock(&q->mutex);
    for (entry = list_first(q->entries); entry; entry = list_next(entry))
venaas's avatar
venaas committed
536
	freerq((struct request *)entry);
537
538
539
540
    list_destroy(q->entries);
    pthread_cond_destroy(&q->cond);
    pthread_mutex_unlock(&q->mutex);
    pthread_mutex_destroy(&q->mutex);
541
    free(q);
542
543
544
545
546
547
548
549
550
551
}

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);
552
553
}

554
struct client *addclient(struct clsrvconf *conf, uint8_t lock) {
555
556
557
558
559
    struct client *new = malloc(sizeof(struct client));
    
    if (!new) {
	debug(DBG_ERR, "malloc failed");
	return NULL;
560
    }
561
562
563

    if (lock)
	pthread_mutex_lock(conf->lock);
564
    if (!conf->clients) {
565
566
	conf->clients = list_create();
	if (!conf->clients) {
567
568
	    if (lock)
		pthread_mutex_unlock(conf->lock);
569
570
571
	    debug(DBG_ERR, "malloc failed");
	    return NULL;
	}
572
    }
573
574
    
    memset(new, 0, sizeof(struct client));
575
    pthread_mutex_init(&new->lock, NULL);
576
    new->conf = conf;
venaas's avatar
venaas committed
577
578
579
580
    if (conf->pdef->addclient)
	conf->pdef->addclient(new);
    else
	new->replyq = newqueue();
581
    list_push(conf->clients, new);
582
583
    if (lock)
	pthread_mutex_unlock(conf->lock);
584
585
586
587
    return new;
}

void removeclient(struct client *client) {
588
    if (!client)
589
	return;
590
591
592
593
594
595
596
597
598
599
600
601

    pthread_mutex_lock(client->conf->lock);
    if (client->conf->clients) {
	pthread_mutex_lock(&client->lock);
	removequeue(client->replyq);
	list_removedata(client->conf->clients, client);
	pthread_mutex_unlock(&client->lock);
	pthread_mutex_destroy(&client->lock);
	free(client->addr);
	free(client);
    }
    pthread_mutex_unlock(client->conf->lock);
602
603
}

604
605
606
void removeclientrqs(struct client *client) {
    struct list_node *entry;
    struct server *server;
607
    struct rqout *rqout;
608
609
610
611
    int i;
    
    for (entry = list_first(srvconfs); entry; entry = list_next(entry)) {
	server = ((struct clsrvconf *)entry->data)->servers;
612
613
	if (!server)
	    continue;
614
	for (i = 0; i < MAX_REQUESTS; i++) {
615
	    rqout = server->requests + i;
616
617
	    pthread_mutex_lock(rqout->lock);
	    if (rqout->rq && rqout->rq->from == client)
venaas's avatar
venaas committed
618
		freerqoutdata(rqout);
619
	    pthread_mutex_unlock(rqout->lock);
620
621
622
	}
    }
}
venaas's avatar
venaas committed
623
624

void freeserver(struct server *server, uint8_t destroymutex) {
625
    struct rqout *rqout, *end;
626

venaas's avatar
venaas committed
627
628
    if (!server)
	return;
629

630
    if (server->requests) {
631
	rqout = server->requests;
632
	for (end = rqout + MAX_REQUESTS; rqout < end; rqout++) {
633
	    freerqoutdata(rqout);
634
635
636
	    pthread_mutex_destroy(rqout->lock);
	    free(rqout->lock);
	}
637
638
	free(server->requests);
    }
639
640
    if (server->rbios)
	freebios(server->rbios);
641
    free(server->dynamiclookuparg);
642
643
    if (server->ssl)
	SSL_free(server->ssl);
venaas's avatar
venaas committed
644
645
646
647
648
649
650
651
652
653
    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
654
    uint8_t type;
655
    int i;
656
    
venaas's avatar
venaas committed
657
658
659
660
    if (conf->servers) {
	debug(DBG_ERR, "addserver: currently works with just one server per conf");
	return 0;
    }
661
    conf->servers = malloc(sizeof(struct server));
venaas's avatar
venaas committed
662
663
664
665
    if (!conf->servers) {
	debug(DBG_ERR, "malloc failed");
	return 0;
    }
666
667
668
    memset(conf->servers, 0, sizeof(struct server));
    conf->servers->conf = conf;

venaas's avatar
venaas committed
669
    type = conf->type;
670
    if (type == RAD_DTLS)
671
	conf->servers->rbios = newqueue();
venaas's avatar
venaas committed
672
673
674
675
    
    if (!srcprotores[type]) {
	res = resolve_hostport(type, *conf->pdef->srcaddrport, NULL);
	srcprotores[type] = res->addrinfo;
venaas's avatar
venaas committed
676
677
678
679
	res->addrinfo = NULL;
	freeclsrvres(res);
    }

venaas's avatar
venaas committed
680
681
682
    conf->servers->sock = -1;
    if (conf->pdef->addserverextra)
	conf->pdef->addserverextra(conf);
683
    
684
    conf->servers->requests = calloc(MAX_REQUESTS, sizeof(struct rqout));
venaas's avatar
venaas committed
685
686
687
688
    if (!conf->servers->requests) {
	debug(DBG_ERR, "malloc failed");
	goto errexit;
    }
689
690
691
692
693
694
695
696
697
698
699
700
701
    for (i = 0; i < MAX_REQUESTS; i++) {
	conf->servers->requests[i].lock = malloc(sizeof(pthread_mutex_t));
	if (!conf->servers->requests[i].lock) {
	    debug(DBG_ERR, "malloc failed");
	    goto errexit;
	}
	if (pthread_mutex_init(conf->servers->requests[i].lock, NULL)) {
	    debug(DBG_ERR, "mutex init failed");
	    free(conf->servers->requests[i].lock);
	    conf->servers->requests[i].lock = NULL;
	    goto errexit;
	}
    }
venaas's avatar
venaas committed
702
703
704
705
    if (pthread_mutex_init(&conf->servers->lock, NULL)) {
	debug(DBG_ERR, "mutex init failed");
	goto errexit;
    }
706
    conf->servers->newrq = 0;
venaas's avatar
venaas committed
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
    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;
725
726
}

727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
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
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
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;
}

802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
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
855
X509 *verifytlscert(SSL *ssl) {
856
857
    X509 *cert;
    unsigned long error;
858
    
venaas's avatar
venaas committed
859
    if (SSL_get_verify_result(ssl) != X509_V_OK) {
venaas's avatar
venaas committed
860
	debug(DBG_ERR, "verifytlscert: basic validation failed");
861
	while ((error = ERR_get_error()))
venaas's avatar
venaas committed
862
863
	    debug(DBG_ERR, "verifytlscert: TLS: %s", ERR_error_string(error, NULL));
	return NULL;
864
    }
865

venaas's avatar
venaas committed
866
    cert = SSL_get_peer_certificate(ssl);
venaas's avatar
venaas committed
867
868
869
870
871
872
873
874
875
876
    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;
    
877
    if (conf->certnamecheck && conf->prefixlen == 255) {
878
879
880
881
882
883
884
885
	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
886
		debug(DBG_WARN, "verifyconfcert: No subjectaltname matching %s %s", type ? "address" : "host", conf->host);
venaas's avatar
venaas committed
887
		return 0;
888
	    }
venaas's avatar
venaas committed
889
	    debug(DBG_DBG, "verifyconfcert: Found subjectaltname matching %s %s", type ? "address" : "host", conf->host);
890
	} else {
venaas's avatar
venaas committed
891
	    if (!cnregexp(cert, conf->host, NULL)) {
venaas's avatar
venaas committed
892
		debug(DBG_WARN, "verifyconfcert: cn not matching host %s", conf->host);
venaas's avatar
venaas committed
893
		return 0;
venaas's avatar
venaas committed
894
	    }		
venaas's avatar
venaas committed
895
	    debug(DBG_DBG, "verifyconfcert: Found cn matching host %s", conf->host);
venaas's avatar
venaas committed
896
897
898
899
	}
    }
    if (conf->certcnregex) {
	if (cnregexp(cert, NULL, conf->certcnregex) < 1) {
venaas's avatar
venaas committed
900
	    debug(DBG_WARN, "verifyconfcert: CN not matching regex");
venaas's avatar
venaas committed
901
	    return 0;
902
	}
venaas's avatar
venaas committed
903
	debug(DBG_DBG, "verifyconfcert: CN matching regex");
904
905
    }
    if (conf->certuriregex) {
venaas's avatar
venaas committed
906
	if (subjectaltnameregexp(cert, GEN_URI, NULL, conf->certuriregex) < 1) {
venaas's avatar
venaas committed
907
	    debug(DBG_WARN, "verifyconfcert: subjectaltname URI not matching regex");
venaas's avatar
venaas committed
908
	    return 0;
909
	}
venaas's avatar
venaas committed
910
	debug(DBG_DBG, "verifyconfcert: subjectaltname URI matching regex");
911
    }
912
    return 1;
913
914
}

915
unsigned char *attrget(unsigned char *attrs, int length, uint8_t type) {
916
    while (length > 1) {
venaas's avatar
venaas committed
917
	if (ATTRTYPE(attrs) == type)
918
	    return attrs;
venaas's avatar
venaas committed
919
920
	length -= ATTRLEN(attrs);
	attrs += ATTRLEN(attrs);
921
922
923
924
    }
    return NULL;
}

925
926
927
928
929
930
void freerq(struct request *rq) {
    if (!rq)
	return;
    debug(DBG_DBG, "freerq: called with refcount %d", rq->refcount);
    if (--rq->refcount)
	return;
venaas's avatar
venaas committed
931
932
933
934
    if (rq->origusername)
	free(rq->origusername);
    if (rq->buf)
	free(rq->buf);
venaas's avatar
venaas committed
935
936
937
    if (rq->replybuf)
	free(rq->replybuf);
    if (rq->msg)
venaas's avatar
venaas committed
938
	radmsg_free(rq->msg);
939
940
941
942
943
944
    free(rq);
}

void freerqoutdata(struct rqout *rqout) {
    if (!rqout)
	return;
945
    if (rqout->rq) {
946
	freerq(rqout->rq);
947
948
949
950
	rqout->rq = NULL;
    }
    rqout->tries = 0;
    memset(&rqout->expiry, 0, sizeof(struct timeval));
951
952
}

venaas's avatar
venaas committed
953
void sendrq(struct server *to, struct request *rq) {
venaas's avatar
   
venaas committed
954
    int i;
955
    
venaas's avatar
   
venaas committed
956
    pthread_mutex_lock(&to->newrq_mutex);
venaas's avatar
venaas committed
957
    /* might simplify if only try nextid, might be ok */
958
    for (i = to->nextid; i < MAX_REQUESTS; i++) {
venaas's avatar
venaas committed
959
	if (!to->requests[i].rq) {
960
	    pthread_mutex_lock(to->requests[i].lock);
venaas's avatar
venaas committed
961
	    if (!to->requests[i].rq)
venaas's avatar
venaas committed
962
		break;
963
964
965
966
967
	    pthread_mutex_unlock(to->requests[i].lock);
	}
    }
    if (i == MAX_REQUESTS) {
	for (i = 0; i < to->nextid; i++) {
venaas's avatar
venaas committed
968
	    if (!to->requests[i].rq) {
969
		pthread_mutex_lock(to->requests[i].lock);
venaas's avatar
venaas committed
970
		if (!to->requests[i].rq)
971
972
973
974
		    break;
		pthread_mutex_unlock(to->requests[i].lock);
	    }
	}
venaas's avatar
venaas committed
975
	if (i == to->nextid) {
venaas's avatar
venaas committed
976
	    debug(DBG_WARN, "sendrq: no room in queue, dropping request");
venaas's avatar
venaas committed
977
978
	    rmclientrq(rq, rq->msg->id);
	    freerq(rq);
venaas's avatar
venaas committed
979
	    goto exit;
venaas's avatar
venaas committed
980
	}
venaas's avatar
   
venaas committed
981
    }
982

venaas's avatar
venaas committed
983
984
985
    rq->msg->id = (uint8_t)i;
    rq->buf = radmsg2buf(rq->msg, (uint8_t *)to->conf->secret);
    if (!rq->buf) {
986
	pthread_mutex_unlock(to->requests[i].lock);
venaas's avatar
venaas committed
987
	debug(DBG_ERR, "sendrq: radmsg2buf failed");
venaas's avatar
venaas committed
988
989
	rmclientrq(rq, rq->msg->id);
	freerq(rq);
venaas's avatar
venaas committed
990
991
992
	goto exit;
    }
    
venaas's avatar
venaas committed
993
    debug(DBG_DBG, "sendrq: inserting packet with id %d in queue for %s", i, to->conf->host);
venaas's avatar
venaas committed
994
    to->requests[i].rq = rq;
995
    pthread_mutex_unlock(to->requests[i].lock);
996
    to->nextid = i + 1;
venaas's avatar
   
venaas committed
997
998
999

    if (!to->newrq) {
	to->newrq = 1;
venaas's avatar
venaas committed
1000
	debug(DBG_DBG, "sendrq: signalling client writer");
venaas's avatar
   
venaas committed
1001
1002
	pthread_cond_signal(&to->newrq_cond);
    }
venaas's avatar
venaas committed
1003

venaas's avatar
venaas committed
1004
 exit:
venaas's avatar
   
venaas committed
1005
1006
1007
    pthread_mutex_unlock(&to->newrq_mutex);
}

venaas's avatar
venaas committed
1008
void sendreply(struct request *rq) {
1009
    uint8_t first;
venaas's avatar
venaas committed
1010
1011
1012
1013
1014
1015
1016
1017
    struct client *to = rq->from;
    
    if (!rq->replybuf)
	rq->replybuf = radmsg2buf(rq->msg, (uint8_t *)to->conf->secret);
    radmsg_free(rq->msg);
    rq->msg = NULL;
    if (!rq->replybuf) {
	freerq(rq);
venaas's avatar
venaas committed
1018
	debug(DBG_ERR, "sendreply: radmsg2buf failed");
venaas's avatar
venaas committed
1019
1020
	return;
    }
1021
1022

    pthread_mutex_lock(&to->replyq->mutex);
1023
    first = list_first(to->replyq->entries) == NULL;
1024
    
venaas's avatar
venaas committed
1025
    if (!list_push(to->replyq->entries, rq)) {
1026
	pthread_mutex_unlock(&to->replyq->mutex);
venaas's avatar
venaas committed
1027
	freerq(rq);
1028
1029
1030
1031
1032
	debug(DBG_ERR, "sendreply: malloc failed");
	return;
    }
    
    if (first) {
1033
	debug(DBG_DBG, "signalling server writer");
1034
	pthread_cond_signal(&to->replyq->cond);
venaas's avatar
   
venaas committed
1035
    }
1036
    pthread_mutex_unlock(&to->replyq->mutex);
venaas's avatar
   
venaas committed
1037
1038
}

venaas's avatar
venaas committed
1039
int pwdencrypt(uint8_t *in, uint8_t len, char *shared, uint8_t sharedlen, uint8_t *auth) {
venaas's avatar
venaas committed
1040
1041
1042
1043
1044
    static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
    static unsigned char first = 1;
    static EVP_MD_CTX mdctx;
    unsigned char hash[EVP_MAX_MD_SIZE], *input;
    unsigned int md_len;
venaas's avatar
venaas committed
1045
    uint8_t i, offset = 0, out[128];
venaas's avatar
venaas committed
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
    
    pthread_mutex_lock(&lock);
    if (first) {
	EVP_MD_CTX_init(&mdctx);
	first = 0;
    }

    input = auth;
    for (;;) {
	if (!EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) ||
venaas's avatar
venaas committed
1056
	    !EVP_DigestUpdate(&mdctx, (uint8_t *)shared, sharedlen) ||
venaas's avatar
venaas committed
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
	    !EVP_DigestUpdate(&mdctx, input, 16) ||
	    !EVP_DigestFinal_ex(&mdctx, hash, &md_len) ||
	    md_len != 16) {
	    pthread_mutex_unlock(&lock);
	    return 0;
	}
	for (i = 0; i < 16; i++)
	    out[offset + i] = hash[i] ^ in[offset + i];
	input = out + offset - 16;
	offset += 16;
	if (offset == len)
	    break;
    }
venaas's avatar
venaas committed
1070
    memcpy(in, out, len);
venaas's avatar
venaas committed
1071
1072
1073
1074
    pthread_mutex_unlock(&lock);
    return 1;
}

venaas's avatar
venaas committed
1075
int pwddecrypt(uint8_t *in, uint8_t len, char *shared, uint8_t sharedlen, uint8_t *auth) {
venaas's avatar
   
venaas committed
1076
1077
1078
1079
1080
    static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
    static unsigned char first = 1;
    static EVP_MD_CTX mdctx;
    unsigned char hash[EVP_MAX_MD_SIZE], *input;
    unsigned int md_len;
venaas's avatar
venaas committed
1081
    uint8_t i, offset = 0, out[128];
venaas's avatar
   
venaas committed
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
    
    pthread_mutex_lock(&lock);
    if (first) {
	EVP_MD_CTX_init(&mdctx);
	first = 0;
    }

    input = auth;
    for (;;) {
	if (!EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) ||
venaas's avatar
venaas committed
1092
	    !EVP_DigestUpdate(&mdctx, (uint8_t *)shared, sharedlen) ||
venaas's avatar
   
venaas committed
1093
1094
1095
1096
1097
1098
1099
	    !EVP_DigestUpdate(&mdctx, input, 16) ||
	    !EVP_DigestFinal_ex(&mdctx, hash, &md_len) ||
	    md_len != 16) {
	    pthread_mutex_unlock(&lock);
	    return 0;
	}
	for (i = 0; i < 16; i++)
venaas's avatar
venaas committed
1100
1101
	    out[offset + i] = hash[i] ^ in[offset + i];
	input = in + offset;
venaas's avatar
   
venaas committed
1102
	offset += 16;
venaas's avatar
venaas committed
1103
	if (offset == len)
venaas's avatar
   
venaas committed
1104
1105
	    break;
    }
venaas's avatar
venaas committed
1106
    memcpy(in, out, len);
venaas's avatar
   
venaas committed
1107
1108
1109
1110
    pthread_mutex_unlock(&lock);
    return 1;
}

venaas's avatar
venaas committed
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
int msmppencrypt(uint8_t *text, uint8_t len, uint8_t *shared, uint8_t sharedlen, uint8_t *auth, uint8_t *salt) {
    static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
    static unsigned char first = 1;
    static EVP_MD_CTX mdctx;
    unsigned char hash[EVP_MAX_MD_SIZE];
    unsigned int md_len;
    uint8_t i, offset;
    
    pthread_mutex_lock(&lock);
    if (first) {
	EVP_MD_CTX_init(&mdctx);
	first = 0;
    }

1125
1126
1127
1128
#if 0
    printfchars(NULL, "msppencrypt auth in", "%02x ", auth, 16);
    printfchars(NULL, "msppencrypt salt in", "%02x ", salt, 2);
    printfchars(NULL, "msppencrypt in", "%02x ", text, len);
venaas's avatar
venaas committed
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
#endif
    
    if (!EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) ||
	!EVP_DigestUpdate(&mdctx, shared, sharedlen) ||
	!EVP_DigestUpdate(&mdctx, auth, 16) ||
	!EVP_DigestUpdate(&mdctx, salt, 2) ||
	!EVP_DigestFinal_ex(&mdctx, hash, &md_len)) {
	pthread_mutex_unlock(&lock);
	return 0;
    }

#if 0    
1141
    printfchars(NULL, "msppencrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1142
1143
1144
1145
1146
1147
#endif
    
    for (i = 0; i < 16; i++)
	text[i] ^= hash[i];
    
    for (offset = 16; offset < len; offset += 16) {
venaas's avatar
venaas committed
1148
#if 0	
venaas's avatar
venaas committed
1149
	printf("text + offset - 16 c(%d): ", offset / 16);
1150
	printfchars(NULL, NULL, "%02x ", text + offset - 16, 16);