radsecproxy.c 97.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
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 "util.h"
#include "gconfig.h"
venaas's avatar
venaas committed
67
#include "radsecproxy.h"
venaas's avatar
venaas committed
68
#include "udp.h"
venaas's avatar
venaas committed
69
70
#include "tcp.h"
#include "tls.h"
venaas's avatar
venaas committed
71
#include "dtls.h"
venaas's avatar
 
venaas committed
72

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

78
static struct addrinfo *srcprotores[4] = { NULL, NULL, NULL, NULL };
79

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

venaas's avatar
venaas committed
85
86
/* minimum required declarations to avoid reordering code */
void adddynamicrealmserver(struct realm *realm, struct clsrvconf *conf, char *id);
87
int dynamicconfig(struct server *server);
88
int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val);
89
90
void freerealm(struct realm *realm);
void freeclsrvconf(struct clsrvconf *conf);
91
void freerqdata(struct request *rq);
92

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

venaas's avatar
venaas committed
166
167
168
169
170
171
172
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
173
174
175
/* callbacks for making OpenSSL thread safe */
unsigned long ssl_thread_id() {
        return (unsigned long)pthread_self();
venaas's avatar
venaas committed
176
}
venaas's avatar
 
venaas committed
177
178
179
180
181
182
183
184
185

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
186
187
188
189
190
191
192
193
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;
}

194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
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);
211
      debug(DBG_WARN, "verify error: num=%d:%s:depth=%d:%s", err, X509_verify_cert_error_string(err), depth, buf);
212
213
214
215

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

venaas's avatar
venaas committed
236
237
238
239
struct addrinfo *getsrcprotores(uint8_t type) {
    return srcprotores[type];
}

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

    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
264
    memset(&hints, 0, sizeof(hints));
venaas's avatar
venaas committed
265
    hints.ai_socktype = conf->pdef->socktype;
venaas's avatar
 
venaas committed
266
    hints.ai_family = AF_UNSPEC;
venaas's avatar
venaas committed
267
    hints.ai_flags = ai_flags;
268
269
    if (!conf->host && !conf->port) {
	/* getaddrinfo() doesn't like host and port to be NULL */
venaas's avatar
venaas committed
270
	if (getaddrinfo(conf->host, conf->pdef->portdefault, &hints, &addrinfo)) {
271
272
273
274
275
276
277
278
279
280
281
	    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;
282
	    }
283
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);
}

venaas's avatar
venaas committed
386
int connecttcp(struct addrinfo *addrinfo, struct addrinfo *src) {
387
    int s;
venaas's avatar
venaas committed
388
    struct addrinfo *res;
389
390

    s = -1;
venaas's avatar
venaas committed
391
    for (res = addrinfo; res; res = res->ai_next) {
venaas's avatar
venaas committed
392
	s = bindtoaddr(src, res->ai_family, 1, 1);
venaas's avatar
venaas committed
393
        if (s < 0) {
394
            debug(DBG_WARN, "connecttoserver: socket failed");
venaas's avatar
venaas committed
395
396
            continue;
        }
397
398
399
        if (connect(s, res->ai_addr, res->ai_addrlen) == 0)
            break;
        debug(DBG_WARN, "connecttoserver: connect failed");
venaas's avatar
venaas committed
400
        close(s);
401
        s = -1;
venaas's avatar
venaas committed
402
    }
403
    return s;
venaas's avatar
venaas committed
404
405
}	  

406
407
408
409
410
411
412
413
414
415
416
417
/* 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]);
}

418
/* returns next config with matching address, or NULL */
venaas's avatar
venaas committed
419
struct clsrvconf *find_conf(uint8_t type, struct sockaddr *addr, struct list *confs, struct list_node **cur) {
420
421
422
423
424
425
426
427
428
429
430
431
432
433
    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
434

venaas's avatar
venaas committed
435
    for (entry = (cur && *cur ? list_next(*cur) : list_first(confs)); entry; entry = list_next(entry)) {
venaas's avatar
venaas committed
436
	conf = (struct clsrvconf *)entry->data;
437
438
439
440
441
442
	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 &&
443
444
445
			 !memcmp(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, 16))) {
			if (cur)
			    *cur = entry;
446
			return conf;
447
		    }
