radsecproxy.c 99 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
#include "hash.h"
65
66
#include "tlv11.h"
#include "radmsg.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
void freerqdata(struct request *rq);
94

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

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

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

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
356
357
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
358
struct clsrvconf *resolve_hostport(uint8_t type, char *lconf, char *default_port) {
359
360
361
362
363
364
365
    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
366
    conf->pdef = &protodefs[conf->type];
367
368
369
370
371
372
373
374
375
    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))
376
	debugx(1, DBG_ERR, "failed to resolve host %s port %s, exiting", conf->host ? conf->host : "(null)", conf->port ? conf->port : "(null)");
377
378
379
    return conf;
}

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

388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
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
414
int connecttcp(struct addrinfo *addrinfo, struct addrinfo *src) {
415
    int s;
venaas's avatar
venaas committed
416
    struct addrinfo *res;
417
418

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

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

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

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

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

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

void removequeue(struct queue *q) {
    struct list_node *entry;
533
534
535

    if (!q)
	return;
536
537
538
539
540
541
542
    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);
543
    free(q);
544
545
546
547
548
549
550
551
552
553
}

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);
554
555
}

556
557
558
559
560
561
struct client *addclient(struct clsrvconf *conf) {
    struct client *new = malloc(sizeof(struct client));
    
    if (!new) {
	debug(DBG_ERR, "malloc failed");
	return NULL;
562
563
    }
    if (!conf->clients) {
564
565
566
567
568
	conf->clients = list_create();
	if (!conf->clients) {
	    debug(DBG_ERR, "malloc failed");
	    return NULL;
	}
569
    }
570
571
572
    
    memset(new, 0, sizeof(struct client));
    new->conf = conf;
venaas's avatar
venaas committed
573
574
575
576
    if (conf->pdef->addclient)
	conf->pdef->addclient(new);
    else
	new->replyq = newqueue();
577
578
579
580
581
582
583
    list_push(conf->clients, new);
    return new;
}

void removeclient(struct client *client) {
    if (!client || !client->conf->clients)
	return;
584
    removequeue(client->replyq);
585
586
    list_removedata(client->conf->clients, client);
    free(client);
587
588
}

589
590
591
592
593
594
595
596
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;
597
598
	if (!server)
	    continue;
599
600
601
602
603
604
605
606
607
	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
608
609

void freeserver(struct server *server, uint8_t destroymutex) {
610
611
    struct request *rq, *end;

venaas's avatar
venaas committed
612
613
    if (!server)
	return;
614

615
    if (server->requests) {
616
617
618
619
620
	rq = server->requests;
	for (end = rq + MAX_REQUESTS; rq < end; rq++)
	    freerqdata(rq);
	free(server->requests);
    }
621
622
    if (server->rbios)
	freebios(server->rbios);
623
    free(server->dynamiclookuparg);
624
625
    if (server->ssl)
	SSL_free(server->ssl);
venaas's avatar
venaas committed
626
627
628
629
630
631
632
633
634
635
    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
636
    uint8_t type;
637
    
venaas's avatar
venaas committed
638
639
640
641
    if (conf->servers) {
	debug(DBG_ERR, "addserver: currently works with just one server per conf");
	return 0;
    }
642
    conf->servers = malloc(sizeof(struct server));
venaas's avatar
venaas committed
643
644
645
646
    if (!conf->servers) {
	debug(DBG_ERR, "malloc failed");
	return 0;
    }
647
648
649
    memset(conf->servers, 0, sizeof(struct server));
    conf->servers->conf = conf;

venaas's avatar
venaas committed
650
    type = conf->type;
651
    if (type == RAD_DTLS)
652
	conf->servers->rbios = newqueue();
venaas's avatar
venaas committed
653
654
655
656
    
    if (!srcprotores[type]) {
	res = resolve_hostport(type, *conf->pdef->srcaddrport, NULL);
	srcprotores[type] = res->addrinfo;
venaas's avatar
venaas committed
657
658
659
660
	res->addrinfo = NULL;
	freeclsrvres(res);
    }

venaas's avatar
venaas committed
661
662
663
    conf->servers->sock = -1;
    if (conf->pdef->addserverextra)
	conf->pdef->addserverextra(conf);
664
    
665
    conf->servers->requests = calloc(MAX_REQUESTS, sizeof(struct request));
venaas's avatar
venaas committed
666
667
668
669
670
671
672
673
    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;
    }
674
    conf->servers->newrq = 0;
venaas's avatar
venaas committed
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
    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;
693
694
}

