2 * Copyright (c) 2001 Brian Somers <brian@Awfulhak.org>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include <sys/types.h>
30 #include <sys/socket.h>
32 #include <net/if_types.h>
33 #include <net/route.h>
35 #include <netinet/in.h>
36 #include <netinet/in_systm.h>
37 #include <netinet/ip.h>
38 #include <arpa/inet.h>
52 #include "slcompress.h"
54 #include "throughput.h"
57 #include "descriptor.h"
69 #define ncprange_ip4addr u.ip4.ipaddr
70 #define ncprange_ip4mask u.ip4.mask
71 #define ncprange_ip4width u.ip4.width
72 #define ncpaddr_ip4addr u.ip4addr
74 #define ncprange_ip6addr u.ip6.ipaddr
75 #define ncprange_ip6width u.ip6.width
76 #define ncpaddr_ip6addr u.ip6addr
79 #define NCP_ASCIIBUFFERSIZE 52
84 struct in_addr result;
85 u_int32_t bit = 0x80000000;
95 result.s_addr = htonl(result.s_addr);
100 mask42bits(struct in_addr mask)
102 u_int32_t msk = ntohl(mask.s_addr);
106 for (ret = 32, tst = 1; tst; ret--, tst <<= 1)
110 for (tst <<= 1; tst; tst <<= 1)
114 return tst ? -1 : ret;
118 static struct in6_addr
121 struct in6_addr result;
122 u_int32_t bit = 0x80;
123 u_char *c = result.s6_addr;
125 memset(&result, '\0', sizeof result);
141 mask62bits(const struct in6_addr *mask)
143 const u_char masks[] = { 0x00, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe };
144 const u_char *c, *p, *end;
147 p = (const u_char *)mask;
148 for (masklen = 0, end = p + 16; p < end && *p == 0xff; p++)
152 for (c = masks; c < masks + sizeof masks; c++)
154 masklen += c - masks;
163 adjust_linklocal(struct sockaddr_in6 *sin6)
165 /* XXX: ?????!?!?!!!!! This is horrible ! */
166 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr) ||
167 IN6_IS_ADDR_MC_LINKLOCAL(&sin6->sin6_addr)) {
168 sin6->sin6_scope_id =
169 ntohs(*(u_short *)&sin6->sin6_addr.s6_addr[2]);
170 *(u_short *)&sin6->sin6_addr.s6_addr[2] = 0;
176 ncpaddr_init(struct ncpaddr *addr)
178 addr->ncpaddr_family = AF_UNSPEC;
182 ncpaddr_isset(const struct ncpaddr *addr)
184 return addr->ncpaddr_family != AF_UNSPEC;
188 ncpaddr_isdefault(const struct ncpaddr *addr)
190 switch (addr->ncpaddr_family) {
192 if (addr->ncpaddr_ip4addr.s_addr == INADDR_ANY)
198 if (IN6_IS_ADDR_UNSPECIFIED(&addr->ncpaddr_ip6addr))
208 ncpaddr_equal(const struct ncpaddr *addr, const struct ncpaddr *cmp)
210 if (addr->ncpaddr_family != cmp->ncpaddr_family)
213 switch (addr->ncpaddr_family) {
215 return addr->ncpaddr_ip4addr.s_addr == cmp->ncpaddr_ip4addr.s_addr;
219 return !memcmp(&addr->ncpaddr_ip6addr, &cmp->ncpaddr_ip6addr,
220 sizeof addr->ncpaddr_ip6addr);
231 ncpaddr_copy(struct ncpaddr *addr, const struct ncpaddr *from)
233 switch (from->ncpaddr_family) {
235 addr->ncpaddr_family = AF_INET;
236 addr->ncpaddr_ip4addr = from->ncpaddr_ip4addr;
240 addr->ncpaddr_family = AF_INET6;
241 addr->ncpaddr_ip6addr = from->ncpaddr_ip6addr;
245 addr->ncpaddr_family = AF_UNSPEC;
250 ncpaddr_setip4addr(struct ncpaddr *addr, u_int32_t ip)
252 addr->ncpaddr_family = AF_INET;
253 addr->ncpaddr_ip4addr.s_addr = ip;
257 ncpaddr_getip4addr(const struct ncpaddr *addr, u_int32_t *ip)
259 if (addr->ncpaddr_family != AF_INET)
261 *ip = addr->ncpaddr_ip4addr.s_addr;
266 ncpaddr_setip4(struct ncpaddr *addr, struct in_addr ip)
268 addr->ncpaddr_family = AF_INET;
269 addr->ncpaddr_ip4addr = ip;
273 ncpaddr_getip4(const struct ncpaddr *addr, struct in_addr *ip)
275 if (addr->ncpaddr_family != AF_INET)
277 *ip = addr->ncpaddr_ip4addr;
283 ncpaddr_setip6(struct ncpaddr *addr, const struct in6_addr *ip6)
285 addr->ncpaddr_family = AF_INET6;
286 addr->ncpaddr_ip6addr = *ip6;
290 ncpaddr_getip6(const struct ncpaddr *addr, struct in6_addr *ip6)
292 if (addr->ncpaddr_family != AF_INET6)
294 *ip6 = addr->ncpaddr_ip6addr;
300 ncpaddr_getsa(const struct ncpaddr *addr, struct sockaddr_storage *host)
302 struct sockaddr_in *host4 = (struct sockaddr_in *)host;
304 struct sockaddr_in6 *host6 = (struct sockaddr_in6 *)host;
307 memset(host, '\0', sizeof(*host));
309 switch (addr->ncpaddr_family) {
311 host4->sin_family = AF_INET;
312 host4->sin_len = sizeof(*host4);
313 host4->sin_addr = addr->ncpaddr_ip4addr;
318 host6->sin6_family = AF_INET6;
319 host6->sin6_len = sizeof(*host6);
320 host6->sin6_addr = addr->ncpaddr_ip6addr;
325 host->ss_family = AF_UNSPEC;
331 ncpaddr_setsa(struct ncpaddr *addr, const struct sockaddr *host)
333 const struct sockaddr_in *host4 = (const struct sockaddr_in *)host;
335 const struct sockaddr_in6 *host6 = (const struct sockaddr_in6 *)host;
338 switch (host->sa_family) {
340 addr->ncpaddr_family = AF_INET;
341 addr->ncpaddr_ip4addr = host4->sin_addr;
346 if (IN6_IS_ADDR_V4MAPPED(&host6->sin6_addr)) {
347 addr->ncpaddr_family = AF_INET;
348 addr->ncpaddr_ip4addr.s_addr =
349 *(const u_int32_t *)(host6->sin6_addr.s6_addr + 12);
351 addr->ncpaddr_family = AF_INET6;
352 addr->ncpaddr_ip6addr = host6->sin6_addr;
358 addr->ncpaddr_family = AF_UNSPEC;
363 ncpaddr_ntowa(const struct ncpaddr *addr)
365 static char res[NCP_ASCIIBUFFERSIZE];
367 struct sockaddr_in6 sin6;
370 switch (addr->ncpaddr_family) {
372 snprintf(res, sizeof res, "%s", inet_ntoa(addr->ncpaddr_ip4addr));
377 memset(&sin6, '\0', sizeof(sin6));
378 sin6.sin6_len = sizeof(sin6);
379 sin6.sin6_family = AF_INET6;
380 sin6.sin6_addr = addr->ncpaddr_ip6addr;
381 adjust_linklocal(&sin6);
382 if (getnameinfo((struct sockaddr *)&sin6, sizeof sin6, res, sizeof(res),
383 NULL, 0, NI_WITHSCOPEID | NI_NUMERICHOST) != 0)
390 snprintf(res, sizeof res, "<AF_UNSPEC>");
395 ncpaddr_ntoa(const struct ncpaddr *addr)
397 return ncpaddr_ntowa(addr);
402 ncpaddr_aton(struct ncpaddr *addr, struct ncp *ncp, const char *data)
404 struct ncprange range;
406 if (!ncprange_aton(&range, ncp, data))
409 if (range.ncprange_family == AF_INET && range.ncprange_ip4width != 32) {
410 log_Printf(LogWARN, "ncpaddr_aton: %s: Only 32 bits allowed\n", data);
415 if (range.ncprange_family == AF_INET6 && range.ncprange_ip6width != 128) {
416 log_Printf(LogWARN, "ncpaddr_aton: %s: Only 128 bits allowed\n", data);
421 switch (range.ncprange_family) {
423 addr->ncpaddr_family = range.ncprange_family;
424 addr->ncpaddr_ip4addr = range.ncprange_ip4addr;
429 addr->ncpaddr_family = range.ncprange_family;
430 addr->ncpaddr_ip6addr = range.ncprange_ip6addr;
439 ncprange_init(struct ncprange *range)
441 range->ncprange_family = AF_UNSPEC;
445 ncprange_isset(const struct ncprange *range)
447 return range->ncprange_family != AF_UNSPEC;
451 ncprange_equal(const struct ncprange *range, const struct ncprange *cmp)
453 if (range->ncprange_family != cmp->ncprange_family)
456 switch (range->ncprange_family) {
458 if (range->ncprange_ip4addr.s_addr != cmp->ncprange_ip4addr.s_addr)
460 return range->ncprange_ip4mask.s_addr == cmp->ncprange_ip4mask.s_addr;
464 if (range->ncprange_ip6width != cmp->ncprange_ip6width)
466 return !memcmp(&range->ncprange_ip6addr, &cmp->ncprange_ip6addr,
467 sizeof range->ncprange_ip6addr);
478 ncprange_isdefault(const struct ncprange *range)
480 switch (range->ncprange_family) {
482 if (range->ncprange_ip4addr.s_addr == INADDR_ANY)
488 if (range->ncprange_ip6width == 0 &&
489 IN6_IS_ADDR_UNSPECIFIED(&range->ncprange_ip6addr))
499 ncprange_setdefault(struct ncprange *range, int af)
501 memset(range, '\0', sizeof *range);
502 range->ncprange_family = af;
506 ncprange_contains(const struct ncprange *range, const struct ncpaddr *addr)
509 const u_char masks[] = { 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe, 0xff };
510 const u_char *addrp, *rangep;
514 if (range->ncprange_family != addr->ncpaddr_family)
517 switch (range->ncprange_family) {
519 return !((addr->ncpaddr_ip4addr.s_addr ^ range->ncprange_ip4addr.s_addr) &
520 range->ncprange_ip4mask.s_addr);
524 rangep = (const u_char *)range->ncprange_ip6addr.s6_addr;
525 addrp = (const u_char *)addr->ncpaddr_ip6addr.s6_addr;
527 for (bits = range->ncprange_ip6width; bits > 0; bits -= 8)
528 if ((*addrp++ ^ *rangep++) & masks[bits > 7 ? 7 : bits - 1])
539 ncprange_containsip4(const struct ncprange *range, struct in_addr addr)
541 switch (range->ncprange_family) {
543 return !((addr.s_addr ^ range->ncprange_ip4addr.s_addr) &
544 range->ncprange_ip4mask.s_addr);
551 ncprange_copy(struct ncprange *range, const struct ncprange *from)
553 switch (from->ncprange_family) {
555 range->ncprange_family = AF_INET;
556 range->ncprange_ip4addr = from->ncprange_ip4addr;
557 range->ncprange_ip4mask = from->ncprange_ip4mask;
558 range->ncprange_ip4width = from->ncprange_ip4width;
563 range->ncprange_family = AF_INET6;
564 range->ncprange_ip6addr = from->ncprange_ip6addr;
565 range->ncprange_ip6width = from->ncprange_ip6width;
570 range->ncprange_family = AF_UNSPEC;
575 ncprange_set(struct ncprange *range, const struct ncpaddr *addr, int width)
577 ncprange_sethost(range, addr);
578 ncprange_setwidth(range, width);
582 ncprange_sethost(struct ncprange *range, const struct ncpaddr *from)
584 switch (from->ncpaddr_family) {
586 range->ncprange_family = AF_INET;
587 range->ncprange_ip4addr = from->ncpaddr_ip4addr;
588 if (from->ncpaddr_ip4addr.s_addr == INADDR_ANY) {
589 range->ncprange_ip4mask.s_addr = INADDR_ANY;
590 range->ncprange_ip4width = 0;
592 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
593 range->ncprange_ip4width = 32;
599 range->ncprange_family = AF_INET6;
600 range->ncprange_ip6addr = from->ncpaddr_ip6addr;
601 range->ncprange_ip6width = 128;
606 range->ncprange_family = AF_UNSPEC;
611 ncprange_ishost(const struct ncprange *range)
613 switch (range->ncprange_family) {
615 return range->ncprange_ip4width == 32;
618 return range->ncprange_ip6width == 128;
626 ncprange_setwidth(struct ncprange *range, int width)
628 switch (range->ncprange_family) {
630 if (width < 0 || width > 32)
632 range->ncprange_ip4width = width;
633 range->ncprange_ip4mask = bits2mask4(width);
638 if (width < 0 || width > 128)
640 range->ncprange_ip6width = width;
652 ncprange_setip4host(struct ncprange *range, struct in_addr from)
654 range->ncprange_family = AF_INET;
655 range->ncprange_ip4addr = from;
656 if (from.s_addr == INADDR_ANY) {
657 range->ncprange_ip4mask.s_addr = INADDR_ANY;
658 range->ncprange_ip4width = 0;
660 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
661 range->ncprange_ip4width = 32;
666 ncprange_setip4(struct ncprange *range, struct in_addr from, struct in_addr msk)
668 range->ncprange_family = AF_INET;
669 range->ncprange_ip4addr = from;
670 range->ncprange_ip4mask = msk;
671 range->ncprange_ip4width = mask42bits(msk);
676 ncprange_setip4mask(struct ncprange *range, struct in_addr mask)
678 if (range->ncprange_family != AF_INET)
680 range->ncprange_ip4mask = mask;
681 range->ncprange_ip4width = mask42bits(mask);
686 ncprange_setsa(struct ncprange *range, const struct sockaddr *host,
687 const struct sockaddr *mask)
689 const struct sockaddr_in *host4 = (const struct sockaddr_in *)host;
690 const struct sockaddr_in *mask4 = (const struct sockaddr_in *)mask;
692 const struct sockaddr_in6 *host6 = (const struct sockaddr_in6 *)host;
693 const struct sockaddr_in6 *mask6 = (const struct sockaddr_in6 *)mask;
696 switch (host->sa_family) {
698 range->ncprange_family = AF_INET;
699 range->ncprange_ip4addr = host4->sin_addr;
700 if (host4->sin_addr.s_addr == INADDR_ANY) {
701 range->ncprange_ip4mask.s_addr = INADDR_ANY;
702 range->ncprange_ip4width = 0;
703 } else if (mask4 && mask4->sin_family == AF_INET) {
704 range->ncprange_ip4mask.s_addr = mask4->sin_addr.s_addr;
705 range->ncprange_ip4width = mask42bits(mask4->sin_addr);
707 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
708 range->ncprange_ip4width = 32;
714 range->ncprange_family = AF_INET6;
715 range->ncprange_ip6addr = host6->sin6_addr;
716 range->ncprange_ip6width = mask6 ? mask62bits(&mask6->sin6_addr) : 128;
721 range->ncprange_family = AF_UNSPEC;
726 ncprange_getsa(const struct ncprange *range, struct sockaddr_storage *host,
727 struct sockaddr_storage *mask)
729 struct sockaddr_in *host4 = (struct sockaddr_in *)host;
730 struct sockaddr_in *mask4 = (struct sockaddr_in *)mask;
732 struct sockaddr_in6 *host6 = (struct sockaddr_in6 *)host;
733 struct sockaddr_in6 *mask6 = (struct sockaddr_in6 *)mask;
736 memset(host, '\0', sizeof(*host));
738 memset(mask, '\0', sizeof(*mask));
740 switch (range->ncprange_family) {
742 host4->sin_family = AF_INET;
743 host4->sin_len = sizeof(*host4);
744 host4->sin_addr = range->ncprange_ip4addr;
746 mask4->sin_family = AF_INET;
747 mask4->sin_len = sizeof(*host4);
748 mask4->sin_addr = range->ncprange_ip4mask;
754 host6->sin6_family = AF_INET6;
755 host6->sin6_len = sizeof(*host6);
756 host6->sin6_addr = range->ncprange_ip6addr;
758 mask6->sin6_family = AF_INET6;
759 mask6->sin6_len = sizeof(*host6);
760 mask6->sin6_addr = bits2mask6(range->ncprange_ip6width);
766 host->ss_family = AF_UNSPEC;
768 mask->ss_family = AF_UNSPEC;
774 ncprange_getaddr(const struct ncprange *range, struct ncpaddr *addr)
776 switch (range->ncprange_family) {
778 addr->ncpaddr_family = AF_INET;
779 addr->ncpaddr_ip4addr = range->ncprange_ip4addr;
783 addr->ncpaddr_family = AF_INET6;
784 addr->ncpaddr_ip6addr = range->ncprange_ip6addr;
793 ncprange_getip4addr(const struct ncprange *range, struct in_addr *addr)
795 if (range->ncprange_family != AF_INET)
798 *addr = range->ncprange_ip4addr;
803 ncprange_getip4mask(const struct ncprange *range, struct in_addr *mask)
805 switch (range->ncprange_family) {
807 *mask = range->ncprange_ip4mask;
815 ncprange_getwidth(const struct ncprange *range, int *width)
817 switch (range->ncprange_family) {
819 *width = range->ncprange_ip4width;
823 *width = range->ncprange_ip6width;
832 ncprange_ntoa(const struct ncprange *range)
838 if (!ncprange_getaddr(range, &addr))
839 return "<AF_UNSPEC>";
841 res = ncpaddr_ntowa(&addr);
843 if (len >= NCP_ASCIIBUFFERSIZE - 1)
846 switch (range->ncprange_family) {
848 if (range->ncprange_ip4width == -1) {
849 /* A non-contiguous mask */
850 for (; len >= 3; res[len -= 2] = '\0')
851 if (strcmp(res + len - 2, ".0"))
853 snprintf(res + len, sizeof res - len, "&0x%08lx",
854 (unsigned long)ntohl(range->ncprange_ip4mask.s_addr));
855 } else if (range->ncprange_ip4width < 32)
856 snprintf(res + len, sizeof res - len, "/%d", range->ncprange_ip4width);
862 if (range->ncprange_ip6width != 128)
863 snprintf(res + len, sizeof res - len, "/%d", range->ncprange_ip6width);
869 return "<AF_UNSPEC>";
874 ncprange_scopeid(const struct ncprange *range)
876 const struct in6_addr *sin6;
879 if (range->ncprange_family == AF_INET6) {
880 sin6 = &range->ncprange_ip6addr;
881 if (IN6_IS_ADDR_LINKLOCAL(sin6) || IN6_IS_ADDR_MC_LINKLOCAL(sin6))
882 if ((scopeid = ntohs(*(const u_short *)&sin6->s6_addr[2])) == 0)
891 ncprange_aton(struct ncprange *range, struct ncp *ncp, const char *data)
898 len = strcspn(data, "/");
900 if (ncp && strncasecmp(data, "HISADDR", len) == 0) {
901 range->ncprange_family = AF_INET;
902 range->ncprange_ip4addr = ncp->ipcp.peer_ip;
903 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
904 range->ncprange_ip4width = 32;
907 } else if (ncp && strncasecmp(data, "HISADDR6", len) == 0) {
908 ncprange_sethost(range, &ncp->ipv6cp.hisaddr);
911 } else if (ncp && strncasecmp(data, "MYADDR", len) == 0) {
912 range->ncprange_family = AF_INET;
913 range->ncprange_ip4addr = ncp->ipcp.my_ip;
914 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
915 range->ncprange_ip4width = 32;
918 } else if (ncp && strncasecmp(data, "MYADDR6", len) == 0) {
919 ncprange_sethost(range, &ncp->ipv6cp.myaddr);
922 } else if (ncp && strncasecmp(data, "DNS0", len) == 0) {
923 range->ncprange_family = AF_INET;
924 range->ncprange_ip4addr = ncp->ipcp.ns.dns[0];
925 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
926 range->ncprange_ip4width = 32;
928 } else if (ncp && strncasecmp(data, "DNS1", len) == 0) {
929 range->ncprange_family = AF_INET;
930 range->ncprange_ip4addr = ncp->ipcp.ns.dns[1];
931 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
932 range->ncprange_ip4width = 32;
936 s = (char *)alloca(len + 1);
937 strncpy(s, data, len);
941 if (data[len] != '\0') {
942 bits = strtol(data + len + 1, &wp, 0);
943 if (*wp || wp == data + len + 1 || bits < 0 || bits > 128) {
944 log_Printf(LogWARN, "ncprange_aton: bad mask width.\n");
949 if ((cp = strchr(data, ':')) == NULL) {
950 range->ncprange_family = AF_INET;
952 range->ncprange_ip4addr = GetIpAddr(s);
954 if (range->ncprange_ip4addr.s_addr == INADDR_NONE) {
955 log_Printf(LogWARN, "ncprange_aton: %s: Bad address\n", s);
959 if (range->ncprange_ip4addr.s_addr == INADDR_ANY) {
960 range->ncprange_ip4mask.s_addr = INADDR_ANY;
961 range->ncprange_ip4width = 0;
962 } else if (bits == -1) {
963 range->ncprange_ip4mask.s_addr = INADDR_BROADCAST;
964 range->ncprange_ip4width = 32;
965 } else if (bits > 32) {
966 log_Printf(LogWARN, "ncprange_aton: bad mask width.\n");
969 range->ncprange_ip4mask = bits2mask4(bits);
970 range->ncprange_ip4width = bits;
975 } else if (strchr(cp + 1, ':') != NULL) {
976 range->ncprange_family = AF_INET6;
978 if (inet_pton(AF_INET6, s, &range->ncprange_ip6addr) != 1) {
979 log_Printf(LogWARN, "ncprange_aton: %s: Bad address\n", s);
983 if (IN6_IS_ADDR_UNSPECIFIED(&range->ncprange_ip6addr))
984 range->ncprange_ip6width = 0;
986 range->ncprange_ip6width = (bits == -1) ? 128 : bits;