448
449
450
451
452
453
	    } 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 &&
454
455
456
		      prefixmatch(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, conf->prefixlen)))) {
		    if (cur)
			*cur = entry;
venaas's avatar
venaas committed
457
		    return conf;
458
		}
459
460
	    }
	}
venaas's avatar
venaas committed
461
    }    
venaas's avatar
venaas committed
462
463
464
    return NULL;
}

venaas's avatar
venaas committed
465
466
467
468
469
470
471
472
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
473
/* returns next config of given type, or NULL */
venaas's avatar
venaas committed
474
struct clsrvconf *find_clconf_type(uint8_t type, struct list_node **cur) {
venaas's avatar
venaas committed
475
476
477
    struct list_node *entry;
    struct clsrvconf *conf;
    
venaas's avatar
venaas committed
478
    for (entry = (cur && *cur ? list_next(*cur) : list_first(clconfs)); entry; entry = list_next(entry)) {
venaas's avatar
venaas committed
479
480
481
482
483
484
485
486
487
488
	conf = (struct clsrvconf *)entry->data;
	if (conf->type == type) {
	    if (cur)
		*cur = entry;
	    return conf;
	}
    }    
    return NULL;
}

489
490
struct queue *newqueue() {
    struct queue *q;
491
    
492
493
    q = malloc(sizeof(struct queue));
    if (!q)
494
	debugx(1, DBG_ERR, "malloc failed");
495
496
    q->entries = list_create();
    if (!q->entries)
497
	debugx(1, DBG_ERR, "malloc failed");
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
    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);
523
524
}

525
526
527
528
529
530
struct client *addclient(struct clsrvconf *conf) {
    struct client *new = malloc(sizeof(struct client));
    
    if (!new) {
	debug(DBG_ERR, "malloc failed");
	return NULL;
531
532
    }
    if (!conf->clients) {
533
534
535
536
537
	conf->clients = list_create();
	if (!conf->clients) {
	    debug(DBG_ERR, "malloc failed");
	    return NULL;
	}
538
    }
539
540
541
    
    memset(new, 0, sizeof(struct client));
    new->conf = conf;
venaas's avatar
venaas committed
542
543
544
545
    if (conf->pdef->addclient)
	conf->pdef->addclient(new);
    else
	new->replyq = newqueue();
546
547
548
549
550
551
552
    list_push(conf->clients, new);
    return new;
}

void removeclient(struct client *client) {
    if (!client || !client->conf->clients)
	return;
553
554
555
    removequeue(client->replyq);
    if (client->rbios)
	freebios(client->rbios);
556
557
    list_removedata(client->conf->clients, client);
    free(client);
558
559
}

560
561
562
563
564
565
566
567
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;
568
569
	if (!server)
	    continue;
570
571
572
573
574
575
576
577
578
	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
579
580

