[Midnightbsd-cvs] src [7525] trunk/sys/net/rtsock.c: Fill sin6_scope_id in sockaddr_in6 before passing it from the kernel to

[laffer1 at midnightbsd.org]

Revision: 7525
          http://svnweb.midnightbsd.org/src/?rev=7525
Author:   laffer1
Date:     2016-04-14 07:32:56 -0400 (Thu, 14 Apr 2016)
Log Message:
-----------
Fill sin6_scope_id in sockaddr_in6 before passing it from the kernel to
userland via routing socket or sysctl.  This eliminates the following
KAME-specific sin6_scope_id handling routine from each userland utility:

 sin6.sin6_scope_id = ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);

This behavior can be controlled by net.inet6.ip6.deembed_scopeid.  This is
set to 1 by default (sin6_scope_id will be filled in the kernel).

Obtained from:	FreeBSD svn rev 243187

Revision Links:
--------------
    http://svnweb.midnightbsd.org/src/?rev=243187

Modified Paths:
--------------
    trunk/sys/net/rtsock.c

Modified: trunk/sys/net/rtsock.c
===================================================================
--- trunk/sys/net/rtsock.c	2016-04-14 11:27:50 UTC (rev 7524)
+++ trunk/sys/net/rtsock.c	2016-04-14 11:32:56 UTC (rev 7525)
@@ -170,7 +170,15 @@
 #define	RTSOCK_UNLOCK()	mtx_unlock(&rtsock_mtx)
 #define	RTSOCK_LOCK_ASSERT()	mtx_assert(&rtsock_mtx, MA_OWNED)
 
-SYSCTL_NODE(_net, OID_AUTO, route, CTLFLAG_RD, 0, "");
+static SYSCTL_NODE(_net, OID_AUTO, route, CTLFLAG_RD, 0, "");
+#ifdef INET6
+static VNET_DEFINE(int, deembed_scopeid) = 1;
+#define        V_deembed_scopeid       VNET(deembed_scopeid)
+SYSCTL_DECL(_net_inet6_ip6);
+SYSCTL_VNET_INT(_net_inet6_ip6, OID_AUTO, deembed_scopeid, CTLFLAG_RW,
+    &VNET_NAME(deembed_scopeid), 0,
+    "Extract embedded zone ID and set it to sin6_scope_id in sockaddr_in6.");
+#endif
 
 struct walkarg {
 	int	w_tmemsize;
@@ -569,6 +577,11 @@
 	struct rtentry *rt = NULL;
 	struct radix_node_head *rnh;
 	struct rt_addrinfo info;
+#ifdef INET6
+	struct sockaddr_storage ss_dst;
+	struct sockaddr_storage ss_gw;
+	struct sockaddr_in6 *sin6;
+#endif
 	int len, error = 0;
 	struct ifnet *ifp = NULL;
 	union sockaddr_union saun;
@@ -796,7 +809,31 @@
 				senderr(ESRCH);
 			}
 			info.rti_info[RTAX_DST] = rt_key(rt);
+#ifdef INET6
+			switch (rt_key(rt)->sa_family) {
+			case AF_INET6:
+				if (V_deembed_scopeid == 0)
+					break;
+				sin6 = (struct sockaddr_in6 *)&ss_dst;
+				bcopy(rt_key(rt), sin6, sizeof(*sin6));
+				if (sa6_recoverscope(sin6) == 0)
+					info.rti_info[RTAX_DST] =
+					    (struct sockaddr *)sin6;
+				break;
+			}
+#endif
 			info.rti_info[RTAX_GATEWAY] = rt->rt_gateway;