695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
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
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
763
764
765
766
767
768
769
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;
}

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
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
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
823
X509 *verifytlscert(SSL *ssl) {
824
825
    X509 *cert;
    unsigned long error;
826
    
venaas's avatar
venaas committed
827
    if (SSL_get_verify_result(ssl) != X509_V_OK) {
venaas's avatar
venaas committed
828
	debug(DBG_ERR, "verifytlscert: basic validation failed");
829
	while ((error = ERR_get_error()))
venaas's avatar
venaas committed
830
831
	    debug(DBG_ERR, "verifytlscert: TLS: %s", ERR_error_string(error, NULL));
	return NULL;
832
    }
833

venaas's avatar
venaas committed
834
    cert = SSL_get_peer_certificate(ssl);
venaas's avatar
venaas committed
835
836
837
838
839
840
841
842
843
844
    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;
    
845
    if (conf->certnamecheck && conf->prefixlen == 255) {
846
847
848
849
850
851
852
853
	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
854
		debug(DBG_WARN, "verifyconfcert: No subjectaltname matching %s %s", type ? "address" : "host", conf->host);
venaas's avatar
venaas committed
855
		return 0;
856
	    }
venaas's avatar
venaas committed
857
	    debug(DBG_DBG, "verifyconfcert: Found subjectaltname matching %s %s", type ? "address" : "host", conf->host);
858
	} else {
venaas's avatar
venaas committed
859
	    if (!cnregexp(cert, conf->host, NULL)) {
venaas's avatar
venaas committed
860
		debug(DBG_WARN, "verifyconfcert: cn not matching host %s", conf->host);
venaas's avatar
venaas committed
861
		return 0;
venaas's avatar
venaas committed
862
	    }		
venaas's avatar
venaas committed
863
	    debug(DBG_DBG, "verifyconfcert: Found cn matching host %s", conf->host);
venaas's avatar
venaas committed
864
865
866
867
	}
    }
    if (conf->certcnregex) {
	if (cnregexp(cert, NULL, conf->certcnregex) < 1) {
venaas's avatar
venaas committed
868
	    debug(DBG_WARN, "verifyconfcert: CN not matching regex");
venaas's avatar
venaas committed
869
	    return 0;
870
	}
venaas's avatar
venaas committed
871
	debug(DBG_DBG, "verifyconfcert: CN matching regex");
872
873
    }
    if (conf->certuriregex) {
venaas's avatar
venaas committed
874
	if (subjectaltnameregexp(cert, GEN_URI, NULL, conf->certuriregex) < 1) {
venaas's avatar
venaas committed
875
	    debug(DBG_WARN, "verifyconfcert: subjectaltname URI not matching regex");
venaas's avatar
venaas committed
876
	    return 0;
877
	}
venaas's avatar
venaas committed
878
	debug(DBG_DBG, "verifyconfcert: subjectaltname URI matching regex");
879
    }
880
    return 1;
881
882
}

venaas's avatar
   
venaas committed
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
int radsign(unsigned char *rad, unsigned char *sec) {
    static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
    static unsigned char first = 1;
    static EVP_MD_CTX mdctx;
    unsigned int md_len;
    int result;
    
    pthread_mutex_lock(&lock);
    if (first) {
	EVP_MD_CTX_init(&mdctx);
	first = 0;
    }

    result = (EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) &&
	EVP_DigestUpdate(&mdctx, rad, RADLEN(rad)) &&
venaas's avatar
venaas committed
898
	EVP_DigestUpdate(&mdctx, sec, strlen((char *)sec)) &&
venaas's avatar
   
venaas committed
899
900
901
902
903
904
	EVP_DigestFinal_ex(&mdctx, rad + 4, &md_len) &&
	md_len == 16);
    pthread_mutex_unlock(&lock);
    return result;
}

venaas's avatar
venaas committed
905
int createmessageauth(unsigned char *rad, unsigned char *authattrval, char *secret) {
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
    static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
    static unsigned char first = 1;
    static HMAC_CTX hmacctx;
    unsigned int md_len;

    if (!authattrval)
	return 1;
    
    pthread_mutex_lock(&lock);
    if (first) {
	HMAC_CTX_init(&hmacctx);
	first = 0;
    }

    memset(authattrval, 0, 16);
    md_len = 0;
    HMAC_Init_ex(&hmacctx, secret, strlen(secret), EVP_md5(), NULL);
    HMAC_Update(&hmacctx, rad, RADLEN(rad));
    HMAC_Final(&hmacctx, authattrval, &md_len);
    if (md_len != 16) {
926
	debug(DBG_WARN, "message auth computation failed");
927
928
929
930
931
932
933
934
	pthread_mutex_unlock(&lock);
	return 0;
    }

    pthread_mutex_unlock(&lock);
    return 1;
}