void freeserver(struct server *server, uint8_t destroymutex) {
581
582
    struct request *rq, *end;

venaas's avatar
venaas committed
583
584
    if (!server)
	return;
585

586
    if (server->requests) {
587
588
589
590
591
	rq = server->requests;
	for (end = rq + MAX_REQUESTS; rq < end; rq++)
	    freerqdata(rq);
	free(server->requests);
    }
592
593
    if (server->rbios)
	freebios(server->rbios);
594
    free(server->dynamiclookuparg);
venaas's avatar
venaas committed
595
596
597
598
599
600
601
602
603
604
    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
605
    uint8_t type;
606
    
venaas's avatar
venaas committed
607
608
609
610
    if (conf->servers) {
	debug(DBG_ERR, "addserver: currently works with just one server per conf");
	return 0;
    }
611
    conf->servers = malloc(sizeof(struct server));
venaas's avatar
venaas committed
612
613
614
615
    if (!conf->servers) {
	debug(DBG_ERR, "malloc failed");
	return 0;
    }
616
617
618
    memset(conf->servers, 0, sizeof(struct server));
    conf->servers->conf = conf;

venaas's avatar
venaas committed
619
    type = conf->type;
620
    if (type == RAD_DTLS)
621
	conf->servers->rbios = newqueue();
venaas's avatar
venaas committed
622
623
624
625
    
    if (!srcprotores[type]) {
	res = resolve_hostport(type, *conf->pdef->srcaddrport, NULL);
	srcprotores[type] = res->addrinfo;
venaas's avatar
venaas committed
626
627
628
629
	res->addrinfo = NULL;
	freeclsrvres(res);
    }

venaas's avatar
venaas committed
630
631
632
    conf->servers->sock = -1;
    if (conf->pdef->addserverextra)
	conf->pdef->addserverextra(conf);
633
    
634
    conf->servers->requests = calloc(MAX_REQUESTS, sizeof(struct request));
venaas's avatar
venaas committed
635
636
637
638
639
640
641
642
    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;
    }
643
    conf->servers->newrq = 0;
venaas's avatar
venaas committed
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
    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;
662
663
}

664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
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
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
731
732
733
734
735
736
737
738
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;
}

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
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
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
792
X509 *verifytlscert(SSL *ssl) {
793
794
    X509 *cert;
    unsigned long error;
795
    
venaas's avatar
venaas committed
796
    if (SSL_get_verify_result(ssl) != X509_V_OK) {
venaas's avatar
venaas committed
797
	debug(DBG_ERR, "verifytlscert: basic validation failed");
798
	while ((error = ERR_get_error()))
venaas's avatar
venaas committed
799
800
	    debug(DBG_ERR, "verifytlscert: TLS: %s", ERR_error_string(error, NULL));
	return NULL;
801
    }
802

venaas's avatar
venaas committed
803
    cert = SSL_get_peer_certificate(ssl);
venaas's avatar
venaas committed
804
805
806
807
808
809
810
811
812
813
    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;
    
814
    if (conf->certnamecheck && conf->prefixlen == 255) {
815
816
817
818
819
820
821
822
	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
823
		debug(DBG_WARN, "verifyconfcert: No subjectaltname matching %s %s", type ? "address" : "host", conf->host);
venaas's avatar
venaas committed
824
		return 0;
825
	    }
venaas's avatar
venaas committed
826
	    debug(DBG_DBG, "verifyconfcert: Found subjectaltname matching %s %s", type ? "address" : "host", conf->host);
827
	} else {
venaas's avatar
venaas committed
828
	    if (!cnregexp(cert, conf->host, NULL)) {
venaas's avatar
venaas committed
829
		debug(DBG_WARN, "verifyconfcert: cn not matching host %s", conf->host);
venaas's avatar
venaas committed
830
		return 0;
venaas's avatar
venaas committed
831
	    }		
venaas's avatar
venaas committed
832
	    debug(DBG_DBG, "verifyconfcert: Found cn matching host %s", conf->host);
venaas's avatar
venaas committed
833
834
835
836
	}
    }
    if (conf->certcnregex) {
	if (cnregexp(cert, NULL, conf->certcnregex) < 1) {
venaas's avatar
venaas committed
837
	    debug(DBG_WARN, "verifyconfcert: CN not matching regex");
venaas's avatar
venaas committed
838
	    return 0;
839
	}
venaas's avatar
venaas committed
840
	debug(DBG_DBG, "verifyconfcert: CN matching regex");
841
842
    }
    if (conf->certuriregex) {
venaas's avatar
venaas committed
843
	if (subjectaltnameregexp(cert, GEN_URI, NULL, conf->certuriregex) < 1) {
venaas's avatar
venaas committed
844
	    debug(DBG_WARN, "verifyconfcert: subjectaltname URI not matching regex");
venaas's avatar
venaas committed
845
	    return 0;
846
	}
venaas's avatar
venaas committed
847
	debug(DBG_DBG, "verifyconfcert: subjectaltname URI matching regex");
848
    }