+#ifdef INET6
+			switch (rt->rt_gateway->sa_family) {
+			case AF_INET6:
+				sin6 = (struct sockaddr_in6 *)&ss_gw;
+				bcopy(rt->rt_gateway, sin6, sizeof(*sin6));
+				if (sa6_recoverscope(sin6) == 0)
+					info.rti_info[RTAX_GATEWAY] =
+					    (struct sockaddr *)sin6;
+				break;
+			}
+#endif
 			info.rti_info[RTAX_NETMASK] = rt_mask(rt);
 			info.rti_info[RTAX_GENMASK] = 0;
 			if (rtm->rtm_addrs & (RTA_IFP | RTA_IFA)) {
@@ -1047,6 +1084,10 @@
 	struct mbuf *m;
 	int i;
 	struct sockaddr *sa;
+#ifdef INET6
+	struct sockaddr_storage ss;
+	struct sockaddr_in6 *sin6;
+#endif
 	int len, dlen;
 
 	switch (type) {
@@ -1094,6 +1135,18 @@
 			continue;
 		rtinfo->rti_addrs |= (1 << i);
 		dlen = SA_SIZE(sa);
+#ifdef INET6
+		switch (sa->sa_family) {
+		case AF_INET6:
+			if (V_deembed_scopeid == 0)
+				break;
+			sin6 = (struct sockaddr_in6 *)&ss;
+			bcopy(sa, sin6, sizeof(*sin6));
+			if (sa6_recoverscope(sin6) == 0)
+				sa = (struct sockaddr *)sin6;
+			break;
+		}
+#endif
 		m_copyback(m, len, dlen, (caddr_t)sa);
 		len += dlen;
 	}
@@ -1116,6 +1169,10 @@
 	int i;
 	int len, dlen, second_time = 0;
 	caddr_t cp0;
+#ifdef INET6
+	struct sockaddr_storage ss;
+	struct sockaddr_in6 *sin6;
+#endif
 
 	rtinfo->rti_addrs = 0;
 again:
@@ -1167,6 +1224,18 @@
 			continue;
 		rtinfo->rti_addrs |= (1 << i);
 		dlen = SA_SIZE(sa);
+#ifdef INET6
+		switch (sa->sa_family) {
+		case AF_INET6:
+			if (V_deembed_scopeid == 0)
+				break;
+			sin6 = (struct sockaddr_in6 *)&ss;
+			bcopy(sa, sin6, sizeof(*sin6));
+			if (sa6_recoverscope(sin6) == 0)
+				sa = (struct sockaddr *)sin6;
+			break;
+		}
+#endif
 		if (cp) {
 			bcopy((caddr_t)sa, cp, (unsigned)dlen);
 			cp += dlen;
@@ -1507,6 +1576,11 @@
 	struct rtentry *rt = (struct rtentry *)rn;
 	int error = 0, size;
 	struct rt_addrinfo info;
+#ifdef INET6
+	struct sockaddr_storage ss[RTAX_MAX];
+	struct sockaddr_in6 *sin6;
+#endif
+	int i;
 
 	if (w->w_op == NET_RT_FLAGS && !(rt->rt_flags & w->w_arg))
 		return 0;
@@ -1525,6 +1599,22 @@
 		if (rt->rt_ifp->if_flags & IFF_POINTOPOINT)
 			info.rti_info[RTAX_BRD] = rt->rt_ifa->ifa_dstaddr;
 	}
+#ifdef INET6
+	for (i = 0; i < RTAX_MAX; i++) {
+		if (info.rti_info[i] == NULL)
+			continue;
+		switch (info.rti_info[i]->sa_family) {
+		case AF_INET6:
+			if (V_deembed_scopeid == 0)
+				break;
+			sin6 = (struct sockaddr_in6 *)&ss[i];
+			bcopy(info.rti_info[i], sin6, sizeof(*sin6));
+			if (sa6_recoverscope(sin6) == 0)
+				info.rti_info[i] = (struct sockaddr *)sin6;
+			break;
+		}
+	}
+#endif
 	size = rt_msg2(RTM_GET, &info, NULL, w);
 	if (w->w_req && w->w_tmem) {
 		struct rt_msghdr *rtm = (struct rt_msghdr *)w->w_tmem;