935
unsigned char *attrget(unsigned char *attrs, int length, uint8_t type) {
936
    while (length > 1) {
venaas's avatar
venaas committed
937
	if (ATTRTYPE(attrs) == type)
938
	    return attrs;
venaas's avatar
venaas committed
939
940
	length -= ATTRLEN(attrs);
	attrs += ATTRLEN(attrs);
941
942
943
944
    }
    return NULL;
}

945
946
947
948
949
950
951
void freerqdata(struct request *rq) {
    if (rq->origusername)
	free(rq->origusername);
    if (rq->buf)
	free(rq->buf);
}

venaas's avatar
venaas committed
952
void sendrq(struct server *to, struct request *rq) {
venaas's avatar
   
venaas committed
953
    int i;
954
    uint8_t *attr;
955

venaas's avatar
   
venaas committed
956
    pthread_mutex_lock(&to->newrq_mutex);
venaas's avatar
venaas committed
957
958
    /* might simplify if only try nextid, might be ok */
    for (i = to->nextid; i < MAX_REQUESTS; i++)
venaas's avatar
   
venaas committed
959
960
961
	if (!to->requests[i].buf)
	    break;
    if (i == MAX_REQUESTS) {
venaas's avatar
venaas committed
962
963
964
965
	for (i = 0; i < to->nextid; i++)
	    if (!to->requests[i].buf)
		break;
	if (i == to->nextid) {
venaas's avatar
venaas committed
966
	    debug(DBG_WARN, "sendrq: no room in queue, dropping request");
967
	    freerqdata(rq);
venaas's avatar
venaas committed
968
	    goto exit;
venaas's avatar
venaas committed
969
	}
venaas's avatar
   
venaas committed
970
    }
venaas's avatar
venaas committed
971
    
venaas's avatar
   
venaas committed
972
    rq->buf[1] = (char)i;
973

974
    attr = attrget(rq->buf + 20, RADLEN(rq->buf) - 20, RAD_Attr_Message_Authenticator);
venaas's avatar
venaas committed
975
    if (attr && !createmessageauth(rq->buf, ATTRVAL(attr), to->conf->secret)) {
976
	freerqdata(rq);
venaas's avatar
venaas committed
977
978
979
	goto exit;
    }
    
venaas's avatar
venaas committed
980
    if (*rq->buf == RAD_Accounting_Request) {
venaas's avatar
venaas committed
981
982
983
984
985
	if (!radsign(rq->buf, (unsigned char *)to->conf->secret)) {
	    debug(DBG_WARN, "sendrq: failed to sign Accounting-Request message");
	    freerqdata(rq);
	    goto exit;
	}
986
    }
venaas's avatar
venaas committed
987

venaas's avatar
venaas committed
988
    debug(DBG_DBG, "sendrq: inserting packet with id %d in queue for %s", i, to->conf->host);
venaas's avatar
   
venaas committed
989
    to->requests[i] = *rq;
990
    to->nextid = i + 1;
venaas's avatar
   
venaas committed
991
992
993

    if (!to->newrq) {
	to->newrq = 1;
venaas's avatar
venaas committed
994
	debug(DBG_DBG, "sendrq: signalling client writer");
venaas's avatar
   
venaas committed
995
996
	pthread_cond_signal(&to->newrq_cond);
    }
venaas's avatar
venaas committed
997
 exit:
venaas's avatar
   
venaas committed
998
999
1000
    pthread_mutex_unlock(&to->newrq_mutex);
}