849
    return 1;
850
851
}

venaas's avatar
 
venaas committed
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
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
867
	EVP_DigestUpdate(&mdctx, sec, strlen((char *)sec)) &&
venaas's avatar
 
venaas committed
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
	EVP_DigestFinal_ex(&mdctx, rad + 4, &md_len) &&
	md_len == 16);
    pthread_mutex_unlock(&lock);
    return result;
}

int validauth(unsigned char *rad, unsigned char *reqauth, unsigned char *sec) {
    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 len;
    int result;
    
    pthread_mutex_lock(&lock);
    if (first) {
	EVP_MD_CTX_init(&mdctx);
	first = 0;
    }

    len = RADLEN(rad);
    
    result = (EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) &&
	      EVP_DigestUpdate(&mdctx, rad, 4) &&
	      EVP_DigestUpdate(&mdctx, reqauth, 16) &&
	      (len <= 20 || EVP_DigestUpdate(&mdctx, rad + 20, len - 20)) &&
venaas's avatar
venaas committed
894
	      EVP_DigestUpdate(&mdctx, sec, strlen((char *)sec)) &&
venaas's avatar
 
venaas committed
895
896
897
898
899
900
901
	      EVP_DigestFinal_ex(&mdctx, hash, &len) &&
	      len == 16 &&
	      !memcmp(hash, rad + 4, 16));
    pthread_mutex_unlock(&lock);
    return result;
}
	      
venaas's avatar
venaas committed
902
int checkmessageauth(unsigned char *rad, uint8_t *authattr, char *secret) {
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
    static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
    static unsigned char first = 1;
    static HMAC_CTX hmacctx;
    unsigned int md_len;
    uint8_t auth[16], hash[EVP_MAX_MD_SIZE];
    
    pthread_mutex_lock(&lock);
    if (first) {
	HMAC_CTX_init(&hmacctx);
	first = 0;
    }

    memcpy(auth, authattr, 16);
    memset(authattr, 0, 16);
    md_len = 0;
    HMAC_Init_ex(&hmacctx, secret, strlen(secret), EVP_md5(), NULL);
    HMAC_Update(&hmacctx, rad, RADLEN(rad));
    HMAC_Final(&hmacctx, hash, &md_len);
venaas's avatar
venaas committed
921
    memcpy(authattr, auth, 16);
922
    if (md_len != 16) {
923
	debug(DBG_WARN, "message auth computation failed");
924
925
926
927
928
	pthread_mutex_unlock(&lock);
	return 0;
    }

    if (memcmp(auth, hash, 16)) {
929
	debug(DBG_WARN, "message authenticator, wrong value");
930
931
932
933
934
935
936
937
	pthread_mutex_unlock(&lock);
	return 0;
    }	
	
    pthread_mutex_unlock(&lock);
    return 1;
}

venaas's avatar
venaas committed
938
int createmessageauth(unsigned char *rad, unsigned char *authattrval, char *secret) {
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
    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) {
959
	debug(DBG_WARN, "message auth computation failed");
960
961
962
963
964
965
966
967
	pthread_mutex_unlock(&lock);
	return 0;
    }

    pthread_mutex_unlock(&lock);
    return 1;
}

968
unsigned char *attrget(unsigned char *attrs, int length, uint8_t type) {
969
    while (length > 1) {
venaas's avatar
venaas committed
970
	if (ATTRTYPE(attrs) == type)
971
	    return attrs;
venaas's avatar
venaas committed
972
973
	length -= ATTRLEN(attrs);
	attrs += ATTRLEN(attrs);
974
975
976
977
    }
    return NULL;
}

978
979
980
981
982
983
984
void freerqdata(struct request *rq) {
    if (rq->origusername)
	free(rq->origusername);
    if (rq->buf)
	free(rq->buf);
}

