Correct bug in rad_tlv_ok(), and add more checks for TLVs.
[freeradius.git] / src / lib / radius.c
1 /*
2  * radius.c     Functions to send/receive radius packets.
3  *
4  * Version:     $Id$
5  *
6  *   This library is free software; you can redistribute it and/or
7  *   modify it under the terms of the GNU Lesser General Public
8  *   License as published by the Free Software Foundation; either
9  *   version 2.1 of the License, or (at your option) any later version.
10  *
11  *   This library is distributed in the hope that it will be useful,
12  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14  *   Lesser General Public License for more details.
15  *
16  *   You should have received a copy of the GNU Lesser General Public
17  *   License along with this library; if not, write to the Free Software
18  *   Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
19  *
20  * Copyright 2000-2003,2006  The FreeRADIUS server project
21  */
22
23 #include        <freeradius-devel/ident.h>
24 RCSID("$Id$")
25
26 #include        <freeradius-devel/libradius.h>
27 #include        <freeradius-devel/md5.h>
28
29 #include        <fcntl.h>
30 #include        <ctype.h>
31
32 #ifdef WITH_UDPFROMTO
33 #include        <freeradius-devel/udpfromto.h>
34 #endif
35
36 #ifdef HAVE_MALLOC_H
37 #include        <malloc.h>
38 #endif
39
40 /*
41  *  The RFC says 4096 octets max, and most packets are less than 256.
42  */
43 #define MAX_PACKET_LEN 4096
44
45 /*
46  *      The maximum number of attributes which we allow in an incoming
47  *      request.  If there are more attributes than this, the request
48  *      is rejected.
49  *
50  *      This helps to minimize the potential for a DoS, when an
51  *      attacker spoofs Access-Request packets, which don't have a
52  *      Message-Authenticator attribute.  This means that the packet
53  *      is unsigned, and the attacker can use resources on the server,
54  *      even if the end request is rejected.
55  */
56 int fr_max_attributes = 0;
57 FILE *fr_log_fp = NULL;
58
59 typedef struct radius_packet_t {
60   uint8_t       code;
61   uint8_t       id;
62   uint8_t       length[2];
63   uint8_t       vector[AUTH_VECTOR_LEN];
64   uint8_t       data[1];
65 } radius_packet_t;
66
67 static fr_randctx fr_rand_pool; /* across multiple calls */
68 static int fr_rand_initialized = 0;
69 static unsigned int salt_offset = 0;
70
71 const char *fr_packet_codes[FR_MAX_PACKET_CODE] = {
72   "",
73   "Access-Request",
74   "Access-Accept",
75   "Access-Reject",
76   "Accounting-Request",
77   "Accounting-Response",
78   "Accounting-Status",
79   "Password-Request",
80   "Password-Accept",
81   "Password-Reject",
82   "Accounting-Message",
83   "Access-Challenge",
84   "Status-Server",
85   "Status-Client",
86   "14",
87   "15",
88   "16",
89   "17",
90   "18",
91   "19",
92   "20",
93   "Resource-Free-Request",
94   "Resource-Free-Response",
95   "Resource-Query-Request",
96   "Resource-Query-Response",
97   "Alternate-Resource-Reclaim-Request",
98   "NAS-Reboot-Request",
99   "NAS-Reboot-Response",
100   "28",
101   "Next-Passcode",
102   "New-Pin",
103   "Terminate-Session",
104   "Password-Expired",
105   "Event-Request",
106   "Event-Response",
107   "35",
108   "36",
109   "37",
110   "38",
111   "39",
112   "Disconnect-Request",
113   "Disconnect-ACK",
114   "Disconnect-NAK",
115   "CoA-Request",
116   "CoA-ACK",
117   "CoA-NAK",
118   "46",
119   "47",
120   "48",
121   "49",
122   "IP-Address-Allocate",
123   "IP-Address-Release"
124 };
125
126
127 void fr_printf_log(const char *fmt, ...)
128 {
129         va_list ap;
130
131         va_start(ap, fmt);
132         if ((fr_debug_flag == 0) || !fr_log_fp) {
133                 va_end(ap);
134                 return;
135         }
136
137         vfprintf(fr_log_fp, fmt, ap);
138         va_end(ap);
139
140         return;
141 }
142
143 #if 0
144 static void print_hex(RADIUS_PACKET *packet)
145 {
146         int i;
147
148         if (!packet->data) return;
149
150         printf("  Code:\t\t%u\n", packet->data[0]);
151         printf("  Id:\t\t%u\n", packet->data[1]);
152         printf("  Length:\t%u\n", ((packet->data[2] << 8) |
153                                    (packet->data[3])));
154         printf("  Vector:\t");
155         for (i = 4; i < 20; i++) {
156                 printf("%02x", packet->data[i]);
157         }
158         printf("\n");
159
160         if (packet->data_len > 20) {
161                 int total;
162                 const uint8_t *ptr;
163                 printf("  Data:");
164
165                 total = packet->data_len - 20;
166                 ptr = packet->data + 20;
167
168                 while (total > 0) {
169                         int attrlen;
170
171                         printf("\t\t");
172                         if (total < 2) { /* too short */
173                                 printf("%02x\n", *ptr);
174                                 break;
175                         }
176
177                         if (ptr[1] > total) { /* too long */
178                                 for (i = 0; i < total; i++) {
179                                         printf("%02x ", ptr[i]);
180                                 }
181                                 break;
182                         }
183
184                         printf("%02x  %02x  ", ptr[0], ptr[1]);
185                         attrlen = ptr[1] - 2;
186                         ptr += 2;
187                         total -= 2;
188
189                         for (i = 0; i < attrlen; i++) {
190                                 if ((i > 0) && ((i & 0x0f) == 0x00))
191                                         printf("\t\t\t");
192                                 printf("%02x ", ptr[i]);
193                                 if ((i & 0x0f) == 0x0f) printf("\n");
194                         }
195
196                         if ((attrlen & 0x0f) != 0x00) printf("\n");
197
198                         ptr += attrlen;
199                         total -= attrlen;
200                 }
201         }
202         fflush(stdout);
203 }
204 #endif
205
206 /*
207  *      Wrapper for sendto which handles sendfromto, IPv6, and all
208  *      possible combinations.
209  */
210 static int rad_sendto(int sockfd, void *data, size_t data_len, int flags,
211                       fr_ipaddr_t *src_ipaddr, int src_port,
212                       fr_ipaddr_t *dst_ipaddr, int dst_port)
213 {
214         struct sockaddr_storage dst;
215         socklen_t               sizeof_dst;
216
217 #ifdef WITH_UDPFROMTO
218         struct sockaddr_storage src;
219         socklen_t               sizeof_src;
220
221         fr_ipaddr2sockaddr(src_ipaddr, src_port, &src, &sizeof_src);
222 #else
223         src_port = src_port;    /* -Wunused */
224 #endif
225
226         if (!fr_ipaddr2sockaddr(dst_ipaddr, dst_port, &dst, &sizeof_dst)) {
227                 return -1;
228         }
229
230 #ifdef WITH_UDPFROMTO
231         /*
232          *      Only IPv4 is supported for udpfromto.
233          *
234          *      And if they don't specify a source IP address, don't
235          *      use udpfromto.
236          */
237         if ((dst_ipaddr->af == AF_INET) &&
238             (src_ipaddr->af != AF_UNSPEC)) {
239                 return sendfromto(sockfd, data, data_len, flags,
240                                   (struct sockaddr *)&src, sizeof_src,
241                                   (struct sockaddr *)&dst, sizeof_dst);
242         }
243 #else
244         src_ipaddr = src_ipaddr; /* -Wunused */
245 #endif
246
247         /*
248          *      No udpfromto, OR an IPv6 socket, fail gracefully.
249          */
250         return sendto(sockfd, data, data_len, flags,
251                       (struct sockaddr *) &dst, sizeof_dst);
252 }
253
254
255 void rad_recv_discard(int sockfd)
256 {
257         uint8_t                 header[4];
258         struct sockaddr_storage src;
259         socklen_t               sizeof_src = sizeof(src);
260
261         recvfrom(sockfd, header, sizeof(header), 0,
262                  (struct sockaddr *)&src, &sizeof_src);
263 }
264
265
266 ssize_t rad_recv_header(int sockfd, fr_ipaddr_t *src_ipaddr, int *src_port,
267                         int *code)
268 {
269         ssize_t                 data_len, packet_len;
270         uint8_t                 header[4];
271         struct sockaddr_storage src;
272         socklen_t               sizeof_src = sizeof(src);
273
274         data_len = recvfrom(sockfd, header, sizeof(header), MSG_PEEK,
275                             (struct sockaddr *)&src, &sizeof_src);
276         if (data_len < 0) {
277                 if ((errno == EAGAIN) || (errno == EINTR)) return 0;
278                 return -1;
279         }
280
281         /*
282          *      Too little data is available, discard the packet.
283          */
284         if (data_len < 4) {
285                 recvfrom(sockfd, header, sizeof(header), 0,
286                          (struct sockaddr *)&src, &sizeof_src);
287                 return 1;
288
289         } else {                /* we got 4 bytes of data. */
290                 /*
291                  *      See how long the packet says it is.
292                  */
293                 packet_len = (header[2] * 256) + header[3];
294
295                 /*
296                  *      The length in the packet says it's less than
297                  *      a RADIUS header length: discard it.
298                  */
299                 if (packet_len < AUTH_HDR_LEN) {
300                         recvfrom(sockfd, header, sizeof(header), 0,
301                                  (struct sockaddr *)&src, &sizeof_src);
302                         return 1;
303
304                         /*
305                          *      Enforce RFC requirements, for sanity.
306                          *      Anything after 4k will be discarded.
307                          */
308                 } else if (packet_len > MAX_PACKET_LEN) {
309                         recvfrom(sockfd, header, sizeof(header), 0,
310                                  (struct sockaddr *)&src, &sizeof_src);
311                         return 1;
312                 }
313         }
314
315         /*
316          *      Convert AF.  If unknown, discard packet.
317          */
318         if (!fr_sockaddr2ipaddr(&src, sizeof_src, src_ipaddr, src_port)) {
319                 recvfrom(sockfd, header, sizeof(header), 0,
320                          (struct sockaddr *)&src, &sizeof_src);
321                 return 1;
322         }
323
324         *code = header[0];
325
326         /*
327          *      The packet says it's this long, but the actual UDP
328          *      size could still be smaller.
329          */
330         return packet_len;
331 }
332
333
334 /*
335  *      wrapper for recvfrom, which handles recvfromto, IPv6, and all
336  *      possible combinations.
337  */
338 static ssize_t rad_recvfrom(int sockfd, uint8_t **pbuf, int flags,
339                             fr_ipaddr_t *src_ipaddr, uint16_t *src_port,
340                             fr_ipaddr_t *dst_ipaddr, uint16_t *dst_port)
341 {
342         struct sockaddr_storage src;
343         struct sockaddr_storage dst;
344         socklen_t               sizeof_src = sizeof(src);
345         socklen_t               sizeof_dst = sizeof(dst);
346         ssize_t                 data_len;
347         uint8_t                 header[4];
348         void                    *buf;
349         size_t                  len;
350         int                     port;
351
352         memset(&src, 0, sizeof_src);
353         memset(&dst, 0, sizeof_dst);
354
355         /*
356          *      Get address family, etc. first, so we know if we
357          *      need to do udpfromto.
358          *
359          *      FIXME: udpfromto also does this, but it's not
360          *      a critical problem.
361          */
362         if (getsockname(sockfd, (struct sockaddr *)&dst,
363                         &sizeof_dst) < 0) return -1;
364
365         /*
366          *      Read the length of the packet, from the packet.
367          *      This lets us allocate the buffer to use for
368          *      reading the rest of the packet.
369          */
370         data_len = recvfrom(sockfd, header, sizeof(header), MSG_PEEK,
371                             (struct sockaddr *)&src, &sizeof_src);
372         if (data_len < 0) {
373                 if ((errno == EAGAIN) || (errno == EINTR)) return 0;
374                 return -1;
375         }
376
377         /*
378          *      Too little data is available, discard the packet.
379          */
380         if (data_len < 4) {
381                 recvfrom(sockfd, header, sizeof(header), flags,
382                          (struct sockaddr *)&src, &sizeof_src);
383                 return 0;
384
385         } else {                /* we got 4 bytes of data. */
386                 /*
387                  *      See how long the packet says it is.
388                  */
389                 len = (header[2] * 256) + header[3];
390
391                 /*
392                  *      The length in the packet says it's less than
393                  *      a RADIUS header length: discard it.
394                  */
395                 if (len < AUTH_HDR_LEN) {
396                         recvfrom(sockfd, header, sizeof(header), flags,
397                                  (struct sockaddr *)&src, &sizeof_src);
398                         return 0;
399
400                         /*
401                          *      Enforce RFC requirements, for sanity.
402                          *      Anything after 4k will be discarded.
403                          */
404                 } else if (len > MAX_PACKET_LEN) {
405                         recvfrom(sockfd, header, sizeof(header), flags,
406                                  (struct sockaddr *)&src, &sizeof_src);
407                         return len;
408                 }
409         }
410
411         buf = malloc(len);
412         if (!buf) return -1;
413
414         /*
415          *      Receive the packet.  The OS will discard any data in the
416          *      packet after "len" bytes.
417          */
418 #ifdef WITH_UDPFROMTO
419         if (dst.ss_family == AF_INET) {
420                 data_len = recvfromto(sockfd, buf, len, flags,
421                                       (struct sockaddr *)&src, &sizeof_src,
422                                       (struct sockaddr *)&dst, &sizeof_dst);
423         } else
424 #endif
425                 /*
426                  *      No udpfromto, OR an IPv6 socket.  Fail gracefully.
427                  */
428                 data_len = recvfrom(sockfd, buf, len, flags,
429                                     (struct sockaddr *)&src, &sizeof_src);
430         if (data_len < 0) {
431                 free(buf);
432                 return data_len;
433         }
434
435         if (!fr_sockaddr2ipaddr(&src, sizeof_src, src_ipaddr, &port)) {
436                 free(buf);
437                 return -1;      /* Unknown address family, Die Die Die! */
438         }
439         *src_port = port;
440
441         fr_sockaddr2ipaddr(&dst, sizeof_dst, dst_ipaddr, &port);
442         *dst_port = port;
443
444         /*
445          *      Different address families should never happen.
446          */
447         if (src.ss_family != dst.ss_family) {
448                 free(buf);
449                 return -1;
450         }
451
452         /*
453          *      Tell the caller about the data
454          */
455         *pbuf = buf;
456
457         return data_len;
458 }
459
460
461 #define AUTH_PASS_LEN (AUTH_VECTOR_LEN)
462 /*************************************************************************
463  *
464  *      Function: make_secret
465  *
466  *      Purpose: Build an encrypted secret value to return in a reply
467  *               packet.  The secret is hidden by xoring with a MD5 digest
468  *               created from the shared secret and the authentication
469  *               vector.  We put them into MD5 in the reverse order from
470  *               that used when encrypting passwords to RADIUS.
471  *
472  *************************************************************************/
473 static void make_secret(uint8_t *digest, const uint8_t *vector,
474                         const char *secret, const uint8_t *value)
475 {
476         FR_MD5_CTX context;
477         int             i;
478
479         fr_MD5Init(&context);
480         fr_MD5Update(&context, vector, AUTH_VECTOR_LEN);
481         fr_MD5Update(&context, (const uint8_t *) secret, strlen(secret));
482         fr_MD5Final(digest, &context);
483
484         for ( i = 0; i < AUTH_VECTOR_LEN; i++ ) {
485                 digest[i] ^= value[i];
486         }
487 }
488
489 #define MAX_PASS_LEN (128)
490 static void make_passwd(uint8_t *output, ssize_t *outlen,
491                         const uint8_t *input, size_t inlen,
492                         const char *secret, const uint8_t *vector)
493 {
494         FR_MD5_CTX context, old;
495         uint8_t digest[AUTH_VECTOR_LEN];
496         uint8_t passwd[MAX_PASS_LEN];
497         int     i, n;
498         int     len;
499
500         /*
501          *      If the length is zero, round it up.
502          */
503         len = inlen;
504
505         if (len > MAX_PASS_LEN) len = MAX_PASS_LEN;
506
507         memcpy(passwd, input, len);
508         memset(passwd + len, 0, sizeof(passwd) - len);
509
510         if (len == 0) {
511                 len = AUTH_PASS_LEN;
512         }
513
514         else if ((len & 0x0f) != 0) {
515                 len += 0x0f;
516                 len &= ~0x0f;
517         }
518         *outlen = len;
519
520         fr_MD5Init(&context);
521         fr_MD5Update(&context, (const uint8_t *) secret, strlen(secret));
522         old = context;
523
524         /*
525          *      Do first pass.
526          */
527         fr_MD5Update(&context, vector, AUTH_PASS_LEN);
528
529         for (n = 0; n < len; n += AUTH_PASS_LEN) {
530                 if (n > 0) {
531                         context = old;
532                         fr_MD5Update(&context,
533                                        passwd + n - AUTH_PASS_LEN,
534                                        AUTH_PASS_LEN);
535                 }
536
537                 fr_MD5Final(digest, &context);
538                 for (i = 0; i < AUTH_PASS_LEN; i++) {
539                         passwd[i + n] ^= digest[i];
540                 }
541         }
542
543         memcpy(output, passwd, len);
544 }
545
546 static void make_tunnel_passwd(uint8_t *output, ssize_t *outlen,
547                                const uint8_t *input, size_t inlen, size_t room,
548                                const char *secret, const uint8_t *vector)
549 {
550         FR_MD5_CTX context, old;
551         uint8_t digest[AUTH_VECTOR_LEN];
552         uint8_t passwd[MAX_STRING_LEN + AUTH_VECTOR_LEN];
553         int     i, n;
554         int     len;
555
556         /*
557          *      Be paranoid.
558          */
559         if (room > 253) room = 253;
560
561         /*
562          *      Account for 2 bytes of the salt, and round the room
563          *      available down to the nearest multiple of 16.  Then,
564          *      subtract one from that to account for the length byte,
565          *      and the resulting number is the upper bound on the data
566          *      to copy.
567          *
568          *      We could short-cut this calculation just be forcing
569          *      inlen to be no more than 239.  It would work for all
570          *      VSA's, as we don't pack multiple VSA's into one
571          *      attribute.
572          *
573          *      However, this calculation is more general, if a little
574          *      complex.  And it will work in the future for all possible
575          *      kinds of weird attribute packing.
576          */
577         room -= 2;
578         room -= (room & 0x0f);
579         room--;
580
581         if (inlen > room) inlen = room;
582
583         /*
584          *      Length of the encrypted data is password length plus
585          *      one byte for the length of the password.
586          */
587         len = inlen + 1;
588         if ((len & 0x0f) != 0) {
589                 len += 0x0f;
590                 len &= ~0x0f;
591         }
592         *outlen = len + 2;      /* account for the salt */
593
594         /*
595          *      Copy the password over.
596          */
597         memcpy(passwd + 3, input, inlen);
598         memset(passwd + 3 + inlen, 0, sizeof(passwd) - 3 - inlen);
599
600         /*
601          *      Generate salt.  The RFC's say:
602          *
603          *      The high bit of salt[0] must be set, each salt in a
604          *      packet should be unique, and they should be random
605          *
606          *      So, we set the high bit, add in a counter, and then
607          *      add in some CSPRNG data.  should be OK..
608          */
609         passwd[0] = (0x80 | ( ((salt_offset++) & 0x0f) << 3) |
610                      (fr_rand() & 0x07));
611         passwd[1] = fr_rand();
612         passwd[2] = inlen;      /* length of the password string */
613
614         fr_MD5Init(&context);
615         fr_MD5Update(&context, (const uint8_t *) secret, strlen(secret));
616         old = context;
617
618         fr_MD5Update(&context, vector, AUTH_VECTOR_LEN);
619         fr_MD5Update(&context, &passwd[0], 2);
620
621         for (n = 0; n < len; n += AUTH_PASS_LEN) {
622                 if (n > 0) {
623                         context = old;
624                         fr_MD5Update(&context,
625                                        passwd + 2 + n - AUTH_PASS_LEN,
626                                        AUTH_PASS_LEN);
627                 }
628
629                 fr_MD5Final(digest, &context);
630
631                 for (i = 0; i < AUTH_PASS_LEN; i++) {
632                         passwd[i + 2 + n] ^= digest[i];
633                 }
634         }
635         memcpy(output, passwd, len + 2);
636 }
637
638 extern int fr_attr_max_tlv;
639 extern int fr_attr_shift[];
640 extern int fr_attr_mask[];
641
642 static int do_next_tlv(const VALUE_PAIR *vp, int nest)
643 {
644         unsigned int tlv1, tlv2;
645
646         if (nest >= fr_attr_max_tlv) return 0;
647
648         /*
649          *      Keep encoding TLVs which have the same scope.
650          *      e.g. two attributes of:
651          *              ATTR.TLV1.TLV2.TLV3 = data1
652          *              ATTR.TLV1.TLV2.TLV4 = data2
653          *      both get put into a container of "ATTR.TLV1.TLV2"
654          */
655
656         /*
657          *      Nothing to follow, we're done.
658          */
659         if (!vp->next) return 0;
660
661         /*
662          *      Not from the same vendor, skip it.
663          */
664         if (vp->vendor != vp->next->vendor) return 0;
665
666         /*
667          *      The next one has already been done.  Maybe by
668          *      another level of recursion.  Skip it.
669          */
670         if (vp->next->flags.encoded) return 0;
671
672         /*
673          *      In a different TLV space, skip it.
674          */
675         tlv1 = vp->attribute;
676         tlv2 = vp->next->attribute;
677         
678         tlv1 &= ((1 << fr_attr_shift[nest]) - 1);
679         tlv2 &= ((1 << fr_attr_shift[nest]) - 1);
680         
681         if (tlv1 != tlv2) return 0;
682
683         return 1;
684 }
685
686
687 static ssize_t vp2data_any(const RADIUS_PACKET *packet,
688                            const RADIUS_PACKET *original,
689                            const char *secret, int nest, VALUE_PAIR *vps,
690                            uint8_t *start, size_t room);
691
692 static ssize_t vp2data_tlvs(const RADIUS_PACKET *packet,
693                             const RADIUS_PACKET *original,
694                             const char *secret, int nest, VALUE_PAIR *vps,
695                             uint8_t *start, size_t room)
696 {
697         ssize_t len;
698         uint8_t *ptr = start;
699         uint8_t *end = start + room;
700         VALUE_PAIR *vp = vps;
701
702 #ifndef NDEBUG
703         if (nest > fr_attr_max_tlv) {
704                 fr_strerror_printf("vp2data_tlvs: attribute nesting overflow");
705                 return -1;
706         }
707 #endif
708
709         while (1) {
710                 ptr[0] = (vp->attribute >> fr_attr_shift[nest]) & fr_attr_mask[nest];
711                 ptr[1] = 2;
712                 
713                 len = vp2data_any(packet, original, secret, nest + 1, vp,
714                                   ptr + ptr[1], end - ptr);
715                 if (len < 0) {
716                         if (vp != vps) break;
717                         return len;
718                 }
719                 
720                 ptr[1] += len;
721                 ptr += ptr[1];
722                 vp->flags.encoded = 1;
723                 
724                 if (!do_next_tlv(vp, nest)) break;
725                 vp = vp->next;
726         }
727         
728         return ptr - start;
729 }
730
731 /*
732  *      Encodes the data portion of an attribute.
733  *      Returns -1 on error, or the length of the data portion.
734  */
735 static ssize_t vp2data_any(const RADIUS_PACKET *packet,
736                            const RADIUS_PACKET *original,
737                            const char *secret, int nest, VALUE_PAIR *vp,
738                            uint8_t *start, size_t room)
739 {
740         uint32_t lvalue;
741         ssize_t len;
742         const uint8_t *data;
743         uint8_t *ptr = start;
744         uint8_t array[4];
745
746         /*
747          *      See if we need to encode a TLV.  The low portion of
748          *      the attribute has already been placed into the packer.
749          *      If there are still attribute bytes left, then go
750          *      encode them as TLVs.
751          *
752          *      If we cared about the stack, we could unroll the loop.
753          */
754         if ((nest > 0) && (nest <= fr_attr_max_tlv) &&
755             ((vp->attribute >> fr_attr_shift[nest]) != 0)) {
756                 return vp2data_tlvs(packet, original, secret, nest, vp,
757                                     start, room);
758         }
759
760         /*
761          *      Set up the default sources for the data.
762          */
763         data = vp->vp_octets;
764         len = vp->length;
765
766         switch(vp->type) {
767         case PW_TYPE_STRING:
768         case PW_TYPE_OCTETS:
769         case PW_TYPE_IFID:
770         case PW_TYPE_IPV6ADDR:
771         case PW_TYPE_IPV6PREFIX:
772         case PW_TYPE_ABINARY:
773                 /* nothing more to do */
774                 break;
775
776         case PW_TYPE_BYTE:
777                 len = 1;        /* just in case */
778                 array[0] = vp->vp_integer & 0xff;
779                 data = array;
780                 break;
781
782         case PW_TYPE_SHORT:
783                 len = 2;        /* just in case */
784                 array[0] = (vp->vp_integer >> 8) & 0xff;
785                 array[1] = vp->vp_integer & 0xff;
786                 data = array;
787                 break;
788
789         case PW_TYPE_INTEGER:
790                 len = 4;        /* just in case */
791                 lvalue = htonl(vp->vp_integer);
792                 memcpy(array, &lvalue, sizeof(lvalue));
793                 data = array;
794                 break;
795
796         case PW_TYPE_IPADDR:
797                 data = (const uint8_t *) &vp->vp_ipaddr;
798                 len = 4;        /* just in case */
799                 break;
800
801                 /*
802                  *  There are no tagged date attributes.
803                  */
804         case PW_TYPE_DATE:
805                 lvalue = htonl(vp->vp_date);
806                 data = (const uint8_t *) &lvalue;
807                 len = 4;        /* just in case */
808                 break;
809
810         case PW_TYPE_SIGNED:
811         {
812                 int32_t slvalue;
813
814                 len = 4;        /* just in case */
815                 slvalue = htonl(vp->vp_signed);
816                 memcpy(array, &slvalue, sizeof(slvalue));
817                 break;
818         }
819
820         case PW_TYPE_TLV:
821                 data = vp->vp_tlv;
822                 if (!data) {
823                         fr_strerror_printf("ERROR: Cannot encode NULL TLV");
824                         return -1;
825                 }
826                 if (vp->length > room) return 0; /* can't chop TLVs to fit */
827                 break;
828
829         default:                /* unknown type: ignore it */
830                 fr_strerror_printf("ERROR: Unknown attribute type %d", vp->type);
831                 return -1;
832         }
833
834         /*
835          *      Bound the data to the calling size
836          */
837         if (len > (ssize_t) room) len = room;
838
839         /*
840          *      Encrypt the various password styles
841          *
842          *      Attributes with encrypted values MUST be less than
843          *      128 bytes long.
844          */
845         switch (vp->flags.encrypt) {
846         case FLAG_ENCRYPT_USER_PASSWORD:
847                 make_passwd(ptr, &len, data, len,
848                             secret, packet->vector);
849                 break;
850
851         case FLAG_ENCRYPT_TUNNEL_PASSWORD:
852                 lvalue = 0;
853                 if (vp->flags.has_tag) lvalue = 1;
854
855                 /*
856                  *      Check if there's enough room.  If there isn't,
857                  *      we discard the attribute.
858                  *
859                  *      This is ONLY a problem if we have multiple VSA's
860                  *      in one Vendor-Specific, though.
861                  */
862                 if (room < (18 + lvalue)) return 0;
863
864                 switch (packet->code) {
865                 case PW_AUTHENTICATION_ACK:
866                 case PW_AUTHENTICATION_REJECT:
867                 case PW_ACCESS_CHALLENGE:
868                 default:
869                         if (!original) {
870                                 fr_strerror_printf("ERROR: No request packet, cannot encrypt %s attribute in the vp.", vp->name);
871                                 return -1;
872                         }
873
874                         if (lvalue) ptr[0] = vp->flags.tag;
875                         make_tunnel_passwd(ptr + lvalue, &len, data, len,
876                                            room - lvalue,
877                                            secret, original->vector);
878                         break;
879                 case PW_ACCOUNTING_REQUEST:
880                 case PW_DISCONNECT_REQUEST:
881                 case PW_COA_REQUEST:
882                         ptr[0] = vp->flags.tag;
883                         make_tunnel_passwd(ptr + 1, &len, data, len - 1, room,
884                                            secret, packet->vector);
885                         break;
886                 }
887                 break;
888
889                 /*
890                  *      The code above ensures that this attribute
891                  *      always fits.
892                  */
893         case FLAG_ENCRYPT_ASCEND_SECRET:
894                 make_secret(ptr, packet->vector, secret, data);
895                 len = AUTH_VECTOR_LEN;
896                 break;
897
898
899         default:
900                 if (vp->flags.has_tag && TAG_VALID(vp->flags.tag)) {
901                         if (vp->type == PW_TYPE_STRING) {
902                                 if (len > ((ssize_t) (room - 1))) len = room - 1;
903                                 ptr[0] = vp->flags.tag;
904                                 ptr++;
905                         } else if (vp->type == PW_TYPE_INTEGER) {
906                                 array[0] = vp->flags.tag;
907                         } /* else it can't be any other type */
908                 }
909                 memcpy(ptr, data, len);
910                 break;
911         } /* switch over encryption flags */
912
913         vp->flags.encoded = 1;
914         return len + (ptr - start);;
915 }
916
917 static ssize_t attr_shift(const uint8_t *start, const uint8_t *end,
918                           uint8_t *ptr, int hdr_len, ssize_t len,
919                           int flag_offset, int vsa_offset)
920 {
921         int check_len = len - ptr[1];
922         int total = len + hdr_len;
923         
924         /*
925          *      Pass 1: Check if the addition of the headers
926          *      overflows the available room.  If so, return
927          *      what we were capable of encoding.
928          */
929         
930         while (check_len > (255 - hdr_len)) {
931                 total += hdr_len;
932                 check_len -= (255 - hdr_len);
933         }
934
935         /*
936          *      Note that this results in a number of attributes maybe
937          *      being marked as "encoded", but which aren't in the
938          *      packet.  Oh well.  The solution is to fix the
939          *      "vp2data_any" function to take into account the header
940          *      lengths.
941          */
942         if ((ptr + ptr[1] + total) > end) {
943                 return (ptr + ptr[1]) - start;
944         }
945         
946         /*
947          *      Pass 2: Now that we know there's enough room,
948          *      re-arrange the data to form a set of valid
949          *      RADIUS attributes.
950          */
951         while (1) {
952                 int sublen = 255 - ptr[1];
953                 
954                 if (len <= sublen) {
955                         break;
956                 }
957                 
958                 len -= sublen;
959                 memmove(ptr + 255 + hdr_len, ptr + 255, sublen);
960                 memcpy(ptr + 255, ptr, hdr_len);
961                 ptr[1] += sublen;
962                 if (vsa_offset) ptr[vsa_offset] += sublen;
963                 ptr[flag_offset] |= 0x80;
964                 
965                 ptr += 255;
966                 ptr[1] = hdr_len;
967                 if (vsa_offset) ptr[vsa_offset] = 3;
968         }
969
970         ptr[1] += len;
971         if (vsa_offset) ptr[vsa_offset] += len;
972
973         return (ptr + ptr[1]) - start;
974 }
975
976
977 /*
978  *      Encode an "extended" attribute.
979  */
980 int rad_vp2extended(const RADIUS_PACKET *packet,
981                     const RADIUS_PACKET *original,
982                     const char *secret, VALUE_PAIR *vp,
983                     uint8_t *ptr, size_t room)
984 {
985         int len;
986         int hdr_len;
987         int nest = 2;
988         uint8_t *start = ptr;
989
990         if (vp->vendor < VENDORPEC_EXTENDED) {
991                 fr_strerror_printf("rad_vp2extended called for non-extended attribute");
992                 return -1;
993         }
994
995         if (room < 3) return 0;
996
997         ptr[0] = vp->attribute & 0xff;
998         ptr[1] = 3;
999
1000         if (vp->flags.extended) {
1001                 ptr[2] = (vp->attribute & 0xff00) >> 8;
1002
1003         } else if (vp->flags.extended_flags) {
1004                 if (room < 4) return 0;
1005
1006                 ptr[1] = 4;
1007                 ptr[2] = (vp->attribute & 0xff00) >> 8;
1008                 ptr[3] = 0;
1009         }
1010
1011         /*
1012          *      Only "flagged" attributes can be longer than one
1013          *      attribute.
1014          */
1015         if (!vp->flags.extended_flags && (room > 255)) {
1016                 room = 255;
1017         }
1018
1019         /*
1020          *      Handle EVS VSAs.
1021          */
1022         if (vp->flags.evs) {
1023                 uint8_t *evs = ptr + ptr[1];
1024
1025                 if (room < (size_t) (ptr[1] + 5)) return 0;
1026
1027                 /*
1028                  *      RADIUS Attribute Type is packed into the high byte
1029                  *      of the Vendor Id.  So over-write it in the packet.
1030                  *
1031                  *      And hard-code Extended-Type to Vendor-Specific.
1032                  */
1033                 ptr[0] = (vp->vendor >> 24) & 0xff;
1034                 ptr[2] = 26;
1035
1036                 evs[0] = 0;     /* always zero */
1037                 evs[1] = (vp->vendor >> 16) & 0xff;
1038                 evs[2] = (vp->vendor >> 8) & 0xff;
1039                 evs[3] = vp->vendor & 0xff;
1040                 evs[4] = vp->attribute & 0xff;          
1041
1042                 ptr[1] += 5;
1043                 nest = 1;
1044         }
1045         hdr_len = ptr[1];
1046
1047         len = vp2data_any(packet, original, secret, nest,
1048                           vp, ptr + ptr[1], room - hdr_len);
1049         if (len < 0) return len;
1050
1051         /*
1052          *      There may be more than 252 octets of data encoded in
1053          *      the attribute.  If so, move the data up in the packet,
1054          *      and copy the existing header over.  Set the "M" flag ONLY
1055          *      after copying the rest of the data.
1056          */
1057         if (vp->flags.extended_flags && (len > (255 - ptr[1]))) {
1058                 return attr_shift(start, start + room, ptr, 4, len, 3, 0);
1059         }
1060
1061         ptr[1] += len;
1062
1063         return (ptr + ptr[1]) - start;
1064 }
1065
1066
1067 /*
1068  *      Encode a WiMAX attribute.
1069  */
1070 int rad_vp2wimax(const RADIUS_PACKET *packet,
1071                  const RADIUS_PACKET *original,
1072                  const char *secret, VALUE_PAIR *vp,
1073                  uint8_t *ptr, size_t room)
1074 {
1075         int len;
1076         uint32_t lvalue;
1077         int hdr_len;
1078         uint8_t *start = ptr;
1079
1080         /*
1081          *      Double-check for WiMAX
1082          */
1083         if (vp->vendor != VENDORPEC_WIMAX) {
1084                 fr_strerror_printf("rad_vp2wimax called for non-WIMAX VSA");
1085                 return -1;
1086         }
1087
1088         /*
1089          *      Not enough room for:
1090          *              attr, len, vendor-id, vsa, vsalen, continuation
1091          */
1092         if (room < 9) return 0;
1093
1094         /*
1095          *      Build the Vendor-Specific header
1096          */
1097         ptr = start;
1098         ptr[0] = PW_VENDOR_SPECIFIC;
1099         ptr[1] = 9;
1100         lvalue = htonl(vp->vendor);
1101         memcpy(ptr + 2, &lvalue, 4);
1102         ptr[6] = (vp->attribute & fr_attr_mask[1]);
1103         ptr[7] = 3;
1104         ptr[8] = 0;             /* continuation byte */
1105
1106         hdr_len = 9;
1107
1108         len = vp2data_any(packet, original, secret, 1, vp, ptr + ptr[1],
1109                           room - hdr_len);
1110         if (len <= 0) return len;
1111
1112         /*
1113          *      There may be more than 252 octets of data encoded in
1114          *      the attribute.  If so, move the data up in the packet,
1115          *      and copy the existing header over.  Set the "C" flag
1116          *      ONLY after copying the rest of the data.
1117          */
1118         if (len > (255 - ptr[1])) {
1119                 return attr_shift(start, start + room, ptr, hdr_len, len, 8, 7);
1120         }
1121
1122         ptr[1] += len;
1123         ptr[7] += len;
1124
1125         return (ptr + ptr[1]) - start;
1126 }
1127
1128 /*
1129  *      Encode an RFC format TLV.  This could be a standard attribute,
1130  *      or a TLV data type.  If it's a standard attribute, then
1131  *      vp->attribute == attribute.  Otherwise, attribute may be
1132  *      something else.
1133  */
1134 static ssize_t vp2attr_rfc(const RADIUS_PACKET *packet,
1135                            const RADIUS_PACKET *original,
1136                            const char *secret, VALUE_PAIR *vp,
1137                            unsigned int attribute, uint8_t *ptr, size_t room)
1138 {
1139         ssize_t len;
1140
1141         if (room < 2) return 0;
1142
1143         ptr[0] = attribute & 0xff;
1144         ptr[1] = 2;
1145
1146         if (room > ((unsigned) 255 - ptr[1])) room = 255 - ptr[1];
1147
1148         len = vp2data_any(packet, original, secret, 0, vp, ptr + ptr[1], room);
1149         if (len < 0) return len;
1150
1151         ptr[1] += len;
1152
1153         return ptr[1];
1154 }
1155
1156
1157 /*
1158  *      Encode a VSA which is a TLV.  If it's in the RFC format, call
1159  *      vp2attr_rfc.  Otherwise, encode it here.
1160  */
1161 static ssize_t vp2attr_vsa(const RADIUS_PACKET *packet,
1162                            const RADIUS_PACKET *original,
1163                            const char *secret, VALUE_PAIR *vp,
1164                            unsigned int attribute, unsigned int vendor,
1165                            uint8_t *ptr, size_t room)
1166 {
1167         ssize_t len;
1168         DICT_VENDOR *dv;
1169
1170         /*
1171          *      Unknown vendor: RFC format.
1172          *      Known vendor and RFC format: go do that.
1173          */
1174         dv = dict_vendorbyvalue(vendor);
1175         if (!dv || ((dv->type == 1) && (dv->length == 1))) {
1176                 return vp2attr_rfc(packet, original, secret, vp,
1177                                    attribute, ptr, room);
1178         }
1179
1180         switch (dv->type) {
1181         default:
1182                 fr_strerror_printf("vp2attr_vsa: Internal sanity check failed,"
1183                                    " type %u", (unsigned) dv->type);
1184                 return -1;
1185
1186         case 4:
1187                 ptr[0] = 0;     /* attr must be 24-bit */
1188                 ptr[1] = (attribute >> 16) & 0xff;
1189                 ptr[2] = (attribute >> 8) & 0xff;
1190                 ptr[3] = attribute & 0xff;
1191                 break;
1192
1193         case 2:
1194                 ptr[0] = (attribute >> 8) & 0xff;
1195                 ptr[1] = attribute & 0xff;
1196                 break;
1197
1198         case 1:
1199                 ptr[0] = attribute & 0xff;
1200                 break;
1201         }
1202
1203         switch (dv->length) {
1204         default:
1205                 fr_strerror_printf("vp2attr_vsa: Internal sanity check failed,"
1206                                    " length %u", (unsigned) dv->length);
1207                 return -1;
1208
1209         case 0:
1210                 break;
1211
1212         case 2:
1213                 ptr[dv->type] = 0;
1214                 /* FALL-THROUGH */
1215
1216         case 1:
1217                 ptr[dv->type + dv->length - 1] = dv->type + dv->length;
1218                 break;
1219
1220         }
1221
1222         if (room > ((unsigned) 255 - (dv->type + dv->length))) {
1223                 room = 255 - (dv->type + dv->length);
1224         }
1225
1226         len = vp2data_any(packet, original, secret, 0, vp,
1227                           ptr + dv->type + dv->length, room);
1228         if (len < 0) return len;
1229
1230         if (dv->length) ptr[dv->type + dv->length - 1] += len;
1231
1232         return dv->type + dv->length + len;
1233 }
1234
1235
1236 /*
1237  *      Encode a Vendor-Specific attribute.
1238  */
1239 int rad_vp2vsa(const RADIUS_PACKET *packet, const RADIUS_PACKET *original,
1240                 const char *secret, VALUE_PAIR *vp, uint8_t *ptr,
1241                 size_t room)
1242 {
1243         ssize_t len;
1244         uint32_t lvalue;
1245
1246         /*
1247          *      Double-check for WiMAX
1248          */
1249         if (vp->vendor == VENDORPEC_WIMAX) {
1250                 return rad_vp2wimax(packet, original, secret, vp,
1251                                     ptr, room);
1252         }
1253
1254         if (vp->vendor > FR_MAX_VENDOR) {
1255                 fr_strerror_printf("rad_vp2vsa: Invalid arguments");
1256                 return -1;
1257         }
1258
1259         /*
1260          *      Not enough room for:
1261          *              attr, len, vendor-id
1262          */
1263         if (room < 6) return 0;
1264
1265         /*
1266          *      Build the Vendor-Specific header
1267          */
1268         ptr[0] = PW_VENDOR_SPECIFIC;
1269         ptr[1] = 6;
1270         lvalue = htonl(vp->vendor);
1271         memcpy(ptr + 2, &lvalue, 4);
1272
1273         if (room > ((unsigned) 255 - ptr[1])) room = 255 - ptr[1];
1274
1275         len = vp2attr_vsa(packet, original, secret, vp,
1276                           vp->attribute, vp->vendor,
1277                           ptr + ptr[1], room);
1278         if (len < 0) return len;
1279
1280         ptr[1] += len;
1281
1282         return ptr[1];
1283 }
1284
1285
1286 /*
1287  *      Encode an RFC standard attribute 1..255
1288  */
1289 int rad_vp2rfc(const RADIUS_PACKET *packet,
1290                const RADIUS_PACKET *original,
1291                const char *secret, VALUE_PAIR *vp,
1292                uint8_t *ptr, size_t room)
1293 {
1294         if (vp->vendor != 0) {
1295                 fr_strerror_printf("rad_vp2rfc called with VSA");
1296                 return -1;
1297         }
1298
1299         if ((vp->attribute == 0) || (vp->attribute > 255)) {
1300                 fr_strerror_printf("rad_vp2rfc called with non-standard attribute %u", vp->attribute);
1301                 return -1;
1302         }
1303
1304         return vp2attr_rfc(packet, original, secret, vp, vp->attribute,
1305                            ptr, room);
1306 }
1307
1308
1309 /*
1310  *      Parse a data structure into a RADIUS attribute.
1311  */
1312 int rad_vp2attr(const RADIUS_PACKET *packet, const RADIUS_PACKET *original,
1313                 const char *secret, VALUE_PAIR *vp, uint8_t *start,
1314                 size_t room)
1315 {
1316         /*
1317          *      RFC format attributes take the fast path.
1318          */
1319         if (vp->vendor == 0) {
1320                 return rad_vp2rfc(packet, original, secret, vp,
1321                                   start, room);
1322         }
1323
1324         if (vp->vendor > FR_MAX_VENDOR) {
1325                 return rad_vp2extended(packet, original, secret, vp,
1326                                        start, room);
1327         }
1328
1329         if (vp->vendor == VENDORPEC_WIMAX) {
1330                 return rad_vp2wimax(packet, original, secret, vp,
1331                                     start, room);
1332         }
1333
1334         return rad_vp2vsa(packet, original, secret, vp,
1335                           start, room);
1336 }
1337
1338
1339 /*
1340  *      Encode a packet.
1341  */
1342 int rad_encode(RADIUS_PACKET *packet, const RADIUS_PACKET *original,
1343                const char *secret)
1344 {
1345         radius_packet_t *hdr;
1346         uint8_t         *ptr;
1347         uint16_t        total_length;
1348         int             len;
1349         VALUE_PAIR      *reply;
1350         const char      *what;
1351         char            ip_buffer[128];
1352
1353         /*
1354          *      A 4K packet, aligned on 64-bits.
1355          */
1356         uint64_t        data[MAX_PACKET_LEN / sizeof(uint64_t)];
1357
1358         if ((packet->code > 0) && (packet->code < FR_MAX_PACKET_CODE)) {
1359                 what = fr_packet_codes[packet->code];
1360         } else {
1361                 what = "Reply";
1362         }
1363
1364         DEBUG("Sending %s of id %d to %s port %d\n",
1365               what, packet->id,
1366               inet_ntop(packet->dst_ipaddr.af,
1367                         &packet->dst_ipaddr.ipaddr,
1368                         ip_buffer, sizeof(ip_buffer)),
1369               packet->dst_port);
1370
1371         /*
1372          *      Double-check some things based on packet code.
1373          */
1374         switch (packet->code) {
1375         case PW_AUTHENTICATION_ACK:
1376         case PW_AUTHENTICATION_REJECT:
1377         case PW_ACCESS_CHALLENGE:
1378                 if (!original) {
1379                         fr_strerror_printf("ERROR: Cannot sign response packet without a request packet.");
1380                         return -1;
1381                 }
1382                 break;
1383
1384                 /*
1385                  *      These packet vectors start off as all zero.
1386                  */
1387         case PW_ACCOUNTING_REQUEST:
1388         case PW_DISCONNECT_REQUEST:
1389         case PW_COA_REQUEST:
1390                 memset(packet->vector, 0, sizeof(packet->vector));
1391                 break;
1392
1393         default:
1394                 break;
1395         }
1396
1397         /*
1398          *      Use memory on the stack, until we know how
1399          *      large the packet will be.
1400          */
1401         hdr = (radius_packet_t *) data;
1402
1403         /*
1404          *      Build standard header
1405          */
1406         hdr->code = packet->code;
1407         hdr->id = packet->id;
1408
1409         memcpy(hdr->vector, packet->vector, sizeof(hdr->vector));
1410
1411         total_length = AUTH_HDR_LEN;
1412
1413         /*
1414          *      Load up the configuration values for the user
1415          */
1416         ptr = hdr->data;
1417         packet->offset = 0;
1418
1419         /*
1420          *      FIXME: Loop twice over the reply list.  The first time,
1421          *      calculate the total length of data.  The second time,
1422          *      allocate the memory, and fill in the VP's.
1423          *
1424          *      Hmm... this may be slower than just doing a small
1425          *      memcpy.
1426          */
1427
1428         /*
1429          *      Loop over the reply attributes for the packet.
1430          */
1431         for (reply = packet->vps; reply; reply = reply->next) {
1432                 /*
1433                  *      Ignore non-wire attributes, but allow extended
1434                  *      attributes.
1435                  */
1436                 if ((reply->vendor == 0) &&
1437                     ((reply->attribute & 0xFFFF) >= 256) &&
1438                     !reply->flags.extended && !reply->flags.extended_flags) {
1439 #ifndef NDEBUG
1440                         /*
1441                          *      Permit the admin to send BADLY formatted
1442                          *      attributes with a debug build.
1443                          */
1444                         if (reply->attribute == PW_RAW_ATTRIBUTE) {
1445                                 memcpy(ptr, reply->vp_octets, reply->length);
1446                                 len = reply->length;
1447                                 goto next;
1448                         }
1449 #endif
1450                         continue;
1451                 }
1452
1453                 /*
1454                  *      Set the Message-Authenticator to the correct
1455                  *      length and initial value.
1456                  */
1457                 if (reply->attribute == PW_MESSAGE_AUTHENTICATOR) {
1458                         reply->length = AUTH_VECTOR_LEN;
1459                         memset(reply->vp_strvalue, 0, AUTH_VECTOR_LEN);
1460
1461                         /*
1462                          *      Cache the offset to the
1463                          *      Message-Authenticator
1464                          */
1465                         packet->offset = total_length;
1466                 }
1467
1468                 /*
1469                  *      Print out ONLY the attributes which
1470                  *      we're sending over the wire, and print
1471                  *      them out BEFORE they're encrypted.
1472                  */
1473                 debug_pair(reply);
1474
1475                 /*
1476                  *      Skip attributes that have already been
1477                  *      encoded.  This can be done when the "vp2attr"
1478                  *      function sees multiple contiguous TLVs.
1479                  */
1480                 if (reply->flags.encoded) continue;
1481
1482                 len = rad_vp2attr(packet, original, secret, reply, ptr,
1483                                   ((uint8_t *) data) + sizeof(data) - ptr);
1484                 if (len < 0) return -1;
1485
1486                 /*
1487                  *      Failed to encode the attribute, likely because
1488                  *      the packet is full.
1489                  */
1490                 if ((len == 0) &&
1491                     (total_length > (sizeof(data) - 2 - reply->length))) {
1492                         DEBUG("WARNING: Attributes are too long for packet.  Discarding data past %d bytes", total_length);
1493                         break;
1494                 }
1495
1496         next:
1497                 ptr += len;
1498                 total_length += len;
1499         } /* done looping over all attributes */
1500
1501         /*
1502          *      Fill in the rest of the fields, and copy the data over
1503          *      from the local stack to the newly allocated memory.
1504          *
1505          *      Yes, all this 'memcpy' is slow, but it means
1506          *      that we only allocate the minimum amount of
1507          *      memory for a request.
1508          */
1509         packet->data_len = total_length;
1510         packet->data = (uint8_t *) malloc(packet->data_len);
1511         if (!packet->data) {
1512                 fr_strerror_printf("Out of memory");
1513                 return -1;
1514         }
1515
1516         memcpy(packet->data, hdr, packet->data_len);
1517         hdr = (radius_packet_t *) packet->data;
1518
1519         total_length = htons(total_length);
1520         memcpy(hdr->length, &total_length, sizeof(total_length));
1521
1522         return 0;
1523 }
1524
1525
1526 /*
1527  *      Sign a previously encoded packet.
1528  */
1529 int rad_sign(RADIUS_PACKET *packet, const RADIUS_PACKET *original,
1530              const char *secret)
1531 {
1532         radius_packet_t *hdr = (radius_packet_t *)packet->data;
1533
1534         /*
1535          *      It wasn't assigned an Id, this is bad!
1536          */
1537         if (packet->id < 0) {
1538                 fr_strerror_printf("ERROR: RADIUS packets must be assigned an Id.");
1539                 return -1;
1540         }
1541
1542         if (!packet->data || (packet->data_len < AUTH_HDR_LEN) ||
1543             (packet->offset < 0)) {
1544                 fr_strerror_printf("ERROR: You must call rad_encode() before rad_sign()");
1545                 return -1;
1546         }
1547
1548         /*
1549          *      If there's a Message-Authenticator, update it
1550          *      now, BEFORE updating the authentication vector.
1551          */
1552         if (packet->offset > 0) {
1553                 uint8_t calc_auth_vector[AUTH_VECTOR_LEN];
1554
1555                 switch (packet->code) {
1556                 case PW_ACCOUNTING_REQUEST:
1557                 case PW_ACCOUNTING_RESPONSE:
1558                 case PW_DISCONNECT_REQUEST:
1559                 case PW_DISCONNECT_ACK:
1560                 case PW_DISCONNECT_NAK:
1561                 case PW_COA_REQUEST:
1562                 case PW_COA_ACK:
1563                 case PW_COA_NAK:
1564                         memset(hdr->vector, 0, AUTH_VECTOR_LEN);
1565                         break;
1566
1567                 case PW_AUTHENTICATION_ACK:
1568                 case PW_AUTHENTICATION_REJECT:
1569                 case PW_ACCESS_CHALLENGE:
1570                         if (!original) {
1571                                 fr_strerror_printf("ERROR: Cannot sign response packet without a request packet.");
1572                                 return -1;
1573                         }
1574                         memcpy(hdr->vector, original->vector,
1575                                AUTH_VECTOR_LEN);
1576                         break;
1577
1578                 default:        /* others have vector already set to zero */
1579                         break;
1580
1581                 }
1582
1583                 /*
1584                  *      Set the authentication vector to zero,
1585                  *      calculate the signature, and put it
1586                  *      into the Message-Authenticator
1587                  *      attribute.
1588                  */
1589                 fr_hmac_md5(packet->data, packet->data_len,
1590                             (const uint8_t *) secret, strlen(secret),
1591                             calc_auth_vector);
1592                 memcpy(packet->data + packet->offset + 2,
1593                        calc_auth_vector, AUTH_VECTOR_LEN);
1594
1595                 /*
1596                  *      Copy the original request vector back
1597                  *      to the raw packet.
1598                  */
1599                 memcpy(hdr->vector, packet->vector, AUTH_VECTOR_LEN);
1600         }
1601
1602         /*
1603          *      Switch over the packet code, deciding how to
1604          *      sign the packet.
1605          */
1606         switch (packet->code) {
1607                 /*
1608                  *      Request packets are not signed, bur
1609                  *      have a random authentication vector.
1610                  */
1611         case PW_AUTHENTICATION_REQUEST:
1612         case PW_STATUS_SERVER:
1613                 break;
1614
1615                 /*
1616                  *      Reply packets are signed with the
1617                  *      authentication vector of the request.
1618                  */
1619         default:
1620                 {
1621                         uint8_t digest[16];
1622
1623                         FR_MD5_CTX      context;
1624                         fr_MD5Init(&context);
1625                         fr_MD5Update(&context, packet->data, packet->data_len);
1626                         fr_MD5Update(&context, (const uint8_t *) secret,
1627                                      strlen(secret));
1628                         fr_MD5Final(digest, &context);
1629
1630                         memcpy(hdr->vector, digest, AUTH_VECTOR_LEN);
1631                         memcpy(packet->vector, digest, AUTH_VECTOR_LEN);
1632                         break;
1633                 }
1634         }/* switch over packet codes */
1635
1636         return 0;
1637 }
1638
1639 /*
1640  *      Reply to the request.  Also attach
1641  *      reply attribute value pairs and any user message provided.
1642  */
1643 int rad_send(RADIUS_PACKET *packet, const RADIUS_PACKET *original,
1644              const char *secret)
1645 {
1646         VALUE_PAIR              *reply;
1647         const char              *what;
1648         char                    ip_buffer[128];
1649
1650         /*
1651          *      Maybe it's a fake packet.  Don't send it.
1652          */
1653         if (!packet || (packet->sockfd < 0)) {
1654                 return 0;
1655         }
1656
1657         if ((packet->code > 0) && (packet->code < FR_MAX_PACKET_CODE)) {
1658                 what = fr_packet_codes[packet->code];
1659         } else {
1660                 what = "Reply";
1661         }
1662
1663         /*
1664          *  First time through, allocate room for the packet
1665          */
1666         if (!packet->data) {
1667                 /*
1668                  *      Encode the packet.
1669                  */
1670                 if (rad_encode(packet, original, secret) < 0) {
1671                         return -1;
1672                 }
1673
1674                 /*
1675                  *      Re-sign it, including updating the
1676                  *      Message-Authenticator.
1677                  */
1678                 if (rad_sign(packet, original, secret) < 0) {
1679                         return -1;
1680                 }
1681
1682                 /*
1683                  *      If packet->data points to data, then we print out
1684                  *      the VP list again only for debugging.
1685                  */
1686         } else if (fr_debug_flag) {
1687                 DEBUG("Sending %s of id %d to %s port %d\n", what, packet->id,
1688                       inet_ntop(packet->dst_ipaddr.af,
1689                                 &packet->dst_ipaddr.ipaddr,
1690                                 ip_buffer, sizeof(ip_buffer)),
1691                       packet->dst_port);
1692
1693                 for (reply = packet->vps; reply; reply = reply->next) {
1694                         if ((reply->vendor == 0) &&
1695                             ((reply->attribute & 0xFFFF) > 0xff)) continue;
1696                         debug_pair(reply);
1697                 }
1698         }
1699
1700         /*
1701          *      And send it on it's way.
1702          */
1703         return rad_sendto(packet->sockfd, packet->data, packet->data_len, 0,
1704                           &packet->src_ipaddr, packet->src_port,
1705                           &packet->dst_ipaddr, packet->dst_port);
1706 }
1707
1708 /*
1709  *      Do a comparison of two authentication digests by comparing
1710  *      the FULL digest.  Otehrwise, the server can be subject to
1711  *      timing attacks that allow attackers find a valid message
1712  *      authenticator.
1713  *
1714  *      http://www.cs.rice.edu/~dwallach/pub/crosby-timing2009.pdf
1715  */
1716 static int digest_cmp(const uint8_t *a, const uint8_t *b, size_t length)
1717 {
1718         int result = 0;
1719         size_t i;
1720
1721         for (i = 0; i < length; i++) {
1722                 result |= a[i] ^ b[i];
1723         }
1724
1725         return result;          /* 0 is OK, !0 is !OK, just like memcmp */
1726 }
1727
1728
1729 /*
1730  *      Validates the requesting client NAS.  Calculates the
1731  *      signature based on the clients private key.
1732  */
1733 static int calc_acctdigest(RADIUS_PACKET *packet, const char *secret)
1734 {
1735         uint8_t         digest[AUTH_VECTOR_LEN];
1736         FR_MD5_CTX              context;
1737
1738         /*
1739          *      Zero out the auth_vector in the received packet.
1740          *      Then append the shared secret to the received packet,
1741          *      and calculate the MD5 sum. This must be the same
1742          *      as the original MD5 sum (packet->vector).
1743          */
1744         memset(packet->data + 4, 0, AUTH_VECTOR_LEN);
1745
1746         /*
1747          *  MD5(packet + secret);
1748          */
1749         fr_MD5Init(&context);
1750         fr_MD5Update(&context, packet->data, packet->data_len);
1751         fr_MD5Update(&context, (const uint8_t *) secret, strlen(secret));
1752         fr_MD5Final(digest, &context);
1753
1754         /*
1755          *      Return 0 if OK, 2 if not OK.
1756          */
1757         if (digest_cmp(digest, packet->vector, AUTH_VECTOR_LEN) != 0) return 2;
1758         return 0;
1759 }
1760
1761
1762 /*
1763  *      Validates the requesting client NAS.  Calculates the
1764  *      signature based on the clients private key.
1765  */
1766 static int calc_replydigest(RADIUS_PACKET *packet, RADIUS_PACKET *original,
1767                             const char *secret)
1768 {
1769         uint8_t         calc_digest[AUTH_VECTOR_LEN];
1770         FR_MD5_CTX              context;
1771
1772         /*
1773          *      Very bad!
1774          */
1775         if (original == NULL) {
1776                 return 3;
1777         }
1778
1779         /*
1780          *  Copy the original vector in place.
1781          */
1782         memcpy(packet->data + 4, original->vector, AUTH_VECTOR_LEN);
1783
1784         /*
1785          *  MD5(packet + secret);
1786          */
1787         fr_MD5Init(&context);
1788         fr_MD5Update(&context, packet->data, packet->data_len);
1789         fr_MD5Update(&context, (const uint8_t *) secret, strlen(secret));
1790         fr_MD5Final(calc_digest, &context);
1791
1792         /*
1793          *  Copy the packet's vector back to the packet.
1794          */
1795         memcpy(packet->data + 4, packet->vector, AUTH_VECTOR_LEN);
1796
1797         /*
1798          *      Return 0 if OK, 2 if not OK.
1799          */
1800         if (digest_cmp(packet->vector, calc_digest, AUTH_VECTOR_LEN) != 0) return 2;
1801         return 0;
1802 }
1803
1804
1805 /*
1806  *      Check if a set of RADIUS formatted TLVs are OK.
1807  */
1808 int rad_tlv_ok(const uint8_t *data, size_t length,
1809                size_t dv_type, size_t dv_length)
1810 {
1811         const uint8_t *end = data + length;
1812
1813         if ((dv_length > 2) || (dv_type == 0) || (dv_type > 4)) {
1814                 fr_strerror_printf("rad_tlv_ok: Invalid arguments");
1815                 return -1;
1816         }
1817
1818         while (data < end) {
1819                 size_t attrlen;
1820
1821                 if ((data + dv_type + dv_length) > end) {
1822                         fr_strerror_printf("Attribute header overflow");
1823                         return -1;
1824                 }
1825
1826                 switch (dv_type) {
1827                 case 4:
1828                         if ((data[0] == 0) && (data[1] == 0) &&
1829                             (data[2] == 0) && (data[3] == 0)) {
1830                         zero:
1831                                 fr_strerror_printf("Invalid attribute 0");
1832                                 return -1;
1833                         }
1834
1835                         if (data[0] != 0) {
1836                                 fr_strerror_printf("Invalid attribute > 2^24");
1837                                 return -1;
1838                         }
1839                         break;
1840
1841                 case 2:
1842                         if ((data[1] == 0) && (data[1] == 0)) goto zero;
1843                         break;
1844
1845                 case 1:
1846                         if (data[0] == 0) goto zero;
1847                         break;
1848
1849                 default:
1850                         fr_strerror_printf("Internal sanity check failed");
1851                         return -1;
1852                 }
1853
1854                 switch (dv_length) {
1855                 case 0:
1856                         return 0;
1857
1858                 case 2:
1859                         if (data[dv_type + 1] != 0) {
1860                                 fr_strerror_printf("Attribute is longer than 256 octets");
1861                                 return -1;
1862                         }
1863                         /* FALL-THROUGH */
1864                 case 1:
1865                         attrlen = data[dv_type + dv_length - 1];
1866                         break;
1867
1868
1869                 default:
1870                         fr_strerror_printf("Internal sanity check failed");
1871                         return -1;
1872                 }
1873
1874                 if (attrlen < (dv_type + dv_length)) {
1875                         fr_strerror_printf("Attribute header has invalid length");
1876                         return -1;
1877                 }
1878
1879                 if (attrlen > length) {
1880                         fr_strerror_printf("Attribute overflows container");
1881                         return -1;
1882                 }
1883
1884                 data += attrlen;
1885                 length -= attrlen;
1886         }
1887
1888         return 0;
1889 }
1890
1891
1892 /*
1893  *      See if the data pointed to by PTR is a valid RADIUS packet.
1894  *
1895  *      packet is not 'const * const' because we may update data_len,
1896  *      if there's more data in the UDP packet than in the RADIUS packet.
1897  */
1898 int rad_packet_ok(RADIUS_PACKET *packet, int flags)
1899 {
1900         uint8_t                 *attr;
1901         int                     totallen;
1902         int                     count;
1903         radius_packet_t         *hdr;
1904         char                    host_ipaddr[128];
1905         int                     require_ma = 0;
1906         int                     seen_ma = 0;
1907         int                     num_attributes;
1908
1909         /*
1910          *      Check for packets smaller than the packet header.
1911          *
1912          *      RFC 2865, Section 3., subsection 'length' says:
1913          *
1914          *      "The minimum length is 20 ..."
1915          */
1916         if (packet->data_len < AUTH_HDR_LEN) {
1917                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: too short (received %d < minimum %d)",
1918                            inet_ntop(packet->src_ipaddr.af,
1919                                      &packet->src_ipaddr.ipaddr,
1920                                      host_ipaddr, sizeof(host_ipaddr)),
1921                                    (int) packet->data_len, AUTH_HDR_LEN);
1922                 return 0;
1923         }
1924
1925         /*
1926          *      RFC 2865, Section 3., subsection 'length' says:
1927          *
1928          *      " ... and maximum length is 4096."
1929          */
1930         if (packet->data_len > MAX_PACKET_LEN) {
1931                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: too long (received %d > maximum %d)",
1932                            inet_ntop(packet->src_ipaddr.af,
1933                                      &packet->src_ipaddr.ipaddr,
1934                                      host_ipaddr, sizeof(host_ipaddr)),
1935                                    (int) packet->data_len, MAX_PACKET_LEN);
1936                 return 0;
1937         }
1938
1939         /*
1940          *      Check for packets with mismatched size.
1941          *      i.e. We've received 128 bytes, and the packet header
1942          *      says it's 256 bytes long.
1943          */
1944         totallen = (packet->data[2] << 8) | packet->data[3];
1945         hdr = (radius_packet_t *)packet->data;
1946
1947         /*
1948          *      Code of 0 is not understood.
1949          *      Code of 16 or greate is not understood.
1950          */
1951         if ((hdr->code == 0) ||
1952             (hdr->code >= FR_MAX_PACKET_CODE)) {
1953                 fr_strerror_printf("WARNING: Bad RADIUS packet from host %s: unknown packet code%d ",
1954                            inet_ntop(packet->src_ipaddr.af,
1955                                      &packet->src_ipaddr.ipaddr,
1956                                      host_ipaddr, sizeof(host_ipaddr)),
1957                            hdr->code);
1958                 return 0;
1959         }
1960
1961         /*
1962          *      Message-Authenticator is required in Status-Server
1963          *      packets, otherwise they can be trivially forged.
1964          */
1965         if (hdr->code == PW_STATUS_SERVER) require_ma = 1;
1966
1967         /*
1968          *      It's also required if the caller asks for it.
1969          */
1970         if (flags) require_ma = 1;
1971
1972         /*
1973          *      Repeat the length checks.  This time, instead of
1974          *      looking at the data we received, look at the value
1975          *      of the 'length' field inside of the packet.
1976          *
1977          *      Check for packets smaller than the packet header.
1978          *
1979          *      RFC 2865, Section 3., subsection 'length' says:
1980          *
1981          *      "The minimum length is 20 ..."
1982          */
1983         if (totallen < AUTH_HDR_LEN) {
1984                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: too short (length %d < minimum %d)",
1985                            inet_ntop(packet->src_ipaddr.af,
1986                                      &packet->src_ipaddr.ipaddr,
1987                                      host_ipaddr, sizeof(host_ipaddr)),
1988                            totallen, AUTH_HDR_LEN);
1989                 return 0;
1990         }
1991
1992         /*
1993          *      And again, for the value of the 'length' field.
1994          *
1995          *      RFC 2865, Section 3., subsection 'length' says:
1996          *
1997          *      " ... and maximum length is 4096."
1998          */
1999         if (totallen > MAX_PACKET_LEN) {
2000                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: too long (length %d > maximum %d)",
2001                            inet_ntop(packet->src_ipaddr.af,
2002                                      &packet->src_ipaddr.ipaddr,
2003                                      host_ipaddr, sizeof(host_ipaddr)),
2004                            totallen, MAX_PACKET_LEN);
2005                 return 0;
2006         }
2007
2008         /*
2009          *      RFC 2865, Section 3., subsection 'length' says:
2010          *
2011          *      "If the packet is shorter than the Length field
2012          *      indicates, it MUST be silently discarded."
2013          *
2014          *      i.e. No response to the NAS.
2015          */
2016         if (packet->data_len < totallen) {
2017                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: received %d octets, packet length says %d",
2018                            inet_ntop(packet->src_ipaddr.af,
2019                                      &packet->src_ipaddr.ipaddr,
2020                                      host_ipaddr, sizeof(host_ipaddr)),
2021                                    (int) packet->data_len, totallen);
2022                 return 0;
2023         }
2024
2025         /*
2026          *      RFC 2865, Section 3., subsection 'length' says:
2027          *
2028          *      "Octets outside the range of the Length field MUST be
2029          *      treated as padding and ignored on reception."
2030          */
2031         if (packet->data_len > totallen) {
2032                 /*
2033                  *      We're shortening the packet below, but just
2034                  *      to be paranoid, zero out the extra data.
2035                  */
2036                 memset(packet->data + totallen, 0, packet->data_len - totallen);
2037                 packet->data_len = totallen;
2038         }
2039
2040         /*
2041          *      Walk through the packet's attributes, ensuring that
2042          *      they add up EXACTLY to the size of the packet.
2043          *
2044          *      If they don't, then the attributes either under-fill
2045          *      or over-fill the packet.  Any parsing of the packet
2046          *      is impossible, and will result in unknown side effects.
2047          *
2048          *      This would ONLY happen with buggy RADIUS implementations,
2049          *      or with an intentional attack.  Either way, we do NOT want
2050          *      to be vulnerable to this problem.
2051          */
2052         attr = hdr->data;
2053         count = totallen - AUTH_HDR_LEN;
2054         num_attributes = 0;
2055
2056         while (count > 0) {
2057                 /*
2058                  *      We need at least 2 bytes to check the
2059                  *      attribute header.
2060                  */
2061                 if (count < 2) {
2062                         fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: attribute header overflows the packet",
2063                                    inet_ntop(packet->src_ipaddr.af,
2064                                              &packet->src_ipaddr.ipaddr,
2065                                              host_ipaddr, sizeof(host_ipaddr)));
2066                         return 0;
2067                 }
2068
2069                 /*
2070                  *      Attribute number zero is NOT defined.
2071                  */
2072                 if (attr[0] == 0) {
2073                         fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: Invalid attribute 0",
2074                                    inet_ntop(packet->src_ipaddr.af,
2075                                              &packet->src_ipaddr.ipaddr,
2076                                              host_ipaddr, sizeof(host_ipaddr)));
2077                         return 0;
2078                 }
2079
2080                 /*
2081                  *      Attributes are at LEAST as long as the ID & length
2082                  *      fields.  Anything shorter is an invalid attribute.
2083                  */
2084                 if (attr[1] < 2) {
2085                         fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: attribute %u too short",
2086                                    inet_ntop(packet->src_ipaddr.af,
2087                                              &packet->src_ipaddr.ipaddr,
2088                                              host_ipaddr, sizeof(host_ipaddr)),
2089                                    attr[0]);
2090                         return 0;
2091                 }
2092
2093                 /*
2094                  *      If there are fewer bytes in the packet than in the
2095                  *      attribute, it's a bad packet.
2096                  */
2097                 if (count < attr[1]) {
2098                         fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: attribute %u data overflows the packet",
2099                                    inet_ntop(packet->src_ipaddr.af,
2100                                              &packet->src_ipaddr.ipaddr,
2101                                              host_ipaddr, sizeof(host_ipaddr)),
2102                                            attr[0]);
2103                         return 0;
2104                 }
2105
2106                 /*
2107                  *      Sanity check the attributes for length.
2108                  */
2109                 switch (attr[0]) {
2110                 default:        /* don't do anything by default */
2111                         break;
2112
2113                         /*
2114                          *      If there's an EAP-Message, we require
2115                          *      a Message-Authenticator.
2116                          */
2117                 case PW_EAP_MESSAGE:
2118                         require_ma = 1;
2119                         break;
2120
2121                 case PW_MESSAGE_AUTHENTICATOR:
2122                         if (attr[1] != 2 + AUTH_VECTOR_LEN) {
2123                                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: Message-Authenticator has invalid length %d",
2124                                            inet_ntop(packet->src_ipaddr.af,
2125                                                      &packet->src_ipaddr.ipaddr,
2126                                                      host_ipaddr, sizeof(host_ipaddr)),
2127                                            attr[1] - 2);
2128                                 return 0;
2129                         }
2130                         seen_ma = 1;
2131                         break;
2132                 }
2133
2134                 /*
2135                  *      FIXME: Look up the base 255 attributes in the
2136                  *      dictionary, and switch over their type.  For
2137                  *      integer/date/ip, the attribute length SHOULD
2138                  *      be 6.
2139                  */
2140                 count -= attr[1];       /* grab the attribute length */
2141                 attr += attr[1];
2142                 num_attributes++;       /* seen one more attribute */
2143         }
2144
2145         /*
2146          *      If the attributes add up to a packet, it's allowed.
2147          *
2148          *      If not, we complain, and throw the packet away.
2149          */
2150         if (count != 0) {
2151                 fr_strerror_printf("WARNING: Malformed RADIUS packet from host %s: packet attributes do NOT exactly fill the packet",
2152                            inet_ntop(packet->src_ipaddr.af,
2153                                      &packet->src_ipaddr.ipaddr,
2154                                      host_ipaddr, sizeof(host_ipaddr)));
2155                 return 0;
2156         }
2157
2158         /*
2159          *      If we're configured to look for a maximum number of
2160          *      attributes, and we've seen more than that maximum,
2161          *      then throw the packet away, as a possible DoS.
2162          */
2163         if ((fr_max_attributes > 0) &&
2164             (num_attributes > fr_max_attributes)) {
2165                 fr_strerror_printf("WARNING: Possible DoS attack from host %s: Too many attributes in request (received %d, max %d are allowed).",
2166                            inet_ntop(packet->src_ipaddr.af,
2167                                      &packet->src_ipaddr.ipaddr,
2168                                      host_ipaddr, sizeof(host_ipaddr)),
2169                            num_attributes, fr_max_attributes);
2170                 return 0;
2171         }
2172
2173         /*
2174          *      http://www.freeradius.org/rfc/rfc2869.html#EAP-Message
2175          *
2176          *      A packet with an EAP-Message attribute MUST also have
2177          *      a Message-Authenticator attribute.
2178          *
2179          *      A Message-Authenticator all by itself is OK, though.
2180          *
2181          *      Similarly, Status-Server packets MUST contain
2182          *      Message-Authenticator attributes.
2183          */
2184         if (require_ma && ! seen_ma) {
2185                 fr_strerror_printf("WARNING: Insecure packet from host %s:  Packet does not contain required Message-Authenticator attribute",
2186                            inet_ntop(packet->src_ipaddr.af,
2187                                      &packet->src_ipaddr.ipaddr,
2188                                      host_ipaddr, sizeof(host_ipaddr)));
2189                 return 0;
2190         }
2191
2192         /*
2193          *      Fill RADIUS header fields
2194          */
2195         packet->code = hdr->code;
2196         packet->id = hdr->id;
2197         memcpy(packet->vector, hdr->vector, AUTH_VECTOR_LEN);
2198
2199         return 1;
2200 }
2201
2202
2203 /*
2204  *      Receive UDP client requests, and fill in
2205  *      the basics of a RADIUS_PACKET structure.
2206  */
2207 RADIUS_PACKET *rad_recv(int fd, int flags)
2208 {
2209         int sock_flags = 0;
2210         RADIUS_PACKET           *packet;
2211
2212         /*
2213          *      Allocate the new request data structure
2214          */
2215         if ((packet = malloc(sizeof(*packet))) == NULL) {
2216                 fr_strerror_printf("out of memory");
2217                 return NULL;
2218         }
2219         memset(packet, 0, sizeof(*packet));
2220
2221         if (flags & 0x02) {
2222                 sock_flags = MSG_PEEK;
2223                 flags &= ~0x02;
2224         }
2225
2226         packet->data_len = rad_recvfrom(fd, &packet->data, sock_flags,
2227                                         &packet->src_ipaddr, &packet->src_port,
2228                                         &packet->dst_ipaddr, &packet->dst_port);
2229
2230         /*
2231          *      Check for socket errors.
2232          */
2233         if (packet->data_len < 0) {
2234                 fr_strerror_printf("Error receiving packet: %s", strerror(errno));
2235                 /* packet->data is NULL */
2236                 free(packet);
2237                 return NULL;
2238         }
2239
2240         /*
2241          *      If the packet is too big, then rad_recvfrom did NOT
2242          *      allocate memory.  Instead, it just discarded the
2243          *      packet.
2244          */
2245         if (packet->data_len > MAX_PACKET_LEN) {
2246                 fr_strerror_printf("Discarding packet: Larger than RFC limitation of 4096 bytes.");
2247                 /* packet->data is NULL */
2248                 free(packet);
2249                 return NULL;
2250         }
2251
2252         /*
2253          *      Read no data.  Continue.
2254          *      This check is AFTER the MAX_PACKET_LEN check above, because
2255          *      if the packet is larger than MAX_PACKET_LEN, we also have
2256          *      packet->data == NULL
2257          */
2258         if ((packet->data_len == 0) || !packet->data) {
2259                 fr_strerror_printf("Empty packet: Socket is not ready.");
2260                 free(packet);
2261                 return NULL;
2262         }
2263
2264         /*
2265          *      See if it's a well-formed RADIUS packet.
2266          */
2267         if (!rad_packet_ok(packet, flags)) {
2268                 rad_free(&packet);
2269                 return NULL;
2270         }
2271
2272         /*
2273          *      Remember which socket we read the packet from.
2274          */
2275         packet->sockfd = fd;
2276
2277         /*
2278          *      FIXME: Do even more filtering by only permitting
2279          *      certain IP's.  The problem is that we don't know
2280          *      how to do this properly for all possible clients...
2281          */
2282
2283         /*
2284          *      Explicitely set the VP list to empty.
2285          */
2286         packet->vps = NULL;
2287
2288         if (fr_debug_flag) {
2289                 char host_ipaddr[128];
2290
2291                 if ((packet->code > 0) && (packet->code < FR_MAX_PACKET_CODE)) {
2292                         DEBUG("rad_recv: %s packet from host %s port %d",
2293                               fr_packet_codes[packet->code],
2294                               inet_ntop(packet->src_ipaddr.af,
2295                                         &packet->src_ipaddr.ipaddr,
2296                                         host_ipaddr, sizeof(host_ipaddr)),
2297                               packet->src_port);
2298                 } else {
2299                         DEBUG("rad_recv: Packet from host %s port %d code=%d",
2300                               inet_ntop(packet->src_ipaddr.af,
2301                                         &packet->src_ipaddr.ipaddr,
2302                                         host_ipaddr, sizeof(host_ipaddr)),
2303                               packet->src_port,
2304                               packet->code);
2305                 }
2306                 DEBUG(", id=%d, length=%d\n",
2307                       packet->id, (int) packet->data_len);
2308         }
2309
2310         return packet;
2311 }
2312
2313
2314 /*
2315  *      Verify the signature of a packet.
2316  */
2317 int rad_verify(RADIUS_PACKET *packet, RADIUS_PACKET *original,
2318                const char *secret)
2319 {
2320         uint8_t                 *ptr;
2321         int                     length;
2322         int                     attrlen;
2323
2324         if (!packet || !packet->data) return -1;
2325
2326         /*
2327          *      Before we allocate memory for the attributes, do more
2328          *      sanity checking.
2329          */
2330         ptr = packet->data + AUTH_HDR_LEN;
2331         length = packet->data_len - AUTH_HDR_LEN;
2332         while (length > 0) {
2333                 uint8_t msg_auth_vector[AUTH_VECTOR_LEN];
2334                 uint8_t calc_auth_vector[AUTH_VECTOR_LEN];
2335
2336                 attrlen = ptr[1];
2337
2338                 switch (ptr[0]) {
2339                 default:        /* don't do anything. */
2340                         break;
2341
2342                         /*
2343                          *      Note that more than one Message-Authenticator
2344                          *      attribute is invalid.
2345                          */
2346                 case PW_MESSAGE_AUTHENTICATOR:
2347                         memcpy(msg_auth_vector, &ptr[2], sizeof(msg_auth_vector));
2348                         memset(&ptr[2], 0, AUTH_VECTOR_LEN);
2349
2350                         switch (packet->code) {
2351                         default:
2352                                 break;
2353
2354                         case PW_ACCOUNTING_REQUEST:
2355                         case PW_ACCOUNTING_RESPONSE:
2356                         case PW_DISCONNECT_REQUEST:
2357                         case PW_DISCONNECT_ACK:
2358                         case PW_DISCONNECT_NAK:
2359                         case PW_COA_REQUEST:
2360                         case PW_COA_ACK:
2361                         case PW_COA_NAK:
2362                                 memset(packet->data + 4, 0, AUTH_VECTOR_LEN);
2363                                 break;
2364
2365                         case PW_AUTHENTICATION_ACK:
2366                         case PW_AUTHENTICATION_REJECT:
2367                         case PW_ACCESS_CHALLENGE:
2368                                 if (!original) {
2369                                         fr_strerror_printf("ERROR: Cannot validate Message-Authenticator in response packet without a request packet.");
2370                                         return -1;
2371                                 }
2372                                 memcpy(packet->data + 4, original->vector, AUTH_VECTOR_LEN);
2373                                 break;
2374                         }
2375
2376                         fr_hmac_md5(packet->data, packet->data_len,
2377                                     (const uint8_t *) secret, strlen(secret),
2378                                     calc_auth_vector);
2379                         if (digest_cmp(calc_auth_vector, msg_auth_vector,
2380                                    sizeof(calc_auth_vector)) != 0) {
2381                                 char buffer[32];
2382                                 fr_strerror_printf("Received packet from %s with invalid Message-Authenticator!  (Shared secret is incorrect.)",
2383                                            inet_ntop(packet->src_ipaddr.af,
2384                                                      &packet->src_ipaddr.ipaddr,
2385                                                      buffer, sizeof(buffer)));
2386                                 /* Silently drop packet, according to RFC 3579 */
2387                                 return -1;
2388                         } /* else the message authenticator was good */
2389
2390                         /*
2391                          *      Reinitialize Authenticators.
2392                          */
2393                         memcpy(&ptr[2], msg_auth_vector, AUTH_VECTOR_LEN);
2394                         memcpy(packet->data + 4, packet->vector, AUTH_VECTOR_LEN);
2395                         break;
2396                 } /* switch over the attributes */
2397
2398                 ptr += attrlen;
2399                 length -= attrlen;
2400         } /* loop over the packet, sanity checking the attributes */
2401
2402         /*
2403          *      It looks like a RADIUS packet, but we can't validate
2404          *      the signature.
2405          */
2406         if ((packet->code == 0) || (packet->code >= FR_MAX_PACKET_CODE)) {
2407                 char buffer[32];
2408                 fr_strerror_printf("Received Unknown packet code %d "
2409                            "from client %s port %d: Cannot validate signature.",
2410                            packet->code,
2411                            inet_ntop(packet->src_ipaddr.af,
2412                                      &packet->src_ipaddr.ipaddr,
2413                                      buffer, sizeof(buffer)),
2414                            packet->src_port);
2415                 return -1;
2416         }
2417
2418         /*
2419          *      Calculate and/or verify digest.
2420          */
2421         switch(packet->code) {
2422                 int rcode;
2423                 char buffer[32];
2424
2425                 case PW_AUTHENTICATION_REQUEST:
2426                 case PW_STATUS_SERVER:
2427                         /*
2428                          *      The authentication vector is random
2429                          *      nonsense, invented by the client.
2430                          */
2431                         break;
2432
2433                 case PW_COA_REQUEST:
2434                 case PW_DISCONNECT_REQUEST:
2435                 case PW_ACCOUNTING_REQUEST:
2436                         if (calc_acctdigest(packet, secret) > 1) {
2437                                 fr_strerror_printf("Received %s packet "
2438                                            "from client %s with invalid signature!  (Shared secret is incorrect.)",
2439                                            fr_packet_codes[packet->code],
2440                                            inet_ntop(packet->src_ipaddr.af,
2441                                                      &packet->src_ipaddr.ipaddr,
2442                                                      buffer, sizeof(buffer)));
2443                                 return -1;
2444                         }
2445                         break;
2446
2447                         /* Verify the reply digest */
2448                 case PW_AUTHENTICATION_ACK:
2449                 case PW_AUTHENTICATION_REJECT:
2450                 case PW_ACCESS_CHALLENGE:
2451                 case PW_ACCOUNTING_RESPONSE:
2452                 case PW_DISCONNECT_ACK:
2453                 case PW_DISCONNECT_NAK:
2454                 case PW_COA_ACK:
2455                 case PW_COA_NAK:
2456                         rcode = calc_replydigest(packet, original, secret);
2457                         if (rcode > 1) {
2458                                 fr_strerror_printf("Received %s packet "
2459                                            "from home server %s port %d with invalid signature!  (Shared secret is incorrect.)",
2460                                            fr_packet_codes[packet->code],
2461                                            inet_ntop(packet->src_ipaddr.af,
2462                                                      &packet->src_ipaddr.ipaddr,
2463                                                      buffer, sizeof(buffer)),
2464                                            packet->src_port);
2465                                 return -1;
2466                         }
2467                         break;
2468
2469                 default:
2470                         fr_strerror_printf("Received Unknown packet code %d "
2471                                    "from client %s port %d: Cannot validate signature",
2472                                    packet->code,
2473                                    inet_ntop(packet->src_ipaddr.af,
2474                                              &packet->src_ipaddr.ipaddr,
2475                                                      buffer, sizeof(buffer)),
2476                                    packet->src_port);
2477                         return -1;
2478         }
2479
2480         return 0;
2481 }
2482
2483
2484 /*
2485  *      Create a "raw" attribute from the attribute contents.
2486  */
2487 static ssize_t data2vp_raw(UNUSED const RADIUS_PACKET *packet,
2488                            UNUSED const RADIUS_PACKET *original,
2489                            UNUSED const char *secret,
2490                            unsigned int attribute, unsigned int vendor,
2491                            const uint8_t *data, size_t length,
2492                            VALUE_PAIR **pvp)
2493 {
2494         VALUE_PAIR *vp;
2495
2496 #ifndef NDEBUG
2497         if (length > sizeof(vp->vp_octets)) {
2498                 fr_strerror_printf("data2vp_raw: Too much data");
2499                 return -1;
2500         }
2501 #endif
2502
2503         /*
2504          *      Keep the next function happy.
2505          */
2506         vp = pairalloc(NULL);
2507         vp = paircreate_raw(attribute, vendor, PW_TYPE_OCTETS, vp);
2508         if (!vp) {
2509                 fr_strerror_printf("data2vp_raw: Failed creating attribute");
2510                 return -1;
2511         }
2512
2513         vp->length = length;
2514         memcpy(vp->vp_octets, data, length);
2515
2516         *pvp = vp;
2517
2518         return length;
2519 }
2520
2521
2522 static ssize_t data2vp_tlvs(const RADIUS_PACKET *packet,
2523                             const RADIUS_PACKET *original,
2524                             const char *secret,
2525                             unsigned int attribute, unsigned int vendor,
2526                             int nest,
2527                             const uint8_t *start, size_t length,
2528                             VALUE_PAIR **pvp);
2529
2530 /*
2531  *      Create any kind of VP from the attribute contents.
2532  *
2533  *      Will return -1 on error, or "length".
2534  */
2535 static ssize_t data2vp_any(const RADIUS_PACKET *packet,
2536                            const RADIUS_PACKET *original,
2537                            const char *secret, int nest,
2538                            unsigned int attribute, unsigned int vendor,
2539                            const uint8_t *data, size_t length,
2540                            VALUE_PAIR **pvp)
2541 {
2542         int data_offset = 0;
2543         DICT_ATTR *da;
2544         VALUE_PAIR *vp = NULL;
2545
2546         da = dict_attrbyvalue(attribute, vendor);
2547
2548         /*
2549          *      Unknown attribute.  Create it as a "raw" attribute.
2550          */
2551         if (!da) {
2552         raw:
2553                 if (vp) pairfree(&vp);
2554                 return data2vp_raw(packet, original, secret,
2555                                    attribute, vendor, data, length, pvp);
2556         }
2557
2558         /*
2559          *      TLVs are handled first.  They can't be tagged, and
2560          *      they can't be encrypted.
2561          */
2562         if (da->type == PW_TYPE_TLV) {
2563                 return data2vp_tlvs(packet, original, secret,
2564                                     attribute, vendor, nest,
2565                                     data, length, pvp);
2566         }
2567
2568         /*
2569          *      The attribute is known, and well formed.  We can now
2570          *      create it.  The main failure from here on in is being
2571          *      out of memory.
2572          */
2573         vp = pairalloc(da);
2574         if (!vp) return -1;
2575
2576         /*
2577          *      Handle tags.
2578          */
2579         if (vp->flags.has_tag) {
2580                 if (TAG_VALID(data[0]) ||
2581                     (vp->flags.encrypt == FLAG_ENCRYPT_TUNNEL_PASSWORD)) {
2582                         /*
2583                          *      Tunnel passwords REQUIRE a tag, even
2584                          *      if don't have a valid tag.
2585                          */
2586                         vp->flags.tag = data[0];
2587
2588                         if ((vp->type == PW_TYPE_STRING) ||
2589                             (vp->type == PW_TYPE_OCTETS)) {
2590                                 if (length == 0) goto raw;
2591                                 data_offset = 1;
2592                         }
2593                 }
2594         }
2595
2596         /*
2597          *      Copy the data to be decrypted
2598          */
2599         vp->length = length - data_offset;
2600         memcpy(&vp->vp_octets[0], data + data_offset, vp->length);
2601
2602         /*
2603          *      Decrypt the attribute.
2604          */
2605         switch (vp->flags.encrypt) {
2606                 /*
2607                  *  User-Password
2608                  */
2609         case FLAG_ENCRYPT_USER_PASSWORD:
2610                 if (original) {
2611                         rad_pwdecode(vp->vp_strvalue,
2612                                      vp->length, secret,
2613                                      original->vector);
2614                 } else {
2615                         rad_pwdecode(vp->vp_strvalue,
2616                                      vp->length, secret,
2617                                      packet->vector);
2618                 }
2619                 if (vp->attribute == PW_USER_PASSWORD) {
2620                         vp->length = strlen(vp->vp_strvalue);
2621                 }
2622                 break;
2623
2624                 /*
2625                  *      Tunnel-Password's may go ONLY
2626                  *      in response packets.
2627                  */
2628         case FLAG_ENCRYPT_TUNNEL_PASSWORD:
2629                 if (!original) goto raw;
2630
2631                 if (rad_tunnel_pwdecode(vp->vp_octets, &vp->length,
2632                                         secret, original->vector) < 0) {
2633                         goto raw;
2634                 }
2635                 break;
2636
2637                 /*
2638                  *  Ascend-Send-Secret
2639                  *  Ascend-Receive-Secret
2640                  */
2641         case FLAG_ENCRYPT_ASCEND_SECRET:
2642                 if (!original) {
2643                         goto raw;
2644                 } else {
2645                         uint8_t my_digest[AUTH_VECTOR_LEN];
2646                         make_secret(my_digest,
2647                                     original->vector,
2648                                     secret, data);
2649                         memcpy(vp->vp_strvalue, my_digest,
2650                                AUTH_VECTOR_LEN );
2651                         vp->vp_strvalue[AUTH_VECTOR_LEN] = '\0';
2652                         vp->length = strlen(vp->vp_strvalue);
2653                 }
2654                 break;
2655
2656         default:
2657                 break;
2658         } /* switch over encryption flags */
2659
2660
2661         switch (vp->type) {
2662         case PW_TYPE_STRING:
2663         case PW_TYPE_OCTETS:
2664         case PW_TYPE_ABINARY:
2665                 /* nothing more to do */
2666                 break;
2667
2668         case PW_TYPE_BYTE:
2669                 if (vp->length != 1) goto raw;
2670
2671                 vp->vp_integer = vp->vp_octets[0];
2672                 break;
2673
2674
2675         case PW_TYPE_SHORT:
2676                 if (vp->length != 2) goto raw;
2677
2678                 vp->vp_integer = (vp->vp_octets[0] << 8) | vp->vp_octets[1];
2679                 break;
2680
2681         case PW_TYPE_INTEGER:
2682                 if (vp->length != 4) goto raw;
2683
2684                 memcpy(&vp->vp_integer, vp->vp_octets, 4);
2685                 vp->vp_integer = ntohl(vp->vp_integer);
2686
2687                 if (vp->flags.has_tag) vp->vp_integer &= 0x00ffffff;
2688
2689                 /*
2690                  *      Try to get named VALUEs
2691                  */
2692                 {
2693                         DICT_VALUE *dval;
2694                         dval = dict_valbyattr(vp->attribute, vp->vendor,
2695                                               vp->vp_integer);
2696                         if (dval) {
2697                                 strlcpy(vp->vp_strvalue,
2698                                         dval->name,
2699                                         sizeof(vp->vp_strvalue));
2700                         }
2701                 }
2702                 break;
2703
2704         case PW_TYPE_DATE:
2705                 if (vp->length != 4) goto raw;
2706
2707                 memcpy(&vp->vp_date, vp->vp_octets, 4);
2708                 vp->vp_date = ntohl(vp->vp_date);
2709                 break;
2710
2711
2712         case PW_TYPE_IPADDR:
2713                 if (vp->length != 4) goto raw;
2714
2715                 memcpy(&vp->vp_ipaddr, vp->vp_octets, 4);
2716                 break;
2717
2718                 /*
2719                  *      IPv6 interface ID is 8 octets long.
2720                  */
2721         case PW_TYPE_IFID:
2722                 if (vp->length != 8) goto raw;
2723                 /* vp->vp_ifid == vp->vp_octets */
2724                 break;
2725
2726                 /*
2727                  *      IPv6 addresses are 16 octets long
2728                  */
2729         case PW_TYPE_IPV6ADDR:
2730                 if (vp->length != 16) goto raw;
2731                 /* vp->vp_ipv6addr == vp->vp_octets */
2732                 break;
2733
2734                 /*
2735                  *      IPv6 prefixes are 2 to 18 octets long.
2736                  *
2737                  *      RFC 3162: The first octet is unused.
2738                  *      The second is the length of the prefix
2739                  *      the rest are the prefix data.
2740                  *
2741                  *      The prefix length can have value 0 to 128.
2742                  */
2743         case PW_TYPE_IPV6PREFIX:
2744                 if (vp->length < 2 || vp->length > 18) goto raw;
2745                 if (vp->vp_octets[1] > 128) goto raw;
2746
2747                 /*
2748                  *      FIXME: double-check that
2749                  *      (vp->vp_octets[1] >> 3) matches vp->length + 2
2750                  */
2751                 if (vp->length < 18) {
2752                         memset(vp->vp_octets + vp->length, 0,
2753                                18 - vp->length);
2754                 }
2755                 break;
2756
2757         case PW_TYPE_SIGNED:
2758                 if (vp->length != 4) goto raw;
2759
2760                 /*
2761                  *      Overload vp_integer for ntohl, which takes
2762                  *      uint32_t, not int32_t
2763                  */
2764                 memcpy(&vp->vp_integer, vp->vp_octets, 4);
2765                 vp->vp_integer = ntohl(vp->vp_integer);
2766                 memcpy(&vp->vp_signed, &vp->vp_integer, 4);
2767                 break;
2768
2769         case PW_TYPE_TLV:
2770                 pairfree(&vp);
2771                 fr_strerror_printf("data2vp_any: Internal sanity check failed");
2772                 return -1;
2773
2774         case PW_TYPE_COMBO_IP:
2775                 if (vp->length == 4) {
2776                         vp->type = PW_TYPE_IPADDR;
2777                         memcpy(&vp->vp_ipaddr, vp->vp_octets, 4);
2778                         break;
2779
2780                 } else if (vp->length == 16) {
2781                         vp->type = PW_TYPE_IPV6ADDR;
2782                         /* vp->vp_ipv6addr == vp->vp_octets */
2783                         break;
2784
2785                 }
2786                 /* FALL-THROUGH */
2787
2788         default:
2789                 goto raw;
2790         }
2791
2792         *pvp = vp;
2793
2794         return length;
2795 }
2796
2797
2798 /*
2799  *      Convert a top-level VSA to a VP.
2800  */
2801 static ssize_t attr2vp_vsa(const RADIUS_PACKET *packet,
2802                            const RADIUS_PACKET *original,
2803                            const char *secret, DICT_VENDOR *dv,
2804                            const uint8_t *data, size_t length,
2805                            VALUE_PAIR **pvp)
2806 {
2807         unsigned int attribute;
2808         ssize_t attrlen, my_len;
2809
2810 #ifndef NDEBUG
2811         if (length <= (dv->type + dv->length)) {
2812                 fr_strerror_printf("attr2vp_vsa: Failure to call rad_tlv_ok");
2813                 return -1;
2814         }
2815 #endif  
2816
2817         switch (dv->type) {
2818         case 4:
2819                 /* data[0] must be zero */
2820                 attribute = data[1] << 16;
2821                 attribute |= data[2] << 8;
2822                 attribute |= data[3];
2823                 break;
2824
2825         case 2:
2826                 attribute = data[0];
2827                 attribute |= data[1];
2828                 break;
2829
2830         case 1:
2831                 attribute = data[0];
2832                 break;
2833
2834         default:
2835                 fr_strerror_printf("attr2vp_vsa: Internal sanity check failed");
2836                 return -1;
2837         }
2838
2839         switch (dv->length) {
2840         case 2:
2841                 /* data[dv->type] must be zero */
2842                 attrlen = data[dv->type + 1];
2843                 break;
2844
2845         case 1:
2846                 attrlen = data[dv->type];
2847                 break;
2848
2849         case 0:
2850                 attrlen = length;
2851                 break;
2852
2853         default:
2854                 fr_strerror_printf("attr2vp_vsa: Internal sanity check failed");
2855                 return -1;
2856         }
2857
2858 #ifndef NDEBUG
2859         if (attrlen <= (ssize_t) (dv->type + dv->length)) {
2860                 fr_strerror_printf("attr2vp_vsa: Failure to call rad_tlv_ok");
2861                 return -1;
2862         }
2863 #endif
2864
2865         attrlen -= (dv->type + dv->length);
2866         
2867         my_len = data2vp_any(packet, original, secret, 0,
2868                              attribute, dv->vendorpec,
2869                              data + dv->type + dv->length, attrlen, pvp);
2870         if (my_len < 0) return my_len;
2871
2872 #ifndef NDEBUG
2873         if (my_len != attrlen) {
2874                 pairfree(pvp);
2875                 fr_strerror_printf("attr2vp_vsa: Incomplete decode %d != %d",
2876                                    (int) my_len, (int) attrlen);
2877                 return -1;
2878         }
2879 #endif
2880
2881         return dv->type + dv->length + attrlen;
2882 }
2883
2884 /*
2885  *      Convert one or more TLVs to VALUE_PAIRs.  This function can
2886  *      be called recursively...
2887  */
2888 static ssize_t data2vp_tlvs(const RADIUS_PACKET *packet,
2889                             const RADIUS_PACKET *original,
2890                             const char *secret,
2891                             unsigned int attribute, unsigned int vendor,
2892                             int nest,
2893                             const uint8_t *start, size_t length,
2894                             VALUE_PAIR **pvp)
2895 {
2896         size_t dv_type, dv_length;
2897         const uint8_t *data, *end;
2898         VALUE_PAIR *head, **last, *vp;
2899
2900         data = start;
2901
2902         /*
2903          *      The default format for a VSA is the RFC recommended
2904          *      format.
2905          */
2906         dv_type = 1;
2907         dv_length = 1;
2908
2909         /*
2910          *      Top-level TLVs can be of a weird format.  TLVs
2911          *      encapsulated in a TLV can only be in the RFC format.
2912          */
2913         if (nest == 1) {
2914                 DICT_VENDOR *dv;
2915                 dv = dict_vendorbyvalue(vendor);        
2916                 if (dv) {
2917                         dv_type = dv->type;
2918                         dv_length = dv->length;
2919                         /* dict.c enforces sane values on the above fields */
2920                 }
2921         }
2922
2923         if (nest >= fr_attr_max_tlv) {
2924                 fr_strerror_printf("data2vp_tlvs: Internal sanity check failed in recursion");
2925                 return -1;
2926         }
2927
2928         /*
2929          *      The VSAs do not exactly fill the data, it's malformed.
2930          */
2931         if (rad_tlv_ok(data, length, dv_type, dv_length) < 0) {
2932                 return data2vp_raw(packet, original, secret,
2933                                    attribute, vendor, data, length, pvp);
2934         }
2935
2936         end = data + length;
2937         head = NULL;
2938         last = &head;
2939
2940         while (data < end) {
2941                 unsigned int my_attr;
2942                 unsigned int my_len;
2943
2944 #ifndef NDEBUG
2945                 if ((data + dv_type + dv_length) > end) {
2946                         fr_strerror_printf("data2vp_tlvs: Internal sanity check failed in tlvs: Insufficient data");
2947                         pairfree(&head);
2948                         return -1;
2949                 }
2950 #endif
2951
2952                 switch (dv_type) {
2953                 case 1:
2954                         my_attr = attribute;
2955                         my_attr |= ((data[0] & fr_attr_mask[nest + 1])
2956                                     << fr_attr_shift[nest + 1]);
2957                         break;
2958                 case 2:
2959                         my_attr = (data[0] << 8) | data[1];
2960                         break;
2961
2962                 case 4:
2963                         my_attr = (data[1] << 16) | (data[1] << 8) | data[3];
2964                         break;
2965
2966                 default:
2967                         fr_strerror_printf("data2vp_tlvs: Internal sanity check failed");
2968                         return -1;
2969                 }
2970
2971                 switch (dv_length) {
2972                 case 0:
2973                         my_len = length;
2974                         break;
2975
2976                 case 1:
2977                 case 2:
2978                         my_len = data[dv_type + dv_length - 1];
2979                         break;
2980
2981                 default:
2982                         fr_strerror_printf("data2vp_tlvs: Internal sanity check failed");
2983                         return -1;
2984                 }
2985                 
2986 #ifndef NDEBUG
2987                 if (my_len < (dv_type + dv_length)) {
2988                         fr_strerror_printf("data2vp_tlvs: Internal sanity check failed in tlvs: underflow");
2989                         pairfree(&head);
2990                         return -1;
2991                 }
2992
2993                 if ((data + my_len) > end) {
2994                         fr_strerror_printf("data2vp_tlvs: Internal sanity check failed in tlvs: overflow");
2995                         pairfree(&head);
2996                         return -1;
2997                 }
2998 #endif
2999
3000                 my_len -= dv_type + dv_length;
3001
3002                 /*
3003                  *      If this returns > 0, it returns "my_len"
3004                  */
3005                 if (data2vp_any(packet, original, secret, nest + 1,
3006                                 my_attr, vendor,
3007                                 data + dv_type + dv_length, my_len, &vp) < 0) {
3008                         pairfree(&head);
3009                         return -1;
3010                 }
3011
3012                 data += my_len + dv_type + dv_length;
3013                 *last = vp;
3014
3015                 while (vp) {
3016                         last = &(vp->next);
3017                         vp = vp->next;
3018                 }
3019         }
3020
3021         *pvp = head;
3022         return data - start;
3023 }
3024
3025
3026 /*
3027  *      Group "continued" attributes together, and create VPs from them.
3028  *      The caller ensures that the RADIUS packet is OK, and that the
3029  *      continuations have all been checked.
3030  */
3031 static ssize_t data2vp_continued(const RADIUS_PACKET *packet,
3032                                  const RADIUS_PACKET *original,
3033                                  const char *secret,
3034                                  const uint8_t *start, size_t length,
3035                                  VALUE_PAIR **pvp, int nest,
3036                                  unsigned int attribute, unsigned int vendor,
3037                                  int first_offset, int later_offset,
3038                                  ssize_t attrlen)
3039 {
3040         ssize_t left;
3041         uint8_t *attr, *ptr;
3042         const uint8_t *data;
3043
3044         attr = malloc(attrlen);
3045         if (!attr) {
3046                 fr_strerror_printf("Out of memory");
3047                 return -1;
3048         }
3049
3050         left = attrlen;
3051         ptr = attr;
3052         data = start;
3053
3054         /*
3055          *      Do the first one.
3056          */
3057         memcpy(ptr, data + first_offset, data[1] - first_offset);
3058         ptr += data[1] - first_offset;
3059         left -= data[1] - first_offset;
3060         data += data[1];
3061
3062         while (left > 0) {
3063 #ifndef NDEBUG
3064                 if (data >= (start + length)) {
3065                         fr_strerror_printf("data2vp_continued: Internal sanity check failed");
3066                         return -1;
3067                 }
3068 #endif
3069                 memcpy(ptr, data + later_offset, data[1] - later_offset);
3070                 ptr += data[1] - later_offset;
3071                 left -= data[1] - later_offset;
3072                 data += data[1];
3073         }
3074
3075         left = data2vp_any(packet, original, secret, nest,
3076                            attribute, vendor,
3077                            attr, attrlen, pvp);
3078         free(attr);
3079         if (left < 0) return left;
3080
3081         return data - start;
3082 }
3083
3084
3085 /*
3086  *      Create a "raw" VALUE_PAIR from a RADIUS attribute.
3087  */
3088 ssize_t rad_attr2vp_raw(const RADIUS_PACKET *packet,
3089                         const RADIUS_PACKET *original,
3090                         const char *secret,
3091                         const uint8_t *data, size_t length,
3092                         VALUE_PAIR **pvp)
3093 {
3094         ssize_t my_len;
3095
3096         if ((data[1] < 2) || (data[1] > length)) {
3097                 fr_strerror_printf("rad_attr2vp_raw: Invalid length");
3098                 return -1;
3099         }
3100
3101         my_len = data2vp_raw(packet, original, secret, data[0], 0,
3102                              data + 2, data[1] - 2, pvp);
3103         if (my_len < 0) return my_len;
3104         
3105         return data[1];
3106 }
3107
3108
3109 /*
3110  *      Get the length of the data portion of all of the contiguous
3111  *      continued attributes.
3112  *
3113  *      0 for "no continuation"
3114  *      -1 on malformed packets (continuation followed by non-wimax, etc.)
3115  */
3116 static ssize_t wimax_attrlen(const uint8_t *start, const uint8_t *end)
3117 {
3118         uint32_t lvalue = htonl(VENDORPEC_WIMAX);
3119         ssize_t total;
3120         const uint8_t *data = start;
3121
3122         if ((data[8] & 0x80) == 0) return 0;
3123         total = data[7] - 3;
3124
3125         do {
3126                 data += data[1];
3127                 
3128                 if ((data + 9) > end) return -1;
3129
3130                 if ((data[0] != PW_VENDOR_SPECIFIC) ||
3131                     (data[1] < 9) ||
3132                     (memcmp(data + 2, &lvalue, 4) != 0) ||
3133                     (data[6] != start[6]) ||
3134                     ((data[7] + 6) != data[1])) return -1;
3135
3136                 total += data[7] - 3;
3137                 if ((data[8] & 0x80) == 0) break;
3138         } while (data < end);
3139
3140         return total;
3141 }
3142
3143
3144 /*
3145  *      Get the length of the data portion of all of the contiguous
3146  *      continued attributes.
3147  *
3148  *      0 for "no continuation"
3149  *      -1 on malformed packets (continuation followed by non-wimax, etc.)
3150  */
3151 static ssize_t extended_attrlen(const uint8_t *start, const uint8_t *end)
3152 {
3153         ssize_t total;
3154         const uint8_t *data = start;
3155
3156         if ((data[3] & 0x80) == 0) return 0;
3157         total = data[1] - 4;
3158
3159         do {
3160                 data += data[1];
3161                 
3162                 if ((data + 4) > end) return -1;
3163
3164                 if ((data[0] != start[0]) ||
3165                     (data[1] < 4) ||
3166                     (data[2] != start[2])) return -1;
3167
3168                 total += data[1] - 4;
3169                 if ((data[3] & 0x80) == 0) break;
3170         } while (data < end);
3171
3172         return total;
3173 }
3174
3175
3176 /*
3177  *      Create WiMAX VALUE_PAIRs from a RADIUS attribute.
3178  */
3179 ssize_t rad_attr2vp_wimax(const RADIUS_PACKET *packet,
3180                           const RADIUS_PACKET *original,
3181                           const char *secret,
3182                           const uint8_t *data,  size_t length,
3183                           VALUE_PAIR **pvp)
3184 {
3185         ssize_t my_len;
3186         unsigned int attribute;
3187         uint32_t lvalue;
3188
3189         if ((length < 2) || (data[1] < 2) || (data[1] > length)) {
3190                 fr_strerror_printf("rad_attr2vp_wimax: Invalid length");
3191                 return -1;
3192         }
3193
3194         if (data[0] != PW_VENDOR_SPECIFIC) {
3195                 fr_strerror_printf("rad_attr2vp_wimax: Invalid attribute");
3196                 return -1;
3197         }
3198
3199         /*
3200          *      Not enough room for a Vendor-Id. + WiMAX header
3201          */
3202         if (data[1] < 9) {
3203                 return rad_attr2vp_raw(packet, original, secret,
3204                                        data, length, pvp);
3205         }
3206
3207         memcpy(&lvalue, data + 2, 4);
3208         lvalue = ntohl(lvalue);
3209
3210         /*
3211          *      Not WiMAX
3212          */
3213         if (lvalue != VENDORPEC_WIMAX) {
3214                 fr_strerror_printf("rad_attr2vp_wimax: Not a WiMAX attribute");
3215                 return -1;
3216         }
3217
3218         /*
3219          *      The WiMAX attribute is encapsulated in a VSA.  If the
3220          *      WiMAX length disagrees with the VSA length, it's malformed.
3221          */
3222         if ((data[7] + 6) != data[1]) {
3223                 return rad_attr2vp_raw(packet, original, secret,
3224                                        data, length, pvp);
3225         }
3226
3227         attribute = data[6];
3228
3229         /*
3230          *      Attribute is continued.  Do some more work.
3231          */
3232         if (data[8] != 0) {
3233                 my_len = wimax_attrlen(data, data + length);
3234                 if (my_len < 0) {
3235                         return rad_attr2vp_raw(packet, original, secret,
3236                                                data, length, pvp);
3237                 }
3238
3239                 return data2vp_continued(packet, original, secret,
3240                                          data, length, pvp, 0,
3241                                          data[6], VENDORPEC_WIMAX,
3242                                          9, 9, my_len);
3243         }
3244
3245         my_len = data2vp_any(packet, original, secret, 0, attribute, lvalue,
3246                              data + 9, data[1] - 9, pvp);
3247         if (my_len < 0) return my_len;
3248
3249         return data[1];
3250 }
3251
3252 /*
3253  *      Create Vendor-Specifc VALUE_PAIRs from a RADIUS attribute.
3254  */
3255 ssize_t rad_attr2vp_vsa(const RADIUS_PACKET *packet,
3256                         const RADIUS_PACKET *original,
3257                         const char *secret,
3258                         const uint8_t *data, size_t length,
3259                         VALUE_PAIR **pvp)
3260 {
3261         size_t dv_type, dv_length;
3262         ssize_t my_len;
3263         uint32_t lvalue;
3264         DICT_VENDOR *dv;
3265
3266         if ((length < 2) || (data[1] < 2) || (data[1] > length)) {
3267                 fr_strerror_printf("rad_attr2vp_vsa: Invalid length");
3268                 return -1;
3269         }
3270
3271         if (data[0] != PW_VENDOR_SPECIFIC) {
3272                 fr_strerror_printf("rad_attr2vp_vsa: Invalid attribute");
3273                 return -1;
3274         }
3275
3276         /*
3277          *      Not enough room for a Vendor-Id.
3278          *      Or the high octet of the Vendor-Id is set.
3279          */
3280         if ((data[1] < 6) || (data[2] != 0)) {
3281                 return rad_attr2vp_raw(packet, original, secret,
3282                                        data, length, pvp);
3283         }
3284
3285         memcpy(&lvalue, data + 2, 4);
3286         lvalue = ntohl(lvalue);
3287
3288         /*
3289          *      WiMAX gets its own set of magic.
3290          */
3291         if (lvalue == VENDORPEC_WIMAX) {
3292                 return rad_attr2vp_wimax(packet, original, secret,
3293                                          data, length, pvp);
3294         }
3295
3296         dv_type = dv_length = 1;
3297         dv = dict_vendorbyvalue(lvalue);
3298         if (dv) {
3299                 dv_type = dv->type;
3300                 dv_length = dv->length;
3301         }
3302
3303         /*
3304          *      Attribute is not in the correct form.
3305          */
3306         if (rad_tlv_ok(data + 6, data[1] - 6, dv_type, dv_length) < 0) {
3307                 return rad_attr2vp_raw(packet, original, secret,
3308                                        data, length, pvp);
3309         }
3310
3311         my_len = attr2vp_vsa(packet, original, secret, dv,
3312                              data + 6, data[1] - 6, pvp);
3313         if (my_len < 0) return my_len;
3314
3315 #ifndef NDEBUG
3316         if (my_len != (data[1] - 6)) {
3317                 pairfree(pvp);
3318                 fr_strerror_printf("rad_attr2vp_vsa: Incomplete decode");
3319                 return -1;
3320         }
3321 #endif
3322
3323         return data[1];
3324 }
3325
3326 /*
3327  *      Create an "extended" VALUE_PAIR from a RADIUS attribute.
3328  */
3329 ssize_t rad_attr2vp_extended(const RADIUS_PACKET *packet,
3330                              const RADIUS_PACKET *original,
3331                              const char *secret,
3332                              const uint8_t *start, size_t length,
3333                              VALUE_PAIR **pvp)
3334 {
3335         unsigned int attribute;
3336         int shift = 1;
3337         int continued = 0;
3338         unsigned int vendor = VENDORPEC_EXTENDED;
3339         size_t data_len = length;
3340         const uint8_t *data;
3341         DICT_ATTR *da;
3342
3343         data = start;
3344
3345         if ((length < 2) || (data[1] < 2) || (data[1] > length)) {
3346                 fr_strerror_printf("rad_attr2vp_extended: Invalid length");
3347                 return -1;
3348         }
3349
3350         da = dict_attrbyvalue(data[0], vendor);
3351         if (!da) {
3352                 fr_strerror_printf("rad_attr2vp_extended: Attribute is not extended format");
3353                 return -1;
3354         }
3355
3356         data = start;
3357
3358         /*
3359          *      No Extended-Type.  It's a raw attribute.
3360          *      Also, if there's no data following the Extended-Type,
3361          *      it's a raw attribute.
3362          */
3363         if (data[1] <= 3) {
3364         raw:
3365                 return rad_attr2vp_raw(packet, original, secret, start,
3366                                        length, pvp);
3367         }
3368
3369         /*
3370          *      The attribute is "241.1", for example.  Go look that
3371          *      up to see what type it is.
3372          */
3373         attribute = data[0];
3374         attribute |= (data[2] << fr_attr_shift[1]);
3375
3376         da = dict_attrbyvalue(attribute, vendor);
3377         if (!da) goto raw;
3378
3379         vendor = VENDORPEC_EXTENDED;
3380
3381         data_len = length;
3382         if (data[1] < length) data_len = data[1];
3383
3384         data += 3;
3385         data_len -= 3;
3386
3387         /*
3388          *      If there's supposed to be a flag octet.  If not, it's
3389          *      a raw attribute.  If the flag is set, it's supposed to
3390          *      be continued.
3391          */
3392         if (da->flags.extended_flags) {
3393                 if (data_len == 0) goto raw;
3394
3395                 continued = ((data[0] & 0x80) != 0);
3396                 data++;
3397                 data_len--;
3398         }
3399         
3400         /*
3401          *      Extended VSAs have 4 octets of
3402          *      Vendor-Id followed by one octet of
3403          *      Vendor-Type.
3404          */
3405         if (da->flags.evs) {
3406                 if (data_len < 5) goto raw;
3407                 
3408                 /*
3409                  *      Vendor Ids can only be 24-bit.
3410                  */
3411                 if (data[0] != 0) goto raw;
3412                 
3413                 vendor = ((data[1] << 16) |
3414                           (data[2] << 8) |
3415                           data[3]);
3416                 
3417                 /*
3418                  *      Pack the *encapsulating* attribute number into
3419                  *      the vendor id.
3420                  */
3421                 vendor |= start[0] * FR_MAX_VENDOR;
3422                 shift = 0;
3423                 
3424                 /*
3425                  *      Over-write the attribute with the
3426                  *      VSA.
3427                  */
3428                 attribute = data[4];
3429                 data += 5;
3430                 data_len -= 5;
3431         }
3432
3433         if (continued) {
3434                 int first_offset = 4;
3435                 ssize_t my_len;
3436
3437                 if (vendor != VENDORPEC_EXTENDED) first_offset += 5;
3438
3439                 my_len = extended_attrlen(start, start + length);
3440                 if (my_len < 0) goto raw;
3441
3442                 if (vendor != VENDORPEC_EXTENDED) my_len -= 5;
3443
3444                 return data2vp_continued(packet, original, secret,
3445                                          start, length, pvp, shift,
3446                                          attribute, vendor,
3447                                          first_offset, 4, my_len);
3448         }
3449
3450         if (data2vp_any(packet, original, secret, shift,
3451                         attribute, vendor, data, data_len, pvp) < 0) {
3452                 return -1;
3453         }
3454
3455         return (data + data_len) - start;
3456 }
3457
3458
3459 /*
3460  *      Create a "standard" RFC VALUE_PAIR from the given data.
3461  */
3462 ssize_t rad_attr2vp_rfc(const RADIUS_PACKET *packet,
3463                         const RADIUS_PACKET *original,
3464                         const char *secret,
3465                         const uint8_t *data, size_t length,
3466                         VALUE_PAIR **pvp)
3467 {
3468         if ((length < 2) || (data[1] < 2) || (data[1] > length)) {
3469                 fr_strerror_printf("rad_attr2vp_rfc: Insufficient data");
3470                 return -1;
3471         }
3472         
3473         if (data2vp_any(packet, original, secret, 0,
3474                         data[0], 0, data + 2, data[1] - 2, pvp) < 0) {
3475                 return -1;
3476         }
3477
3478         return data[1];
3479 }       
3480
3481 /*
3482  *      Create a "normal" VALUE_PAIR from the given data.
3483  */
3484 ssize_t rad_attr2vp(const RADIUS_PACKET *packet,
3485                     const RADIUS_PACKET *original,
3486                     const char *secret,
3487                     const uint8_t *data, size_t length,
3488                     VALUE_PAIR **pvp)
3489 {
3490         if ((length < 2) || (data[1] < 2) || (data[1] > length)) {
3491                 fr_strerror_printf("rad_attr2vp: Insufficient data");
3492                 return -1;
3493         }
3494
3495         /*
3496          *      VSAs get their own handler.
3497          */
3498         if (data[0] == PW_VENDOR_SPECIFIC) {
3499                 return rad_attr2vp_vsa(packet, original, secret,
3500                                        data, length, pvp);
3501         }
3502
3503         /*
3504          *      Extended attribute format gets their own handler.
3505          */
3506         if (dict_attrbyvalue(data[0], VENDORPEC_EXTENDED) != NULL) {
3507                 return rad_attr2vp_extended(packet, original, secret,
3508                                             data, length, pvp);
3509         }
3510
3511         return rad_attr2vp_rfc(packet, original, secret, data, length, pvp);
3512 }
3513
3514
3515 /*
3516  *      Calculate/check digest, and decode radius attributes.
3517  *      Returns:
3518  *      -1 on decoding error
3519  *      0 on success
3520  */
3521 int rad_decode(RADIUS_PACKET *packet, RADIUS_PACKET *original,
3522                const char *secret)
3523 {
3524         int                     packet_length;
3525         int                     num_attributes;
3526         uint8_t                 *ptr;
3527         radius_packet_t         *hdr;
3528         VALUE_PAIR *head, **tail, *vp;
3529
3530         /*
3531          *      Extract attribute-value pairs
3532          */
3533         hdr = (radius_packet_t *)packet->data;
3534         ptr = hdr->data;
3535         packet_length = packet->data_len - AUTH_HDR_LEN;
3536
3537         head = NULL;
3538         tail = &head;
3539         num_attributes = 0;
3540
3541         /*
3542          *      Loop over the attributes, decoding them into VPs.
3543          */
3544         while (packet_length > 0) {
3545                 ssize_t my_len;
3546
3547                 /*
3548                  *      This may return many VPs
3549                  */
3550                 my_len = rad_attr2vp(packet, original, secret,
3551                                      ptr, packet_length, &vp);
3552                 if (my_len < 0) {
3553                         pairfree(&head);
3554                         return -1;
3555                 }
3556
3557                 *tail = vp;
3558                 while (vp) {
3559                         num_attributes++;
3560                         debug_pair(vp);
3561                         tail = &(vp->next);
3562                         vp = vp->next;
3563                 }
3564
3565                 /*
3566                  *      VSA's may not have been counted properly in
3567                  *      rad_packet_ok() above, as it is hard to count
3568                  *      then without using the dictionary.  We
3569                  *      therefore enforce the limits here, too.
3570                  */
3571                 if ((fr_max_attributes > 0) &&
3572                     (num_attributes > fr_max_attributes)) {
3573                         char host_ipaddr[128];
3574
3575                         pairfree(&head);
3576                         fr_strerror_printf("WARNING: Possible DoS attack from host %s: Too many attributes in request (received %d, max %d are allowed).",
3577                                    inet_ntop(packet->src_ipaddr.af,
3578                                              &packet->src_ipaddr.ipaddr,
3579                                              host_ipaddr, sizeof(host_ipaddr)),
3580                                    num_attributes, fr_max_attributes);
3581                         return -1;
3582                 }
3583
3584                 ptr += my_len;
3585                 packet_length -= my_len;
3586         }
3587
3588         /*
3589          *      Merge information from the outside world into our
3590          *      random pool.
3591          */
3592         fr_rand_seed(packet->data, AUTH_HDR_LEN);
3593         
3594         /*
3595          *      There may be VP's already in the packet.  Don't
3596          *      destroy them.  Instead, add the decoded attributes to
3597          *      the tail of the list.
3598          */
3599         for (tail = &packet->vps; *tail != NULL; tail = &((*tail)->next)) {
3600                 /* nothing */
3601         }
3602         *tail = head;
3603
3604         return 0;
3605 }
3606
3607
3608 /*
3609  *      Encode password.
3610  *
3611  *      We assume that the passwd buffer passed is big enough.
3612  *      RFC2138 says the password is max 128 chars, so the size
3613  *      of the passwd buffer must be at least 129 characters.
3614  *      Preferably it's just MAX_STRING_LEN.
3615  *
3616  *      int *pwlen is updated to the new length of the encrypted
3617  *      password - a multiple of 16 bytes.
3618  */
3619 int rad_pwencode(char *passwd, size_t *pwlen, const char *secret,
3620                  const uint8_t *vector)
3621 {
3622         FR_MD5_CTX context, old;
3623         uint8_t digest[AUTH_VECTOR_LEN];
3624         int     i, n, secretlen;
3625         int     len;
3626
3627         /*
3628          *      RFC maximum is 128 bytes.
3629          *
3630          *      If length is zero, pad it out with zeros.
3631          *
3632          *      If the length isn't aligned to 16 bytes,
3633          *      zero out the extra data.
3634          */
3635         len = *pwlen;
3636
3637         if (len > 128) len = 128;
3638
3639         if (len == 0) {
3640                 memset(passwd, 0, AUTH_PASS_LEN);
3641                 len = AUTH_PASS_LEN;
3642         } else if ((len % AUTH_PASS_LEN) != 0) {
3643                 memset(&passwd[len], 0, AUTH_PASS_LEN - (len % AUTH_PASS_LEN));
3644                 len += AUTH_PASS_LEN - (len % AUTH_PASS_LEN);
3645         }
3646         *pwlen = len;
3647
3648         /*
3649          *      Use the secret to setup the decryption digest
3650          */
3651         secretlen = strlen(secret);
3652
3653         fr_MD5Init(&context);
3654         fr_MD5Update(&context, (const uint8_t *) secret, secretlen);
3655         old = context;          /* save intermediate work */
3656
3657         /*
3658          *      Encrypt it in place.  Don't bother checking
3659          *      len, as we've ensured above that it's OK.
3660          */
3661         for (n = 0; n < len; n += AUTH_PASS_LEN) {
3662                 if (n == 0) {
3663                         fr_MD5Update(&context, vector, AUTH_PASS_LEN);
3664                         fr_MD5Final(digest, &context);
3665                 } else {
3666                         context = old;
3667                         fr_MD5Update(&context,
3668                                      (uint8_t *) passwd + n - AUTH_PASS_LEN,
3669                                      AUTH_PASS_LEN);
3670                         fr_MD5Final(digest, &context);
3671                 }
3672
3673                 for (i = 0; i < AUTH_PASS_LEN; i++) {
3674                         passwd[i + n] ^= digest[i];
3675                 }
3676         }
3677
3678         return 0;
3679 }
3680
3681 /*
3682  *      Decode password.
3683  */
3684 int rad_pwdecode(char *passwd, size_t pwlen, const char *secret,
3685                  const uint8_t *vector)
3686 {
3687         FR_MD5_CTX context, old;
3688         uint8_t digest[AUTH_VECTOR_LEN];
3689         int     i;
3690         size_t  n, secretlen;
3691
3692         /*
3693          *      The RFC's say that the maximum is 128.
3694          *      The buffer we're putting it into above is 254, so
3695          *      we don't need to do any length checking.
3696          */
3697         if (pwlen > 128) pwlen = 128;
3698
3699         /*
3700          *      Catch idiots.
3701          */
3702         if (pwlen == 0) goto done;
3703
3704         /*
3705          *      Use the secret to setup the decryption digest
3706          */
3707         secretlen = strlen(secret);
3708
3709         fr_MD5Init(&context);
3710         fr_MD5Update(&context, (const uint8_t *) secret, secretlen);
3711         old = context;          /* save intermediate work */
3712
3713         /*
3714          *      The inverse of the code above.
3715          */
3716         for (n = 0; n < pwlen; n += AUTH_PASS_LEN) {
3717                 if (n == 0) {
3718                         fr_MD5Update(&context, vector, AUTH_VECTOR_LEN);
3719                         fr_MD5Final(digest, &context);
3720
3721                         context = old;
3722                         if (pwlen > AUTH_PASS_LEN) {
3723                                 fr_MD5Update(&context, (uint8_t *) passwd,
3724                                              AUTH_PASS_LEN);
3725                         }
3726                 } else {
3727                         fr_MD5Final(digest, &context);
3728
3729                         context = old;
3730                         if (pwlen > (n + AUTH_PASS_LEN)) {
3731                                 fr_MD5Update(&context, (uint8_t *) passwd + n,
3732                                              AUTH_PASS_LEN);
3733                         }
3734                 }
3735
3736                 for (i = 0; i < AUTH_PASS_LEN; i++) {
3737                         passwd[i + n] ^= digest[i];
3738                 }
3739         }
3740
3741  done:
3742         passwd[pwlen] = '\0';
3743         return strlen(passwd);
3744 }
3745
3746
3747 /*
3748  *      Encode Tunnel-Password attributes when sending them out on the wire.
3749  *
3750  *      int *pwlen is updated to the new length of the encrypted
3751  *      password - a multiple of 16 bytes.
3752  *
3753  *      This is per RFC-2868 which adds a two char SALT to the initial intermediate
3754  *      value MD5 hash.
3755  */
3756 int rad_tunnel_pwencode(char *passwd, size_t *pwlen, const char *secret,
3757                         const uint8_t *vector)
3758 {
3759         uint8_t buffer[AUTH_VECTOR_LEN + MAX_STRING_LEN + 3];
3760         unsigned char   digest[AUTH_VECTOR_LEN];
3761         char*   salt;
3762         int     i, n, secretlen;
3763         unsigned len, n2;
3764
3765         len = *pwlen;
3766
3767         if (len > 127) len = 127;
3768
3769         /*
3770          * Shift the password 3 positions right to place a salt and original
3771          * length, tag will be added automatically on packet send
3772          */
3773         for (n=len ; n>=0 ; n--) passwd[n+3] = passwd[n];
3774         salt = passwd;
3775         passwd += 2;
3776         /*
3777          * save original password length as first password character;
3778          */
3779         *passwd = len;
3780         len += 1;
3781
3782
3783         /*
3784          *      Generate salt.  The RFC's say:
3785          *
3786          *      The high bit of salt[0] must be set, each salt in a
3787          *      packet should be unique, and they should be random
3788          *
3789          *      So, we set the high bit, add in a counter, and then
3790          *      add in some CSPRNG data.  should be OK..
3791          */
3792         salt[0] = (0x80 | ( ((salt_offset++) & 0x0f) << 3) |
3793                    (fr_rand() & 0x07));
3794         salt[1] = fr_rand();
3795
3796         /*
3797          *      Padd password to multiple of AUTH_PASS_LEN bytes.
3798          */
3799         n = len % AUTH_PASS_LEN;
3800         if (n) {
3801                 n = AUTH_PASS_LEN - n;
3802                 for (; n > 0; n--, len++)
3803                         passwd[len] = 0;
3804         }
3805         /* set new password length */
3806         *pwlen = len + 2;
3807
3808         /*
3809          *      Use the secret to setup the decryption digest
3810          */
3811         secretlen = strlen(secret);
3812         memcpy(buffer, secret, secretlen);
3813
3814         for (n2 = 0; n2 < len; n2+=AUTH_PASS_LEN) {
3815                 if (!n2) {
3816                         memcpy(buffer + secretlen, vector, AUTH_VECTOR_LEN);
3817                         memcpy(buffer + secretlen + AUTH_VECTOR_LEN, salt, 2);
3818                         fr_md5_calc(digest, buffer, secretlen + AUTH_VECTOR_LEN + 2);
3819                 } else {
3820                         memcpy(buffer + secretlen, passwd + n2 - AUTH_PASS_LEN, AUTH_PASS_LEN);
3821                         fr_md5_calc(digest, buffer, secretlen + AUTH_PASS_LEN);
3822                 }
3823
3824                 for (i = 0; i < AUTH_PASS_LEN; i++) {
3825                         passwd[i + n2] ^= digest[i];
3826                 }
3827         }
3828         passwd[n2] = 0;
3829         return 0;
3830 }
3831
3832 /*
3833  *      Decode Tunnel-Password encrypted attributes.
3834  *
3835  *      Defined in RFC-2868, this uses a two char SALT along with the
3836  *      initial intermediate value, to differentiate it from the
3837  *      above.
3838  */
3839 int rad_tunnel_pwdecode(uint8_t *passwd, size_t *pwlen, const char *secret,
3840                         const uint8_t *vector)
3841 {
3842         FR_MD5_CTX  context, old;
3843         uint8_t         digest[AUTH_VECTOR_LEN];
3844         int             secretlen;
3845         unsigned        i, n, len, reallen;
3846
3847         len = *pwlen;
3848
3849         /*
3850          *      We need at least a salt.
3851          */
3852         if (len < 2) {
3853                 fr_strerror_printf("tunnel password is too short");
3854                 return -1;
3855         }
3856
3857         /*
3858          *      There's a salt, but no password.  Or, there's a salt
3859          *      and a 'data_len' octet.  It's wrong, but at least we
3860          *      can figure out what it means: the password is empty.
3861          *
3862          *      Note that this means we ignore the 'data_len' field,
3863          *      if the attribute length tells us that there's no
3864          *      more data.  So the 'data_len' field may be wrong,
3865          *      but that's ok...
3866          */
3867         if (len <= 3) {
3868                 passwd[0] = 0;
3869                 *pwlen = 0;
3870                 return 0;
3871         }
3872
3873         len -= 2;               /* discount the salt */
3874
3875         /*
3876          *      Use the secret to setup the decryption digest
3877          */
3878         secretlen = strlen(secret);
3879
3880         fr_MD5Init(&context);
3881         fr_MD5Update(&context, (const uint8_t *) secret, secretlen);
3882         old = context;          /* save intermediate work */
3883
3884         /*
3885          *      Set up the initial key:
3886          *
3887          *       b(1) = MD5(secret + vector + salt)
3888          */
3889         fr_MD5Update(&context, vector, AUTH_VECTOR_LEN);
3890         fr_MD5Update(&context, passwd, 2);
3891
3892         reallen = 0;
3893         for (n = 0; n < len; n += AUTH_PASS_LEN) {
3894                 int base = 0;
3895
3896                 if (n == 0) {
3897                         fr_MD5Final(digest, &context);
3898
3899                         context = old;
3900
3901                         /*
3902                          *      A quick check: decrypt the first octet
3903                          *      of the password, which is the
3904                          *      'data_len' field.  Ensure it's sane.
3905                          */
3906                         reallen = passwd[2] ^ digest[0];
3907                         if (reallen >= len) {
3908                                 fr_strerror_printf("tunnel password is too long for the attribute");
3909                                 return -1;
3910                         }
3911
3912                         fr_MD5Update(&context, passwd + 2, AUTH_PASS_LEN);
3913
3914                         base = 1;
3915                 } else {
3916                         fr_MD5Final(digest, &context);
3917
3918                         context = old;
3919                         fr_MD5Update(&context, passwd + n + 2, AUTH_PASS_LEN);
3920                 }
3921
3922                 for (i = base; i < AUTH_PASS_LEN; i++) {
3923                         passwd[n + i - 1] = passwd[n + i + 2] ^ digest[i];
3924                 }
3925         }
3926
3927         /*
3928          *      See make_tunnel_password, above.
3929          */
3930         if (reallen > 239) reallen = 239;
3931
3932         *pwlen = reallen;
3933         passwd[reallen] = 0;
3934
3935         return reallen;
3936 }
3937
3938 /*
3939  *      Encode a CHAP password
3940  *
3941  *      FIXME: might not work with Ascend because
3942  *      we use vp->length, and Ascend gear likes
3943  *      to send an extra '\0' in the string!
3944  */
3945 int rad_chap_encode(RADIUS_PACKET *packet, uint8_t *output, int id,
3946                     VALUE_PAIR *password)
3947 {
3948         int             i;
3949         uint8_t         *ptr;
3950         uint8_t         string[MAX_STRING_LEN * 2 + 1];
3951         VALUE_PAIR      *challenge;
3952
3953         /*
3954          *      Sanity check the input parameters
3955          */
3956         if ((packet == NULL) || (password == NULL)) {
3957                 return -1;
3958         }
3959
3960         /*
3961          *      Note that the password VP can be EITHER
3962          *      a User-Password attribute (from a check-item list),
3963          *      or a CHAP-Password attribute (the client asking
3964          *      the library to encode it).
3965          */
3966
3967         i = 0;
3968         ptr = string;
3969         *ptr++ = id;
3970
3971         i++;
3972         memcpy(ptr, password->vp_strvalue, password->length);
3973         ptr += password->length;
3974         i += password->length;
3975
3976         /*
3977          *      Use Chap-Challenge pair if present,
3978          *      Request-Authenticator otherwise.
3979          */
3980         challenge = pairfind(packet->vps, PW_CHAP_CHALLENGE, 0);
3981         if (challenge) {
3982                 memcpy(ptr, challenge->vp_strvalue, challenge->length);
3983                 i += challenge->length;
3984         } else {
3985                 memcpy(ptr, packet->vector, AUTH_VECTOR_LEN);
3986                 i += AUTH_VECTOR_LEN;
3987         }
3988
3989         *output = id;
3990         fr_md5_calc((uint8_t *)output + 1, (uint8_t *)string, i);
3991
3992         return 0;
3993 }
3994
3995
3996 /*
3997  *      Seed the random number generator.
3998  *
3999  *      May be called any number of times.
4000  */
4001 void fr_rand_seed(const void *data, size_t size)
4002 {
4003         uint32_t hash;
4004
4005         /*
4006          *      Ensure that the pool is initialized.
4007          */
4008         if (!fr_rand_initialized) {
4009                 int fd;
4010
4011                 memset(&fr_rand_pool, 0, sizeof(fr_rand_pool));
4012
4013                 fd = open("/dev/urandom", O_RDONLY);
4014                 if (fd >= 0) {
4015                         size_t total;
4016                         ssize_t this;
4017
4018                         total = 0;
4019                         while (total < sizeof(fr_rand_pool.randrsl)) {
4020                                 this = read(fd, fr_rand_pool.randrsl,
4021                                             sizeof(fr_rand_pool.randrsl) - total);
4022                                 if ((this < 0) && (errno != EINTR)) break;
4023                                 if (this > 0) total += this;
4024                         }
4025                         close(fd);
4026                 } else {
4027                         fr_rand_pool.randrsl[0] = fd;
4028                         fr_rand_pool.randrsl[1] = time(NULL);
4029                         fr_rand_pool.randrsl[2] = errno;
4030                 }
4031
4032                 fr_randinit(&fr_rand_pool, 1);
4033                 fr_rand_pool.randcnt = 0;
4034                 fr_rand_initialized = 1;
4035         }
4036
4037         if (!data) return;
4038
4039         /*
4040          *      Hash the user data
4041          */
4042         hash = fr_rand();
4043         if (!hash) hash = fr_rand();
4044         hash = fr_hash_update(data, size, hash);
4045
4046         fr_rand_pool.randmem[fr_rand_pool.randcnt] ^= hash;
4047 }
4048
4049
4050 /*
4051  *      Return a 32-bit random number.
4052  */
4053 uint32_t fr_rand(void)
4054 {
4055         uint32_t num;
4056
4057         /*
4058          *      Ensure that the pool is initialized.
4059          */
4060         if (!fr_rand_initialized) {
4061                 fr_rand_seed(NULL, 0);
4062         }
4063
4064         num = fr_rand_pool.randrsl[fr_rand_pool.randcnt++];
4065         if (fr_rand_pool.randcnt >= 256) {
4066                 fr_rand_pool.randcnt = 0;
4067                 fr_isaac(&fr_rand_pool);
4068         }
4069
4070         return num;
4071 }
4072
4073
4074 /*
4075  *      Allocate a new RADIUS_PACKET
4076  */
4077 RADIUS_PACKET *rad_alloc(int newvector)
4078 {
4079         RADIUS_PACKET   *rp;
4080
4081         if ((rp = malloc(sizeof(RADIUS_PACKET))) == NULL) {
4082                 fr_strerror_printf("out of memory");
4083                 return NULL;
4084         }
4085         memset(rp, 0, sizeof(*rp));
4086         rp->id = -1;
4087         rp->offset = -1;
4088
4089         if (newvector) {
4090                 int i;
4091                 uint32_t hash, base;
4092
4093                 /*
4094                  *      Don't expose the actual contents of the random
4095                  *      pool.
4096                  */
4097                 base = fr_rand();
4098                 for (i = 0; i < AUTH_VECTOR_LEN; i += sizeof(uint32_t)) {
4099                         hash = fr_rand() ^ base;
4100                         memcpy(rp->vector + i, &hash, sizeof(hash));
4101                 }
4102         }
4103         fr_rand();              /* stir the pool again */
4104
4105         return rp;
4106 }
4107
4108 RADIUS_PACKET *rad_alloc_reply(RADIUS_PACKET *packet)
4109 {
4110         RADIUS_PACKET *reply;
4111
4112         if (!packet) return NULL;
4113
4114         reply = rad_alloc(0);
4115         if (!reply) return NULL;
4116
4117         /*
4118          *      Initialize the fields from the request.
4119          */
4120         reply->sockfd = packet->sockfd;
4121         reply->dst_ipaddr = packet->src_ipaddr;
4122         reply->src_ipaddr = packet->dst_ipaddr;
4123         reply->dst_port = packet->src_port;
4124         reply->src_port = packet->dst_port;
4125         reply->id = packet->id;
4126         reply->code = 0; /* UNKNOWN code */
4127         memcpy(reply->vector, packet->vector,
4128                sizeof(reply->vector));
4129         reply->vps = NULL;
4130         reply->data = NULL;
4131         reply->data_len = 0;
4132
4133         return reply;
4134 }
4135
4136
4137 /*
4138  *      Free a RADIUS_PACKET
4139  */
4140 void rad_free(RADIUS_PACKET **radius_packet_ptr)
4141 {
4142         RADIUS_PACKET *radius_packet;
4143
4144         if (!radius_packet_ptr || !*radius_packet_ptr) return;
4145         radius_packet = *radius_packet_ptr;
4146
4147         free(radius_packet->data);
4148
4149         pairfree(&radius_packet->vps);
4150
4151         free(radius_packet);
4152
4153         *radius_packet_ptr = NULL;
4154 }