1001
void sendreply(struct client *to, unsigned char *buf, struct sockaddr_storage *tosa, int toudpsock) {
1002
1003
    struct reply *reply;
    uint8_t first;
venaas's avatar
   
venaas committed
1004
    
venaas's avatar
venaas committed
1005
    if (!radsign(buf, (unsigned char *)to->conf->secret)) {
venaas's avatar
venaas committed
1006
1007
1008
1009
	free(buf);
	debug(DBG_WARN, "sendreply: failed to sign message");
	return;
    }
1010
1011
1012

    reply = malloc(sizeof(struct reply));
    if (!reply) {
1013
	free(buf);
1014
	debug(DBG_ERR, "sendreply: malloc failed");
venaas's avatar
   
venaas committed
1015
1016
	return;
    }
1017
1018
    memset(reply, 0, sizeof(struct reply));
    reply->buf = buf;
venaas's avatar
   
venaas committed
1019
    if (tosa)
1020
	reply->tosa = *tosa;
1021
    reply->toudpsock = toudpsock;
1022
1023
    
    pthread_mutex_lock(&to->replyq->mutex);
venaas's avatar
   
venaas committed
1024

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

venaas's avatar
venaas committed
1042
int pwdencrypt(uint8_t *in, uint8_t len, char *shared, uint8_t sharedlen, uint8_t *auth) {
venaas's avatar
venaas committed
1043
1044
1045
1046
1047
    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
1048
    uint8_t i, offset = 0, out[128];
venaas's avatar
venaas committed
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
    
    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
1059
	    !EVP_DigestUpdate(&mdctx, (uint8_t *)shared, sharedlen) ||
venaas's avatar
venaas committed
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
	    !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
1073
    memcpy(in, out, len);
venaas's avatar
venaas committed
1074
1075
1076
1077
    pthread_mutex_unlock(&lock);
    return 1;
}

venaas's avatar
venaas committed
1078
int pwddecrypt(uint8_t *in, uint8_t len, char *shared, uint8_t sharedlen, uint8_t *auth) {
venaas's avatar
   
venaas committed
1079
1080
1081
1082
1083
    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
1084
    uint8_t i, offset = 0, out[128];
venaas's avatar
   
venaas committed
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
    
    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
1095
	    !EVP_DigestUpdate(&mdctx, (uint8_t *)shared, sharedlen) ||
venaas's avatar
   
venaas committed
1096
1097
1098
1099
1100
1101
1102
	    !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
1103
1104
	    out[offset + i] = hash[i] ^ in[offset + i];
	input = in + offset;
venaas's avatar
   
venaas committed
1105
	offset += 16;
venaas's avatar
venaas committed
1106
	if (offset == len)
venaas's avatar
   
venaas committed
1107
1108
	    break;
    }
venaas's avatar
venaas committed
1109
    memcpy(in, out, len);
venaas's avatar
   
venaas committed
1110
1111
1112
1113
    pthread_mutex_unlock(&lock);
    return 1;
}

venaas's avatar
venaas committed
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
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;
    }

1128
1129
1130
1131
#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
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
#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    
1144
    printfchars(NULL, "msppencrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1145
1146
1147
1148
1149
1150
#endif
    
    for (i = 0; i < 16; i++)
	text[i] ^= hash[i];
    
    for (offset = 16; offset < len; offset += 16) {
venaas's avatar
venaas committed
1151
#if 0	
venaas's avatar
venaas committed
1152
	printf("text + offset - 16 c(%d): ", offset / 16);
1153
	printfchars(NULL, NULL, "%02x ", text + offset - 16, 16);
venaas's avatar
venaas committed
1154
#endif
venaas's avatar
venaas committed
1155
1156
1157
1158
1159
1160
1161
1162
	if (!EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) ||
	    !EVP_DigestUpdate(&mdctx, shared, sharedlen) ||
	    !EVP_DigestUpdate(&mdctx, text + offset - 16, 16) ||
	    !EVP_DigestFinal_ex(&mdctx, hash, &md_len) ||
	    md_len != 16) {
	    pthread_mutex_unlock(&lock);
	    return 0;
	}
1163
1164
#if 0
	printfchars(NULL, "msppencrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1165
1166
1167
1168
1169
1170
1171
#endif    
	
	for (i = 0; i < 16; i++)
	    text[offset + i] ^= hash[i];
    }
    
#if 0
1172
    printfchars(NULL, "msppencrypt out", "%02x ", text, len);
venaas's avatar
venaas committed
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
#endif

    pthread_mutex_unlock(&lock);
    return 1;
}

int msmppdecrypt(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;
    char plain[255];
    
    pthread_mutex_lock(&lock);
    if (first) {
	EVP_MD_CTX_init(&mdctx);
	first = 0;
    }

1194
1195
1196
1197
#if 0
    printfchars(NULL, "msppdecrypt auth in", "%02x ", auth, 16);
    printfchars(NULL, "msppdecrypt salt in", "%02x ", salt, 2);
    printfchars(NULL, "msppdecrypt in", "%02x ", text, len);
venaas's avatar
venaas committed
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
#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    
1210
    printfchars(NULL, "msppdecrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1211
1212
1213
1214
1215
1216
1217
1218
#endif
    
    for (i = 0; i < 16; i++)
	plain[i] = text[i] ^ hash[i];
    
    for (offset = 16; offset < len; offset += 16) {
#if 0 	
	printf("text + offset - 16 c(%d): ", offset / 16);
1219
	printfchars(NULL, NULL, "%02x ", text + offset - 16, 16);
venaas's avatar
venaas committed
1220
1221
1222
1223
1224
1225
1226
1227
1228
#endif
	if (!EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) ||
	    !EVP_DigestUpdate(&mdctx, shared, sharedlen) ||
	    !EVP_DigestUpdate(&mdctx, text + offset - 16, 16) ||
	    !EVP_DigestFinal_ex(&mdctx, hash, &md_len) ||
	    md_len != 16) {
	    pthread_mutex_unlock(&lock);
	    return 0;
	}
1229
1230
#if 0
	printfchars(NULL, "msppdecrypt hash", "%02x ", hash, 16);