venaas's avatar
venaas committed
985
void sendrq(struct server *to, struct request *rq) {
venaas's avatar
 
venaas committed
986
    int i;
987
    uint8_t *attr;
988

venaas's avatar
 
venaas committed
989
    pthread_mutex_lock(&to->newrq_mutex);
venaas's avatar
venaas committed
990
991
    /* might simplify if only try nextid, might be ok */
    for (i = to->nextid; i < MAX_REQUESTS; i++)
venaas's avatar
 
venaas committed
992
993
994
	if (!to->requests[i].buf)
	    break;
    if (i == MAX_REQUESTS) {
venaas's avatar
venaas committed
995
996
997
998
	for (i = 0; i < to->nextid; i++)
	    if (!to->requests[i].buf)
		break;
	if (i == to->nextid) {
venaas's avatar
venaas committed
999
	    debug(DBG_WARN, "sendrq: no room in queue, dropping request");
1000
	    freerqdata(rq);
venaas's avatar
venaas committed
1001
	    goto exit;
venaas's avatar
venaas committed
1002
	}
venaas's avatar
 
venaas committed
1003
    }
venaas's avatar
venaas committed
1004
    
venaas's avatar
 
venaas committed
1005
    rq->buf[1] = (char)i;
1006

1007
    attr = attrget(rq->buf + 20, RADLEN(rq->buf) - 20, RAD_Attr_Message_Authenticator);
venaas's avatar
venaas committed
1008
    if (attr && !createmessageauth(rq->buf, ATTRVAL(attr), to->conf->secret)) {
1009
	freerqdata(rq);
venaas's avatar
venaas committed
1010
1011
1012
	goto exit;
    }
    
venaas's avatar
venaas committed
1013
    if (*rq->buf == RAD_Accounting_Request) {
venaas's avatar
venaas committed
1014
1015
1016
1017
1018
	if (!radsign(rq->buf, (unsigned char *)to->conf->secret)) {
	    debug(DBG_WARN, "sendrq: failed to sign Accounting-Request message");
	    freerqdata(rq);
	    goto exit;
	}
1019
    }
venaas's avatar
venaas committed
1020

venaas's avatar
venaas committed
1021
    debug(DBG_DBG, "sendrq: inserting packet with id %d in queue for %s", i, to->conf->host);
venaas's avatar
 
venaas committed
1022
    to->requests[i] = *rq;
1023
    to->nextid = i + 1;
venaas's avatar
 
venaas committed
1024
1025
1026

    if (!to->newrq) {
	to->newrq = 1;
venaas's avatar
venaas committed
1027
	debug(DBG_DBG, "sendrq: signalling client writer");
venaas's avatar
 
venaas committed
1028
1029
	pthread_cond_signal(&to->newrq_cond);
    }
venaas's avatar
venaas committed
1030
 exit:
venaas's avatar
 
venaas committed
1031
1032
1033
    pthread_mutex_unlock(&to->newrq_mutex);
}

1034
void sendreply(struct client *to, unsigned char *buf, struct sockaddr_storage *tosa, int toudpsock) {
1035
1036
    struct reply *reply;
    uint8_t first;
venaas's avatar
 
venaas committed
1037
    
venaas's avatar
venaas committed
1038
    if (!radsign(buf, (unsigned char *)to->conf->secret)) {
venaas's avatar
venaas committed
1039
1040
1041
1042
	free(buf);
	debug(DBG_WARN, "sendreply: failed to sign message");
	return;
    }
1043
1044
1045

    reply = malloc(sizeof(struct reply));
    if (!reply) {
1046
	free(buf);
1047
	debug(DBG_ERR, "sendreply: malloc failed");
venaas's avatar
 
venaas committed
1048
1049
	return;
    }
1050
1051
    memset(reply, 0, sizeof(struct reply));
    reply->buf = buf;
venaas's avatar
 
venaas committed
1052
    if (tosa)
1053
	reply->tosa = *tosa;
1054
    reply->toudpsock = toudpsock;
1055
1056
    
    pthread_mutex_lock(&to->replyq->mutex);
venaas's avatar
 
venaas committed
1057

1058
    first = list_first(to->replyq->entries) == NULL;
1059
    
1060
    if (!list_push(to->replyq->entries, reply)) {
1061
1062
1063
1064
1065
1066
1067
1068
	pthread_mutex_unlock(&to->replyq->mutex);
	free(reply);
	free(buf);
	debug(DBG_ERR, "sendreply: malloc failed");
	return;
    }
    
    if (first) {
1069
	debug(DBG_DBG, "signalling server writer");
1070
	pthread_cond_signal(&to->replyq->cond);
venaas's avatar
 
venaas committed
1071
    }
1072
    pthread_mutex_unlock(&to->replyq->mutex);
venaas's avatar
 
venaas committed
1073
1074
}

