some code improvemetns, more efficiently removing outstanding requests when removing...
[radsecproxy.git] / radsecproxy.c
index 9136c18..280cb41 100644 (file)
@@ -6,6 +6,11 @@
  * copyright notice and this permission notice appear in all copies.
  */
 
+/* Code contributions from:
+ *
+ * Arne Schwabe <schwabe at uni-paderborn.de>
+ */
+
 /* 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
 */
 
 /* Bugs:
- * TCP accounting not yet supported
+ * May segfault when dtls connections go down? More testing needed
+ * Need to remove UDP clients when no activity for a while...
+ * Remove expired stuff from clients request list?
  * We are not removing client requests from dynamic servers, see removeclientrqs()
+ * Multiple outgoing connections if not enough IDs? (multiple servers per conf?)
+ * Useful for TCP accounting? Now we require separate server config for alt port
  */
 
 #include <signal.h>
 #include <openssl/x509v3.h>
 #include "debug.h"
 #include "list.h"
+#include "hash.h"
 #include "util.h"
 #include "gconfig.h"
 #include "radsecproxy.h"
+#include "udp.h"
+#include "tcp.h"
+#include "tls.h"
+#include "dtls.h"
 
 static struct options options;
-struct list *clconfs, *srvconfs, *realms, *tlsconfs, *rewriteconfs;
+static struct list *clconfs, *srvconfs;
+struct list *realms;
+struct hash *tlsconfs, *rewriteconfs;
 
-static struct addrinfo *srcprotores[3] = { NULL, NULL, NULL };
+static struct addrinfo *srcprotores[4] = { NULL, NULL, NULL, NULL };
 
-static struct replyq *udp_server_replyq = NULL;
-static int udp_client4_sock = -1;
-static int udp_client6_sock = -1;
-static pthread_mutex_t *ssl_locks;
+static pthread_mutex_t *ssl_locks = NULL;
 static long *ssl_lock_count;
 extern int optind;
 extern char *optarg;
@@ -84,19 +97,10 @@ int dynamicconfig(struct server *server);
 int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val);
 void freerealm(struct realm *realm);
 void freeclsrvconf(struct clsrvconf *conf);
-void freerqdata(struct request *rq);
-void *udpserverrd(void *arg);
-void *tlslistener(void *arg);
-void *tcplistener(void *arg);
-int tlsconnect(struct server *server, struct timeval *when, int timeout, char *text);
-int tcpconnect(struct server *server, struct timeval *when, int timeout, char *text);
-void *udpclientrd(void *arg);
-void *tlsclientrd(void *arg);
-void *tcpclientrd(void *arg);
-int clientradputudp(struct server *server, unsigned char *rad);
-int clientradputtls(struct server *server, unsigned char *rad);
-int clientradputtcp(struct server *server, unsigned char *rad);
-    
+void freerq(struct request *rq);
+void freerqoutdata(struct rqout *rqout);
+void rmclientrq(struct request *rq, uint8_t id);
+
 static const struct protodefs protodefs[] = {
     {   "udp", /* UDP, assuming RAD_UDP defined as 0 */
        NULL, /* secretdefault */
@@ -106,11 +110,15 @@ static const struct protodefs protodefs[] = {
        10, /* retrycountmax */
        REQUEST_RETRY_INTERVAL, /* retryintervaldefault */
        60, /* retryintervalmax */
+       DUPLICATE_INTERVAL, /* duplicateintervaldefault */
        udpserverrd, /* listener */
        &options.sourceudp, /* srcaddrport */
        NULL, /* connecter */
-       udpclientrd, /* clientreader */
-       clientradputudp /* clientradput */
+       NULL, /* clientconnreader */
+       clientradputudp, /* clientradput */
+       addclientudp, /* addclient */
+       addserverextraudp, /* addserverextra */
+       initextraudp /* initextra */
     },
     {   "tls", /* TLS, assuming RAD_TLS defined as 1 */
        "mysecret", /* secretdefault */
@@ -120,11 +128,15 @@ static const struct protodefs protodefs[] = {
        0, /* retrycountmax */
        REQUEST_RETRY_INTERVAL * REQUEST_RETRY_COUNT, /* retryintervaldefault */
        60, /* retryintervalmax */
+       DUPLICATE_INTERVAL, /* duplicateintervaldefault */
        tlslistener, /* listener */
        &options.sourcetls, /* srcaddrport */
        tlsconnect, /* connecter */
-       tlsclientrd, /* clientreader */
-       clientradputtls /* clientradput */
+       tlsclientrd, /* clientconnreader */
+       clientradputtls, /* clientradput */
+       NULL, /* addclient */
+       NULL, /* addserverextra */
+       NULL /* initextra */
     },
     {   "tcp", /* TCP, assuming RAD_TCP defined as 2 */
        NULL, /* secretdefault */
@@ -134,11 +146,33 @@ static const struct protodefs protodefs[] = {
        0, /* retrycountmax */
        REQUEST_RETRY_INTERVAL * REQUEST_RETRY_COUNT, /* retryintervaldefault */
        60, /* retryintervalmax */
+       DUPLICATE_INTERVAL, /* duplicateintervaldefault */
        tcplistener, /* listener */
        &options.sourcetcp, /* srcaddrport */
        tcpconnect, /* connecter */
-       tcpclientrd, /* clientreader */
-       clientradputtcp /* clientradput */
+       tcpclientrd, /* clientconnreader */
+       clientradputtcp, /* clientradput */
+       NULL, /* addclient */
+       NULL, /* addserverextra */
+       NULL /* initextra */
+    },
+    {   "dtls", /* DTLS, assuming RAD_DTLS defined as 3 */
+       "mysecret", /* secretdefault */
+       SOCK_DGRAM, /* socktype */
+       "2083", /* portdefault */
+       REQUEST_RETRY_COUNT, /* retrycountdefault */
+       10, /* retrycountmax */
+       REQUEST_RETRY_INTERVAL, /* retryintervaldefault */
+       60, /* retryintervalmax */
+       DUPLICATE_INTERVAL, /* duplicateintervaldefault */
+       udpdtlsserverrd, /* listener */
+       &options.sourcedtls, /* srcaddrport */
+       dtlsconnect, /* connecter */
+       dtlsclientrd, /* clientconnreader */
+       clientradputdtls, /* clientradput */
+       NULL, /* addclient */
+       addserverextradtls, /* addserverextra */
+       initextradtls /* initextra */
     },
     {   NULL
     }
@@ -214,6 +248,10 @@ static int verify_cb(int ok, X509_STORE_CTX *ctx) {
   return ok;
 }
 
+struct addrinfo *getsrcprotores(uint8_t type) {
+    return srcprotores[type];
+}
+
 int resolvepeer(struct clsrvconf *conf, int ai_flags) {
     struct addrinfo hints, *addrinfo, *res;
     char *slash, *s;
@@ -248,16 +286,8 @@ int resolvepeer(struct clsrvconf *conf, int ai_flags) {
            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;
-           }
-       }
+       for (res = addrinfo; res; res = res->ai_next)
+           port_set(res->ai_addr, 0);
     } else {
        if (slash)
            hints.ai_flags |= AI_NUMERICHOST;
@@ -292,33 +322,6 @@ int resolvepeer(struct clsrvconf *conf, int ai_flags) {
     return 1;
 }        
 
-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;
-}        
-
 char *parsehostport(char *s, struct clsrvconf *conf, char *default_port) {
     char *p, *field;
     int ipv6 = 0;
@@ -387,26 +390,6 @@ void freeclsrvres(struct clsrvconf *res) {
     free(res);
 }
 
-int connecttcp(struct addrinfo *addrinfo, struct addrinfo *src) {
-    int s;
-    struct addrinfo *res;
-
-    s = -1;
-    for (res = addrinfo; res; res = res->ai_next) {
-       s = bindtoaddr(src, res->ai_family, 1, 1);
-        if (s < 0) {
-            debug(DBG_WARN, "connecttoserver: socket failed");
-            continue;
-        }
-        if (connect(s, res->ai_addr, res->ai_addrlen) == 0)
-            break;
-        debug(DBG_WARN, "connecttoserver: connect failed");
-        close(s);
-        s = -1;
-    }
-    return s;
-}        
-
 /* 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 };
@@ -419,42 +402,6 @@ int prefixmatch(void *a1, void *a2, uint8_t len) {
     return (((uint8_t *)a1)[l] & mask[r]) == (((uint8_t *)a2)[l] & mask[r]);
 }
 
-/* check if conf has matching address */
-struct clsrvconf *checkconfaddr(uint8_t type, struct sockaddr *addr, struct clsrvconf *conf) {
-    struct sockaddr_in6 *sa6 = NULL;
-    struct in_addr *a4 = NULL;
-    struct addrinfo *res;
-    
-    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;
-
-    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 &&
-                    !memcmp(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, 16)))
-                   return conf;
-       } 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 &&
-                 prefixmatch(&sa6->sin6_addr, &((struct sockaddr_in6 *)res->ai_addr)->sin6_addr, conf->prefixlen))))
-               return conf;
-       }
-    }
-    return NULL;
-}
-
 /* returns next config with matching address, or NULL */
 struct clsrvconf *find_conf(uint8_t type, struct sockaddr *addr, struct list *confs, struct list_node **cur) {
     struct sockaddr_in6 *sa6 = NULL;
@@ -502,12 +449,20 @@ struct clsrvconf *find_conf(uint8_t type, struct sockaddr *addr, struct list *co
     return NULL;
 }
 
+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);
+}
+
 /* returns next config of given type, or NULL */