venaas's avatar
venaas committed
1075
int pwdencrypt(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
1100
1101
1102
1103
1104
1105
	    !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
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
int pwddecrypt(uint8_t *in, uint8_t len, char *shared, uint8_t sharedlen, uint8_t *auth) {
venaas's avatar
 
venaas committed
1112
1113
1114
1115
1116
    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
1117
    uint8_t i, offset = 0, out[128];
venaas's avatar
 
venaas committed
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
    
    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
1128
	    !EVP_DigestUpdate(&mdctx, (uint8_t *)shared, sharedlen) ||
venaas's avatar
 
venaas committed
1129
1130
1131
1132
1133
1134
1135
	    !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
1136
1137
	    out[offset + i] = hash[i] ^ in[offset + i];
	input = in + offset;
venaas's avatar
 
venaas committed
1138
	offset += 16;
venaas's avatar
venaas committed
1139
	if (offset == len)
venaas's avatar
 
venaas committed
1140
1141
	    break;
    }
venaas's avatar
venaas committed
1142
    memcpy(in, out, len);
venaas's avatar
 
venaas committed
1143
1144
1145
1146
    pthread_mutex_unlock(&lock);
    return 1;
}

venaas's avatar
venaas committed
1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
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;
    }

1161
1162
1163
1164
#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
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
#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    
1177
    printfchars(NULL, "msppencrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1178
1179
1180
1181
1182
1183
#endif
    
    for (i = 0; i < 16; i++)
	text[i] ^= hash[i];
    
    for (offset = 16; offset < len; offset += 16) {
venaas's avatar
venaas committed
1184
#if 0	
venaas's avatar
venaas committed
1185
	printf("text + offset - 16 c(%d): ", offset / 16);
1186
	printfchars(NULL, NULL, "%02x ", text + offset - 16, 16);
venaas's avatar
venaas committed
1187
#endif
venaas's avatar
venaas committed
1188
1189
1190
1191
1192
1193
1194
1195
	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;
	}
1196
1197
#if 0
	printfchars(NULL, "msppencrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1198
1199
1200
1201
1202
1203
1204
#endif    
	
	for (i = 0; i < 16; i++)
	    text[offset + i] ^= hash[i];
    }
    
#if 0
1205
    printfchars(NULL, "msppencrypt out", "%02x ", text, len);
venaas's avatar
venaas committed
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
#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;
    }

1227
1228
1229
1230
#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
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
#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    
1243
    printfchars(NULL, "msppdecrypt hash", "%02x ", hash, 16);
venaas's avatar
venaas committed
1244
1245
1246
1247
1248
1249
1250
1251
#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);
1252
	printfchars(NULL, NULL, "%02x ", text + offset - 16, 16);
venaas's avatar
venaas committed
1253
1254
1255
1256
1257
1258
1259
1260
1261
#endif
	if (!EVP_DigestInit_ex(&mdctx, EVP_md5(), NULL) ||
	    !EVP_DigestUpdate(&mdctx, shared, sharedlen) ||
	    !EVP_DigestUpdate(&mdctx, text + offset