-struct clsrvconf *find_conf_type(uint8_t type, struct list *confs, struct list_node **cur) {
+struct clsrvconf *find_clconf_type(uint8_t type, struct list_node **cur) {
     struct list_node *entry;
     struct clsrvconf *conf;
     
-    for (entry = (cur && *cur ? list_next(*cur) : list_first(confs)); entry; entry = list_next(entry)) {
+    for (entry = (cur && *cur ? list_next(*cur) : list_first(clconfs)); entry; entry = list_next(entry)) {
        conf = (struct clsrvconf *)entry->data;
        if (conf->type == type) {
            if (cur)
@@ -518,30 +473,60 @@ struct clsrvconf *find_conf_type(uint8_t type, struct list *confs, struct list_n
     return NULL;
 }
 
-struct replyq *newreplyq() {
-    struct replyq *replyq;
+struct queue *newqueue() {
+    struct queue *q;
     
-    replyq = malloc(sizeof(struct replyq));
-    if (!replyq)
+    q = malloc(sizeof(struct queue));
+    if (!q)
        debugx(1, DBG_ERR, "malloc failed");
-    replyq->replies = list_create();
-    if (!replyq->replies)
+    q->entries = list_create();
+    if (!q->entries)
        debugx(1, DBG_ERR, "malloc failed");
-    pthread_mutex_init(&replyq->mutex, NULL);
-    pthread_cond_init(&replyq->cond, NULL);
-    return replyq;
+    pthread_mutex_init(&q->mutex, NULL);
+    pthread_cond_init(&q->cond, NULL);
+    return q;
+}
+
+void removequeue(struct queue *q) {
+    struct list_node *entry;
+
+    if (!q)
+       return;
+    pthread_mutex_lock(&q->mutex);
+    for (entry = list_first(q->entries); entry; entry = list_next(entry))
+       freerq((struct request *)entry);
+    list_destroy(q->entries);
+    pthread_cond_destroy(&q->cond);
+    pthread_mutex_unlock(&q->mutex);
+    pthread_mutex_destroy(&q->mutex);
+    free(q);
+}
+
+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);
 }
 
-struct client *addclient(struct clsrvconf *conf) {
+struct client *addclient(struct clsrvconf *conf, uint8_t lock) {
     struct client *new = malloc(sizeof(struct client));
     
     if (!new) {
        debug(DBG_ERR, "malloc failed");
        return NULL;
     }
+
+    if (lock)
+       pthread_mutex_lock(conf->lock);
     if (!conf->clients) {
        conf->clients = list_create();
        if (!conf->clients) {
+           if (lock)
+               pthread_mutex_unlock(conf->lock);
            debug(DBG_ERR, "malloc failed");
            return NULL;
        }
@@ -549,62 +534,71 @@ struct client *addclient(struct clsrvconf *conf) {
     
     memset(new, 0, sizeof(struct client));
     new->conf = conf;
-    new->replyq = conf->type == RAD_UDP ? udp_server_replyq : newreplyq();
-
+    if (conf->pdef->addclient)
+       conf->pdef->addclient(new);
+    else
+       new->replyq = newqueue();
     list_push(conf->clients, new);
+    if (lock)
+       pthread_mutex_unlock(conf->lock);
     return new;
 }
 
-void removeclient(struct client *client) {
-    struct list_node *entry;
-    
-    if (!client || !client->conf->clients)
-       return;
-
-    pthread_mutex_lock(&client->replyq->mutex);
-    for (entry = list_first(client->replyq->replies); entry; entry = list_next(entry))
-       free(((struct reply *)entry)->buf);
-    list_destroy(client->replyq->replies);
-    pthread_cond_destroy(&client->replyq->cond);
-    pthread_mutex_unlock(&client->replyq->mutex);
-    pthread_mutex_destroy(&client->replyq->mutex);
-    list_removedata(client->conf->clients, client);
-    free(client);
-}
-
 void removeclientrqs(struct client *client) {
-    struct list_node *entry;
-    struct server *server;
     struct request *rq;
+    struct rqout *rqout;
     int i;
-    
-    for (entry = list_first(srvconfs); entry; entry = list_next(entry)) {
-       server = ((struct clsrvconf *)entry->data)->servers;
-       if (!server)
+
+    for (i = 0; i < MAX_REQUESTS; i++) {
+       rq = client->rqs[i];
+       if (!rq)
            continue;
-       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);
+       rqout = rq->to->requests + rq->newid;
+       pthread_mutex_lock(rqout->lock);
+       if (rqout->rq == rq) /* still pointing to our request */
+           freerqoutdata(rqout);
+       pthread_mutex_unlock(rqout->lock);                              
+       freerq(rq);
+    }
+}
+
+void removeclient(struct client *client) {
+    struct clsrvconf *conf;
+    
+    if (!client)
+       return;
+    conf = client->conf;
+    pthread_mutex_lock(conf->lock);
+    if (conf->clients) {
+       removeclientrqs(client);
+       removequeue(client->replyq);
+       list_removedata(conf->clients, client);
+       free(client->addr);
+       free(client);
     }
+    pthread_mutex_unlock(conf->lock);
 }
 
 void freeserver(struct server *server, uint8_t destroymutex) {
-    struct request *rq, *end;
+    struct rqout *rqout, *end;
 
     if (!server)
        return;
 
-    if(server->requests) {
-       rq = server->requests;
-       for (end = rq + MAX_REQUESTS; rq < end; rq++)
-           freerqdata(rq);
+    if (server->requests) {
+       rqout = server->requests;
+       for (end = rqout + MAX_REQUESTS; rqout < end; rqout++) {
+           freerqoutdata(rqout);
+           pthread_mutex_destroy(rqout->lock);
+           free(rqout->lock);
+       }
        free(server->requests);
     }
+    if (server->rbios)
+       freebios(server->rbios);
     free(server->dynamiclookuparg);
+    if (server->ssl)
+       SSL_free(server->ssl);
     if (destroymutex) {
        pthread_mutex_destroy(&server->lock);
        pthread_cond_destroy(&server->newrq_cond);
@@ -615,6 +609,8 @@ void freeserver(struct server *server, uint8_t destroymutex) {
 
 int addserver(struct clsrvconf *conf) {
     struct clsrvconf *res;
+    uint8_t type;
+    int i;
     
     if (conf->servers) {
        debug(DBG_ERR, "addserver: currently works with just one server per conf");
@@ -628,43 +624,39 @@ int addserver(struct clsrvconf *conf) {
     memset(conf->servers, 0, sizeof(struct server));
     conf->servers->conf = conf;
 
-    if (!srcprotores[conf->type]) {
-       res = resolve_hostport(conf->type, *conf->pdef->srcaddrport, NULL);
-       srcprotores[conf->type] = res->addrinfo;
+    type = conf->type;
+    if (type == RAD_DTLS)
+       conf->servers->rbios = newqueue();
+    
+    if (!srcprotores[type]) {
+       res = resolve_hostport(type, *conf->pdef->srcaddrport, NULL);
+       srcprotores[type] = res->addrinfo;
        res->addrinfo = NULL;
        freeclsrvres(res);
     }
 
-    if (conf->type == RAD_UDP) {
-       switch (conf->addrinfo->ai_family) {
-       case AF_INET:
-           if (udp_client4_sock < 0) {
-               udp_client4_sock = bindtoaddr(srcprotores[RAD_UDP], AF_INET, 0, 1);
-               if (udp_client4_sock < 0)
-                   debugx(1, DBG_ERR, "addserver: failed to create client socket for server %s", conf->host);
-           }
-           conf->servers->sock = udp_client4_sock;
-           break;
-       case AF_INET6:
-           if (udp_client6_sock < 0) {
-               udp_client6_sock = bindtoaddr(srcprotores[RAD_UDP], AF_INET6, 0, 1);
-               if (udp_client6_sock < 0)
-                   debugx(1, DBG_ERR, "addserver: failed to create client socket for server %s", conf->host);
-           }
-           conf->servers->sock = udp_client6_sock;
-           break;
-       default:
-           debugx(1, DBG_ERR, "addserver: unsupported address family");
-       }
-       
-    } else
-       conf->servers->sock = -1;
+    conf->servers->sock = -1;
+    if (conf->pdef->addserverextra)
+       conf->pdef->addserverextra(conf);
     
-    conf->servers->requests = calloc(MAX_REQUESTS, sizeof(struct request));
+    conf->servers->requests = calloc(MAX_REQUESTS, sizeof(struct rqout));
     if (!conf->servers->requests) {
        debug(DBG_ERR, "malloc failed");
        goto errexit;
     }
+    for (i = 0; i < MAX_REQUESTS; i++) {
+       conf->servers->requests[i].lock = malloc(sizeof(pthread_mutex_t));
+       if (!conf->servers->requests[i].lock) {
+           debug(DBG_ERR, "malloc failed");
+           goto errexit;
+       }
+       if (pthread_mutex_init(conf->servers->requests[i].lock, NULL)) {
+           debug(DBG_ERR, "mutex init failed");
+           free(conf->servers->requests[i].lock);
+           conf->servers->requests[i].lock = NULL;
+           goto errexit;
+       }
+    }
     if (pthread_mutex_init(&conf->servers->lock, NULL)) {
        debug(DBG_ERR, "mutex init failed");
        goto errexit;
@@ -690,85 +682,6 @@ int addserver(struct clsrvconf *conf) {
     return 0;
 }
 
-/* exactly one of client and server must be non-NULL */
-/* should probably take peer list (client(s) or server(s)) as argument instead */
-/* if *peer == NULL we return who we received from, else require it to be from peer */
-/* return from in sa if not NULL */
-unsigned char *radudpget(int s, struct client **client, struct server **server, struct sockaddr_storage *sa) {
-    int cnt, len;
-    unsigned char buf[4], *rad;
-    struct sockaddr_storage from;
-    socklen_t fromlen = sizeof(from);
-    struct clsrvconf *p;
-    struct list_node *node;
-    
-    for (;;) {
-       cnt = recvfrom(s, buf, 4, MSG_PEEK, (struct sockaddr *)&from, &fromlen);
-       if (cnt == -1) {
-           debug(DBG_WARN, "radudpget: recv failed");
-           continue;
-       }
-
-       if (client)
-           if (*client)
-               p = checkconfaddr(RAD_UDP, (struct sockaddr *)&from, (*client)->conf);
-           else
-               p = find_conf(RAD_UDP, (struct sockaddr *)&from, clconfs, NULL);
-       else
-           if (*server)
-               p = checkconfaddr(RAD_UDP, (struct sockaddr *)&from, (*server)->conf);
-           else
-               p = find_conf(RAD_UDP, (struct sockaddr *)&from, srvconfs, NULL);
-
-       if (!p) {
-           debug(DBG_WARN, "radudpget: got packet from wrong or unknown UDP peer %s, ignoring", addr2string((struct sockaddr *)&from, fromlen));
-           recv(s, buf, 4, 0);
-           continue;
-       }
-       
-       len = RADLEN(buf);
-       if (len < 20) {
-           debug(DBG_WARN, "radudpget: length too small");
-           recv(s, buf, 4, 0);
-           continue;
-       }
-       
-       rad = malloc(len);
-       if (!rad) {
-           debug(DBG_ERR, "radudpget: malloc failed");
-           recv(s, buf, 4, 0);
-           continue;
-       }
-       
-       cnt = recv(s, rad, len, MSG_TRUNC);
-       debug(DBG_DBG, "radudpget: got %d bytes from %s", cnt, addr2string((struct sockaddr *)&from, fromlen));
-
-       if (cnt < len) {
-           debug(DBG_WARN, "radudpget: packet smaller than length field in radius header");
-           free(rad);
-           continue;
-       }
-       
-       if (cnt > len)
-           debug(DBG_DBG, "radudpget: packet was padded with %d bytes", cnt - len);
-
-       if (client && !*client) {
-           node = list_first(p->clients);
-           *client = node ? (struct client *)node->data : addclient(p);
-           if (!*client) {
-               free(rad);
-               continue;
-           }
-       } else if (server && !*server)
-           *server = p->servers;
-       
-       break;
-    }
-    if (sa)
-       *sa = from;
-    return rad;
-}
-
 int subjectaltnameaddr(X509 *cert, int family, struct in6_addr *addr) {
     int loc, i, l, n, r = 0;
     char *v;
@@ -957,560 +870,136 @@ int verifyconfcert(X509 *cert, struct clsrvconf *conf) {
     return 1;
 }
 
-int tlsconnect(struct server *server, struct timeval *when, int timeout, char *text) {
-    struct timeval now;
-    time_t elapsed;
-    X509 *cert;
-    
-    debug(DBG_DBG, "tlsconnect: called from %s", text);
-    pthread_mutex_lock(&server->lock);
-    if (when && memcmp(&server->lastconnecttry, when, sizeof(struct timeval))) {
-       /* already reconnected, nothing to do */
-       debug(DBG_DBG, "tlsconnect(%s): seems already reconnected", text);
-       pthread_mutex_unlock(&server->lock);
-       return 1;
-    }
-
-    for (;;) {
-       gettimeofday(&now, NULL);
-       elapsed = now.tv_sec - server->lastconnecttry.tv_sec;
-       if (timeout && server->lastconnecttry.tv_sec && elapsed > timeout) {
-           debug(DBG_DBG, "tlsconnect: timeout");
-           if (server->sock >= 0)
-               close(server->sock);
-           SSL_free(server->ssl);
-           server->ssl = NULL;
-           pthread_mutex_unlock(&server->lock);
-           return 0;
-       }
-       if (server->connectionok) {
-           server->connectionok = 0;
-           sleep(2);
-       } else if (elapsed < 1)
-           sleep(2);
-       else if (elapsed < 60) {
-           debug(DBG_INFO, "tlsconnect: sleeping %lds", elapsed);
-           sleep(elapsed);
-       } else if (elapsed < 100000) {
-           debug(DBG_INFO, "tlsconnect: sleeping %ds", 60);
-           sleep(60);
-       } else
-           server->lastconnecttry.tv_sec = now.tv_sec;  /* no sleep at startup */
-       debug(DBG_WARN, "tlsconnect: trying to open TLS connection to %s port %s", server->conf->host, server->conf->port);
-       if (server->sock >= 0)
-           close(server->sock);
-       if ((server->sock = connecttcp(server->conf->addrinfo, srcprotores[RAD_TLS])) < 0) {
-           debug(DBG_ERR, "tlsconnect: connecttcp failed");
-           continue;
-       }
-       
-       SSL_free(server->ssl);
-       server->ssl = SSL_new(server->conf->ssl_ctx);
-       SSL_set_fd(server->ssl, server->sock);
-       if (SSL_connect(server->ssl) <= 0)
-           continue;
-       cert = verifytlscert(server->ssl);
-       if (!cert)
-           continue;
-       if (verifyconfcert(cert, server->conf)) {
-           X509_free(cert);
-           break;
-       }
-       X509_free(cert);
+unsigned char *attrget(unsigned char *attrs, int length, uint8_t type) {
+    while (length > 1) {
+       if (ATTRTYPE(attrs) == type)
+           return attrs;
+       length -= ATTRLEN(attrs);
+       attrs += ATTRLEN(attrs);
     }
-    debug(DBG_WARN, "tlsconnect: TLS connection to %s port %s up", server->conf->host, server->conf->port);
-    gettimeofday(&server->lastconnecttry, NULL);
-    pthread_mutex_unlock(&server->lock);
-    return 1;
+    return NULL;
 }
 
-int tcpconnect(struct server *server, struct timeval *when, int timeout, char *text) {
-    struct timeval now;
-    time_t elapsed;
-    
-    debug(DBG_DBG, "tcpconnect: called from %s", text);
-    pthread_mutex_lock(&server->lock);
-    if (when && memcmp(&server->lastconnecttry, when, sizeof(struct timeval))) {
-       /* already reconnected, nothing to do */
-       debug(DBG_DBG, "tcpconnect(%s): seems already reconnected", text);
-       pthread_mutex_unlock(&server->lock);
-       return 1;
-    }
-
-    for (;;) {
-       gettimeofday(&now, NULL);
-       elapsed = now.tv_sec - server->lastconnecttry.tv_sec;
-       if (timeout && server->lastconnecttry.tv_sec && elapsed > timeout) {
-           debug(DBG_DBG, "tcpconnect: timeout");
-           if (server->sock >= 0)
-               close(server->sock);
-           pthread_mutex_unlock(&server->lock);
-           return 0;
-       }
-       if (server->connectionok) {
-           server->connectionok = 0;
-           sleep(2);
-       } else if (elapsed < 1)
-           sleep(2);
-       else if (elapsed < 60) {
-           debug(DBG_INFO, "tcpconnect: sleeping %lds", elapsed);
-           sleep(elapsed);
-       } else if (elapsed < 100000) {
-           debug(DBG_INFO, "tcpconnect: sleeping %ds", 60);
-           sleep(60);
-       } else
-           server->lastconnecttry.tv_sec = now.tv_sec;  /* no sleep at startup */
-       debug(DBG_WARN, "tcpconnect: trying to open TCP connection to %s port %s", server->conf->host, server->conf->port);
-       if (server->sock >= 0)
-           close(server->sock);
-       if ((server->sock = connecttcp(server->conf->addrinfo, srcprotores[RAD_TCP])) >= 0)
-           break;
-       debug(DBG_ERR, "tcpconnect: connecttcp failed");
-    }
-    debug(DBG_WARN, "tcpconnect: TCP connection to %s port %s up", server->conf->host, server->conf->port);
-    gettimeofday(&server->lastconnecttry, NULL);
-    pthread_mutex_unlock(&server->lock);
-    return 1;
+void freerq(struct request *rq) {
+    if (!rq)
+       return;
+    debug(DBG_DBG, "freerq: called with refcount %d", rq->refcount);
+    if (--rq->refcount)
+       return;
+    if (rq->origusername)
+       free(rq->origusername);
+    if (rq->buf)
+       free(rq->buf);
+    if (rq->replybuf)
+       free(rq->replybuf);
+    if (rq->msg)
+       radmsg_free(rq->msg);
+    free(rq);
 }
 
-/* timeout in seconds, 0 means no timeout (blocking), returns when num bytes have been read, or timeout */
-/* returns 0 on timeout, -1 on error and num if ok */
-int sslreadtimeout(SSL *ssl, unsigned char *buf, int num, int timeout) {
-    int s, ndesc, cnt, len;
-    fd_set readfds, writefds;
-    struct timeval timer;
-    
-    s = SSL_get_fd(ssl);
-    if (s < 0)
-       return -1;
-    /* make socket non-blocking? */
-    for (len = 0; len < num; len += cnt) {
-       FD_ZERO(&readfds);
-       FD_SET(s, &readfds);
-       writefds = readfds;
-       if (timeout) {
-           timer.tv_sec = timeout;
-           timer.tv_usec = 0;
-       }
-       ndesc = select(s + 1, &readfds, &writefds, NULL, timeout ? &timer : NULL);
-       if (ndesc < 1)
-           return ndesc;
-
-       cnt = SSL_read(ssl, buf + len, num - len);
-       if (cnt <= 0)
-           switch (SSL_get_error(ssl, cnt)) {
-           case SSL_ERROR_WANT_READ:
-           case SSL_ERROR_WANT_WRITE:
-               cnt = 0;
-               continue;
-           case SSL_ERROR_ZERO_RETURN:
-               /* remote end sent close_notify, send one back */
-               SSL_shutdown(ssl);
-               /* fall through */
-           default:
-               return -1;
-           }
+void freerqoutdata(struct rqout *rqout) {
+    if (!rqout)
+       return;
+    if (rqout->rq) {
+       freerq(rqout->rq);
+       rqout->rq = NULL;
     }
-    return num;
+    rqout->tries = 0;
+    memset(&rqout->expiry, 0, sizeof(struct timeval));
 }
 
-/* timeout in seconds, 0 means no timeout (blocking) */
-unsigned char *radtlsget(SSL *ssl, int timeout) {
-    int cnt, len;
-    unsigned char buf[4], *rad;
-
-    for (;;) {
-       cnt = sslreadtimeout(ssl, buf, 4, timeout);
-       if (cnt < 1) {
-           debug(DBG_DBG, cnt ? "radtlsget: connection lost" : "radtlsget: timeout");
-           return NULL;
+void sendrq(struct request *rq) {
+    int i, start;
+    struct server *to = rq->to;
+    
+    start = to->conf->statusserver ? 1 : 0;
+    pthread_mutex_lock(&to->newrq_mutex);
+    if (start && rq->msg->code == RAD_Status_Server) {
+       pthread_mutex_lock(to->requests[0].lock);
+       if (to->requests[0].rq) {
+           pthread_mutex_unlock(to->requests[0].lock);
+           debug(DBG_WARN, "sendrq: status server already in queue, dropping request");
+           goto errexit;
        }
-
-       len = RADLEN(buf);
-       rad = malloc(len);
-       if (!rad) {
-           debug(DBG_ERR, "radtlsget: malloc failed");
-           continue;
+       i = 0;
+    } else {
+       if (!to->nextid)
+           to->nextid = start;
+       /* might simplify if only try nextid, might be ok */
+       for (i = to->nextid; i < MAX_REQUESTS; i++) {
+           if (!to->requests[i].rq) {
+               pthread_mutex_lock(to->requests[i].lock);
+               if (!to->requests[i].rq)
+                   break;
+               pthread_mutex_unlock(to->requests[i].lock);
+           }
        }
-       memcpy(rad, buf, 4);
-       
-       cnt = sslreadtimeout(ssl, rad + 4, len - 4, timeout);
-       if (cnt < 1) {
-           debug(DBG_DBG, cnt ? "radtlsget: connection lost" : "radtlsget: timeout");
-           free(rad);
-           return NULL;
+       if (i == MAX_REQUESTS) {
+           for (i = start; i < to->nextid; i++) {
+               if (!to->requests[i].rq) {
+                   pthread_mutex_lock(to->requests[i].lock);
+                   if (!to->requests[i].rq)
+                       break;
+                   pthread_mutex_unlock(to->requests[i].lock);
+               }
+           }
+           if (i == to->nextid) {
+               debug(DBG_WARN, "sendrq: no room in queue, dropping request");
+               goto errexit;
+           }
        }
-       
-       if (len >= 20)
-           break;
-       
-       free(rad);
-       debug(DBG_WARN, "radtlsget: packet smaller than minimum radius size");
+    }
+    rq->newid = (uint8_t)i;
+    rq->msg->id = (uint8_t)i;
+    rq->buf = radmsg2buf(rq->msg, (uint8_t *)to->conf->secret);
+    if (!rq->buf) {
+       pthread_mutex_unlock(to->requests[i].lock);
+       debug(DBG_ERR, "sendrq: radmsg2buf failed");
+       goto errexit;
     }
     
-    debug(DBG_DBG, "radtlsget: got %d bytes", len);
-    return rad;
-}
-
-/* timeout in seconds, 0 means no timeout (blocking), returns when num bytes have been read, or timeout */
-/* returns 0 on timeout, -1 on error and num if ok */
-int tcpreadtimeout(int s, unsigned char *buf, int num, int timeout) {
-    int ndesc, cnt, len;
-    fd_set readfds, writefds;
-    struct timeval timer;
-    
-    if (s < 0)
-       return -1;
-    /* make socket non-blocking? */
-    for (len = 0; len < num; len += cnt) {
-       FD_ZERO(&readfds);
-       FD_SET(s, &readfds);
-       writefds = readfds;
-       if (timeout) {
-           timer.tv_sec = timeout;
-           timer.tv_usec = 0;
-       }
-       ndesc = select(s + 1, &readfds, &writefds, NULL, timeout ? &timer : NULL);
-       if (ndesc < 1)
-           return ndesc;
+    debug(DBG_DBG, "sendrq: inserting packet with id %d in queue for %s", i, to->conf->host);
+    to->requests[i].rq = rq;
+    pthread_mutex_unlock(to->requests[i].lock);
+    if (i >= start) /* i is not reserved for statusserver */
+       to->nextid = i + 1;
 
-       cnt = read(s, buf + len, num - len);
-       if (cnt <= 0)
-           return -1;
+    if (!to->newrq) {
+       to->newrq = 1;
+       debug(DBG_DBG, "sendrq: signalling client writer");
+       pthread_cond_signal(&to->newrq_cond);
     }
-    return num;
-}
-
-/* timeout in seconds, 0 means no timeout (blocking) */
-unsigned char *radtcpget(int s, int timeout) {
-    int cnt, len;
-    unsigned char buf[4], *rad;
 
-    for (;;) {
-       cnt = tcpreadtimeout(s, buf, 4, timeout);
-       if (cnt < 1) {
-           debug(DBG_DBG, cnt ? "radtcpget: connection lost" : "radtcpget: timeout");
-           return NULL;
-       }
+    pthread_mutex_unlock(&to->newrq_mutex);
+    return;
 
-       len = RADLEN(buf);
-       rad = malloc(len);
-       if (!rad) {
-           debug(DBG_ERR, "radtcpget: malloc failed");
-           continue;
-       }
-       memcpy(rad, buf, 4);
-       
-       cnt = tcpreadtimeout(s, rad + 4, len - 4, timeout);
-       if (cnt < 1) {
-           debug(DBG_DBG, cnt ? "radtcpget: connection lost" : "radtcpget: timeout");
-           free(rad);
-           return NULL;
-       }
-       
-       if (len >= 20)
-           break;
-       
-       free(rad);
-       debug(DBG_WARN, "radtcpget: packet smaller than minimum radius size");
-    }
-    
-    debug(DBG_DBG, "radtcpget: got %d bytes", len);
-    return rad;
+ errexit:
+    if (rq->from)
+       rmclientrq(rq, rq->msg->id);
+    freerq(rq);
+    pthread_mutex_unlock(&to->newrq_mutex);
 }
 
-int clientradputudp(struct server *server, unsigned char *rad) {
-    size_t len;
-    struct sockaddr_storage sa;
-    struct sockaddr *sap;
-    struct clsrvconf *conf = server->conf;
-    in_port_t *port = NULL;
-    
-    len = RADLEN(rad);
-    
-    if (*rad == RAD_Accounting_Request) {
-       sap = (struct sockaddr *)&sa;
-       memcpy(sap, conf->addrinfo->ai_addr, conf->addrinfo->ai_addrlen);
-    } else
-       sap = conf->addrinfo->ai_addr;
-    
-    switch (sap->sa_family) {
-    case AF_INET:
-       port = &((struct sockaddr_in *)sap)->sin_port;
-       break;
-    case AF_INET6:
-       port = &((struct sockaddr_in6 *)sap)->sin6_port;
-       break;
-    default:
-       return 0;
+void sendreply(struct request *rq) {
+    uint8_t first;
+    struct client *to = rq->from;
+    
+    if (!rq->replybuf)
+       rq->replybuf = radmsg2buf(rq->msg, (uint8_t *)to->conf->secret);
+    radmsg_free(rq->msg);
+    rq->msg = NULL;
+    if (!rq->replybuf) {
+       freerq(rq);
+       debug(DBG_ERR, "sendreply: radmsg2buf failed");
+       return;
     }
 
-    if (*rad == RAD_Accounting_Request)
-       *port = htons(ntohs(*port) + 1);
+    pthread_mutex_lock(&to->replyq->mutex);
+    first = list_first(to->replyq->entries) == NULL;
     
-    if (sendto(server->sock, rad, len, 0, sap, conf->addrinfo->ai_addrlen) >= 0) {
-       debug(DBG_DBG, "clienradputudp: sent UDP of length %d to %s port %d", len, conf->host, ntohs(*port));
-       return 1;
-    }
-
-    debug(DBG_WARN, "clientradputudp: send failed");
-    return 0;
-}
-
-int clientradputtls(struct server *server, unsigned char *rad) {
-    int cnt;
-    size_t len;
-    unsigned long error;
-    struct timeval lastconnecttry;
-    struct clsrvconf *conf = server->conf;
-    
-    len = RADLEN(rad);
-    lastconnecttry = server->lastconnecttry;
-    while ((cnt = SSL_write(server->ssl, rad, len)) <= 0) {
-       while ((error = ERR_get_error()))
-           debug(DBG_ERR, "clientradputtls: TLS: %s", ERR_error_string(error, NULL));
-       if (server->dynamiclookuparg)
-           return 0;
-       tlsconnect(server, &lastconnecttry, 0, "clientradputtls");
-       lastconnecttry = server->lastconnecttry;
-    }
-
-    server->connectionok = 1;
-    debug(DBG_DBG, "clientradputtls: Sent %d bytes, Radius packet of length %d to TLS peer %s", cnt, len, conf->host);
-    return 1;
-}
-
-int clientradputtcp(struct server *server, unsigned char *rad) {
-    int cnt;
-    size_t len;
-    struct timeval lastconnecttry;
-    struct clsrvconf *conf = server->conf;
-    
-    len = RADLEN(rad);
-    lastconnecttry = server->lastconnecttry;
-    while ((cnt = write(server->sock, rad, len)) <= 0) {
-       debug(DBG_ERR, "clientradputtcp: write error");
-       tcpconnect(server, &lastconnecttry, 0, "clientradputtcp");
-       lastconnecttry = server->lastconnecttry;
-    }
-
-    server->connectionok = 1;
-    debug(DBG_DBG, "clientradputtcp: Sent %d bytes, Radius packet of length %d to TCP peer %s", cnt, len, conf->host);
-    return 1;
-}
-
-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)) &&
-       EVP_DigestUpdate(&mdctx, sec, strlen((char *)sec)) &&
-       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)) &&
-             EVP_DigestUpdate(&mdctx, sec, strlen((char *)sec)) &&
-             EVP_DigestFinal_ex(&mdctx, hash, &len) &&
-             len == 16 &&
-             !memcmp(hash, rad + 4, 16));
-    pthread_mutex_unlock(&lock);
-    return result;
-}
-             
-int checkmessageauth(unsigned char *rad, uint8_t *authattr, char *secret) {
-    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);
-    memcpy(authattr, auth, 16);
-    if (md_len != 16) {
-       debug(DBG_WARN, "message auth computation failed");
-       pthread_mutex_unlock(&lock);
-       return 0;
-    }
-
-    if (memcmp(auth, hash, 16)) {
-       debug(DBG_WARN, "message authenticator, wrong value");
-       pthread_mutex_unlock(&lock);
-       return 0;
-    }  
-       
-    pthread_mutex_unlock(&lock);
-    return 1;
-}
-
-int createmessageauth(unsigned char *rad, unsigned char *authattrval, char *secret) {
-    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) {
-       debug(DBG_WARN, "message auth computation failed");
-       pthread_mutex_unlock(&lock);
-       return 0;
-    }
-
-    pthread_mutex_unlock(&lock);
-    return 1;
-}
-
-unsigned char *attrget(unsigned char *attrs, int length, uint8_t type) {
-    while (length > 1) {
-       if (ATTRTYPE(attrs) == type)
-           return attrs;
-       length -= ATTRLEN(attrs);
-       attrs += ATTRLEN(attrs);
-    }
-    return NULL;
-}
-
-void freerqdata(struct request *rq) {
-    if (rq->origusername)
-       free(rq->origusername);
-    if (rq->buf)
-       free(rq->buf);
-}
-
-void sendrq(struct server *to, struct request *rq) {
-    int i;
-    uint8_t *attr;
-
-    pthread_mutex_lock(&to->newrq_mutex);
-    /* might simplify if only try nextid, might be ok */
-    for (i = to->nextid; i < MAX_REQUESTS; i++)
-       if (!to->requests[i].buf)
-           break;
-    if (i == MAX_REQUESTS) {
-       for (i = 0; i < to->nextid; i++)
-           if (!to->requests[i].buf)
-               break;
-       if (i == to->nextid) {
-           debug(DBG_WARN, "sendrq: no room in queue, dropping request");
-           freerqdata(rq);
-           goto exit;
-       }
-    }
-    
-    rq->buf[1] = (char)i;
-
-    attr = attrget(rq->buf + 20, RADLEN(rq->buf) - 20, RAD_Attr_Message_Authenticator);
-    if (attr && !createmessageauth(rq->buf, ATTRVAL(attr), to->conf->secret)) {
-       freerqdata(rq);
-       goto exit;
-    }
-    
-    if (*rq->buf == RAD_Accounting_Request) {
-       if (!radsign(rq->buf, (unsigned char *)to->conf->secret)) {
-           debug(DBG_WARN, "sendrq: failed to sign Accounting-Request message");
-           freerqdata(rq);
-           goto exit;
-       }
-    }
-
-    debug(DBG_DBG, "sendrq: inserting packet with id %d in queue for %s", i, to->conf->host);
-    to->requests[i] = *rq;
-    to->nextid = i + 1;
-
-    if (!to->newrq) {
-       to->newrq = 1;
-       debug(DBG_DBG, "sendrq: signalling client writer");
-       pthread_cond_signal(&to->newrq_cond);
-    }
- exit:
-    pthread_mutex_unlock(&to->newrq_mutex);
-}
-
-void sendreply(struct client *to, unsigned char *buf, struct sockaddr_storage *tosa, int toudpsock) {
-    struct reply *reply;
-    uint8_t first;
-    
-    if (!radsign(buf, (unsigned char *)to->conf->secret)) {
-       free(buf);
-       debug(DBG_WARN, "sendreply: failed to sign message");
-       return;
-    }
-
-    reply = malloc(sizeof(struct reply));
-    if (!reply) {
-       free(buf);
-       debug(DBG_ERR, "sendreply: malloc failed");
-       return;
-    }
-    memset(reply, 0, sizeof(struct reply));
-    reply->buf = buf;
-    if (tosa)
-       reply->tosa = *tosa;
-    reply->toudpsock = toudpsock;
-    
-    pthread_mutex_lock(&to->replyq->mutex);
-
-    first = list_first(to->replyq->replies) == NULL;
-    
-    if (!list_push(to->replyq->replies, reply)) {
+    if (!list_push(to->replyq->entries, rq)) {
        pthread_mutex_unlock(&to->replyq->mutex);
-       free(reply);
-       free(buf);
+       freerq(rq);
        debug(DBG_ERR, "sendreply: malloc failed");
        return;
     }
@@ -1793,18 +1282,6 @@ void removeserversubrealms(struct list *realmlist, struct clsrvconf *srv) {
     }
 }
                        
-int rqinqueue(struct server *to, struct client *from, uint8_t id, uint8_t code) {
-    struct request *rq = to->requests, *end;
-    
-    pthread_mutex_lock(&to->newrq_mutex);
-    for (end = rq + MAX_REQUESTS; rq < end; rq++)
-       if (rq->buf && !rq->received && rq->origid == id && rq->from == from && *rq->buf == code)
-           break;
-    pthread_mutex_unlock(&to->newrq_mutex);
-    
-    return rq < end;
-}
-
 int attrvalidate(unsigned char *attrs, int length) {
     while (length > 1) {
        if (ATTRLEN(attrs) < 2) {
@@ -1843,14 +1320,14 @@ int pwdrecrypt(uint8_t *pwd, uint8_t len, char *oldsecret, char *newsecret, uint
     return 1;
 }
 
-int msmpprecrypt(uint8_t *msmpp, uint8_t len, char *oldsecret, char *newsecret, unsigned char *oldauth, char *newauth) {
+int msmpprecrypt(uint8_t *msmpp, uint8_t len, char *oldsecret, char *newsecret, uint8_t *oldauth, uint8_t *newauth) {
     if (len < 18)
        return 0;
-    if (!msmppdecrypt(msmpp + 2, len - 2, (unsigned char *)oldsecret, strlen(oldsecret), oldauth, msmpp)) {
+    if (!msmppdecrypt(msmpp + 2, len - 2, (uint8_t *)oldsecret, strlen(oldsecret), oldauth, msmpp)) {
        debug(DBG_WARN, "msmpprecrypt: failed to decrypt msppe key");
        return 0;
     }
-    if (!msmppencrypt(msmpp + 2, len - 2, (unsigned char *)newsecret, strlen(newsecret), (unsigned char *)newauth, msmpp)) {
+    if (!msmppencrypt(msmpp + 2, len - 2, (uint8_t *)newsecret, strlen(newsecret), newauth, msmpp)) {
        debug(DBG_WARN, "msmpprecrypt: failed to encrypt msppe key");
        return 0;
     }
@@ -1863,7 +1340,7 @@ int msmppe(unsigned char *attrs, int length, uint8_t type, char *attrtxt, struct
     
     for (attr = attrs; (attr = attrget(attr, length - (attr - attrs), type)); attr += ATTRLEN(attr)) {
        debug(DBG_DBG, "msmppe: Got %s", attrtxt);
-       if (!msmpprecrypt(ATTRVAL(attr), ATTRVALLEN(attr), oldsecret, newsecret, rq->buf + 4, rq->origauth))
+       if (!msmpprecrypt(ATTRVAL(attr), ATTRVALLEN(attr), oldsecret, newsecret, rq->buf + 4, rq->rqauth))
            return 0;
     }
     return 1;
@@ -1879,126 +1356,109 @@ int findvendorsubattr(uint32_t *attrs, uint32_t vendor, uint8_t subattr) {
     return 0;
 }
 
-int dovendorrewrite(uint8_t *attrs, uint16_t length, uint32_t *removevendorattrs) {
-    uint8_t alen, sublen, rmlen = 0;
-    uint32_t vendor = *(uint32_t *)ATTRVAL(attrs);
+/* returns 1 if entire element is to be removed, else 0 */
+int dovendorrewriterm(struct tlv *attr, uint32_t *removevendorattrs) {
+    uint8_t alen, sublen;
+    uint32_t vendor;
     uint8_t *subattrs;
     
     if (!removevendorattrs)
        return 0;
 
+    memcpy(&vendor, attr->v, 4);
+    vendor = ntohl(vendor);
     while (*removevendorattrs && *removevendorattrs != vendor)
        removevendorattrs += 2;
     if (!*removevendorattrs)
        return 0;
     
-    alen = ATTRLEN(attrs);
+    if (findvendorsubattr(removevendorattrs, vendor, -1))
+       return 1; /* remove entire vendor attribute */
 
-    if (findvendorsubattr(removevendorattrs, vendor, -1)) {
-       /* remove entire vendor attribute */
-       memmove(attrs, attrs + alen, length - alen);
-       return alen;
-    }
-
-    sublen = alen - 4;
-    subattrs = ATTRVAL(attrs) + 4;
+    sublen = attr->l - 4;
+    subattrs = attr->v + 4;
     
     if (!attrvalidate(subattrs, sublen)) {
        debug(DBG_WARN, "dovendorrewrite: vendor attribute validation failed, no rewrite");
        return 0;
     }
 
-    length -= 6;
     while (sublen > 1) {
        alen = ATTRLEN(subattrs);
        sublen -= alen;
-       length -= alen;
        if (findvendorsubattr(removevendorattrs, vendor, ATTRTYPE(subattrs))) {
-           memmove(subattrs, subattrs + alen, length);
-           rmlen += alen;
+           memmove(subattrs, subattrs + alen, sublen);
+           attr->l -= alen;
        } else
            subattrs += alen;
     }
-
-    ATTRLEN(attrs) -= rmlen;
-    return rmlen;
+    return 0;
 }
 
-void dorewrite(uint8_t *buf, struct rewrite *rewrite) {
-    uint8_t *attrs, alen;
-    uint16_t len, rmlen = 0;
-    
-    if (!rewrite || (!rewrite->removeattrs && !rewrite->removevendorattrs))
-       return;
+void dorewriterm(struct radmsg *msg, uint8_t *rmattrs, uint32_t *rmvattrs) {
+    struct list_node *n, *p;
+    struct tlv *attr;
 
-    len = RADLEN(buf) - 20;
-    attrs = buf + 20;
-    while (len > 1) {
-       alen = ATTRLEN(attrs);
-       len -= alen;
-       if (rewrite->removeattrs && strchr((char *)rewrite->removeattrs, ATTRTYPE(attrs))) {
-           memmove(attrs, attrs + alen, len);
-           rmlen += alen;
-       } else if (ATTRTYPE(attrs) == RAD_Attr_Vendor_Specific && rewrite->removevendorattrs)
-           rmlen += dovendorrewrite(attrs, len, rewrite->removevendorattrs);
-       else
-           attrs += alen;
+    p = NULL;
+    n = list_first(msg->attrs);
+    while (n) {
+       attr = (struct tlv *)n->data;
+       if ((rmattrs && strchr((char *)rmattrs, attr->t)) ||
+           (rmvattrs && attr->t == RAD_Attr_Vendor_Specific && dovendorrewriterm(attr, rmvattrs))) {
+           list_removedata(msg->attrs, attr);
+           freetlv(attr);
+           n = p ? list_next(p) : list_first(msg->attrs);
+       } else
+           p = n;
+            n = list_next(n);
     }
-    if (rmlen)
-       ((uint16_t *)buf)[1] = htons(RADLEN(buf) - rmlen);
 }
 
-/* returns a pointer to the resized attribute value */
-uint8_t *resizeattr(uint8_t **buf, uint8_t newvallen, uint8_t type) {
-    uint8_t *attrs, *attr, vallen;
-    uint16_t len;
-    unsigned char *new;
+int dorewriteadd(struct radmsg *msg, struct list *addattrs) {
+    struct list_node *n;
+    struct tlv *a;
     
-    len = RADLEN(*buf) - 20;
-    attrs = *buf + 20;
+    for (n = list_first(addattrs); n; n = list_next(n)) {
+       a = copytlv((struct tlv *)n->data);
+       if (!a)
+           return 0;
+       if (!radmsg_add(msg, a)) {
+           freetlv(a);
+           return 0;
+       }
+    }
+    return 1;
+}
 
-    attr = attrget(attrs, len, type);
-    if (!attr)
-       return NULL;
+int resizeattr(struct tlv *attr, uint8_t newlen) {
+    uint8_t *newv;
     
-    vallen = ATTRVALLEN(attr);
-    if (vallen == newvallen)
-       return attr + 2;
-
-    len += newvallen - vallen;
-    if (newvallen > vallen) {
-       new = realloc(*buf, len + 20);
-       if (!new) {
-           debug(DBG_ERR, "resizeattr: malloc failed");
-           return NULL;
-       }
-       if (new != *buf) {
-           attr += new - *buf;
-           attrs = new + 20;
-           *buf = new;
-       }
+    if (newlen != attr->l) {
+       newv = realloc(attr->v, newlen);
+       if (!newv)
+           return 0;
+       attr->v = newv;
+       attr->l = newlen;
     }
-    memmove(attr + 2 + newvallen, attr + 2 + vallen, len - (attr - attrs + newvallen));
-    attr[1] = newvallen + 2;
-    ((uint16_t *)*buf)[1] = htons(len + 20);
-    return attr + 2;
+    return 1;
 }
-               
-int rewriteusername(struct request *rq, char *in) {
+
+int dorewritemodattr(struct tlv *attr, struct modattr *modattr) {
     size_t nmatch = 10, reslen = 0, start = 0;
     regmatch_t pmatch[10], *pfield;
     int i;
-    unsigned char *result;
-    char *out = rq->from->conf->rewriteattrreplacement;
+    char *in, *out;
+
+    in = stringcopy((char *)attr->v, attr->l);
+    if (!in)
+       return 0;
     
-    if (regexec(rq->from->conf->rewriteattrregex, in, nmatch, pmatch, 0)) {
-       debug(DBG_DBG, "rewriteattr: username not matching, no rewrite");
+    if (regexec(modattr->regex, in, nmatch, pmatch, 0)) {
+       free(in);
        return 1;
     }
     
-    rq->origusername = stringcopy(in, 0);
-    if (!rq->origusername)
-       return 0;
+    out = modattr->replacement;
     
     for (i = start; out[i]; i++) {
        if (out[i] == '\\' && out[i + 1] >= '1' && out[i + 1] <= '9') {
@@ -2011,20 +1471,26 @@ int rewriteusername(struct request *rq, char *in) {
        }
     }
     reslen += i - start;
+    if (reslen > 253) {
+       debug(DBG_WARN, "rewritten attribute length would be %d, max possible is 253, discarding message", reslen);
+       free(in);
+       return 0;
+    }
 
-    result = resizeattr(&rq->buf, reslen, RAD_Attr_User_Name);
-    if (!result)
+    if (!resizeattr(attr, reslen)) {
+       free(in);
        return 0;
-    
+    }
+
     start = 0;
     reslen = 0;
     for (i = start; out[i]; i++) {
        if (out[i] == '\\' && out[i + 1] >= '1' && out[i + 1] <= '9') {
            pfield = &pmatch[out[i + 1] - '0'];
            if (pfield->rm_so >= 0) {
-               memcpy(result + reslen, out + start, i - start);
+               memcpy(attr->v + reslen, out + start, i - start);
                reslen += i - start;
-               memcpy(result + reslen, in + pfield->rm_so, pfield->rm_eo - pfield->rm_so);
+               memcpy(attr->v + reslen, in + pfield->rm_so, pfield->rm_eo - pfield->rm_so);
                reslen += pfield->rm_eo - pfield->rm_so;
                start = i + 2;
            }
@@ -2032,10 +1498,43 @@ int rewriteusername(struct request *rq, char *in) {
        }
     }
 
-    memcpy(result + reslen, out + start, i - start);
-    reslen += i - start;
-    memcpy(in, result, reslen);
-    in[reslen] = '\0';
+    memcpy(attr->v + reslen, out + start, i - start);
+    return 1;
+}
+
+int dorewritemod(struct radmsg *msg, struct list *modattrs) {
+    struct list_node *n, *m;
+
+    for (n = list_first(msg->attrs); n; n = list_next(n))
+       for (m = list_first(modattrs); m; m = list_next(m))
+           if (((struct tlv *)n->data)->t == ((struct modattr *)m->data)->t &&
+               !dorewritemodattr((struct tlv *)n->data, (struct modattr *)m->data))
+               return 0;
+    return 1;
+}
+
+int dorewrite(struct radmsg *msg, struct rewrite *rewrite) {
+    if (!rewrite)
+       return 1;
+    if (rewrite->removeattrs || rewrite->removevendorattrs)
+       dorewriterm(msg, rewrite->removeattrs, rewrite->removevendorattrs);
+    if (rewrite->addattrs && !dorewriteadd(msg, rewrite->addattrs))
+       return 0;
+    if (rewrite->modattrs && !dorewritemod(msg, rewrite->modattrs))
+       return 0;
+    return 1;
+}
+
+int rewriteusername(struct request *rq, struct tlv *attr) {
+    char *orig = (char *)tlv2str(attr);
+    if (!dorewritemodattr(attr, rq->from->conf->rewriteusername)) {
+       free(orig);
+       return 0;
+    }
+    if (strlen(orig) != attr->l || memcmp(orig, attr->v, attr->l))
+       rq->origusername = (char *)orig;
+    else
+       free(orig);
     return 1;
 }
 
@@ -2057,104 +1556,76 @@ void char2hex(char *h, unsigned char c) {
     return;
 }
 
-char *radattr2ascii(char *ascii, size_t len, unsigned char *attr) {
+uint8_t *radattr2ascii(struct tlv *attr) {
     int i, l;
-    char *s, *d;
+    uint8_t *a, *d;
 
-    if (!attr || len == 1) {
-       *ascii = '\0';
-       return ascii;
-    }
+    if (!attr)
+       return NULL;
 
-    l = ATTRVALLEN(attr);
-    s = (char *)ATTRVAL(attr);
-    d = ascii;
+    l = attr->l;
+    for (i = 0; i < attr->l; i++)
+       if (attr->v[i] < 32 || attr->v[i] > 126)
+           l += 2;
+    if (l == attr->l)
+       return (uint8_t *)stringcopy((char *)attr->v, attr->l);
+    
+    a = malloc(l + 1);
+    if (!a)
+       return NULL;
 
-    for (i = 0; i < l; i++) {
-       if (s[i] > 31 && s[i] < 127) {
-           *d++ = s[i];
-           if (d - ascii == len - 1)
-               break;
-       } else {
-           if (d - ascii > len - 4)
-               break;
+    d = a;
+    for (i = 0; i < attr->l; i++)
+       if (attr->v[i] < 32 || attr->v[i] > 126) {
            *d++ = '%';
-           char2hex(d, s[i]);
+           char2hex((char *)d, attr->v[i]);
            d += 2;
-           if (d - ascii == len - 1)
-               break;
-       }
-    }
+       } else
+           *d++ = attr->v[i];
     *d = '\0';
-    return ascii;
+    return a;
 }
 
-void acclog(unsigned char *attrs, int length, char *host) {
-    unsigned char *attr;
-    char username[760];
+void acclog(struct radmsg *msg, char *host) {
+    struct tlv *attr;
+    uint8_t *username;
     
-    attr = attrget(attrs, length, RAD_Attr_User_Name);
+    attr = radmsg_gettype(msg, RAD_Attr_User_Name);
     if (!attr) {
        debug(DBG_INFO, "acclog: accounting-request from %s without username attribute", host);
        return;
     }
-    radattr2ascii(username, sizeof(username), attr);
-    debug(DBG_INFO, "acclog: accounting-request from %s with username: %s", host, username);
-}
-       
-void respondaccounting(struct request *rq) {
-    unsigned char *resp;
-
-    resp = malloc(20);
-    if (!resp) {
-       debug(DBG_ERR, "respondaccounting: malloc failed");
-       return;
-    }
-    memcpy(resp, rq->buf, 20);
-    resp[0] = RAD_Accounting_Response;
-    resp[2] = 0;
-    resp[3] = 20;
-    debug(DBG_DBG, "respondaccounting: responding to %s", rq->from->conf->host);
-    sendreply(rq->from, resp, &rq->fromsa, rq->fromudpsock);
-}
-
-void respondstatusserver(struct request *rq) {
-    unsigned char *resp;
-
-    resp = malloc(20);
-    if (!resp) {
-       debug(DBG_ERR, "respondstatusserver: malloc failed");
-       return;
+    username = radattr2ascii(attr);
+    if (username) {
+       debug(DBG_INFO, "acclog: accounting-request from %s with username: %s", host, username);
+       free(username);
     }
-    memcpy(resp, rq->buf, 20);
-    resp[0] = RAD_Access_Accept;
-    resp[2] = 0;
-    resp[3] = 20;
-    debug(DBG_DBG, "respondstatusserver: responding to %s", rq->from->conf->host);
-    sendreply(rq->from, resp, &rq->fromsa, rq->fromudpsock);
 }
 
-void respondreject(struct request *rq, char *message) {
-    unsigned char *resp;
-    int len = 20;
+void respond(struct request *rq, uint8_t code, char *message) {
+    struct radmsg *msg;
+    struct tlv *attr;
 
-    if (message && *message)
-       len += 2 + strlen(message);
-    
-    resp = malloc(len);
-    if (!resp) {
-       debug(DBG_ERR, "respondreject: malloc failed");
+    msg = radmsg_init(code, rq->msg->id, rq->msg->auth);
+    if (!msg) {
+       debug(DBG_ERR, "respond: malloc failed");
        return;
     }
-    memcpy(resp, rq->buf, 20);
-    resp[0] = RAD_Access_Reject;
-    *(uint16_t *)(resp + 2) = htons(len);
     if (message && *message) {
-       resp[20] = RAD_Attr_Reply_Message;
-       resp[21] = len - 20;
-       memcpy(resp + 22, message, len - 22);
+       attr = maketlv(RAD_Attr_Reply_Message, strlen(message), message);
+       if (!attr || !radmsg_add(msg, attr)) {
+           freetlv(attr);
+           radmsg_free(msg);
+           debug(DBG_ERR, "respond: malloc failed");
+           return;
+       }
     }
-    sendreply(rq->from, resp, &rq->fromsa, rq->fromudpsock);
+
+    radmsg_free(rq->msg);
+    rq->msg = msg;
+    debug(DBG_DBG, "respond: sending %s to %s", radmsgtype2string(msg->code), rq->from->conf->host);
+    rq->refcount++;
+    sendreply(rq);
 }
 
 struct clsrvconf *choosesrvconf(struct list *srvconfs) {
@@ -2181,412 +1652,378 @@ struct clsrvconf *choosesrvconf(struct list *srvconfs) {
     return best ? best : first;
 }
 
-struct server *findserver(struct realm **realm, char *id, uint8_t acc) {
+struct server *findserver(struct realm **realm, struct tlv *username, uint8_t acc) {
     struct clsrvconf *srvconf;
+    char *id = (char *)tlv2str(username);
     
+    if (!id)
+       return NULL;
     *realm = id2realm(realms, id);
-    if (!*realm)
+    if (!*realm) {
+       free(id);
        return NULL;
+    }
     debug(DBG_DBG, "found matching realm: %s", (*realm)->name);
     srvconf = choosesrvconf(acc ? (*realm)->accsrvconfs : (*realm)->srvconfs);
-    if (!srvconf)
+    if (!srvconf) {
+       free(id);
        return NULL;
+    }
     if (!acc && !srvconf->servers)
        adddynamicrealmserver(*realm, srvconf, id);
+    free(id);
     return srvconf->servers;
 }
 
-/* returns 0 if validation/authentication fails, else 1 */
-int radsrv(struct request *rq) {
-    uint8_t code, id, *auth, *attrs, *attr;
-    uint16_t len;
-    struct server *to = NULL;
-    char username[254], userascii[760];
-    unsigned char newauth[16];
-    struct realm *realm = NULL;
-    
-    code = *(uint8_t *)rq->buf;
-    id = *(uint8_t *)(rq->buf + 1);
-    len = RADLEN(rq->buf);
-    auth = (uint8_t *)(rq->buf + 4);
 
-    debug(DBG_DBG, "radsrv: code %d, id %d, length %d", code, id, len);
+struct request *newrequest() {
+    struct request *rq;
+
+    rq = malloc(sizeof(struct request));
+    if (!rq) {
+       debug(DBG_ERR, "newrequest: malloc failed");
+       return NULL;
+    }
+    memset(rq, 0, sizeof(struct request));
+    rq->refcount = 1;
+    gettimeofday(&rq->created, NULL);
+    return rq;
+}
+
+int addclientrq(struct request *rq) {
+    struct request *r;
+    struct timeval now;
     
-    if (code != RAD_Access_Request && code != RAD_Status_Server && code != RAD_Accounting_Request) {
-       debug(DBG_INFO, "radsrv: server currently accepts only access-requests, accounting-requests and status-server, ignoring");
-       goto exit;
+    r = rq->from->rqs[rq->rqid];
+    if (r) {
+       if (rq->udpport == r->udpport && !memcmp(rq->rqauth, r->rqauth, 16)) {
+           gettimeofday(&now, NULL);
+           if (now.tv_sec - r->created.tv_sec < r->from->conf->dupinterval) {
+               if (r->replybuf) {
+                   debug(DBG_INFO, "addclientrq: already sent reply to request with id %d from %s, resending", rq->rqid, addr2string(r->from->addr));
+                   r->refcount++;
+                   sendreply(r);
+               } else
+                   debug(DBG_INFO, "addclientrq: already got request with id %d from %s, ignoring", rq->rqid, addr2string(r->from->addr));
+               return 0;
+           }
+       }
+       freerq(r);
     }
+    rq->refcount++;
+    rq->from->rqs[rq->rqid] = rq;
+    return 1;
+}
 
-    len -= 20;
-    attrs = rq->buf + 20;
+void rmclientrq(struct request *rq, uint8_t id) {
+    struct request *r;
 
-    if (!attrvalidate(attrs, len)) {
-       debug(DBG_WARN, "radsrv: attribute validation failed, ignoring packet");
-       goto errvalauth;
+    r = rq->from->rqs[id];
+    if (r) {
+       freerq(r);
+       rq->from->rqs[id] = NULL;
     }
+}
 
-    attr = attrget(attrs, len, RAD_Attr_Message_Authenticator);
-    if (attr && (ATTRVALLEN(attr) != 16 || !checkmessageauth(rq->buf, ATTRVAL(attr), rq->from->conf->secret))) {
-       debug(DBG_WARN, "radsrv: message authentication failed");
-       goto errvalauth;
-    }
+/* returns 0 if validation/authentication fails, else 1 */
+int radsrv(struct request *rq) {
+    struct radmsg *msg = NULL;
+    struct tlv *attr;
+    uint8_t *userascii = NULL;
+    struct realm *realm = NULL;
+    struct server *to = NULL;
+    struct client *from = rq->from;
+    
+    msg = buf2radmsg(rq->buf, (uint8_t *)from->conf->secret, NULL);
+    free(rq->buf);
+    rq->buf = NULL;
 
-    if (code == RAD_Status_Server) {
-       respondstatusserver(rq);
-       goto exit;
+    if (!msg) {
+       debug(DBG_WARN, "radsrv: message validation failed, ignoring packet");
+       freerq(rq);
+       return 0;
     }
     
-    /* below: code == RAD_Access_Request || code == RAD_Accounting_Request */
+    rq->msg = msg;
+    rq->rqid = msg->id;
+    memcpy(rq->rqauth, msg->auth, 16);
 
-    if (code == RAD_Accounting_Request) {
-       memset(newauth, 0, 16);
-       if (!validauth(rq->buf, newauth, (unsigned char *)rq->from->conf->secret)) {
-           debug(DBG_WARN, "radsrv: Accounting-Request message authentication failed");
-           goto errvalauth;
-       }
+    debug(DBG_DBG, "radsrv: code %d, id %d", msg->code, msg->id);
+    if (msg->code != RAD_Access_Request && msg->code != RAD_Status_Server && msg->code != RAD_Accounting_Request) {
+       debug(DBG_INFO, "radsrv: server currently accepts only access-requests, accounting-requests and status-server, ignoring");      
+       goto exit;
     }
     
-    if (rq->from->conf->rewrite) {
-       dorewrite(rq->buf, rq->from->conf->rewrite);
-       len = RADLEN(rq->buf) - 20;
+    if (!addclientrq(rq))
+       goto exit;
+
+    if (msg->code == RAD_Status_Server) {
+       respond(rq, RAD_Access_Accept, NULL);
+       goto exit;
     }
-    
-    attr = attrget(attrs, len, RAD_Attr_User_Name);
+
+    /* below: code == RAD_Access_Request || code == RAD_Accounting_Request */
+
+    if (from->conf->rewritein && !dorewrite(msg, from->conf->rewritein))
+       goto rmclrqexit;
+
+    attr = radmsg_gettype(msg, RAD_Attr_User_Name);
     if (!attr) {
-       if (code == RAD_Accounting_Request) {
-           acclog(attrs, len, rq->from->conf->host);
-           respondaccounting(rq);
+       if (msg->code == RAD_Accounting_Request) {
+           acclog(msg, from->conf->host);
+           respond(rq, RAD_Accounting_Response, NULL);
        } else
            debug(DBG_WARN, "radsrv: ignoring access request, no username attribute");
        goto exit;
     }
-    memcpy(username, ATTRVAL(attr), ATTRVALLEN(attr));
-    username[ATTRVALLEN(attr)] = '\0';
-    radattr2ascii(userascii, sizeof(userascii), attr);
-
-    if (rq->from->conf->rewriteattrregex) {
-       if (!rewriteusername(rq, username)) {
-           debug(DBG_WARN, "radsrv: username malloc failed, ignoring request");
-           goto exit;
-       }
-       len = RADLEN(rq->buf) - 20;
-       auth = (uint8_t *)(rq->buf + 4);
-       attrs = rq->buf + 20;
+    
+    if (from->conf->rewriteusername && !rewriteusername(rq, attr)) {
+       debug(DBG_WARN, "radsrv: username malloc failed, ignoring request");
+       goto rmclrqexit;
     }
-
-    debug(DBG_DBG, "%s with username: %s", radmsgtype2string(code), userascii);
     
-    to = findserver(&realm, username, code == RAD_Accounting_Request);
+    userascii = radattr2ascii(attr);
+    if (!userascii)
+       goto rmclrqexit;
+    debug(DBG_DBG, "%s with username: %s", radmsgtype2string(msg->code), userascii);
+
+    to = findserver(&realm, attr, msg->code == RAD_Accounting_Request);
     if (!realm) {
        debug(DBG_INFO, "radsrv: ignoring request, don't know where to send it");
        goto exit;
     }
+
     if (!to) {
-       if (realm->message && code == RAD_Access_Request) {
-           debug(DBG_INFO, "radsrv: sending reject to %s for %s", rq->from->conf->host, userascii);
-           respondreject(rq, realm->message);
-       } else if (realm->accresp && code == RAD_Accounting_Request) {
-           acclog(attrs, len, rq->from->conf->host);
-           respondaccounting(rq);
+       if (realm->message && msg->code == RAD_Access_Request) {
+           debug(DBG_INFO, "radsrv: sending reject to %s for %s", from->conf->host, userascii);
+           respond(rq, RAD_Access_Reject, realm->message);
+       } else if (realm->accresp && msg->code == RAD_Accounting_Request) {
+           acclog(msg, from->conf->host);
+           respond(rq, RAD_Accounting_Response, NULL);
        }
        goto exit;
     }
     
-    if (options.loopprevention && !strcmp(rq->from->conf->name, to->conf->name)) {
+    if (options.loopprevention && !strcmp(from->conf->name, to->conf->name)) {
        debug(DBG_INFO, "radsrv: Loop prevented, not forwarding request from client %s to server %s, discarding",
-             rq->from->conf->name, to->conf->name);
+             from->conf->name, to->conf->name);
        goto exit;
     }
 
-    if (rqinqueue(to, rq->from, id, code)) {
-       debug(DBG_INFO, "radsrv: already got %s from host %s with id %d, ignoring",
-             radmsgtype2string(code), rq->from->conf->host, id);
-       goto exit;
+    if (msg->code == RAD_Accounting_Request)
+       memset(msg->auth, 0, 16);
+    else if (!RAND_bytes(msg->auth, 16)) {
+       debug(DBG_WARN, "radsrv: failed to generate random auth");
+       goto rmclrqexit;
     }
     
-    if (code != RAD_Accounting_Request) {
-       if (!RAND_bytes(newauth, 16)) {
-           debug(DBG_WARN, "radsrv: failed to generate random auth");
-           goto exit;
-       }
-    }
-
 #ifdef DEBUG
     printfchars(NULL, "auth", "%02x ", auth, 16);
 #endif
 
-    attr = attrget(attrs, len, RAD_Attr_User_Password);
+    attr = radmsg_gettype(msg, RAD_Attr_User_Password);
     if (attr) {
-       debug(DBG_DBG, "radsrv: found userpwdattr with value length %d", ATTRVALLEN(attr));
-       if (!pwdrecrypt(ATTRVAL(attr), ATTRVALLEN(attr), rq->from->conf->secret, to->conf->secret, auth, newauth))
-           goto exit;
+       debug(DBG_DBG, "radsrv: found userpwdattr with value length %d", attr->l);
+       if (!pwdrecrypt(attr->v, attr->l, from->conf->secret, to->conf->secret, rq->rqauth, msg->auth))
+           goto rmclrqexit;
     }
-    
-    attr = attrget(attrs, len, RAD_Attr_Tunnel_Password);
+
+    attr = radmsg_gettype(msg, RAD_Attr_Tunnel_Password);
     if (attr) {
-       debug(DBG_DBG, "radsrv: found tunnelpwdattr with value length %d", ATTRVALLEN(attr));
-       if (!pwdrecrypt(ATTRVAL(attr), ATTRVALLEN(attr), rq->from->conf->secret, to->conf->secret, auth, newauth))
-           goto exit;
+       debug(DBG_DBG, "radsrv: found tunnelpwdattr with value length %d", attr->l);
+       if (!pwdrecrypt(attr->v, attr->l, from->conf->secret, to->conf->secret, rq->rqauth, msg->auth))
+           goto rmclrqexit;
     }
 
-    rq->origid = id;
-    memcpy(rq->origauth, auth, 16);
-    memcpy(auth, newauth, 16);
-    sendrq(to, rq);
+    if (to->conf->rewriteout && !dorewrite(msg, to->conf->rewriteout))
+       goto rmclrqexit;
+    
+    free(userascii);
+    rq->to = to;
+    sendrq(rq);
     return 1;
     
+ rmclrqexit:
+    rmclientrq(rq, msg->id);
  exit:
-    freerqdata(rq);
+    freerq(rq);
+    free(userascii);
     return 1;
-
- errvalauth:
-    freerqdata(rq);
-    return 0;
 }
 
-int replyh(struct server *server, unsigned char *buf) {
+void replyh(struct server *server, unsigned char *buf) {
     struct client *from;
-    struct request *rq;
-    int i, len, sublen;
-    unsigned char *messageauth, *subattrs, *attrs, *attr, *username;
-    struct sockaddr_storage fromsa;
-    char tmp[760], stationid[760];
+    struct rqout *rqout;
+    int sublen;
+    unsigned char *subattrs;
+    uint8_t *username, *stationid, *replymsg;
+    struct radmsg *msg = NULL;
+    struct tlv *attr;
+    struct list_node *node;
     
     server->connectionok = 1;
     server->lostrqs = 0;
-       
-    i = buf[1]; /* i is the id */
 
-    if (*buf != RAD_Access_Accept && *buf != RAD_Access_Reject && *buf != RAD_Access_Challenge
-       && *buf != RAD_Accounting_Response) {
-       debug(DBG_INFO, "replyh: discarding message type %s, accepting only access accept, access reject, access challenge and accounting response messages", radmsgtype2string(*buf));
-       return 0;
-    }
-    debug(DBG_DBG, "got %s message with id %d", radmsgtype2string(*buf), i);
-
-    rq = server->requests + i;
-
-    pthread_mutex_lock(&server->newrq_mutex);
-    if (!rq->buf || !rq->tries) {
-       pthread_mutex_unlock(&server->newrq_mutex);
-       debug(DBG_INFO, "replyh: no matching request sent with this id, ignoring reply");
-       return 0;
-    }
-
-    if (rq->received) {
-       pthread_mutex_unlock(&server->newrq_mutex);
-       debug(DBG_INFO, "replyh: already received, ignoring reply");
-       return 0;
+    rqout = server->requests + buf[1];
+    pthread_mutex_lock(rqout->lock);
+    if (!rqout->tries) {
+       free(buf);
+       buf = NULL;
+       debug(DBG_INFO, "replyh: no outstanding request with this id, ignoring reply");
+       goto errunlock;
     }
        
-    if (!validauth(buf, rq->buf + 4, (unsigned char *)server->conf->secret)) {
-       pthread_mutex_unlock(&server->newrq_mutex);
-       debug(DBG_WARN, "replyh: invalid auth, ignoring reply");
-       return 0;
+    msg = buf2radmsg(buf, (uint8_t *)server->conf->secret, rqout->rq->msg->auth);
+    free(buf);
+    buf = NULL;
+    if (!msg) {
+        debug(DBG_WARN, "replyh: message validation failed, ignoring packet");
+       goto errunlock;
     }
-       
-    len = RADLEN(buf) - 20;
-    attrs = buf + 20;
-
-    if (!attrvalidate(attrs, len)) {
-       pthread_mutex_unlock(&server->newrq_mutex);
-       debug(DBG_WARN, "replyh: attribute validation failed, ignoring reply");
-       return 0;
+    if (msg->code != RAD_Access_Accept && msg->code != RAD_Access_Reject && msg->code != RAD_Access_Challenge
+       && msg->code != RAD_Accounting_Response) {
+       debug(DBG_INFO, "replyh: discarding message type %s, accepting only access accept, access reject, access challenge and accounting response messages", radmsgtype2string(msg->code));
+       goto errunlock;
     }
-       
-    /* Message Authenticator */
-    messageauth = attrget(attrs, len, RAD_Attr_Message_Authenticator);
-    if (messageauth) {
-       if (ATTRVALLEN(messageauth) != 16) {
-           pthread_mutex_unlock(&server->newrq_mutex);
-           debug(DBG_WARN, "replyh: illegal message auth attribute length, ignoring reply");
-           return 0;
-       }
-       memcpy(tmp, buf + 4, 16);
-       memcpy(buf + 4, rq->buf + 4, 16);
-       if (!checkmessageauth(buf, ATTRVAL(messageauth), server->conf->secret)) {
-           pthread_mutex_unlock(&server->newrq_mutex);
-           debug(DBG_WARN, "replyh: message authentication failed, ignoring reply");
-           return 0;
-       }
-       memcpy(buf + 4, tmp, 16);
-       debug(DBG_DBG, "replyh: message auth ok");
-    }
-    
+    debug(DBG_DBG, "got %s message with id %d", radmsgtype2string(msg->code), msg->id);
+
     gettimeofday(&server->lastrcv, NULL);
     
-    if (*rq->buf == RAD_Status_Server) {
-       rq->received = 1;
-       pthread_mutex_unlock(&server->newrq_mutex);
+    if (rqout->rq->msg->code == RAD_Status_Server) {
+       freerqoutdata(rqout);
        debug(DBG_DBG, "replyh: got status server response from %s", server->conf->host);
-       return 0;
+       goto errunlock;
     }
 
     gettimeofday(&server->lastreply, NULL);
-    
-    from = rq->from;
-    if (!from) {
-       pthread_mutex_unlock(&server->newrq_mutex);
-       debug(DBG_INFO, "replyh: client gone, ignoring reply");
-       return 0;
-    }
+    from = rqout->rq->from;
        
-    if (server->conf->rewrite) {
-       dorewrite(buf, server->conf->rewrite);
-       len = RADLEN(buf) - 20;
+    if (server->conf->rewritein && !dorewrite(msg, from->conf->rewritein)) {
+       debug(DBG_WARN, "replyh: rewritein failed");
+       goto errunlock;
     }
     
     /* MS MPPE */
-    for (attr = attrs; (attr = attrget(attr, len - (attr - attrs), RAD_Attr_Vendor_Specific)); attr += ATTRLEN(attr)) {
-       if (ATTRVALLEN(attr) <= 4)
+    for (node = list_first(msg->attrs); node; node = list_next(node)) {
+       attr = (struct tlv *)node->data;
+       if (attr->t != RAD_Attr_Vendor_Specific)
+           continue;
+       if (attr->l <= 4)
            break;
-           
-       if (attr[2] != 0 || attr[3] != 0 || attr[4] != 1 || attr[5] != 55)  /* 311 == MS */
+       if (attr->v[0] != 0 || attr->v[1] != 0 || attr->v[2] != 1 || attr->v[3] != 55)  /* 311 == MS */
            continue;
            
-       sublen = ATTRVALLEN(attr) - 4;
-       subattrs = ATTRVAL(attr) + 4;  
+       sublen = attr->l - 4;
+       subattrs = attr->v + 4;  
        if (!attrvalidate(subattrs, sublen) ||
            !msmppe(subattrs, sublen, RAD_VS_ATTR_MS_MPPE_Send_Key, "MS MPPE Send Key",
-                   rq, server->conf->secret, from->conf->secret) ||
+                   rqout->rq, server->conf->secret, from->conf->secret) ||
            !msmppe(subattrs, sublen, RAD_VS_ATTR_MS_MPPE_Recv_Key, "MS MPPE Recv Key",
-                   rq, server->conf->secret, from->conf->secret))
+                   rqout->rq, server->conf->secret, from->conf->secret))
            break;
     }
-    if (attr) {
-       pthread_mutex_unlock(&server->newrq_mutex);
+    if (node) {
        debug(DBG_WARN, "replyh: MS attribute handling failed, ignoring reply");
-       return 0;
-    }
-       
-    if (*buf == RAD_Access_Accept || *buf == RAD_Access_Reject || *buf == RAD_Accounting_Response) {
-       attr = attrget(rq->buf + 20, RADLEN(rq->buf) - 20, RAD_Attr_User_Name);
-       if (attr) {
-           radattr2ascii(tmp, sizeof(tmp), attr);
-           attr = attrget(rq->buf + 20, RADLEN(rq->buf) - 20, RAD_Attr_Calling_Station_Id);
-           if (attr) {
-               radattr2ascii(stationid, sizeof(stationid), attr);
-               debug(DBG_INFO, "%s for user %s stationid %s from %s",
-                     radmsgtype2string(*buf), tmp, stationid, server->conf->host);
-           } else
-               debug(DBG_INFO, "%s for user %s from %s", radmsgtype2string(*buf), tmp, server->conf->host);
+       goto errunlock;
+    }
+
+    if (msg->code == RAD_Access_Accept || msg->code == RAD_Access_Reject || msg->code == RAD_Accounting_Response) {
+       username = radattr2ascii(radmsg_gettype(rqout->rq->msg, RAD_Attr_User_Name));
+       if (username) {
+           stationid = radattr2ascii(radmsg_gettype(rqout->rq->msg, RAD_Attr_Calling_Station_Id));
+           replymsg = radattr2ascii(radmsg_gettype(msg, RAD_Attr_Reply_Message));
+           if (stationid) {
+               if (replymsg) {
+                   debug(DBG_INFO, "%s for user %s stationid %s from %s (%s)",
+                         radmsgtype2string(msg->code), username, stationid, server->conf->host, replymsg);
+                   free(replymsg);
+               } else
+                   debug(DBG_INFO, "%s for user %s stationid %s from %s",
+                         radmsgtype2string(msg->code), username, stationid, server->conf->host);
+               free(stationid);
+           } else {
+               if (replymsg) {
+                   debug(DBG_INFO, "%s for user %s from %s (%s)",
+                         radmsgtype2string(msg->code), username, server->conf->host, replymsg);
+                   free(replymsg);
+               } else
+                   debug(DBG_INFO, "%s for user %s from %s",
+                         radmsgtype2string(msg->code), username, server->conf->host);
+           }
+           free(username);
        }
     }
-       
-    buf[1] = (char)rq->origid;
-    memcpy(buf + 4, rq->origauth, 16);
+
+    msg->id = (char)rqout->rq->rqid;
+    memcpy(msg->auth, rqout->rq->rqauth, 16);
+
 #ifdef DEBUG   
     printfchars(NULL, "origauth/buf+4", "%02x ", buf + 4, 16);
 #endif
 
-    if (rq->origusername) {
-       username = resizeattr(&buf, strlen(rq->origusername), RAD_Attr_User_Name);
-       if (!username) {
-           pthread_mutex_unlock(&server->newrq_mutex);
+    if (rqout->rq->origusername && (attr = radmsg_gettype(msg, RAD_Attr_User_Name))) {
+       if (!resizeattr(attr, strlen(rqout->rq->origusername))) {
            debug(DBG_WARN, "replyh: malloc failed, ignoring reply");
-           return 0;
+           goto errunlock;
        }
-       memcpy(username, rq->origusername, strlen(rq->origusername));
-       len = RADLEN(buf) - 20;
-       attrs = buf + 20;
-       if (messageauth)
-           messageauth = attrget(attrs, len, RAD_Attr_Message_Authenticator);
-    }
-       
-    if (messageauth) {
-       if (!createmessageauth(buf, ATTRVAL(messageauth), from->conf->secret)) {
-           pthread_mutex_unlock(&server->newrq_mutex);
-           debug(DBG_WARN, "replyh: failed to create authenticator, malloc failed?, ignoring reply");
-           return 0;
-       }
-       debug(DBG_DBG, "replyh: computed messageauthattr");
+       memcpy(attr->v, rqout->rq->origusername, strlen(rqout->rq->origusername));
     }
 
-    fromsa = rq->fromsa; /* only needed for UDP */
-    /* once we set received = 1, rq may be reused */
-    rq->received = 1;
+    if (from->conf->rewriteout && !dorewrite(msg, from->conf->rewriteout)) {
+       debug(DBG_WARN, "replyh: rewriteout failed");
+       goto errunlock;
+    }
 
     debug(DBG_INFO, "replyh: passing reply to client %s", from->conf->name);
-    sendreply(from, buf, &fromsa, rq->fromudpsock);
-    pthread_mutex_unlock(&server->newrq_mutex);
-    return 1;
-}
+    radmsg_free(rqout->rq->msg);
+    rqout->rq->msg = msg;
+    rqout->rq->refcount++;
+    sendreply(rqout->rq);
+    freerqoutdata(rqout);
+    pthread_mutex_unlock(rqout->lock);
+    return;
 
-void *udpclientrd(void *arg) {
-    struct server *server;
-    unsigned char *buf;
-    int *s = (int *)arg;
-    
-    for (;;) {
-       server = NULL;
-       buf = radudpget(*s, NULL, &server, NULL);
-       if (!replyh(server, buf))
-           free(buf);
-    }
+ errunlock:
+    radmsg_free(msg);
+    pthread_mutex_unlock(rqout->lock);
+    return;
 }
 
-void *tlsclientrd(void *arg) {
-    struct server *server = (struct server *)arg;
-    unsigned char *buf;
-    struct timeval now, lastconnecttry;
-    
-    for (;;) {
-       /* yes, lastconnecttry is really necessary */
-       lastconnecttry = server->lastconnecttry;
-       buf = radtlsget(server->ssl, server->dynamiclookuparg ? IDLE_TIMEOUT : 0);
-       if (!buf) {
-           if (server->dynamiclookuparg)
-               break;
-           tlsconnect(server, &lastconnecttry, 0, "tlsclientrd");
-           continue;
-       }
+struct request *createstatsrvrq() {
+    struct request *rq;
+    struct tlv *attr;
 
-       if (!replyh(server, buf))
-           free(buf);
-       if (server->dynamiclookuparg) {
-           gettimeofday(&now, NULL);
-           if (now.tv_sec - server->lastreply.tv_sec > IDLE_TIMEOUT) {
-               debug(DBG_INFO, "tlsclientrd: idle timeout for %s", server->conf->name);
-               break;
-           }
-       }
+    rq = newrequest();
+    if (!rq)
+       return NULL;
+    rq->msg = radmsg_init(RAD_Status_Server, 0, NULL);
+    if (!rq->msg)
+       goto exit;
+    attr = maketlv(RAD_Attr_Message_Authenticator, 16, NULL);
+    if (!attr)
+       goto exit;
+    if (!radmsg_add(rq->msg, attr)) {
+       freetlv(attr);
+       goto exit;
     }
-    server->clientrdgone = 1;
-    return NULL;
-}
-
-void *tcpclientrd(void *arg) {
-    struct server *server = (struct server *)arg;
-    unsigned char *buf;
-    struct timeval lastconnecttry;
-    
-    for (;;) {
-       /* yes, lastconnecttry is really necessary */
-       lastconnecttry = server->lastconnecttry;
-       buf = radtcpget(server->sock, 0);
-       if (!buf) {
-           tcpconnect(server, &lastconnecttry, 0, "tcpclientrd");
-           continue;
-       }
+    return rq;
 
-       if (!replyh(server, buf))
-           free(buf);
-    }
-    server->clientrdgone = 1;
+ exit:
+    freerq(rq);
     return NULL;
 }
 
 /* code for removing state not finished */
 void *clientwr(void *arg) {
     struct server *server = (struct server *)arg;
-    struct request *rq;
+    struct rqout *rqout = NULL;
     pthread_t clientrdth;
     int i, dynconffail = 0;
+    time_t secs;
     uint8_t rnd;
-    struct timeval now;
+    struct timeval now, laststatsrv;
     struct timespec timeout;
-    struct request statsrvrq;
-    unsigned char statsrvbuf[38];
+    struct request *statsrvrq;
     struct clsrvconf *conf;
     
     conf = server->conf;
@@ -2604,20 +2041,15 @@ void *clientwr(void *arg) {
     memset(&timeout, 0, sizeof(struct timespec));
     
     if (conf->statusserver) {
-       memset(&statsrvrq, 0, sizeof(struct request));
-       memset(statsrvbuf, 0, sizeof(statsrvbuf));
-       statsrvbuf[0] = RAD_Status_Server;
-       statsrvbuf[3] = 38;
-       statsrvbuf[20] = RAD_Attr_Message_Authenticator;
-       statsrvbuf[21] = 18;
        gettimeofday(&server->lastrcv, NULL);
+       gettimeofday(&laststatsrv, NULL);
     }
 
     if (conf->pdef->connecter) {
        if (!conf->pdef->connecter(server, NULL, server->dynamiclookuparg ? 6 : 0, "clientwr"))
            goto errexit;
        server->connectionok = 1;
-       if (pthread_create(&clientrdth, NULL, conf->pdef->clientreader, (void *)server)) {
+       if (pthread_create(&clientrdth, NULL, conf->pdef->clientconnreader, (void *)server)) {
            debug(DBG_ERR, "clientwr: pthread_create failed");
            goto errexit;
        }
@@ -2632,443 +2064,109 @@ void *clientwr(void *arg) {
            RAND_bytes(&rnd, 1);
            rnd /= 32;
            if (conf->statusserver) {
-               if (!timeout.tv_sec || timeout.tv_sec > server->lastrcv.tv_sec + STATUS_SERVER_PERIOD + rnd)
-                   timeout.tv_sec = server->lastrcv.tv_sec + STATUS_SERVER_PERIOD + rnd;
+               secs = server->lastrcv.tv_sec > laststatsrv.tv_sec ? server->lastrcv.tv_sec : laststatsrv.tv_sec;
+               if (now.tv_sec - secs > STATUS_SERVER_PERIOD)
+                   secs = now.tv_sec;
+               if (!timeout.tv_sec || timeout.tv_sec > secs + STATUS_SERVER_PERIOD + rnd)
+                   timeout.tv_sec = secs + STATUS_SERVER_PERIOD + rnd;
            } else {
                if (!timeout.tv_sec || timeout.tv_sec > now.tv_sec + STATUS_SERVER_PERIOD + rnd)
                    timeout.tv_sec = now.tv_sec + STATUS_SERVER_PERIOD + rnd;
-           }
-#if 0      
-           if (timeout.tv_sec > now.tv_sec)
-               debug(DBG_DBG, "clientwr: waiting up to %ld secs for new request", timeout.tv_sec - now.tv_sec);
-#endif     
-           pthread_cond_timedwait(&server->newrq_cond, &server->newrq_mutex, &timeout);
-           timeout.tv_sec = 0;
-       }
-       if (server->newrq) {
-           debug(DBG_DBG, "clientwr: got new request");
-           server->newrq = 0;
-       }
-#if 0  
-       else
-           debug(DBG_DBG, "clientwr: request timer expired, processing request queue");
-#endif 
-       pthread_mutex_unlock(&server->newrq_mutex);
-
-       for (i = 0; i < MAX_REQUESTS; i++) {
-           if (server->clientrdgone) {
-               pthread_join(clientrdth, NULL);
-               goto errexit;
-           }
-           pthread_mutex_lock(&server->newrq_mutex);
-           while (i < MAX_REQUESTS && !server->requests[i].buf)
-               i++;
-           if (i == MAX_REQUESTS) {
-               pthread_mutex_unlock(&server->newrq_mutex);
-               break;
-           }
-           rq = server->requests + i;
-
-            if (rq->received) {
-               debug(DBG_DBG, "clientwr: packet %d in queue is marked as received", i);
-               if (rq->buf) {
-                   debug(DBG_DBG, "clientwr: freeing received packet %d from queue", i);
-                   freerqdata(rq);
-                   /* setting this to NULL means that it can be reused */
-                   rq->buf = NULL;
-               }
-                pthread_mutex_unlock(&server->newrq_mutex);
-                continue;
-            }
-           
-           gettimeofday(&now, NULL);
-            if (now.tv_sec < rq->expiry.tv_sec) {
-               if (!timeout.tv_sec || rq->expiry.tv_sec < timeout.tv_sec)
-                   timeout.tv_sec = rq->expiry.tv_sec;
-               pthread_mutex_unlock(&server->newrq_mutex);
-               continue;
-           }
-
-           if (rq->tries == (*rq->buf == RAD_Status_Server ? 1 : conf->retrycount + 1)) {
-               debug(DBG_DBG, "clientwr: removing expired packet from queue");
-               if (conf->statusserver) {
-                   if (*rq->buf == RAD_Status_Server) {
-                       debug(DBG_WARN, "clientwr: no status server response, %s dead?", conf->host);
-                       if (server->lostrqs < 255)
-                           server->lostrqs++;
-                   }
-                } else {
-                   debug(DBG_WARN, "clientwr: no server response, %s dead?", conf->host);
-                   if (server->lostrqs < 255)
-                       server->lostrqs++;
-               }
-               freerqdata(rq);
-               /* setting this to NULL means that it can be reused */
-               rq->buf = NULL;
-               pthread_mutex_unlock(&server->newrq_mutex);
-               continue;
-           }
-            pthread_mutex_unlock(&server->newrq_mutex);
-
-           rq->expiry.tv_sec = now.tv_sec + conf->retryinterval;
-           if (!timeout.tv_sec || rq->expiry.tv_sec < timeout.tv_sec)
-               timeout.tv_sec = rq->expiry.tv_sec;
-           rq->tries++;
-           conf->pdef->clientradput(server, server->requests[i].buf);
-       }
-       if (conf->statusserver) {
-           gettimeofday(&now, NULL);
-           if (now.tv_sec - server->lastrcv.tv_sec >= STATUS_SERVER_PERIOD) {
-               if (!RAND_bytes(statsrvbuf + 4, 16)) {
-                   debug(DBG_WARN, "clientwr: failed to generate random auth");
-                   continue;
-               }
-               statsrvrq.buf = malloc(sizeof(statsrvbuf));
-               if (!statsrvrq.buf) {
-                   debug(DBG_ERR, "clientwr: malloc failed");
-                   continue;
-               }
-               memcpy(statsrvrq.buf, statsrvbuf, sizeof(statsrvbuf));
-               debug(DBG_DBG, "clientwr: sending status server to %s", conf->host);
-               sendrq(server, &statsrvrq);
-           }
-       }
-    }
- errexit:
-    conf->servers = NULL;
-    if (server->dynamiclookuparg) {
-       removeserversubrealms(realms, conf);
-       if (dynconffail)
-           free(conf);
-       else
-           freeclsrvconf(conf);
-    }
-    freeserver(server, 1);
-    return NULL;
-}
-
-void *udpserverwr(void *arg) {
-    struct replyq *replyq = udp_server_replyq;
-    struct reply *reply;
-    
-    for (;;) {
-       pthread_mutex_lock(&replyq->mutex);
-       while (!(reply = (struct reply *)list_shift(replyq->replies))) {
-           debug(DBG_DBG, "udp server writer, waiting for signal");
-           pthread_cond_wait(&replyq->cond, &replyq->mutex);
-           debug(DBG_DBG, "udp server writer, got signal");
-       }
-       pthread_mutex_unlock(&replyq->mutex);
-
-       if (sendto(reply->toudpsock, reply->buf, RADLEN(reply->buf), 0,
-                  (struct sockaddr *)&reply->tosa, SOCKADDR_SIZE(reply->tosa)) < 0)
-           debug(DBG_WARN, "sendudp: send failed");
-       free(reply->buf);
-       free(reply);
-    }
-}
-
-void *udpserverrd(void *arg) {
-    struct request rq;
-    int *sp = (int *)arg;
-    
-    for (;;) {
-       memset(&rq, 0, sizeof(struct request));
-       rq.buf = radudpget(*sp, &rq.from, NULL, &rq.fromsa);
-       rq.fromudpsock = *sp;
-       radsrv(&rq);
-    }
-    free(sp);
-}
-
-void *tlsserverwr(void *arg) {
-    int cnt;
-    unsigned long error;
-    struct client *client = (struct client *)arg;
-    struct replyq *replyq;
-    struct reply *reply;
-    
-    debug(DBG_DBG, "tlsserverwr: starting for %s", client->conf->host);
-    replyq = client->replyq;
-    for (;;) {
-       pthread_mutex_lock(&replyq->mutex);
-       while (!list_first(replyq->replies)) {
-           if (client->ssl) {      
-               debug(DBG_DBG, "tlsserverwr: waiting for signal");
-               pthread_cond_wait(&replyq->cond, &replyq->mutex);
-               debug(DBG_DBG, "tlsserverwr: got signal");
-           }
-           if (!client->ssl) {
-               /* ssl might have changed while waiting */
-               pthread_mutex_unlock(&replyq->mutex);
-               debug(DBG_DBG, "tlsserverwr: exiting as requested");
-               pthread_exit(NULL);
-           }
-       }
-       reply = (struct reply *)list_shift(replyq->replies);
-       pthread_mutex_unlock(&replyq->mutex);
-       cnt = SSL_write(client->ssl, reply->buf, RADLEN(reply->buf));
-       if (cnt > 0)
-           debug(DBG_DBG, "tlsserverwr: sent %d bytes, Radius packet of length %d",
-                 cnt, RADLEN(reply->buf));
-       else
-           while ((error = ERR_get_error()))
-               debug(DBG_ERR, "tlsserverwr: SSL: %s", ERR_error_string(error, NULL));
-       free(reply->buf);
-       free(reply);
-    }
-}
-
-void tlsserverrd(struct client *client) {
-    struct request rq;
-    pthread_t tlsserverwrth;
-    
-    debug(DBG_DBG, "tlsserverrd: starting for %s", client->conf->host);
-    
-    if (pthread_create(&tlsserverwrth, NULL, tlsserverwr, (void *)client)) {
-       debug(DBG_ERR, "tlsserverrd: pthread_create failed");
-       return;
-    }
-
-    for (;;) {
-       memset(&rq, 0, sizeof(struct request));
-       rq.buf = radtlsget(client->ssl, 0);
-       if (!rq.buf) {
-           debug(DBG_ERR, "tlsserverrd: connection from %s lost", client->conf->host);
-           break;
-       }
-       debug(DBG_DBG, "tlsserverrd: got Radius message from %s", client->conf->host);
-       rq.from = client;
-       if (!radsrv(&rq)) {
-           debug(DBG_ERR, "tlsserverrd: message authentication/validation failed, closing connection from %s", client->conf->host);
-           break;
-       }
-    }
-    
-    /* stop writer by setting ssl to NULL and give signal in case waiting for data */
-    client->ssl = NULL;
-    pthread_mutex_lock(&client->replyq->mutex);
-    pthread_cond_signal(&client->replyq->cond);
-    pthread_mutex_unlock(&client->replyq->mutex);
-    debug(DBG_DBG, "tlsserverrd: waiting for writer to end");
-    pthread_join(tlsserverwrth, NULL);
-    removeclientrqs(client);
-    debug(DBG_DBG, "tlsserverrd: reader for %s exiting", client->conf->host);
-}
-
-void *tlsservernew(void *arg) {
-    int s;
-    struct sockaddr_storage from;
-    size_t fromlen = sizeof(from);
-    struct clsrvconf *conf;
-    struct list_node *cur = NULL;
-    SSL *ssl = NULL;
-    X509 *cert = NULL;
-    unsigned long error;
-    struct client *client;
-
-    s = *(int *)arg;
-    if (getpeername(s, (struct sockaddr *)&from, &fromlen)) {
-       debug(DBG_DBG, "tlsservernew: getpeername failed, exiting");
-       goto exit;
-    }
-    debug(DBG_WARN, "tlsservernew: incoming TLS connection from %s", addr2string((struct sockaddr *)&from, fromlen));
-
-    conf = find_conf(RAD_TLS, (struct sockaddr *)&from, clconfs, &cur);
-    if (conf) {
-       ssl = SSL_new(conf->ssl_ctx);
-       SSL_set_fd(ssl, s);
-
-       if (SSL_accept(ssl) <= 0) {
-           while ((error = ERR_get_error()))
-               debug(DBG_ERR, "tlsservernew: SSL: %s", ERR_error_string(error, NULL));
-           debug(DBG_ERR, "tlsservernew: SSL_accept failed");
-           goto exit;
-       }
-       cert = verifytlscert(ssl);
-       if (!cert)
-           goto exit;
-    }
-    
-    while (conf) {
-       if (verifyconfcert(cert, conf)) {
-           X509_free(cert);
-           client = addclient(conf);
-           if (client) {
-               client->ssl = ssl;
-               tlsserverrd(client);
-               removeclient(client);
-           } else
-               debug(DBG_WARN, "tlsservernew: failed to create new client instance");
-           goto exit;
-       }
-       conf = find_conf(RAD_TLS, (struct sockaddr *)&from, clconfs, &cur);
-    }
-    debug(DBG_WARN, "tlsservernew: ignoring request, no matching TLS client");
-    if (cert)
-       X509_free(cert);
-
- exit:
-    SSL_free(ssl);
-    shutdown(s, SHUT_RDWR);
-    close(s);
-    pthread_exit(NULL);
-}
-
-void *tlslistener(void *arg) {
-    pthread_t tlsserverth;
-    int s, *sp = (int *)arg;
-    struct sockaddr_storage from;
-    size_t fromlen = sizeof(from);
-
-    listen(*sp, 0);
-
-    for (;;) {
-       s = accept(*sp, (struct sockaddr *)&from, &fromlen);
-       if (s < 0) {
-           debug(DBG_WARN, "accept failed");
-           continue;
-       }
-       if (pthread_create(&tlsserverth, NULL, tlsservernew, (void *)&s)) {
-           debug(DBG_ERR, "tlslistener: pthread_create failed");
-           shutdown(s, SHUT_RDWR);
-           close(s);
-           continue;
-       }
-       pthread_detach(tlsserverth);
-    }
-    free(sp);
-    return NULL;
-}
-
-void *tcpserverwr(void *arg) {
-    int cnt;
-    struct client *client = (struct client *)arg;
-    struct replyq *replyq;
-    struct reply *reply;
-    
-    debug(DBG_DBG, "tcpserverwr: starting for %s", client->conf->host);
-    replyq = client->replyq;
-    for (;;) {
-       pthread_mutex_lock(&replyq->mutex);
-       while (!list_first(replyq->replies)) {
-           if (client->s >= 0) {           
-               debug(DBG_DBG, "tcpserverwr: waiting for signal");
-               pthread_cond_wait(&replyq->cond, &replyq->mutex);
-               debug(DBG_DBG, "tcpserverwr: got signal");
-           }
-           if (client->s < 0) {
-               /* s might have changed while waiting */
-               pthread_mutex_unlock(&replyq->mutex);
-               debug(DBG_DBG, "tcpserverwr: exiting as requested");
-               pthread_exit(NULL);
-           }
-       }
-       reply = (struct reply *)list_shift(replyq->replies);
-       pthread_mutex_unlock(&replyq->mutex);
-       cnt = write(client->s, reply->buf, RADLEN(reply->buf));
-       if (cnt > 0)
-           debug(DBG_DBG, "tcpserverwr: sent %d bytes, Radius packet of length %d",
-                 cnt, RADLEN(reply->buf));
-       else
-           debug(DBG_ERR, "tcpserverwr: write error for %s", client->conf->host);
-       free(reply->buf);
-       free(reply);
-    }
-}
-
-void tcpserverrd(struct client *client) {
-    struct request rq;
-    pthread_t tcpserverwrth;
-    
-    debug(DBG_DBG, "tcpserverrd: starting for %s", client->conf->host);
-    
-    if (pthread_create(&tcpserverwrth, NULL, tcpserverwr, (void *)client)) {
-       debug(DBG_ERR, "tcpserverrd: pthread_create failed");
-       return;
-    }
-
-    for (;;) {
-       memset(&rq, 0, sizeof(struct request));
-       rq.buf = radtcpget(client->s, 0);
-       if (!rq.buf) {
-           debug(DBG_ERR, "tcpserverrd: connection from %s lost", client->conf->host);
-           break;
+           }
+#if 0
+           if (timeout.tv_sec > now.tv_sec)
+               debug(DBG_DBG, "clientwr: waiting up to %ld secs for new request", timeout.tv_sec - now.tv_sec);
+#endif     
+           pthread_cond_timedwait(&server->newrq_cond, &server->newrq_mutex, &timeout);
+           timeout.tv_sec = 0;
        }
-       debug(DBG_DBG, "tcpserverrd: got Radius message from %s", client->conf->host);
-       rq.from = client;
-       if (!radsrv(&rq)) {
-           debug(DBG_ERR, "tcpserverrd: message authentication/validation failed, closing connection from %s", client->conf->host);
-           break;
+       if (server->newrq) {
+           debug(DBG_DBG, "clientwr: got new request");
+           server->newrq = 0;
        }
-    }
-
-    /* stop writer by setting s to -1 and give signal in case waiting for data */
-    client->s = -1;
-    pthread_mutex_lock(&client->replyq->mutex);
-    pthread_cond_signal(&client->replyq->cond);
-    pthread_mutex_unlock(&client->replyq->mutex);
-    debug(DBG_DBG, "tcpserverrd: waiting for writer to end");
-    pthread_join(tcpserverwrth, NULL);
-    removeclientrqs(client);
-    debug(DBG_DBG, "tcpserverrd: reader for %s exiting", client->conf->host);
-}
-
-void *tcpservernew(void *arg) {
-    int s;
-    struct sockaddr_storage from;
-    size_t fromlen = sizeof(from);
-    struct clsrvconf *conf;
-    struct client *client;
-
-    s = *(int *)arg;
-    if (getpeername(s, (struct sockaddr *)&from, &fromlen)) {
-       debug(DBG_DBG, "tcpservernew: getpeername failed, exiting");
-       goto exit;
-    }
-    debug(DBG_WARN, "tcpservernew: incoming TCP connection from %s", addr2string((struct sockaddr *)&from, fromlen));
+#if 0  
+       else
+           debug(DBG_DBG, "clientwr: request timer expired, processing request queue");
+#endif 
+       pthread_mutex_unlock(&server->newrq_mutex);
 
-    conf = find_conf(RAD_TCP, (struct sockaddr *)&from, clconfs, NULL);
-    if (conf) {
-       client = addclient(conf);
-       if (client) {
-           client->s = s;
-           tcpserverrd(client);
-           removeclient(client);
-       } else
-           debug(DBG_WARN, "tcpservernew: failed to create new client instance");
-    } else
-       debug(DBG_WARN, "tcpservernew: ignoring request, no matching TCP client");
+       for (i = 0; i < MAX_REQUESTS; i++) {
+           if (server->clientrdgone) {
+               pthread_join(clientrdth, NULL);
+               goto errexit;
+           }
 
- exit:
-    shutdown(s, SHUT_RDWR);
-    close(s);
-    pthread_exit(NULL);
-}
+           for (; i < MAX_REQUESTS; i++) {
+               rqout = server->requests + i;
+               if (rqout->rq) {
+                   pthread_mutex_lock(rqout->lock);
+                   if (rqout->rq)
+                       break;
+                   pthread_mutex_unlock(rqout->lock);
+               }
+           }
+               
+           if (i == MAX_REQUESTS)
+               break;
 
-void *tcplistener(void *arg) {
-    pthread_t tcpserverth;
-    int s, *sp = (int *)arg;
-    struct sockaddr_storage from;
-    size_t fromlen = sizeof(from);
+           gettimeofday(&now, NULL);
+            if (now.tv_sec < rqout->expiry.tv_sec) {
+               if (!timeout.tv_sec || rqout->expiry.tv_sec < timeout.tv_sec)
+                   timeout.tv_sec = rqout->expiry.tv_sec;
+                pthread_mutex_unlock(rqout->lock);
+               continue;
+           }
 
-    listen(*sp, 0);
+           if (rqout->tries == (*rqout->rq->buf == RAD_Status_Server ? 1 : conf->retrycount + 1)) {
+               debug(DBG_DBG, "clientwr: removing expired packet from queue");
+               if (conf->statusserver) {
+                   if (*rqout->rq->buf == RAD_Status_Server) {
+                       debug(DBG_WARN, "clientwr: no status server response, %s dead?", conf->host);
+                       if (server->lostrqs < 255)
+                           server->lostrqs++;
+                   }
+                } else {
+                   debug(DBG_WARN, "clientwr: no server response, %s dead?", conf->host);
+                   if (server->lostrqs < 255)
+                       server->lostrqs++;
+               }
+               freerqoutdata(rqout);
+                pthread_mutex_unlock(rqout->lock);
+               continue;
+           }
 
-    for (;;) {
-       s = accept(*sp, (struct sockaddr *)&from, &fromlen);
-       if (s < 0) {
-           debug(DBG_WARN, "accept failed");
-           continue;
+           rqout->expiry.tv_sec = now.tv_sec + conf->retryinterval;
+           if (!timeout.tv_sec || rqout->expiry.tv_sec < timeout.tv_sec)
+               timeout.tv_sec = rqout->expiry.tv_sec;
+           rqout->tries++;
+           conf->pdef->clientradput(server, rqout->rq->buf);
+           pthread_mutex_unlock(rqout->lock);
        }
-       if (pthread_create(&tcpserverth, NULL, tcpservernew, (void *)&s)) {
-           debug(DBG_ERR, "tcplistener: pthread_create failed");
-           shutdown(s, SHUT_RDWR);
-           close(s);
-           continue;
+       if (conf->statusserver && server->connectionok) {
+           secs = server->lastrcv.tv_sec > laststatsrv.tv_sec ? server->lastrcv.tv_sec : laststatsrv.tv_sec;
+           gettimeofday(&now, NULL);
+           if (now.tv_sec - secs > STATUS_SERVER_PERIOD) {
+               laststatsrv = now;
+               statsrvrq = createstatsrvrq();
+               if (statsrvrq) {
+                   statsrvrq->to = server;
+                   debug(DBG_DBG, "clientwr: sending status server to %s", conf->host);
+                   sendrq(statsrvrq);
+               }
+           }
        }
-       pthread_detach(tcpserverth);
     }
-    free(sp);
+ errexit:
+    conf->servers = NULL;
+    if (server->dynamiclookuparg) {
+       removeserversubrealms(realms, conf);
+       if (dynconffail)
+           free(conf);
+       else
+           freeclsrvconf(conf);
+    }
+    freeserver(server, 1);
+    ERR_remove_state(0);
     return NULL;
 }
 
@@ -3126,22 +2224,44 @@ void createlisteners(uint8_t type, char **args) {
        createlistener(type, NULL);
 }
 
-void tlsadd(char *value, char *cacertfile, char *cacertpath, char *certfile, char *certkeyfile, char *certkeypwd, uint8_t crlcheck) {
-    struct tls *new;
-    SSL_CTX *ctx;
+#ifdef DEBUG
+void ssl_info_callback(const SSL *ssl, int where, int ret) {
+    const char *s;
+    int w;
+
+    w = where & ~SSL_ST_MASK;
+
+    if (w & SSL_ST_CONNECT)
+       s = "SSL_connect";
+    else if (w & SSL_ST_ACCEPT)
+       s = "SSL_accept";
+    else
+       s = "undefined";
+
+    if (where & SSL_CB_LOOP)
+       debug(DBG_DBG, "%s:%s\n", s, SSL_state_string_long(ssl));
+    else if (where & SSL_CB_ALERT) {
+       s = (where & SSL_CB_READ) ? "read" : "write";
+       debug(DBG_DBG, "SSL3 alert %s:%s:%s\n", s, SSL_alert_type_string_long(ret), SSL_alert_desc_string_long(ret));
+    }
+    else if (where & SSL_CB_EXIT) {
+       if (ret == 0)
+           debug(DBG_DBG, "%s:failed in %s\n", s, SSL_state_string_long(ssl));
+       else if (ret < 0)
+           debug(DBG_DBG, "%s:error in %s\n", s, SSL_state_string_long(ssl));
+    }
+}
+#endif
+
+SSL_CTX *tlscreatectx(uint8_t type, struct tls *conf) {
+    SSL_CTX *ctx = NULL;
     STACK_OF(X509_NAME) *calist;
     X509_STORE *x509_s;
     int i;
     unsigned long error;
-    
-    if (!certfile || !certkeyfile)
-       debugx(1, DBG_ERR, "TLSCertificateFile and TLSCertificateKeyFile must be specified in TLS context %s", value);
-
-    if (!cacertfile && !cacertpath)
-       debugx(1, DBG_ERR, "CA Certificate file or path need to be specified in TLS context %s", value);
 
     if (!ssl_locks) {
-       ssl_locks = malloc(CRYPTO_num_locks() * sizeof(pthread_mutex_t));
+       ssl_locks = calloc(CRYPTO_num_locks(), sizeof(pthread_mutex_t));
        ssl_lock_count = OPENSSL_malloc(CRYPTO_num_locks() * sizeof(long));
        for (i = 0; i < CRYPTO_num_locks(); i++) {
            ssl_lock_count[i] = 0;
@@ -3160,26 +2280,48 @@ void tlsadd(char *value, char *cacertfile, char *cacertpath, char *certfile, cha
            RAND_seed((unsigned char *)&pid, sizeof(pid));
        }
     }
-    ctx = SSL_CTX_new(TLSv1_method());
-    if (certkeypwd) {
-       SSL_CTX_set_default_passwd_cb_userdata(ctx, certkeypwd);
+
+    switch (type) {
+    case RAD_TLS:
+       ctx = SSL_CTX_new(TLSv1_method());
+#ifdef DEBUG   
+       SSL_CTX_set_info_callback(ctx, ssl_info_callback);
+#endif 
+       break;
+    case RAD_DTLS:
+       ctx = SSL_CTX_new(DTLSv1_method());
+#ifdef DEBUG   
+       SSL_CTX_set_info_callback(ctx, ssl_info_callback);
+#endif 
+       SSL_CTX_set_read_ahead(ctx, 1);
+       break;
+    }
+    if (!ctx) {
+       debug(DBG_ERR, "tlscreatectx: Error initialising SSL/TLS in TLS context %s", conf->name);
+       return NULL;
+    }
+    
+    if (conf->certkeypwd) {
+       SSL_CTX_set_default_passwd_cb_userdata(ctx, conf->certkeypwd);
        SSL_CTX_set_default_passwd_cb(ctx, pem_passwd_cb);
     }
-    if (!SSL_CTX_use_certificate_chain_file(ctx, certfile) ||
-       !SSL_CTX_use_PrivateKey_file(ctx, certkeyfile, SSL_FILETYPE_PEM) ||
+    if (!SSL_CTX_use_certificate_chain_file(ctx, conf->certfile) ||
+       !SSL_CTX_use_PrivateKey_file(ctx, conf->certkeyfile, SSL_FILETYPE_PEM) ||
        !SSL_CTX_check_private_key(ctx) ||
-       !SSL_CTX_load_verify_locations(ctx, cacertfile, cacertpath)) {
+       !SSL_CTX_load_verify_locations(ctx, conf->cacertfile, conf->cacertpath)) {
        while ((error = ERR_get_error()))
            debug(DBG_ERR, "SSL: %s", ERR_error_string(error, NULL));
-       debugx(1, DBG_ERR, "Error initialising SSL/TLS in TLS context %s", value);
+       debug(DBG_ERR, "tlscreatectx: Error initialising SSL/TLS in TLS context %s", conf->name);
+       SSL_CTX_free(ctx);
+       return NULL;
     }
 
-    calist = cacertfile ? SSL_load_client_CA_file(cacertfile) : NULL;
-    if (!cacertfile || calist) {
-       if (cacertpath) {
+    calist = conf->cacertfile ? SSL_load_client_CA_file(conf->cacertfile) : NULL;
+    if (!conf->cacertfile || calist) {
+       if (conf->cacertpath) {
            if (!calist)
                calist = sk_X509_NAME_new_null();
-           if (!SSL_add_dir_cert_subjects_to_stack(calist, cacertpath)) {
+           if (!SSL_add_dir_cert_subjects_to_stack(calist, conf->cacertpath)) {
                sk_X509_NAME_free(calist);
                calist = NULL;
            }
@@ -3188,48 +2330,72 @@ void tlsadd(char *value, char *cacertfile, char *cacertpath, char *certfile, cha
     if (!calist) {
        while ((error = ERR_get_error()))
            debug(DBG_ERR, "SSL: %s", ERR_error_string(error, NULL));
-       debugx(1, DBG_ERR, "Error adding CA subjects in TLS context %s", value);
+       debug(DBG_ERR, "tlscreatectx: Error adding CA subjects in TLS context %s", conf->name);
+       SSL_CTX_free(ctx);
+       return NULL;
     }
+    ERR_clear_error(); /* add_dir_cert_subj returns errors on success */
     SSL_CTX_set_client_CA_list(ctx, calist);
     
     SSL_CTX_set_verify(ctx, SSL_VERIFY_PEER | SSL_VERIFY_FAIL_IF_NO_PEER_CERT, verify_cb);
     SSL_CTX_set_verify_depth(ctx, MAX_CERT_DEPTH + 1);
 
-    if (crlcheck) {
+    if (conf->crlcheck) {
        x509_s = SSL_CTX_get_cert_store(ctx);
        X509_STORE_set_flags(x509_s, X509_V_FLAG_CRL_CHECK | X509_V_FLAG_CRL_CHECK_ALL);
     }
 
-    new = malloc(sizeof(struct tls));
-    if (!new || !list_push(tlsconfs, new))
-       debugx(1, DBG_ERR, "malloc failed");
+    debug(DBG_DBG, "tlscreatectx: created TLS context %s", conf->name);
+    return ctx;
+}
 
-    memset(new, 0, sizeof(struct tls));
-    new->name = stringcopy(value, 0);
-    if (!new->name)
-       debugx(1, DBG_ERR, "malloc failed");
-    new->ctx = ctx;
-    debug(DBG_DBG, "tlsadd: added TLS context %s", value);
+struct tls *tlsgettls(char *alt1, char *alt2) {
+    struct tls *t;
+
+    t = hash_read(tlsconfs, alt1, strlen(alt1));
+    if (!t)
+       t = hash_read(tlsconfs, alt2, strlen(alt2));
+    return t;
 }
 
-SSL_CTX *tlsgetctx(char *alt1, char *alt2) {
-    struct list_node *entry;
-    struct tls *t, *t1 = NULL, *t2 = NULL;
+SSL_CTX *tlsgetctx(uint8_t type, struct tls *t) {
+    struct timeval now;
     
-    for (entry = list_first(tlsconfs); entry; entry = list_next(entry)) {
-       t = (struct tls *)entry->data;
-       if (!strcasecmp(t->name, alt1)) {
-           t1 = t;
-           break;
-       }
-       if (!t2 && alt2 && !strcasecmp(t->name, alt2))
-           t2 = t;
-    }
-
-    t = (t1 ? t1 : t2);
     if (!t)
        return NULL;
-    return t->ctx;
+    gettimeofday(&now, NULL);
+    
+    switch (type) {
+    case RAD_TLS:
+       if (t->tlsexpiry && t->tlsctx) {
+           if (t->tlsexpiry < now.tv_sec) {
+               t->tlsexpiry = now.tv_sec + t->cacheexpiry;
+               SSL_CTX_free(t->tlsctx);
+               return t->tlsctx = tlscreatectx(RAD_TLS, t);
+           }
+       }
+       if (!t->tlsctx) {
+           t->tlsctx = tlscreatectx(RAD_TLS, t);
+           if (t->cacheexpiry)
+               t->tlsexpiry = now.tv_sec + t->cacheexpiry;
+       }
+       return t->tlsctx;
+    case RAD_DTLS:
+       if (t->dtlsexpiry && t->dtlsctx) {
+           if (t->dtlsexpiry < now.tv_sec) {
+               t->dtlsexpiry = now.tv_sec + t->cacheexpiry;
+               SSL_CTX_free(t->dtlsctx);
+               return t->dtlsctx = tlscreatectx(RAD_DTLS, t);
+           }
+       }
+       if (!t->dtlsctx) {
+           t->dtlsctx = tlscreatectx(RAD_DTLS, t);
+           if (t->cacheexpiry)
+               t->dtlsexpiry = now.tv_sec + t->cacheexpiry;
+       }
+       return t->dtlsctx;
+    }
+    return NULL;
 }
 
 struct list *addsrvconfs(char *value, char **names) {
@@ -3353,7 +2519,7 @@ struct realm *addrealm(struct list *realmlist, char *value, char **servers, char
     realm->message = message;
     realm->accresp = accresp;
     
-    if (regcomp(&realm->regex, regex ? regex : value + 1, REG_ICASE | REG_NOSUB)) {
+    if (regcomp(&realm->regex, regex ? regex : value + 1, REG_EXTENDED | REG_ICASE | REG_NOSUB)) {
        debug(DBG_ERR, "addrealm: failed to compile regular expression %s", regex ? regex : value + 1);
        goto errexit;
     }
@@ -3559,7 +2725,7 @@ int addmatchcertattr(struct clsrvconf *conf) {
        debug(DBG_ERR, "malloc failed");
        return 0;
     }
-    if (regcomp(*r, v, REG_ICASE | REG_NOSUB)) {
+    if (regcomp(*r, v, REG_EXTENDED | REG_ICASE | REG_NOSUB)) {
        free(*r);
        *r = NULL;
        debug(DBG_ERR, "failed to compile regular expression %s", v);
@@ -3568,47 +2734,6 @@ int addmatchcertattr(struct clsrvconf *conf) {
     return 1;
 }
 
-int addrewriteattr(struct clsrvconf *conf) {
-    char *v, *w;
-    
-    v = conf->rewriteattr + 11;
-    if (strncasecmp(conf->rewriteattr, "User-Name:/", 11) || !*v)
-       return 0;
-    /* regexp, remove optional trailing / if present */
-    if (v[strlen(v) - 1] == '/')
-       v[strlen(v) - 1] = '\0';
-
-    w = strchr(v, '/');
-    if (!*w)
-       return 0;
-    *w = '\0';
-    w++;
-    
-    conf->rewriteattrregex = malloc(sizeof(regex_t));
-    if (!conf->rewriteattrregex) {
-       debug(DBG_ERR, "malloc failed");
-       return 0;
-    }
-
-    conf->rewriteattrreplacement = stringcopy(w, 0);
-    if (!conf->rewriteattrreplacement) {
-       free(conf->rewriteattrregex);
-       conf->rewriteattrregex = NULL;
-       return 0;
-    }
-    
-    if (regcomp(conf->rewriteattrregex, v, REG_ICASE | REG_EXTENDED)) {
-       free(conf->rewriteattrregex);
-       conf->rewriteattrregex = NULL;
-       free(conf->rewriteattrreplacement);
-       conf->rewriteattrreplacement = NULL;
-       debug(DBG_ERR, "failed to compile regular expression %s", v);
-       return 0;
-    }
-
-    return 1;
-}
-
 /* should accept both names and numeric values, only numeric right now */
 uint8_t attrname2val(char *attrname) {
     int val = 0;
@@ -3631,83 +2756,182 @@ int vattrname2val(char *attrname, uint32_t *vendor, uint32_t *type) {
     return *type >= 0 && *type < 256;
 }
 
-struct rewrite *getrewrite(char *alt1, char *alt2) {
-    struct list_node *entry;
-    struct rewriteconf *r, *r1 = NULL, *r2 = NULL;
+/* should accept both names and numeric values, only numeric right now */
+struct tlv *extractattr(char *nameval) {
+    int len, name = 0;
+    char *s;
+    struct tlv *a;
     
-    for (entry = list_first(rewriteconfs); entry; entry = list_next(entry)) {
-       r = (struct rewriteconf *)entry->data;
-       if (!strcasecmp(r->name, alt1)) {
-           r1 = r;
-           break;
-       }
-       if (!r2 && alt2 && !strcasecmp(r->name, alt2))
-           r2 = r;
+    s = strchr(nameval, ':');
+    name = atoi(nameval);
+    if (!s || name < 1 || name > 255)
+       return NULL;
+    len = strlen(s + 1);
+    if (len > 253)
+       return NULL;
+    a = malloc(sizeof(struct tlv));
+    if (!a)
+       return NULL;
+    a->v = (uint8_t *)stringcopy(s + 1, 0);
+    if (!a->v) {
+       free(a);
+       return NULL;
     }
+    a->t = name;
+    a->l = len;
+    return a;
+}
 
-    r = (r1 ? r1 : r2);
-    if (!r)
+/* should accept both names and numeric values, only numeric right now */
+struct modattr *extractmodattr(char *nameval) {
+    int name = 0;
+    char *s, *t;
+    struct modattr *m;
+
+    if (!strncasecmp(nameval, "User-Name:/", 11)) {
+       s = nameval + 11;
+       name = 1;
+    } else {
+       s = strchr(nameval, ':');
+       name = atoi(nameval);
+       if (!s || name < 1 || name > 255 || s[1] != '/')
+           return NULL;
+       s += 2;
+    }
+    /* regexp, remove optional trailing / if present */
+    if (s[strlen(s) - 1] == '/')
+       s[strlen(s) - 1] = '\0';
+
+    t = strchr(s, '/');
+    if (!t)
+       return NULL;
+    *t = '\0';
+    t++;
+
+    m = malloc(sizeof(struct modattr));
+    if (!m) {
+       debug(DBG_ERR, "malloc failed");
+       return NULL;
+    }
+    m->t = name;
+
+    m->replacement = stringcopy(t, 0);
+    if (!m->replacement) {
+       free(m);
+       debug(DBG_ERR, "malloc failed");
+       return NULL;
+    }
+       
+    m->regex = malloc(sizeof(regex_t));
+    if (!m->regex) {
+       free(m->replacement);
+       free(m);
+       debug(DBG_ERR, "malloc failed");
+       return NULL;
+    }
+    
+    if (regcomp(m->regex, s, REG_ICASE | REG_EXTENDED)) {
+       free(m->regex);
+       free(m->replacement);
+       free(m);
+       debug(DBG_ERR, "failed to compile regular expression %s", s);
        return NULL;
-    return r->rewrite;
+    }
+
+    return m;
+}
+
+struct rewrite *getrewrite(char *alt1, char *alt2) {
+    struct rewrite *r;
+
+    if ((r = hash_read(rewriteconfs,  alt1, strlen(alt1))))
+       return r;
+    if ((r = hash_read(rewriteconfs,  alt2, strlen(alt2))))
+       return r;
+    return NULL;
 }
 
-void addrewrite(char *value, char **attrs, char **vattrs) {
-    struct rewriteconf *new;
+void addrewrite(char *value, char **rmattrs, char **rmvattrs, char **addattrs, char **modattrs) {
     struct rewrite *rewrite = NULL;
     int i, n;
-    uint8_t *a = NULL;
-    uint32_t *p, *va = NULL;
-
-    if (attrs) {
-       n = 0;
-       for (; attrs[n]; n++);
-       a = malloc((n + 1) * sizeof(uint8_t));
-       if (!a)
+    uint8_t *rma = NULL;
+    uint32_t *p, *rmva = NULL;
+    struct list *adda = NULL, *moda = NULL;
+    struct tlv *a;
+    struct modattr *m;
+    
+    if (rmattrs) {
+       for (n = 0; rmattrs[n]; n++);
+       rma = calloc(n + 1, sizeof(uint8_t));
+       if (!rma)
            debugx(1, DBG_ERR, "malloc failed");
     
        for (i = 0; i < n; i++) {
-           if (!(a[i] = attrname2val(attrs[i])))
-               debugx(1, DBG_ERR, "addrewrite: invalid attribute %s", attrs[i]);
-           free(attrs[i]);
+           if (!(rma[i] = attrname2val(rmattrs[i])))
+               debugx(1, DBG_ERR, "addrewrite: invalid attribute %s", rmattrs[i]);
+           free(rmattrs[i]);
        }
-       free(attrs);
-       a[i] = 0;
+       free(rmattrs);
+       rma[i] = 0;
     }
     
-    if (vattrs) {
-       n = 0;
-       for (; vattrs[n]; n++);
-       va = malloc((2 * n + 1) * sizeof(uint32_t));
-       if (!va)
+    if (rmvattrs) {
+       for (n = 0; rmvattrs[n]; n++);
+       rmva = calloc(2 * n + 1, sizeof(uint32_t));
+       if (!rmva)
            debugx(1, DBG_ERR, "malloc failed");
     
-       for (p = va, i = 0; i < n; i++, p += 2) {
-           if (!vattrname2val(vattrs[i], p, p + 1))
-               debugx(1, DBG_ERR, "addrewrite: invalid vendor attribute %s", vattrs[i]);
-           free(vattrs[i]);
+       for (p = rmva, i = 0; i < n; i++, p += 2) {
+           if (!vattrname2val(rmvattrs[i], p, p + 1))
+               debugx(1, DBG_ERR, "addrewrite: invalid vendor attribute %s", rmvattrs[i]);
+           free(rmvattrs[i]);
        }
-       free(vattrs);
+       free(rmvattrs);
        *p = 0;
     }
     
-    if (a || va) {
+    if (addattrs) {
+       adda = list_create();
+       if (!adda)
+           debugx(1, DBG_ERR, "malloc failed");
+       for (i = 0; addattrs[i]; i++) {
+           a = extractattr(addattrs[i]);
+           if (!a)
+               debugx(1, DBG_ERR, "addrewrite: invalid attribute %s", addattrs[i]);
+           free(addattrs[i]);
+           if (!list_push(adda, a))
+               debugx(1, DBG_ERR, "malloc failed");
+       }
+       free(addattrs);
+    }
+
+    if (modattrs) {
+       moda = list_create();
+       if (!moda)
+           debugx(1, DBG_ERR, "malloc failed");
+       for (i = 0; modattrs[i]; i++) {
+           m = extractmodattr(modattrs[i]);
+           if (!m)
+               debugx(1, DBG_ERR, "addrewrite: invalid attribute %s", modattrs[i]);
+           free(modattrs[i]);
+           if (!list_push(moda, m))
+               debugx(1, DBG_ERR, "malloc failed");
+       }
+       free(modattrs);
+    }
+       
+    if (rma || rmva || adda || moda) {
        rewrite = malloc(sizeof(struct rewrite));
        if (!rewrite)
            debugx(1, DBG_ERR, "malloc failed");
-       rewrite->removeattrs = a;
-       rewrite->removevendorattrs = va;
+       rewrite->removeattrs = rma;
+       rewrite->removevendorattrs = rmva;
+       rewrite->addattrs = adda;
+       rewrite->modattrs = moda;
     }
     
-    new = malloc(sizeof(struct rewriteconf));
-    if (!new || !list_push(rewriteconfs, new))
-       debugx(1, DBG_ERR, "malloc failed");
-
-    memset(new, 0, sizeof(struct rewriteconf));
-    new->name = stringcopy(value, 0);
-    if (!new->name)
+    if (!hash_insert(rewriteconfs, value, strlen(value), rewrite))
        debugx(1, DBG_ERR, "malloc failed");
-       
-    new->rewrite = rewrite;
     debug(DBG_DBG, "addrewrite: added rewrite block %s", value);
 }
 
@@ -3722,15 +2946,23 @@ void freeclsrvconf(struct clsrvconf *conf) {
        regfree(conf->certcnregex);
     if (conf->certuriregex)
        regfree(conf->certuriregex);
-    free(conf->confrewrite);
-    free(conf->rewriteattr);
-    if (conf->rewriteattrregex)
-       regfree(conf->rewriteattrregex);
-    free(conf->rewriteattrreplacement);
+    free(conf->confrewritein);
+    free(conf->confrewriteout);
+    if (conf->rewriteusername) {
+       if (conf->rewriteusername->regex)
+           regfree(conf->rewriteusername->regex);
+       free(conf->rewriteusername->replacement);
+       free(conf->rewriteusername);
+    }
     free(conf->dynamiclookupcommand);
-    free(conf->rewrite);
+    free(conf->rewritein);
+    free(conf->rewriteout);
     if (conf->addrinfo)
        freeaddrinfo(conf->addrinfo);
+    if (conf->lock) {
+       pthread_mutex_destroy(conf->lock);
+       free(conf->lock);
+    }
     /* not touching ssl_ctx, clients and servers */
     free(conf);
 }
@@ -3762,7 +2994,8 @@ int mergesrvconf(struct clsrvconf *dst, struct clsrvconf *src) {
        !mergeconfstring(&dst->secret, &src->secret) ||
        !mergeconfstring(&dst->tls, &src->tls) ||
        !mergeconfstring(&dst->matchcertattr, &src->matchcertattr) ||
-       !mergeconfstring(&dst->confrewrite, &src->confrewrite) ||
+       !mergeconfstring(&dst->confrewritein, &src->confrewritein) ||
+       !mergeconfstring(&dst->confrewriteout, &src->confrewriteout) ||
        !mergeconfstring(&dst->dynamiclookupcommand, &src->dynamiclookupcommand))
        return 0;
     if (src->pdef)
@@ -3778,12 +3011,13 @@ int mergesrvconf(struct clsrvconf *dst, struct clsrvconf *src) {
 
 int confclient_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val) {
     struct clsrvconf *conf;
-    char *conftype = NULL;
+    char *conftype = NULL, *rewriteinalias = NULL;
+    long int dupinterval = LONG_MIN;
     
     debug(DBG_DBG, "confclient_cb called for %s", block);
 
     conf = malloc(sizeof(struct clsrvconf));
-    if (!conf || !list_push(clconfs, conf))
+    if (!conf)
        debugx(1, DBG_ERR, "malloc failed");
     memset(conf, 0, sizeof(struct clsrvconf));
     conf->certnamecheck = 1;
@@ -3795,8 +3029,11 @@ int confclient_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
                     "tls", CONF_STR, &conf->tls,
                     "matchcertificateattribute", CONF_STR, &conf->matchcertattr,
                     "CertificateNameCheck", CONF_BLN, &conf->certnamecheck,
-                    "rewrite", CONF_STR, &conf->confrewrite,
-                    "rewriteattribute", CONF_STR, &conf->rewriteattr,
+                    "DuplicateInterval", CONF_LINT, &dupinterval,
+                    "rewrite", CONF_STR, &rewriteinalias,
+                    "rewriteIn", CONF_STR, &conf->confrewritein,
+                    "rewriteOut", CONF_STR, &conf->confrewriteout,
+                    "rewriteattribute", CONF_STR, &conf->confrewriteusername,
                     NULL
                          ))
        debugx(1, DBG_ERR, "configuration error");
@@ -3804,7 +3041,9 @@ int confclient_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
     conf->name = stringcopy(val, 0);
     if (!conf->host)
        conf->host = stringcopy(val, 0);
-
+    if (!conf->name || !conf->host)
+       debugx(1, DBG_ERR, "malloc failed");
+       
     if (!conftype)
        debugx(1, DBG_ERR, "error in block %s, option type missing", block);
     conf->type = protoname2int(conftype);
@@ -3813,18 +3052,32 @@ int confclient_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
        debugx(1, DBG_ERR, "error in block %s, unknown transport %s", block, conftype);
     free(conftype);
     
-    if (conf->type == RAD_TLS) {
-       conf->ssl_ctx = conf->tls ? tlsgetctx(conf->tls, NULL) : tlsgetctx("defaultclient", "default");
-       if (!conf->ssl_ctx)
+    if (conf->type == RAD_TLS || conf->type == RAD_DTLS) {
+       conf->tlsconf = conf->tls ? tlsgettls(conf->tls, NULL) : tlsgettls("defaultclient", "default");
+       if (!conf->tlsconf)
            debugx(1, DBG_ERR, "error in block %s, no tls context defined", block);
        if (conf->matchcertattr && !addmatchcertattr(conf))
            debugx(1, DBG_ERR, "error in block %s, invalid MatchCertificateAttributeValue", block);
     }
     
-    conf->rewrite = conf->confrewrite ? getrewrite(conf->confrewrite, NULL) : getrewrite("defaultclient", "default");
+    if (dupinterval != LONG_MIN) {
+       if (dupinterval < 0 || dupinterval > 255)
+           debugx(1, DBG_ERR, "error in block %s, value of option DuplicateInterval is %d, must be 0-255", block, dupinterval);
+       conf->dupinterval = (uint8_t)dupinterval;
+    } else
+       conf->dupinterval = conf->pdef->duplicateintervaldefault;
     
-    if (conf->rewriteattr) {
-       if (!addrewriteattr(conf))
+    if (!conf->confrewritein)
+       conf->confrewritein = rewriteinalias;
+    else
+       free(rewriteinalias);
+    conf->rewritein = conf->confrewritein ? getrewrite(conf->confrewritein, NULL) : getrewrite("defaultclient", "default");
+    if (conf->confrewriteout)
+       conf->rewriteout = getrewrite(conf->confrewriteout, NULL);
+    
+    if (conf->confrewriteusername) {
+       conf->rewriteusername = extractmodattr(conf->confrewriteusername);
+       if (!conf->rewriteusername)
            debugx(1, DBG_ERR, "error in block %s, invalid RewriteAttributeValue", block);
     }
     
@@ -3838,13 +3091,21 @@ int confclient_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
        if (!conf->secret)
            debugx(1, DBG_ERR, "malloc failed");
     }
+
+    conf->lock = malloc(sizeof(pthread_mutex_t));
+    if (!conf->lock)
+       debugx(1, DBG_ERR, "malloc failed");
+
+    pthread_mutex_init(conf->lock, NULL);
+    if (!list_push(clconfs, conf))
+       debugx(1, DBG_ERR, "malloc failed");
     return 1;
 }
 
 int compileserverconfig(struct clsrvconf *conf, const char *block) {
-    if (conf->type == RAD_TLS) {
-       conf->ssl_ctx = conf->tls ? tlsgetctx(conf->tls, NULL) : tlsgetctx("defaultserver", "default");
-       if (!conf->ssl_ctx) {
+    if (conf->type == RAD_TLS || conf->type == RAD_DTLS) {
+       conf->tlsconf = conf->tls ? tlsgettls(conf->tls, NULL) : tlsgettls("defaultserver", "default");
+       if (!conf->tlsconf) {
            debug(DBG_ERR, "error in block %s, no tls context defined", block);
            return 0;
        }
@@ -3867,7 +3128,9 @@ int compileserverconfig(struct clsrvconf *conf, const char *block) {
     if (conf->retrycount == 255)
        conf->retrycount = protodefs[conf->type].retrycountdefault;
     
-    conf->rewrite = conf->confrewrite ? getrewrite(conf->confrewrite, NULL) : getrewrite("defaultserver", "default");
+    conf->rewritein = conf->confrewritein ? getrewrite(conf->confrewritein, NULL) : getrewrite("defaultserver", "default");
+    if (conf->confrewriteout)
+       conf->rewriteout = getrewrite(conf->confrewriteout, NULL);
 
     if (!conf->secret) {
        if (!conf->pdef->secretdefault) {
@@ -3890,7 +3153,7 @@ int compileserverconfig(struct clsrvconf *conf, const char *block) {
                        
 int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val) {
     struct clsrvconf *conf, *resconf;
-    char *conftype = NULL;
+    char *conftype = NULL, *rewriteinalias = NULL;
     long int retryinterval = LONG_MIN, retrycount = LONG_MIN;
     
     debug(DBG_DBG, "confserver_cb called for %s", block);
@@ -3915,7 +3178,9 @@ int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
                          "secret", CONF_STR, &conf->secret,
                          "tls", CONF_STR, &conf->tls,
                          "MatchCertificateAttribute", CONF_STR, &conf->matchcertattr,
-                         "rewrite", CONF_STR, &conf->confrewrite,
+                         "rewrite", CONF_STR, &rewriteinalias,
+                         "rewriteIn", CONF_STR, &conf->confrewritein,
+                         "rewriteOut", CONF_STR, &conf->confrewriteout,
                          "StatusServer", CONF_BLN, &conf->statusserver,
                          "RetryInterval", CONF_LINT, &retryinterval,
                          "RetryCount", CONF_LINT, &retrycount,
@@ -3946,11 +3211,17 @@ int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
     conf->pdef = &protodefs[conf->type];
     if (!conf->pdef->name) {
        debug(DBG_ERR, "error in block %s, unknown transport %s", block, conftype);
-       free(conftype);
        goto errexit;
     }
     free(conftype);
-           
+    conftype = NULL;
+
+    if (!conf->confrewritein)
+       conf->confrewritein = rewriteinalias;
+    else
+       free(rewriteinalias);
+    rewriteinalias = NULL;
+
     if (retryinterval != LONG_MIN) {
        if (retryinterval < 1 || retryinterval > conf->pdef->retryintervalmax) {
            debug(DBG_ERR, "error in block %s, value of option RetryInterval is %d, must be 1-%d", block, retryinterval, conf->pdef->retryintervalmax);
@@ -3994,7 +3265,9 @@ int confserver_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
     }
     return 1;
 
- errexit:    
+ errexit:
+    free(conftype);
+    free(rewriteinalias);
     freeclsrvconf(conf);
     return 0;
 }
@@ -4019,43 +3292,85 @@ int confrealm_cb(struct gconffile **cf, void *arg, char *block, char *opt, char
 }
 
 int conftls_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val) {
-    char *cacertfile = NULL, *cacertpath = NULL, *certfile = NULL, *certkeyfile = NULL, *certkeypwd = NULL;
-    uint8_t crlcheck = 0;
+    struct tls *conf;
+    long int expiry = LONG_MIN;
     
     debug(DBG_DBG, "conftls_cb called for %s", block);
     
+    conf = malloc(sizeof(struct tls));
+    if (!conf) {
+       debug(DBG_ERR, "conftls_cb: malloc failed");
+       return 0;
+    }
+    memset(conf, 0, sizeof(struct tls));
+    
     if (!getgenericconfig(cf, block,
-                    "CACertificateFile", CONF_STR, &cacertfile,
-                    "CACertificatePath", CONF_STR, &cacertpath,
-                    "CertificateFile", CONF_STR, &certfile,
-                    "CertificateKeyFile", CONF_STR, &certkeyfile,
-                    "CertificateKeyPassword", CONF_STR, &certkeypwd,
-                    "CRLCheck", CONF_BLN, &crlcheck,
+                    "CACertificateFile", CONF_STR, &conf->cacertfile,
+                    "CACertificatePath", CONF_STR, &conf->cacertpath,
+                    "CertificateFile", CONF_STR, &conf->certfile,
+                    "CertificateKeyFile", CONF_STR, &conf->certkeyfile,
+                    "CertificateKeyPassword", CONF_STR, &conf->certkeypwd,
+                    "CacheExpiry", CONF_LINT, &expiry,
+                    "CRLCheck", CONF_BLN, &conf->crlcheck,
                     NULL
-                         ))
-       debugx(1, DBG_ERR, "configuration error");
-    
-    tlsadd(val, cacertfile, cacertpath, certfile, certkeyfile, certkeypwd, crlcheck);
-    free(cacertfile);
-    free(cacertpath);
-    free(certfile);
-    free(certkeyfile);
-    free(certkeypwd);
+                         )) {
+       debug(DBG_ERR, "conftls_cb: configuration error in block %s", val);
+       goto errexit;
+    }
+    if (!conf->certfile || !conf->certkeyfile) {
+       debug(DBG_ERR, "conftls_cb: TLSCertificateFile and TLSCertificateKeyFile must be specified in block %s", val);
+       goto errexit;
+    }
+    if (!conf->cacertfile && !conf->cacertpath) {
+       debug(DBG_ERR, "conftls_cb: CA Certificate file or path need to be specified in block %s", val);
+       goto errexit;
+    }
+    if (expiry != LONG_MIN) {
+       if (expiry < 0) {
+           debug(DBG_ERR, "error in block %s, value of option CacheExpiry is %ld, may not be negative", val, expiry);
+           goto errexit;
+       }
+       conf->cacheexpiry = expiry;
+    }    
+
+    conf->name = stringcopy(val, 0);
+    if (!conf->name) {
+       debug(DBG_ERR, "conftls_cb: malloc failed");
+       goto errexit;
+    }
+
+    if (!hash_insert(tlsconfs, val, strlen(val), conf)) {
+       debug(DBG_ERR, "conftls_cb: malloc failed");
+       goto errexit;
+    }
+           
+    debug(DBG_DBG, "conftls_cb: added TLS block %s", val);
     return 1;
+
+ errexit:
+    free(conf->cacertfile);
+    free(conf->cacertpath);
+    free(conf->certfile);
+    free(conf->certkeyfile);
+    free(conf->certkeypwd);
+    free(conf);
+    return 0;
 }
 
 int confrewrite_cb(struct gconffile **cf, void *arg, char *block, char *opt, char *val) {
-    char **attrs = NULL, **vattrs = NULL;
+    char **rmattrs = NULL, **rmvattrs = NULL, **addattrs = NULL, **modattrs = NULL;
     
     debug(DBG_DBG, "confrewrite_cb called for %s", block);
     
     if (!getgenericconfig(cf, block,
-                    "removeAttribute", CONF_MSTR, &attrs,
-                    "removeVendorAttribute", CONF_MSTR, &vattrs,
+                    "removeAttribute", CONF_MSTR, &rmattrs,
+                    "removeVendorAttribute", CONF_MSTR, &rmvattrs,
+                    "addAttribute", CONF_MSTR, &addattrs,
+                    "modifyAttribute", CONF_MSTR, &modattrs,
                     NULL
                          ))
        debugx(1, DBG_ERR, "configuration error");
-    addrewrite(val, attrs, vattrs);
+    addrewrite(val, rmattrs, rmvattrs, addattrs, modattrs);
     return 1;
 }
 
@@ -4078,11 +3393,11 @@ void getmainconfig(const char *configfile) {
     if (!realms)
        debugx(1, DBG_ERR, "malloc failed");    
  
-    tlsconfs = list_create();
+    tlsconfs = hash_create();
     if (!tlsconfs)
        debugx(1, DBG_ERR, "malloc failed");
     
-    rewriteconfs = list_create();
+    rewriteconfs = hash_create();
     if (!rewriteconfs)
        debugx(1, DBG_ERR, "malloc failed");    
  
@@ -4090,10 +3405,12 @@ void getmainconfig(const char *configfile) {
                          "ListenUDP", CONF_MSTR, &options.listenudp,
                          "ListenTCP", CONF_MSTR, &options.listentcp,
                          "ListenTLS", CONF_MSTR, &options.listentls,
+                         "ListenDTLS", CONF_MSTR, &options.listendtls,
                          "ListenAccountingUDP", CONF_MSTR, &options.listenaccudp,
                          "SourceUDP", CONF_STR, &options.sourceudp,
                          "SourceTCP", CONF_STR, &options.sourcetcp,
                          "SourceTLS", CONF_STR, &options.sourcetls,
+                         "SourceDTLS", CONF_STR, &options.sourcedtls,
                          "LogLevel", CONF_LINT, &loglevel,
                          "LogDestination", CONF_STR, &options.logdestination,
                          "LoopPrevention", CONF_BLN, &options.loopprevention,
@@ -4185,15 +3502,17 @@ void *sighandler(void *arg) {
 }
 
 int main(int argc, char **argv) {
-    pthread_t sigth, udpclient4rdth, udpclient6rdth, udpserverwrth;
+    pthread_t sigth;
     sigset_t sigset;
     struct list_node *entry;
     uint8_t foreground = 0, pretend = 0, loglevel = 0;
     char *configfile = NULL;
     struct clsrvconf *srvconf;
+    int i;
     
     debug_init("radsecproxy");
     debug_set_level(DEBUG_LEVEL);
+    
     getargs(argc, argv, &foreground, &pretend, &loglevel, &configfile);
     if (loglevel)
        debug_set_level(loglevel);
@@ -4208,8 +3527,6 @@ int main(int argc, char **argv) {
 
     if (!list_first(clconfs))
        debugx(1, DBG_ERR, "No clients configured, nothing to do, exiting");
-    if (!list_first(srvconfs))
-       debugx(1, DBG_ERR, "No servers configured, nothing to do, exiting");
     if (!list_first(realms))
        debugx(1, DBG_ERR, "No realms configured, nothing to do, exiting");
 
@@ -4219,6 +3536,7 @@ int main(int argc, char **argv) {
     if (!foreground && (daemon(0, 0) < 0))
        debugx(1, DBG_ERR, "daemon() failed: %s", strerror(errno));
     
+    debug_timestamp_on();
     debug(DBG_INFO, "radsecproxy revision $Rev$ starting");
 
     sigemptyset(&sigset);
@@ -4227,15 +3545,6 @@ int main(int argc, char **argv) {
     pthread_sigmask(SIG_BLOCK, &sigset, NULL);
     pthread_create(&sigth, NULL, sighandler, NULL);
 
-    if (find_conf_type(RAD_UDP, clconfs, NULL)) {
-       udp_server_replyq = newreplyq();
-       if (pthread_create(&udpserverwrth, NULL, udpserverwr, NULL))
-           debugx(1, DBG_ERR, "pthread_create failed");
-       createlisteners(RAD_UDP, options.listenudp);
-       if (options.listenaccudp)
-           createlisteners(RAD_UDP, options.listenaccudp);
-    }
-    
     for (entry = list_first(srvconfs); entry; entry = list_next(entry)) {
        srvconf = (struct clsrvconf *)entry->data;
        if (srvconf->dynamiclookupcommand)
@@ -4251,19 +3560,26 @@ int main(int argc, char **argv) {
        freeaddrinfo(srcprotores[RAD_UDP]);
        srcprotores[RAD_UDP] = NULL;
     }
-    if (udp_client4_sock >= 0)
-       if (pthread_create(&udpclient4rdth, NULL, protodefs[RAD_UDP].clientreader, (void *)&udp_client4_sock))
-           debugx(1, DBG_ERR, "pthread_create failed");
-    if (udp_client6_sock >= 0)
-       if (pthread_create(&udpclient6rdth, NULL, protodefs[RAD_UDP].clientreader, (void *)&udp_client6_sock))
-           debugx(1, DBG_ERR, "pthread_create failed");
+
+    for (i = 0; protodefs[i].name; i++)
+       if (protodefs[i].initextra)
+           protodefs[i].initextra();
     
-    if (find_conf_type(RAD_TCP, clconfs, NULL))
+    if (find_clconf_type(RAD_TCP, NULL))
        createlisteners(RAD_TCP, options.listentcp);
     
-    if (find_conf_type(RAD_TLS, clconfs, NULL))
+    if (find_clconf_type(RAD_TLS, NULL))
        createlisteners(RAD_TLS, options.listentls);
     
+    if (find_clconf_type(RAD_DTLS, NULL))
+       createlisteners(RAD_DTLS, options.listendtls);
+    
+    if (find_clconf_type(RAD_UDP, NULL)) {
+       createlisteners(RAD_UDP, options.listenudp);
+       if (options.listenaccudp)
+           createlisteners(RAD_UDP, options.listenaccudp);
+    }
+    
     /* just hang around doing nothing, anything to do here? */
     for (;;)
        sleep(1000);