xref: /openbmc/linux/net/ipv6/datagram.c (revision f95b414e)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *	common UDP/RAW code
31da177e4SLinus Torvalds  *	Linux INET6 implementation
41da177e4SLinus Torvalds  *
51da177e4SLinus Torvalds  *	Authors:
61da177e4SLinus Torvalds  *	Pedro Roque		<roque@di.fc.ul.pt>
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  *	This program is free software; you can redistribute it and/or
91da177e4SLinus Torvalds  *      modify it under the terms of the GNU General Public License
101da177e4SLinus Torvalds  *      as published by the Free Software Foundation; either version
111da177e4SLinus Torvalds  *      2 of the License, or (at your option) any later version.
121da177e4SLinus Torvalds  */
131da177e4SLinus Torvalds 
144fc268d2SRandy Dunlap #include <linux/capability.h>
151da177e4SLinus Torvalds #include <linux/errno.h>
161da177e4SLinus Torvalds #include <linux/types.h>
171da177e4SLinus Torvalds #include <linux/kernel.h>
181da177e4SLinus Torvalds #include <linux/interrupt.h>
191da177e4SLinus Torvalds #include <linux/socket.h>
201da177e4SLinus Torvalds #include <linux/sockios.h>
211da177e4SLinus Torvalds #include <linux/in6.h>
221da177e4SLinus Torvalds #include <linux/ipv6.h>
231da177e4SLinus Torvalds #include <linux/route.h>
245a0e3ad6STejun Heo #include <linux/slab.h>
25a495f836SChris Elston #include <linux/export.h>
261da177e4SLinus Torvalds 
271da177e4SLinus Torvalds #include <net/ipv6.h>
281da177e4SLinus Torvalds #include <net/ndisc.h>
291da177e4SLinus Torvalds #include <net/addrconf.h>
301da177e4SLinus Torvalds #include <net/transp_v6.h>
311da177e4SLinus Torvalds #include <net/ip6_route.h>
32c752f073SArnaldo Carvalho de Melo #include <net/tcp_states.h>
33e7219858SYOSHIFUJI Hideaki / 吉藤英明 #include <net/dsfield.h>
341da177e4SLinus Torvalds 
351da177e4SLinus Torvalds #include <linux/errqueue.h>
361da177e4SLinus Torvalds #include <asm/uaccess.h>
371da177e4SLinus Torvalds 
38a50feda5SEric Dumazet static bool ipv6_mapped_addr_any(const struct in6_addr *a)
39c15fea2dSMax Matveev {
40a50feda5SEric Dumazet 	return ipv6_addr_v4mapped(a) && (a->s6_addr32[3] == 0);
41c15fea2dSMax Matveev }
42c15fea2dSMax Matveev 
431da177e4SLinus Torvalds int ip6_datagram_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len)
441da177e4SLinus Torvalds {
451da177e4SLinus Torvalds 	struct sockaddr_in6	*usin = (struct sockaddr_in6 *) uaddr;
461da177e4SLinus Torvalds 	struct inet_sock	*inet = inet_sk(sk);
471da177e4SLinus Torvalds 	struct ipv6_pinfo	*np = inet6_sk(sk);
4820c59de2SArnaud Ebalard 	struct in6_addr	*daddr, *final_p, final;
491da177e4SLinus Torvalds 	struct dst_entry	*dst;
504c9483b2SDavid S. Miller 	struct flowi6		fl6;
511da177e4SLinus Torvalds 	struct ip6_flowlabel	*flowlabel = NULL;
5220c59de2SArnaud Ebalard 	struct ipv6_txoptions	*opt;
531da177e4SLinus Torvalds 	int			addr_type;
541da177e4SLinus Torvalds 	int			err;
551da177e4SLinus Torvalds 
561da177e4SLinus Torvalds 	if (usin->sin6_family == AF_INET) {
571da177e4SLinus Torvalds 		if (__ipv6_only_sock(sk))
581da177e4SLinus Torvalds 			return -EAFNOSUPPORT;
591da177e4SLinus Torvalds 		err = ip4_datagram_connect(sk, uaddr, addr_len);
601da177e4SLinus Torvalds 		goto ipv4_connected;
611da177e4SLinus Torvalds 	}
621da177e4SLinus Torvalds 
631da177e4SLinus Torvalds 	if (addr_len < SIN6_LEN_RFC2133)
641da177e4SLinus Torvalds 		return -EINVAL;
651da177e4SLinus Torvalds 
661da177e4SLinus Torvalds 	if (usin->sin6_family != AF_INET6)
671da177e4SLinus Torvalds 		return -EAFNOSUPPORT;
681da177e4SLinus Torvalds 
694c9483b2SDavid S. Miller 	memset(&fl6, 0, sizeof(fl6));
701da177e4SLinus Torvalds 	if (np->sndflow) {
714c9483b2SDavid S. Miller 		fl6.flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK;
724c9483b2SDavid S. Miller 		if (fl6.flowlabel&IPV6_FLOWLABEL_MASK) {
734c9483b2SDavid S. Miller 			flowlabel = fl6_sock_lookup(sk, fl6.flowlabel);
741da177e4SLinus Torvalds 			if (flowlabel == NULL)
751da177e4SLinus Torvalds 				return -EINVAL;
761da177e4SLinus Torvalds 		}
771da177e4SLinus Torvalds 	}
781da177e4SLinus Torvalds 
791da177e4SLinus Torvalds 	addr_type = ipv6_addr_type(&usin->sin6_addr);
801da177e4SLinus Torvalds 
811da177e4SLinus Torvalds 	if (addr_type == IPV6_ADDR_ANY) {
821da177e4SLinus Torvalds 		/*
831da177e4SLinus Torvalds 		 *	connect to self
841da177e4SLinus Torvalds 		 */
851da177e4SLinus Torvalds 		usin->sin6_addr.s6_addr[15] = 0x01;
861da177e4SLinus Torvalds 	}
871da177e4SLinus Torvalds 
881da177e4SLinus Torvalds 	daddr = &usin->sin6_addr;
891da177e4SLinus Torvalds 
901da177e4SLinus Torvalds 	if (addr_type == IPV6_ADDR_MAPPED) {
911da177e4SLinus Torvalds 		struct sockaddr_in sin;
921da177e4SLinus Torvalds 
931da177e4SLinus Torvalds 		if (__ipv6_only_sock(sk)) {
941da177e4SLinus Torvalds 			err = -ENETUNREACH;
951da177e4SLinus Torvalds 			goto out;
961da177e4SLinus Torvalds 		}
971da177e4SLinus Torvalds 		sin.sin_family = AF_INET;
981da177e4SLinus Torvalds 		sin.sin_addr.s_addr = daddr->s6_addr32[3];
991da177e4SLinus Torvalds 		sin.sin_port = usin->sin6_port;
1001da177e4SLinus Torvalds 
1011da177e4SLinus Torvalds 		err = ip4_datagram_connect(sk,
1021da177e4SLinus Torvalds 					   (struct sockaddr *) &sin,
1031da177e4SLinus Torvalds 					   sizeof(sin));
1041da177e4SLinus Torvalds 
1051da177e4SLinus Torvalds ipv4_connected:
1061da177e4SLinus Torvalds 		if (err)
1071da177e4SLinus Torvalds 			goto out;
1081da177e4SLinus Torvalds 
109efe4208fSEric Dumazet 		ipv6_addr_set_v4mapped(inet->inet_daddr, &sk->sk_v6_daddr);
1101da177e4SLinus Torvalds 
111c15fea2dSMax Matveev 		if (ipv6_addr_any(&np->saddr) ||
112c15fea2dSMax Matveev 		    ipv6_mapped_addr_any(&np->saddr))
113c720c7e8SEric Dumazet 			ipv6_addr_set_v4mapped(inet->inet_saddr, &np->saddr);
1141da177e4SLinus Torvalds 
115efe4208fSEric Dumazet 		if (ipv6_addr_any(&sk->sk_v6_rcv_saddr) ||
116efe4208fSEric Dumazet 		    ipv6_mapped_addr_any(&sk->sk_v6_rcv_saddr)) {
117c720c7e8SEric Dumazet 			ipv6_addr_set_v4mapped(inet->inet_rcv_saddr,
118efe4208fSEric Dumazet 					       &sk->sk_v6_rcv_saddr);
119719f8358SEric Dumazet 			if (sk->sk_prot->rehash)
120719f8358SEric Dumazet 				sk->sk_prot->rehash(sk);
121719f8358SEric Dumazet 		}
122b301e82cSBrian Haley 
1231da177e4SLinus Torvalds 		goto out;
1241da177e4SLinus Torvalds 	}
1251da177e4SLinus Torvalds 
126842df073SHannes Frederic Sowa 	if (__ipv6_addr_needs_scope_id(addr_type)) {
1271da177e4SLinus Torvalds 		if (addr_len >= sizeof(struct sockaddr_in6) &&
1281da177e4SLinus Torvalds 		    usin->sin6_scope_id) {
1291da177e4SLinus Torvalds 			if (sk->sk_bound_dev_if &&
1301da177e4SLinus Torvalds 			    sk->sk_bound_dev_if != usin->sin6_scope_id) {
1311da177e4SLinus Torvalds 				err = -EINVAL;
1321da177e4SLinus Torvalds 				goto out;
1331da177e4SLinus Torvalds 			}
1341da177e4SLinus Torvalds 			sk->sk_bound_dev_if = usin->sin6_scope_id;
1351da177e4SLinus Torvalds 		}
1361da177e4SLinus Torvalds 
1371ac4f008SBrian Haley 		if (!sk->sk_bound_dev_if && (addr_type & IPV6_ADDR_MULTICAST))
1381ac4f008SBrian Haley 			sk->sk_bound_dev_if = np->mcast_oif;
1391ac4f008SBrian Haley 
1401da177e4SLinus Torvalds 		/* Connect to link-local address requires an interface */
1411da177e4SLinus Torvalds 		if (!sk->sk_bound_dev_if) {
1421da177e4SLinus Torvalds 			err = -EINVAL;
1431da177e4SLinus Torvalds 			goto out;
1441da177e4SLinus Torvalds 		}
1451da177e4SLinus Torvalds 	}
1461da177e4SLinus Torvalds 
147efe4208fSEric Dumazet 	sk->sk_v6_daddr = *daddr;
1484c9483b2SDavid S. Miller 	np->flow_label = fl6.flowlabel;
1491da177e4SLinus Torvalds 
150c720c7e8SEric Dumazet 	inet->inet_dport = usin->sin6_port;
1511da177e4SLinus Torvalds 
1521da177e4SLinus Torvalds 	/*
1531da177e4SLinus Torvalds 	 *	Check for a route to destination an obtain the
1541da177e4SLinus Torvalds 	 *	destination cache for it.
1551da177e4SLinus Torvalds 	 */
1561da177e4SLinus Torvalds 
1574c9483b2SDavid S. Miller 	fl6.flowi6_proto = sk->sk_protocol;
158efe4208fSEric Dumazet 	fl6.daddr = sk->sk_v6_daddr;
1594e3fd7a0SAlexey Dobriyan 	fl6.saddr = np->saddr;
1604c9483b2SDavid S. Miller 	fl6.flowi6_oif = sk->sk_bound_dev_if;
1614c9483b2SDavid S. Miller 	fl6.flowi6_mark = sk->sk_mark;
1621958b856SDavid S. Miller 	fl6.fl6_dport = inet->inet_dport;
1631958b856SDavid S. Miller 	fl6.fl6_sport = inet->inet_sport;
1641da177e4SLinus Torvalds 
1654c9483b2SDavid S. Miller 	if (!fl6.flowi6_oif && (addr_type&IPV6_ADDR_MULTICAST))
1664c9483b2SDavid S. Miller 		fl6.flowi6_oif = np->mcast_oif;
1671da177e4SLinus Torvalds 
1684c9483b2SDavid S. Miller 	security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
169beb8d13bSVenkat Yekkirala 
17020c59de2SArnaud Ebalard 	opt = flowlabel ? flowlabel->opt : np->opt;
1714c9483b2SDavid S. Miller 	final_p = fl6_update_dst(&fl6, opt, &final);
1721da177e4SLinus Torvalds 
1730e0d44abSSteffen Klassert 	dst = ip6_dst_lookup_flow(sk, &fl6, final_p);
17468d0c6d3SDavid S. Miller 	err = 0;
17568d0c6d3SDavid S. Miller 	if (IS_ERR(dst)) {
17668d0c6d3SDavid S. Miller 		err = PTR_ERR(dst);
1771da177e4SLinus Torvalds 		goto out;
17814e50e57SDavid S. Miller 	}
1791da177e4SLinus Torvalds 
1801da177e4SLinus Torvalds 	/* source address lookup done in ip6_dst_lookup */
1811da177e4SLinus Torvalds 
1821da177e4SLinus Torvalds 	if (ipv6_addr_any(&np->saddr))
1834e3fd7a0SAlexey Dobriyan 		np->saddr = fl6.saddr;
1841da177e4SLinus Torvalds 
185efe4208fSEric Dumazet 	if (ipv6_addr_any(&sk->sk_v6_rcv_saddr)) {
186efe4208fSEric Dumazet 		sk->sk_v6_rcv_saddr = fl6.saddr;
187c720c7e8SEric Dumazet 		inet->inet_rcv_saddr = LOOPBACK4_IPV6;
188719f8358SEric Dumazet 		if (sk->sk_prot->rehash)
189719f8358SEric Dumazet 			sk->sk_prot->rehash(sk);
1901da177e4SLinus Torvalds 	}
1911da177e4SLinus Torvalds 
1921da177e4SLinus Torvalds 	ip6_dst_store(sk, dst,
193efe4208fSEric Dumazet 		      ipv6_addr_equal(&fl6.daddr, &sk->sk_v6_daddr) ?
194efe4208fSEric Dumazet 		      &sk->sk_v6_daddr : NULL,
1958e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES
1964c9483b2SDavid S. Miller 		      ipv6_addr_equal(&fl6.saddr, &np->saddr) ?
1978e1ef0a9SYOSHIFUJI Hideaki 		      &np->saddr :
1988e1ef0a9SYOSHIFUJI Hideaki #endif
1998e1ef0a9SYOSHIFUJI Hideaki 		      NULL);
2001da177e4SLinus Torvalds 
2011da177e4SLinus Torvalds 	sk->sk_state = TCP_ESTABLISHED;
202b73c3d0eSTom Herbert 	ip6_set_txhash(sk);
2031da177e4SLinus Torvalds out:
2041da177e4SLinus Torvalds 	fl6_sock_release(flowlabel);
2051da177e4SLinus Torvalds 	return err;
2061da177e4SLinus Torvalds }
207a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_datagram_connect);
2081da177e4SLinus Torvalds 
20982b276cdSHannes Frederic Sowa int ip6_datagram_connect_v6_only(struct sock *sk, struct sockaddr *uaddr,
21082b276cdSHannes Frederic Sowa 				 int addr_len)
21182b276cdSHannes Frederic Sowa {
21282b276cdSHannes Frederic Sowa 	DECLARE_SOCKADDR(struct sockaddr_in6 *, sin6, uaddr);
21382b276cdSHannes Frederic Sowa 	if (sin6->sin6_family != AF_INET6)
21482b276cdSHannes Frederic Sowa 		return -EAFNOSUPPORT;
21582b276cdSHannes Frederic Sowa 	return ip6_datagram_connect(sk, uaddr, addr_len);
21682b276cdSHannes Frederic Sowa }
21782b276cdSHannes Frederic Sowa EXPORT_SYMBOL_GPL(ip6_datagram_connect_v6_only);
21882b276cdSHannes Frederic Sowa 
2191da177e4SLinus Torvalds void ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err,
220e69a4adcSAl Viro 		     __be16 port, u32 info, u8 *payload)
2211da177e4SLinus Torvalds {
2221da177e4SLinus Torvalds 	struct ipv6_pinfo *np  = inet6_sk(sk);
223cc70ab26SArnaldo Carvalho de Melo 	struct icmp6hdr *icmph = icmp6_hdr(skb);
2241da177e4SLinus Torvalds 	struct sock_exterr_skb *serr;
2251da177e4SLinus Torvalds 
2261da177e4SLinus Torvalds 	if (!np->recverr)
2271da177e4SLinus Torvalds 		return;
2281da177e4SLinus Torvalds 
2291da177e4SLinus Torvalds 	skb = skb_clone(skb, GFP_ATOMIC);
2301da177e4SLinus Torvalds 	if (!skb)
2311da177e4SLinus Torvalds 		return;
2321da177e4SLinus Torvalds 
233d40a4de0SBrian Haley 	skb->protocol = htons(ETH_P_IPV6);
234d40a4de0SBrian Haley 
2351da177e4SLinus Torvalds 	serr = SKB_EXT_ERR(skb);
2361da177e4SLinus Torvalds 	serr->ee.ee_errno = err;
2371da177e4SLinus Torvalds 	serr->ee.ee_origin = SO_EE_ORIGIN_ICMP6;
2381da177e4SLinus Torvalds 	serr->ee.ee_type = icmph->icmp6_type;
2391da177e4SLinus Torvalds 	serr->ee.ee_code = icmph->icmp6_code;
2401da177e4SLinus Torvalds 	serr->ee.ee_pad = 0;
2411da177e4SLinus Torvalds 	serr->ee.ee_info = info;
2421da177e4SLinus Torvalds 	serr->ee.ee_data = 0;
243d56f90a7SArnaldo Carvalho de Melo 	serr->addr_offset = (u8 *)&(((struct ipv6hdr *)(icmph + 1))->daddr) -
244d56f90a7SArnaldo Carvalho de Melo 				  skb_network_header(skb);
2451da177e4SLinus Torvalds 	serr->port = port;
2461da177e4SLinus Torvalds 
2471da177e4SLinus Torvalds 	__skb_pull(skb, payload - skb->data);
248bd82393cSArnaldo Carvalho de Melo 	skb_reset_transport_header(skb);
2491da177e4SLinus Torvalds 
2501da177e4SLinus Torvalds 	if (sock_queue_err_skb(sk, skb))
2511da177e4SLinus Torvalds 		kfree_skb(skb);
2521da177e4SLinus Torvalds }
2531da177e4SLinus Torvalds 
2544c9483b2SDavid S. Miller void ipv6_local_error(struct sock *sk, int err, struct flowi6 *fl6, u32 info)
2551da177e4SLinus Torvalds {
2561da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
2571da177e4SLinus Torvalds 	struct sock_exterr_skb *serr;
2581da177e4SLinus Torvalds 	struct ipv6hdr *iph;
2591da177e4SLinus Torvalds 	struct sk_buff *skb;
2601da177e4SLinus Torvalds 
2611da177e4SLinus Torvalds 	if (!np->recverr)
2621da177e4SLinus Torvalds 		return;
2631da177e4SLinus Torvalds 
2641da177e4SLinus Torvalds 	skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC);
2651da177e4SLinus Torvalds 	if (!skb)
2661da177e4SLinus Torvalds 		return;
2671da177e4SLinus Torvalds 
268d40a4de0SBrian Haley 	skb->protocol = htons(ETH_P_IPV6);
269d40a4de0SBrian Haley 
2701ced98e8SArnaldo Carvalho de Melo 	skb_put(skb, sizeof(struct ipv6hdr));
2711ced98e8SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
2720660e03fSArnaldo Carvalho de Melo 	iph = ipv6_hdr(skb);
2734e3fd7a0SAlexey Dobriyan 	iph->daddr = fl6->daddr;
2741da177e4SLinus Torvalds 
2751da177e4SLinus Torvalds 	serr = SKB_EXT_ERR(skb);
2761da177e4SLinus Torvalds 	serr->ee.ee_errno = err;
2771da177e4SLinus Torvalds 	serr->ee.ee_origin = SO_EE_ORIGIN_LOCAL;
2781da177e4SLinus Torvalds 	serr->ee.ee_type = 0;
2791da177e4SLinus Torvalds 	serr->ee.ee_code = 0;
2801da177e4SLinus Torvalds 	serr->ee.ee_pad = 0;
2811da177e4SLinus Torvalds 	serr->ee.ee_info = info;
2821da177e4SLinus Torvalds 	serr->ee.ee_data = 0;
283d56f90a7SArnaldo Carvalho de Melo 	serr->addr_offset = (u8 *)&iph->daddr - skb_network_header(skb);
2841958b856SDavid S. Miller 	serr->port = fl6->fl6_dport;
2851da177e4SLinus Torvalds 
28627a884dcSArnaldo Carvalho de Melo 	__skb_pull(skb, skb_tail_pointer(skb) - skb->data);
287bd82393cSArnaldo Carvalho de Melo 	skb_reset_transport_header(skb);
2881da177e4SLinus Torvalds 
2891da177e4SLinus Torvalds 	if (sock_queue_err_skb(sk, skb))
2901da177e4SLinus Torvalds 		kfree_skb(skb);
2911da177e4SLinus Torvalds }
2921da177e4SLinus Torvalds 
2934c9483b2SDavid S. Miller void ipv6_local_rxpmtu(struct sock *sk, struct flowi6 *fl6, u32 mtu)
2944b340ae2SBrian Haley {
2954b340ae2SBrian Haley 	struct ipv6_pinfo *np = inet6_sk(sk);
2964b340ae2SBrian Haley 	struct ipv6hdr *iph;
2974b340ae2SBrian Haley 	struct sk_buff *skb;
2984b340ae2SBrian Haley 	struct ip6_mtuinfo *mtu_info;
2994b340ae2SBrian Haley 
3004b340ae2SBrian Haley 	if (!np->rxopt.bits.rxpmtu)
3014b340ae2SBrian Haley 		return;
3024b340ae2SBrian Haley 
3034b340ae2SBrian Haley 	skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC);
3044b340ae2SBrian Haley 	if (!skb)
3054b340ae2SBrian Haley 		return;
3064b340ae2SBrian Haley 
3074b340ae2SBrian Haley 	skb_put(skb, sizeof(struct ipv6hdr));
3084b340ae2SBrian Haley 	skb_reset_network_header(skb);
3094b340ae2SBrian Haley 	iph = ipv6_hdr(skb);
3104e3fd7a0SAlexey Dobriyan 	iph->daddr = fl6->daddr;
3114b340ae2SBrian Haley 
3124b340ae2SBrian Haley 	mtu_info = IP6CBMTU(skb);
3134b340ae2SBrian Haley 
3144b340ae2SBrian Haley 	mtu_info->ip6m_mtu = mtu;
3154b340ae2SBrian Haley 	mtu_info->ip6m_addr.sin6_family = AF_INET6;
3164b340ae2SBrian Haley 	mtu_info->ip6m_addr.sin6_port = 0;
3174b340ae2SBrian Haley 	mtu_info->ip6m_addr.sin6_flowinfo = 0;
3184c9483b2SDavid S. Miller 	mtu_info->ip6m_addr.sin6_scope_id = fl6->flowi6_oif;
3194e3fd7a0SAlexey Dobriyan 	mtu_info->ip6m_addr.sin6_addr = ipv6_hdr(skb)->daddr;
3204b340ae2SBrian Haley 
3214b340ae2SBrian Haley 	__skb_pull(skb, skb_tail_pointer(skb) - skb->data);
3224b340ae2SBrian Haley 	skb_reset_transport_header(skb);
3234b340ae2SBrian Haley 
3244b340ae2SBrian Haley 	skb = xchg(&np->rxpmtu, skb);
3254b340ae2SBrian Haley 	kfree_skb(skb);
3264b340ae2SBrian Haley }
3274b340ae2SBrian Haley 
328829ae9d6SWillem de Bruijn static void ip6_datagram_prepare_pktinfo_errqueue(struct sk_buff *skb)
329829ae9d6SWillem de Bruijn {
330829ae9d6SWillem de Bruijn 	int ifindex = skb->dev ? skb->dev->ifindex : -1;
331829ae9d6SWillem de Bruijn 
332829ae9d6SWillem de Bruijn 	if (skb->protocol == htons(ETH_P_IPV6))
333829ae9d6SWillem de Bruijn 		IP6CB(skb)->iif = ifindex;
334829ae9d6SWillem de Bruijn 	else
335829ae9d6SWillem de Bruijn 		PKTINFO_SKB_CB(skb)->ipi_ifindex = ifindex;
336829ae9d6SWillem de Bruijn }
337829ae9d6SWillem de Bruijn 
3381da177e4SLinus Torvalds /*
3391da177e4SLinus Torvalds  *	Handle MSG_ERRQUEUE
3401da177e4SLinus Torvalds  */
34185fbaa75SHannes Frederic Sowa int ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len, int *addr_len)
3421da177e4SLinus Torvalds {
3431da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
3441da177e4SLinus Torvalds 	struct sock_exterr_skb *serr;
345364a9e93SWillem de Bruijn 	struct sk_buff *skb;
346342dfc30SSteffen Hurrle 	DECLARE_SOCKADDR(struct sockaddr_in6 *, sin, msg->msg_name);
3471da177e4SLinus Torvalds 	struct {
3481da177e4SLinus Torvalds 		struct sock_extended_err ee;
3491da177e4SLinus Torvalds 		struct sockaddr_in6	 offender;
3501da177e4SLinus Torvalds 	} errhdr;
3511da177e4SLinus Torvalds 	int err;
3521da177e4SLinus Torvalds 	int copied;
3531da177e4SLinus Torvalds 
3541da177e4SLinus Torvalds 	err = -EAGAIN;
355364a9e93SWillem de Bruijn 	skb = sock_dequeue_err_skb(sk);
3561da177e4SLinus Torvalds 	if (skb == NULL)
3571da177e4SLinus Torvalds 		goto out;
3581da177e4SLinus Torvalds 
3591da177e4SLinus Torvalds 	copied = skb->len;
3601da177e4SLinus Torvalds 	if (copied > len) {
3611da177e4SLinus Torvalds 		msg->msg_flags |= MSG_TRUNC;
3621da177e4SLinus Torvalds 		copied = len;
3631da177e4SLinus Torvalds 	}
36451f3d02bSDavid S. Miller 	err = skb_copy_datagram_msg(skb, 0, msg, copied);
3651da177e4SLinus Torvalds 	if (err)
3661da177e4SLinus Torvalds 		goto out_free_skb;
3671da177e4SLinus Torvalds 
3681da177e4SLinus Torvalds 	sock_recv_timestamp(msg, sk, skb);
3691da177e4SLinus Torvalds 
3701da177e4SLinus Torvalds 	serr = SKB_EXT_ERR(skb);
3711da177e4SLinus Torvalds 
3721da177e4SLinus Torvalds 	if (sin) {
373d56f90a7SArnaldo Carvalho de Melo 		const unsigned char *nh = skb_network_header(skb);
3741da177e4SLinus Torvalds 		sin->sin6_family = AF_INET6;
3751da177e4SLinus Torvalds 		sin->sin6_flowinfo = 0;
3761da177e4SLinus Torvalds 		sin->sin6_port = serr->port;
377d40a4de0SBrian Haley 		if (skb->protocol == htons(ETH_P_IPV6)) {
3786c40d100SYOSHIFUJI Hideaki / 吉藤英明 			const struct ipv6hdr *ip6h = container_of((struct in6_addr *)(nh + serr->addr_offset),
3796c40d100SYOSHIFUJI Hideaki / 吉藤英明 								  struct ipv6hdr, daddr);
3806c40d100SYOSHIFUJI Hideaki / 吉藤英明 			sin->sin6_addr = ip6h->daddr;
3811da177e4SLinus Torvalds 			if (np->sndflow)
3826502ca52SYOSHIFUJI Hideaki / 吉藤英明 				sin->sin6_flowinfo = ip6_flowinfo(ip6h);
383842df073SHannes Frederic Sowa 			sin->sin6_scope_id =
384842df073SHannes Frederic Sowa 				ipv6_iface_scope_id(&sin->sin6_addr,
385842df073SHannes Frederic Sowa 						    IP6CB(skb)->iif);
3861da177e4SLinus Torvalds 		} else {
387b301e82cSBrian Haley 			ipv6_addr_set_v4mapped(*(__be32 *)(nh + serr->addr_offset),
388b301e82cSBrian Haley 					       &sin->sin6_addr);
389842df073SHannes Frederic Sowa 			sin->sin6_scope_id = 0;
3901da177e4SLinus Torvalds 		}
39185fbaa75SHannes Frederic Sowa 		*addr_len = sizeof(*sin);
3921da177e4SLinus Torvalds 	}
3931da177e4SLinus Torvalds 
3941da177e4SLinus Torvalds 	memcpy(&errhdr.ee, &serr->ee, sizeof(struct sock_extended_err));
3951da177e4SLinus Torvalds 	sin = &errhdr.offender;
3961da177e4SLinus Torvalds 	sin->sin6_family = AF_UNSPEC;
3971da177e4SLinus Torvalds 	if (serr->ee.ee_origin != SO_EE_ORIGIN_LOCAL) {
3981da177e4SLinus Torvalds 		sin->sin6_family = AF_INET6;
3991da177e4SLinus Torvalds 		sin->sin6_flowinfo = 0;
4001fa4c710SHannes Frederic Sowa 		sin->sin6_port = 0;
401829ae9d6SWillem de Bruijn 		if (np->rxopt.all) {
402829ae9d6SWillem de Bruijn 			if (serr->ee.ee_origin != SO_EE_ORIGIN_ICMP &&
403829ae9d6SWillem de Bruijn 			    serr->ee.ee_origin != SO_EE_ORIGIN_ICMP6)
404829ae9d6SWillem de Bruijn 				ip6_datagram_prepare_pktinfo_errqueue(skb);
4054b261c75SHannes Frederic Sowa 			ip6_datagram_recv_common_ctl(sk, msg, skb);
406829ae9d6SWillem de Bruijn 		}
407d40a4de0SBrian Haley 		if (skb->protocol == htons(ETH_P_IPV6)) {
4084e3fd7a0SAlexey Dobriyan 			sin->sin6_addr = ipv6_hdr(skb)->saddr;
4091da177e4SLinus Torvalds 			if (np->rxopt.all)
4104b261c75SHannes Frederic Sowa 				ip6_datagram_recv_specific_ctl(sk, msg, skb);
411842df073SHannes Frederic Sowa 			sin->sin6_scope_id =
412842df073SHannes Frederic Sowa 				ipv6_iface_scope_id(&sin->sin6_addr,
413842df073SHannes Frederic Sowa 						    IP6CB(skb)->iif);
4141da177e4SLinus Torvalds 		} else {
4151da177e4SLinus Torvalds 			struct inet_sock *inet = inet_sk(sk);
4161da177e4SLinus Torvalds 
417b301e82cSBrian Haley 			ipv6_addr_set_v4mapped(ip_hdr(skb)->saddr,
418b301e82cSBrian Haley 					       &sin->sin6_addr);
419842df073SHannes Frederic Sowa 			sin->sin6_scope_id = 0;
4201da177e4SLinus Torvalds 			if (inet->cmsg_flags)
4211da177e4SLinus Torvalds 				ip_cmsg_recv(msg, skb);
4221da177e4SLinus Torvalds 		}
4231da177e4SLinus Torvalds 	}
4241da177e4SLinus Torvalds 
4251da177e4SLinus Torvalds 	put_cmsg(msg, SOL_IPV6, IPV6_RECVERR, sizeof(errhdr), &errhdr);
4261da177e4SLinus Torvalds 
4271da177e4SLinus Torvalds 	/* Now we could try to dump offended packet options */
4281da177e4SLinus Torvalds 
4291da177e4SLinus Torvalds 	msg->msg_flags |= MSG_ERRQUEUE;
4301da177e4SLinus Torvalds 	err = copied;
4311da177e4SLinus Torvalds 
4321da177e4SLinus Torvalds out_free_skb:
4331da177e4SLinus Torvalds 	kfree_skb(skb);
4341da177e4SLinus Torvalds out:
4351da177e4SLinus Torvalds 	return err;
4361da177e4SLinus Torvalds }
437a495f836SChris Elston EXPORT_SYMBOL_GPL(ipv6_recv_error);
4381da177e4SLinus Torvalds 
4394b340ae2SBrian Haley /*
4404b340ae2SBrian Haley  *	Handle IPV6_RECVPATHMTU
4414b340ae2SBrian Haley  */
44285fbaa75SHannes Frederic Sowa int ipv6_recv_rxpmtu(struct sock *sk, struct msghdr *msg, int len,
44385fbaa75SHannes Frederic Sowa 		     int *addr_len)
4444b340ae2SBrian Haley {
4454b340ae2SBrian Haley 	struct ipv6_pinfo *np = inet6_sk(sk);
4464b340ae2SBrian Haley 	struct sk_buff *skb;
4474b340ae2SBrian Haley 	struct ip6_mtuinfo mtu_info;
448342dfc30SSteffen Hurrle 	DECLARE_SOCKADDR(struct sockaddr_in6 *, sin, msg->msg_name);
4494b340ae2SBrian Haley 	int err;
4504b340ae2SBrian Haley 	int copied;
4514b340ae2SBrian Haley 
4524b340ae2SBrian Haley 	err = -EAGAIN;
4534b340ae2SBrian Haley 	skb = xchg(&np->rxpmtu, NULL);
4544b340ae2SBrian Haley 	if (skb == NULL)
4554b340ae2SBrian Haley 		goto out;
4564b340ae2SBrian Haley 
4574b340ae2SBrian Haley 	copied = skb->len;
4584b340ae2SBrian Haley 	if (copied > len) {
4594b340ae2SBrian Haley 		msg->msg_flags |= MSG_TRUNC;
4604b340ae2SBrian Haley 		copied = len;
4614b340ae2SBrian Haley 	}
46251f3d02bSDavid S. Miller 	err = skb_copy_datagram_msg(skb, 0, msg, copied);
4634b340ae2SBrian Haley 	if (err)
4644b340ae2SBrian Haley 		goto out_free_skb;
4654b340ae2SBrian Haley 
4664b340ae2SBrian Haley 	sock_recv_timestamp(msg, sk, skb);
4674b340ae2SBrian Haley 
4684b340ae2SBrian Haley 	memcpy(&mtu_info, IP6CBMTU(skb), sizeof(mtu_info));
4694b340ae2SBrian Haley 
4704b340ae2SBrian Haley 	if (sin) {
4714b340ae2SBrian Haley 		sin->sin6_family = AF_INET6;
4724b340ae2SBrian Haley 		sin->sin6_flowinfo = 0;
4734b340ae2SBrian Haley 		sin->sin6_port = 0;
4744b340ae2SBrian Haley 		sin->sin6_scope_id = mtu_info.ip6m_addr.sin6_scope_id;
4754e3fd7a0SAlexey Dobriyan 		sin->sin6_addr = mtu_info.ip6m_addr.sin6_addr;
47685fbaa75SHannes Frederic Sowa 		*addr_len = sizeof(*sin);
4774b340ae2SBrian Haley 	}
4784b340ae2SBrian Haley 
4794b340ae2SBrian Haley 	put_cmsg(msg, SOL_IPV6, IPV6_PATHMTU, sizeof(mtu_info), &mtu_info);
4804b340ae2SBrian Haley 
4814b340ae2SBrian Haley 	err = copied;
4824b340ae2SBrian Haley 
4834b340ae2SBrian Haley out_free_skb:
4844b340ae2SBrian Haley 	kfree_skb(skb);
4854b340ae2SBrian Haley out:
4864b340ae2SBrian Haley 	return err;
4874b340ae2SBrian Haley }
4881da177e4SLinus Torvalds 
4891da177e4SLinus Torvalds 
4904b261c75SHannes Frederic Sowa void ip6_datagram_recv_common_ctl(struct sock *sk, struct msghdr *msg,
4914b261c75SHannes Frederic Sowa 				 struct sk_buff *skb)
4924b261c75SHannes Frederic Sowa {
4934b261c75SHannes Frederic Sowa 	struct ipv6_pinfo *np = inet6_sk(sk);
4944b261c75SHannes Frederic Sowa 	bool is_ipv6 = skb->protocol == htons(ETH_P_IPV6);
4954b261c75SHannes Frederic Sowa 
4964b261c75SHannes Frederic Sowa 	if (np->rxopt.bits.rxinfo) {
4974b261c75SHannes Frederic Sowa 		struct in6_pktinfo src_info;
4984b261c75SHannes Frederic Sowa 
4994b261c75SHannes Frederic Sowa 		if (is_ipv6) {
5004b261c75SHannes Frederic Sowa 			src_info.ipi6_ifindex = IP6CB(skb)->iif;
5014b261c75SHannes Frederic Sowa 			src_info.ipi6_addr = ipv6_hdr(skb)->daddr;
5024b261c75SHannes Frederic Sowa 		} else {
5034b261c75SHannes Frederic Sowa 			src_info.ipi6_ifindex =
5044b261c75SHannes Frederic Sowa 				PKTINFO_SKB_CB(skb)->ipi_ifindex;
5054b261c75SHannes Frederic Sowa 			ipv6_addr_set_v4mapped(ip_hdr(skb)->daddr,
5064b261c75SHannes Frederic Sowa 					       &src_info.ipi6_addr);
5074b261c75SHannes Frederic Sowa 		}
508829ae9d6SWillem de Bruijn 
509829ae9d6SWillem de Bruijn 		if (src_info.ipi6_ifindex >= 0)
510829ae9d6SWillem de Bruijn 			put_cmsg(msg, SOL_IPV6, IPV6_PKTINFO,
511829ae9d6SWillem de Bruijn 				 sizeof(src_info), &src_info);
5124b261c75SHannes Frederic Sowa 	}
5134b261c75SHannes Frederic Sowa }
5144b261c75SHannes Frederic Sowa 
5154b261c75SHannes Frederic Sowa void ip6_datagram_recv_specific_ctl(struct sock *sk, struct msghdr *msg,
51673df66f8STom Parkin 				    struct sk_buff *skb)
5171da177e4SLinus Torvalds {
5181da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
5191da177e4SLinus Torvalds 	struct inet6_skb_parm *opt = IP6CB(skb);
520d56f90a7SArnaldo Carvalho de Melo 	unsigned char *nh = skb_network_header(skb);
5211da177e4SLinus Torvalds 
5221da177e4SLinus Torvalds 	if (np->rxopt.bits.rxhlim) {
5230660e03fSArnaldo Carvalho de Melo 		int hlim = ipv6_hdr(skb)->hop_limit;
5241da177e4SLinus Torvalds 		put_cmsg(msg, SOL_IPV6, IPV6_HOPLIMIT, sizeof(hlim), &hlim);
5251da177e4SLinus Torvalds 	}
5261da177e4SLinus Torvalds 
52741a1f8eaSYOSHIFUJI Hideaki 	if (np->rxopt.bits.rxtclass) {
528e7219858SYOSHIFUJI Hideaki / 吉藤英明 		int tclass = ipv6_get_dsfield(ipv6_hdr(skb));
52941a1f8eaSYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_TCLASS, sizeof(tclass), &tclass);
53041a1f8eaSYOSHIFUJI Hideaki 	}
53141a1f8eaSYOSHIFUJI Hideaki 
5326502ca52SYOSHIFUJI Hideaki / 吉藤英明 	if (np->rxopt.bits.rxflow) {
5336502ca52SYOSHIFUJI Hideaki / 吉藤英明 		__be32 flowinfo = ip6_flowinfo((struct ipv6hdr *)nh);
5346502ca52SYOSHIFUJI Hideaki / 吉藤英明 		if (flowinfo)
5351da177e4SLinus Torvalds 			put_cmsg(msg, SOL_IPV6, IPV6_FLOWINFO, sizeof(flowinfo), &flowinfo);
5361da177e4SLinus Torvalds 	}
537333fad53SYOSHIFUJI Hideaki 
538333fad53SYOSHIFUJI Hideaki 	/* HbH is allowed only once */
5391da177e4SLinus Torvalds 	if (np->rxopt.bits.hopopts && opt->hop) {
540d56f90a7SArnaldo Carvalho de Melo 		u8 *ptr = nh + opt->hop;
5411da177e4SLinus Torvalds 		put_cmsg(msg, SOL_IPV6, IPV6_HOPOPTS, (ptr[1]+1)<<3, ptr);
5421da177e4SLinus Torvalds 	}
543333fad53SYOSHIFUJI Hideaki 
544333fad53SYOSHIFUJI Hideaki 	if (opt->lastopt &&
545333fad53SYOSHIFUJI Hideaki 	    (np->rxopt.bits.dstopts || np->rxopt.bits.srcrt)) {
546333fad53SYOSHIFUJI Hideaki 		/*
547333fad53SYOSHIFUJI Hideaki 		 * Silly enough, but we need to reparse in order to
548333fad53SYOSHIFUJI Hideaki 		 * report extension headers (except for HbH)
549333fad53SYOSHIFUJI Hideaki 		 * in order.
550333fad53SYOSHIFUJI Hideaki 		 *
551333fad53SYOSHIFUJI Hideaki 		 * Also note that IPV6_RECVRTHDRDSTOPTS is NOT
552333fad53SYOSHIFUJI Hideaki 		 * (and WILL NOT be) defined because
553333fad53SYOSHIFUJI Hideaki 		 * IPV6_RECVDSTOPTS is more generic. --yoshfuji
554333fad53SYOSHIFUJI Hideaki 		 */
555333fad53SYOSHIFUJI Hideaki 		unsigned int off = sizeof(struct ipv6hdr);
5560660e03fSArnaldo Carvalho de Melo 		u8 nexthdr = ipv6_hdr(skb)->nexthdr;
557333fad53SYOSHIFUJI Hideaki 
558333fad53SYOSHIFUJI Hideaki 		while (off <= opt->lastopt) {
55995c96174SEric Dumazet 			unsigned int len;
560d56f90a7SArnaldo Carvalho de Melo 			u8 *ptr = nh + off;
561333fad53SYOSHIFUJI Hideaki 
562333fad53SYOSHIFUJI Hideaki 			switch (nexthdr) {
563333fad53SYOSHIFUJI Hideaki 			case IPPROTO_DSTOPTS:
564333fad53SYOSHIFUJI Hideaki 				nexthdr = ptr[0];
565333fad53SYOSHIFUJI Hideaki 				len = (ptr[1] + 1) << 3;
566333fad53SYOSHIFUJI Hideaki 				if (np->rxopt.bits.dstopts)
567333fad53SYOSHIFUJI Hideaki 					put_cmsg(msg, SOL_IPV6, IPV6_DSTOPTS, len, ptr);
568333fad53SYOSHIFUJI Hideaki 				break;
569333fad53SYOSHIFUJI Hideaki 			case IPPROTO_ROUTING:
570333fad53SYOSHIFUJI Hideaki 				nexthdr = ptr[0];
571333fad53SYOSHIFUJI Hideaki 				len = (ptr[1] + 1) << 3;
572333fad53SYOSHIFUJI Hideaki 				if (np->rxopt.bits.srcrt)
573333fad53SYOSHIFUJI Hideaki 					put_cmsg(msg, SOL_IPV6, IPV6_RTHDR, len, ptr);
574333fad53SYOSHIFUJI Hideaki 				break;
575333fad53SYOSHIFUJI Hideaki 			case IPPROTO_AH:
576333fad53SYOSHIFUJI Hideaki 				nexthdr = ptr[0];
577a3059893SVille Nuorvala 				len = (ptr[1] + 2) << 2;
578333fad53SYOSHIFUJI Hideaki 				break;
579333fad53SYOSHIFUJI Hideaki 			default:
580333fad53SYOSHIFUJI Hideaki 				nexthdr = ptr[0];
581333fad53SYOSHIFUJI Hideaki 				len = (ptr[1] + 1) << 3;
582333fad53SYOSHIFUJI Hideaki 				break;
583333fad53SYOSHIFUJI Hideaki 			}
584333fad53SYOSHIFUJI Hideaki 
585333fad53SYOSHIFUJI Hideaki 			off += len;
586333fad53SYOSHIFUJI Hideaki 		}
587333fad53SYOSHIFUJI Hideaki 	}
588333fad53SYOSHIFUJI Hideaki 
589333fad53SYOSHIFUJI Hideaki 	/* socket options in old style */
590333fad53SYOSHIFUJI Hideaki 	if (np->rxopt.bits.rxoinfo) {
591333fad53SYOSHIFUJI Hideaki 		struct in6_pktinfo src_info;
592333fad53SYOSHIFUJI Hideaki 
593333fad53SYOSHIFUJI Hideaki 		src_info.ipi6_ifindex = opt->iif;
5944e3fd7a0SAlexey Dobriyan 		src_info.ipi6_addr = ipv6_hdr(skb)->daddr;
595333fad53SYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_2292PKTINFO, sizeof(src_info), &src_info);
596333fad53SYOSHIFUJI Hideaki 	}
597333fad53SYOSHIFUJI Hideaki 	if (np->rxopt.bits.rxohlim) {
5980660e03fSArnaldo Carvalho de Melo 		int hlim = ipv6_hdr(skb)->hop_limit;
599333fad53SYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_2292HOPLIMIT, sizeof(hlim), &hlim);
600333fad53SYOSHIFUJI Hideaki 	}
601333fad53SYOSHIFUJI Hideaki 	if (np->rxopt.bits.ohopopts && opt->hop) {
602d56f90a7SArnaldo Carvalho de Melo 		u8 *ptr = nh + opt->hop;
603333fad53SYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_2292HOPOPTS, (ptr[1]+1)<<3, ptr);
604333fad53SYOSHIFUJI Hideaki 	}
605333fad53SYOSHIFUJI Hideaki 	if (np->rxopt.bits.odstopts && opt->dst0) {
606d56f90a7SArnaldo Carvalho de Melo 		u8 *ptr = nh + opt->dst0;
607333fad53SYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr);
6081da177e4SLinus Torvalds 	}
609333fad53SYOSHIFUJI Hideaki 	if (np->rxopt.bits.osrcrt && opt->srcrt) {
610d56f90a7SArnaldo Carvalho de Melo 		struct ipv6_rt_hdr *rthdr = (struct ipv6_rt_hdr *)(nh + opt->srcrt);
611333fad53SYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_2292RTHDR, (rthdr->hdrlen+1) << 3, rthdr);
6121da177e4SLinus Torvalds 	}
613333fad53SYOSHIFUJI Hideaki 	if (np->rxopt.bits.odstopts && opt->dst1) {
614d56f90a7SArnaldo Carvalho de Melo 		u8 *ptr = nh + opt->dst1;
615333fad53SYOSHIFUJI Hideaki 		put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr);
6161da177e4SLinus Torvalds 	}
6176c468622SBalazs Scheidler 	if (np->rxopt.bits.rxorigdstaddr) {
6186c468622SBalazs Scheidler 		struct sockaddr_in6 sin6;
619747465efSEric Dumazet 		__be16 *ports = (__be16 *) skb_transport_header(skb);
6206c468622SBalazs Scheidler 
6216c468622SBalazs Scheidler 		if (skb_transport_offset(skb) + 4 <= skb->len) {
6226c468622SBalazs Scheidler 			/* All current transport protocols have the port numbers in the
6236c468622SBalazs Scheidler 			 * first four bytes of the transport header and this function is
6246c468622SBalazs Scheidler 			 * written with this assumption in mind.
6256c468622SBalazs Scheidler 			 */
6266c468622SBalazs Scheidler 
6276c468622SBalazs Scheidler 			sin6.sin6_family = AF_INET6;
6284e3fd7a0SAlexey Dobriyan 			sin6.sin6_addr = ipv6_hdr(skb)->daddr;
6296c468622SBalazs Scheidler 			sin6.sin6_port = ports[1];
6306c468622SBalazs Scheidler 			sin6.sin6_flowinfo = 0;
6313868b7aaSHannes Frederic Sowa 			sin6.sin6_scope_id =
6323868b7aaSHannes Frederic Sowa 				ipv6_iface_scope_id(&ipv6_hdr(skb)->daddr,
6333868b7aaSHannes Frederic Sowa 						    opt->iif);
6346c468622SBalazs Scheidler 
6356c468622SBalazs Scheidler 			put_cmsg(msg, SOL_IPV6, IPV6_ORIGDSTADDR, sizeof(sin6), &sin6);
6366c468622SBalazs Scheidler 		}
6376c468622SBalazs Scheidler 	}
6384b261c75SHannes Frederic Sowa }
6394b261c75SHannes Frederic Sowa 
6404b261c75SHannes Frederic Sowa void ip6_datagram_recv_ctl(struct sock *sk, struct msghdr *msg,
6414b261c75SHannes Frederic Sowa 			  struct sk_buff *skb)
6424b261c75SHannes Frederic Sowa {
6434b261c75SHannes Frederic Sowa 	ip6_datagram_recv_common_ctl(sk, msg, skb);
6444b261c75SHannes Frederic Sowa 	ip6_datagram_recv_specific_ctl(sk, msg, skb);
6451da177e4SLinus Torvalds }
6468e72d37eSTom Parkin EXPORT_SYMBOL_GPL(ip6_datagram_recv_ctl);
6471da177e4SLinus Torvalds 
64873df66f8STom Parkin int ip6_datagram_send_ctl(struct net *net, struct sock *sk,
6494c9483b2SDavid S. Miller 			  struct msghdr *msg, struct flowi6 *fl6,
6501da177e4SLinus Torvalds 			  struct ipv6_txoptions *opt,
65113b52cd4SBrian Haley 			  int *hlimit, int *tclass, int *dontfrag)
6521da177e4SLinus Torvalds {
6531da177e4SLinus Torvalds 	struct in6_pktinfo *src_info;
6541da177e4SLinus Torvalds 	struct cmsghdr *cmsg;
6551da177e4SLinus Torvalds 	struct ipv6_rt_hdr *rthdr;
6561da177e4SLinus Torvalds 	struct ipv6_opt_hdr *hdr;
6571da177e4SLinus Torvalds 	int len;
6581da177e4SLinus Torvalds 	int err = 0;
6591da177e4SLinus Torvalds 
660f95b414eSGu Zheng 	for_each_cmsghdr(cmsg, msg) {
6611da177e4SLinus Torvalds 		int addr_type;
6621da177e4SLinus Torvalds 
6631da177e4SLinus Torvalds 		if (!CMSG_OK(msg, cmsg)) {
6641da177e4SLinus Torvalds 			err = -EINVAL;
6651da177e4SLinus Torvalds 			goto exit_f;
6661da177e4SLinus Torvalds 		}
6671da177e4SLinus Torvalds 
6681da177e4SLinus Torvalds 		if (cmsg->cmsg_level != SOL_IPV6)
6691da177e4SLinus Torvalds 			continue;
6701da177e4SLinus Torvalds 
6711da177e4SLinus Torvalds 		switch (cmsg->cmsg_type) {
6721da177e4SLinus Torvalds 		case IPV6_PKTINFO:
673333fad53SYOSHIFUJI Hideaki 		case IPV6_2292PKTINFO:
674187e3838SYOSHIFUJI Hideaki 		    {
675187e3838SYOSHIFUJI Hideaki 			struct net_device *dev = NULL;
676187e3838SYOSHIFUJI Hideaki 
6771da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct in6_pktinfo))) {
6781da177e4SLinus Torvalds 				err = -EINVAL;
6791da177e4SLinus Torvalds 				goto exit_f;
6801da177e4SLinus Torvalds 			}
6811da177e4SLinus Torvalds 
6821da177e4SLinus Torvalds 			src_info = (struct in6_pktinfo *)CMSG_DATA(cmsg);
6831da177e4SLinus Torvalds 
6841da177e4SLinus Torvalds 			if (src_info->ipi6_ifindex) {
6854c9483b2SDavid S. Miller 				if (fl6->flowi6_oif &&
6864c9483b2SDavid S. Miller 				    src_info->ipi6_ifindex != fl6->flowi6_oif)
6871da177e4SLinus Torvalds 					return -EINVAL;
6884c9483b2SDavid S. Miller 				fl6->flowi6_oif = src_info->ipi6_ifindex;
6891da177e4SLinus Torvalds 			}
6901da177e4SLinus Torvalds 
691187e3838SYOSHIFUJI Hideaki 			addr_type = __ipv6_addr_type(&src_info->ipi6_addr);
6921da177e4SLinus Torvalds 
693536b2e92SEric Dumazet 			rcu_read_lock();
6944c9483b2SDavid S. Miller 			if (fl6->flowi6_oif) {
6954c9483b2SDavid S. Miller 				dev = dev_get_by_index_rcu(net, fl6->flowi6_oif);
696536b2e92SEric Dumazet 				if (!dev) {
697536b2e92SEric Dumazet 					rcu_read_unlock();
6981da177e4SLinus Torvalds 					return -ENODEV;
699536b2e92SEric Dumazet 				}
700536b2e92SEric Dumazet 			} else if (addr_type & IPV6_ADDR_LINKLOCAL) {
701536b2e92SEric Dumazet 				rcu_read_unlock();
702187e3838SYOSHIFUJI Hideaki 				return -EINVAL;
703536b2e92SEric Dumazet 			}
704187e3838SYOSHIFUJI Hideaki 
705187e3838SYOSHIFUJI Hideaki 			if (addr_type != IPV6_ADDR_ANY) {
706187e3838SYOSHIFUJI Hideaki 				int strict = __ipv6_addr_src_scope(addr_type) <= IPV6_ADDR_SCOPE_LINKLOCAL;
7072563fa59SMaciej Żenczykowski 				if (!(inet_sk(sk)->freebind || inet_sk(sk)->transparent) &&
708ec0506dbSMaciej Żenczykowski 				    !ipv6_chk_addr(net, &src_info->ipi6_addr,
7097c90cc2dSFX Le Bail 						   strict ? dev : NULL, 0) &&
7107c90cc2dSFX Le Bail 				    !ipv6_chk_acast_addr_src(net, dev,
7117c90cc2dSFX Le Bail 							     &src_info->ipi6_addr))
7121da177e4SLinus Torvalds 					err = -EINVAL;
713187e3838SYOSHIFUJI Hideaki 				else
7144e3fd7a0SAlexey Dobriyan 					fl6->saddr = src_info->ipi6_addr;
7151da177e4SLinus Torvalds 			}
716187e3838SYOSHIFUJI Hideaki 
717536b2e92SEric Dumazet 			rcu_read_unlock();
7181da177e4SLinus Torvalds 
719187e3838SYOSHIFUJI Hideaki 			if (err)
720187e3838SYOSHIFUJI Hideaki 				goto exit_f;
721187e3838SYOSHIFUJI Hideaki 
7221da177e4SLinus Torvalds 			break;
723187e3838SYOSHIFUJI Hideaki 		    }
7241da177e4SLinus Torvalds 
7251da177e4SLinus Torvalds 		case IPV6_FLOWINFO:
7261da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(4)) {
7271da177e4SLinus Torvalds 				err = -EINVAL;
7281da177e4SLinus Torvalds 				goto exit_f;
7291da177e4SLinus Torvalds 			}
7301da177e4SLinus Torvalds 
7314c9483b2SDavid S. Miller 			if (fl6->flowlabel&IPV6_FLOWINFO_MASK) {
7324c9483b2SDavid S. Miller 				if ((fl6->flowlabel^*(__be32 *)CMSG_DATA(cmsg))&~IPV6_FLOWINFO_MASK) {
7331da177e4SLinus Torvalds 					err = -EINVAL;
7341da177e4SLinus Torvalds 					goto exit_f;
7351da177e4SLinus Torvalds 				}
7361da177e4SLinus Torvalds 			}
7374c9483b2SDavid S. Miller 			fl6->flowlabel = IPV6_FLOWINFO_MASK & *(__be32 *)CMSG_DATA(cmsg);
7381da177e4SLinus Torvalds 			break;
7391da177e4SLinus Torvalds 
740333fad53SYOSHIFUJI Hideaki 		case IPV6_2292HOPOPTS:
7411da177e4SLinus Torvalds 		case IPV6_HOPOPTS:
7421da177e4SLinus Torvalds 			if (opt->hopopt || cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) {
7431da177e4SLinus Torvalds 				err = -EINVAL;
7441da177e4SLinus Torvalds 				goto exit_f;
7451da177e4SLinus Torvalds 			}
7461da177e4SLinus Torvalds 
7471da177e4SLinus Torvalds 			hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg);
7481da177e4SLinus Torvalds 			len = ((hdr->hdrlen + 1) << 3);
7491da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(len)) {
7501da177e4SLinus Torvalds 				err = -EINVAL;
7511da177e4SLinus Torvalds 				goto exit_f;
7521da177e4SLinus Torvalds 			}
753af31f412SEric W. Biederman 			if (!ns_capable(net->user_ns, CAP_NET_RAW)) {
7541da177e4SLinus Torvalds 				err = -EPERM;
7551da177e4SLinus Torvalds 				goto exit_f;
7561da177e4SLinus Torvalds 			}
7571da177e4SLinus Torvalds 			opt->opt_nflen += len;
7581da177e4SLinus Torvalds 			opt->hopopt = hdr;
7591da177e4SLinus Torvalds 			break;
7601da177e4SLinus Torvalds 
761333fad53SYOSHIFUJI Hideaki 		case IPV6_2292DSTOPTS:
7621da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) {
7631da177e4SLinus Torvalds 				err = -EINVAL;
7641da177e4SLinus Torvalds 				goto exit_f;
7651da177e4SLinus Torvalds 			}
7661da177e4SLinus Torvalds 
7671da177e4SLinus Torvalds 			hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg);
7681da177e4SLinus Torvalds 			len = ((hdr->hdrlen + 1) << 3);
7691da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(len)) {
7701da177e4SLinus Torvalds 				err = -EINVAL;
7711da177e4SLinus Torvalds 				goto exit_f;
7721da177e4SLinus Torvalds 			}
773af31f412SEric W. Biederman 			if (!ns_capable(net->user_ns, CAP_NET_RAW)) {
7741da177e4SLinus Torvalds 				err = -EPERM;
7751da177e4SLinus Torvalds 				goto exit_f;
7761da177e4SLinus Torvalds 			}
7771da177e4SLinus Torvalds 			if (opt->dst1opt) {
7781da177e4SLinus Torvalds 				err = -EINVAL;
7791da177e4SLinus Torvalds 				goto exit_f;
7801da177e4SLinus Torvalds 			}
7811da177e4SLinus Torvalds 			opt->opt_flen += len;
7821da177e4SLinus Torvalds 			opt->dst1opt = hdr;
7831da177e4SLinus Torvalds 			break;
7841da177e4SLinus Torvalds 
785333fad53SYOSHIFUJI Hideaki 		case IPV6_DSTOPTS:
786333fad53SYOSHIFUJI Hideaki 		case IPV6_RTHDRDSTOPTS:
787333fad53SYOSHIFUJI Hideaki 			if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) {
788333fad53SYOSHIFUJI Hideaki 				err = -EINVAL;
789333fad53SYOSHIFUJI Hideaki 				goto exit_f;
790333fad53SYOSHIFUJI Hideaki 			}
791333fad53SYOSHIFUJI Hideaki 
792333fad53SYOSHIFUJI Hideaki 			hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg);
793333fad53SYOSHIFUJI Hideaki 			len = ((hdr->hdrlen + 1) << 3);
794333fad53SYOSHIFUJI Hideaki 			if (cmsg->cmsg_len < CMSG_LEN(len)) {
795333fad53SYOSHIFUJI Hideaki 				err = -EINVAL;
796333fad53SYOSHIFUJI Hideaki 				goto exit_f;
797333fad53SYOSHIFUJI Hideaki 			}
798af31f412SEric W. Biederman 			if (!ns_capable(net->user_ns, CAP_NET_RAW)) {
799333fad53SYOSHIFUJI Hideaki 				err = -EPERM;
800333fad53SYOSHIFUJI Hideaki 				goto exit_f;
801333fad53SYOSHIFUJI Hideaki 			}
802333fad53SYOSHIFUJI Hideaki 			if (cmsg->cmsg_type == IPV6_DSTOPTS) {
803333fad53SYOSHIFUJI Hideaki 				opt->opt_flen += len;
804333fad53SYOSHIFUJI Hideaki 				opt->dst1opt = hdr;
805333fad53SYOSHIFUJI Hideaki 			} else {
806333fad53SYOSHIFUJI Hideaki 				opt->opt_nflen += len;
807333fad53SYOSHIFUJI Hideaki 				opt->dst0opt = hdr;
808333fad53SYOSHIFUJI Hideaki 			}
809333fad53SYOSHIFUJI Hideaki 			break;
810333fad53SYOSHIFUJI Hideaki 
811333fad53SYOSHIFUJI Hideaki 		case IPV6_2292RTHDR:
8121da177e4SLinus Torvalds 		case IPV6_RTHDR:
8131da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_rt_hdr))) {
8141da177e4SLinus Torvalds 				err = -EINVAL;
8151da177e4SLinus Torvalds 				goto exit_f;
8161da177e4SLinus Torvalds 			}
8171da177e4SLinus Torvalds 
8181da177e4SLinus Torvalds 			rthdr = (struct ipv6_rt_hdr *)CMSG_DATA(cmsg);
8191da177e4SLinus Torvalds 
820280a9d34SMasahide NAKAMURA 			switch (rthdr->type) {
82107a93626SAmerigo Wang #if IS_ENABLED(CONFIG_IPV6_MIP6)
822280a9d34SMasahide NAKAMURA 			case IPV6_SRCRT_TYPE_2:
8236e093d9dSBrian Haley 				if (rthdr->hdrlen != 2 ||
8246e093d9dSBrian Haley 				    rthdr->segments_left != 1) {
8256e093d9dSBrian Haley 					err = -EINVAL;
8266e093d9dSBrian Haley 					goto exit_f;
8276e093d9dSBrian Haley 				}
828280a9d34SMasahide NAKAMURA 				break;
829bb4dbf9eSYOSHIFUJI Hideaki #endif
830280a9d34SMasahide NAKAMURA 			default:
8311da177e4SLinus Torvalds 				err = -EINVAL;
8321da177e4SLinus Torvalds 				goto exit_f;
8331da177e4SLinus Torvalds 			}
8341da177e4SLinus Torvalds 
8351da177e4SLinus Torvalds 			len = ((rthdr->hdrlen + 1) << 3);
8361da177e4SLinus Torvalds 
8371da177e4SLinus Torvalds 			if (cmsg->cmsg_len < CMSG_LEN(len)) {
8381da177e4SLinus Torvalds 				err = -EINVAL;
8391da177e4SLinus Torvalds 				goto exit_f;
8401da177e4SLinus Torvalds 			}
8411da177e4SLinus Torvalds 
8421da177e4SLinus Torvalds 			/* segments left must also match */
8431da177e4SLinus Torvalds 			if ((rthdr->hdrlen >> 1) != rthdr->segments_left) {
8441da177e4SLinus Torvalds 				err = -EINVAL;
8451da177e4SLinus Torvalds 				goto exit_f;
8461da177e4SLinus Torvalds 			}
8471da177e4SLinus Torvalds 
8481da177e4SLinus Torvalds 			opt->opt_nflen += len;
8491da177e4SLinus Torvalds 			opt->srcrt = rthdr;
8501da177e4SLinus Torvalds 
851333fad53SYOSHIFUJI Hideaki 			if (cmsg->cmsg_type == IPV6_2292RTHDR && opt->dst1opt) {
8521da177e4SLinus Torvalds 				int dsthdrlen = ((opt->dst1opt->hdrlen+1)<<3);
8531da177e4SLinus Torvalds 
8541da177e4SLinus Torvalds 				opt->opt_nflen += dsthdrlen;
8551da177e4SLinus Torvalds 				opt->dst0opt = opt->dst1opt;
8561da177e4SLinus Torvalds 				opt->dst1opt = NULL;
8571da177e4SLinus Torvalds 				opt->opt_flen -= dsthdrlen;
8581da177e4SLinus Torvalds 			}
8591da177e4SLinus Torvalds 
8601da177e4SLinus Torvalds 			break;
8611da177e4SLinus Torvalds 
862333fad53SYOSHIFUJI Hideaki 		case IPV6_2292HOPLIMIT:
8631da177e4SLinus Torvalds 		case IPV6_HOPLIMIT:
8641da177e4SLinus Torvalds 			if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) {
8651da177e4SLinus Torvalds 				err = -EINVAL;
8661da177e4SLinus Torvalds 				goto exit_f;
8671da177e4SLinus Torvalds 			}
8681da177e4SLinus Torvalds 
8691da177e4SLinus Torvalds 			*hlimit = *(int *)CMSG_DATA(cmsg);
870e8766fc8SShan Wei 			if (*hlimit < -1 || *hlimit > 0xff) {
871e8766fc8SShan Wei 				err = -EINVAL;
872e8766fc8SShan Wei 				goto exit_f;
873e8766fc8SShan Wei 			}
874e8766fc8SShan Wei 
8751da177e4SLinus Torvalds 			break;
8761da177e4SLinus Torvalds 
87741a1f8eaSYOSHIFUJI Hideaki 		case IPV6_TCLASS:
87841a1f8eaSYOSHIFUJI Hideaki 		    {
87941a1f8eaSYOSHIFUJI Hideaki 			int tc;
88041a1f8eaSYOSHIFUJI Hideaki 
88141a1f8eaSYOSHIFUJI Hideaki 			err = -EINVAL;
882b5a4257cSEldad Zack 			if (cmsg->cmsg_len != CMSG_LEN(sizeof(int)))
88341a1f8eaSYOSHIFUJI Hideaki 				goto exit_f;
88441a1f8eaSYOSHIFUJI Hideaki 
88541a1f8eaSYOSHIFUJI Hideaki 			tc = *(int *)CMSG_DATA(cmsg);
886d0ee011fSRemi Denis-Courmont 			if (tc < -1 || tc > 0xff)
88741a1f8eaSYOSHIFUJI Hideaki 				goto exit_f;
88841a1f8eaSYOSHIFUJI Hideaki 
88941a1f8eaSYOSHIFUJI Hideaki 			err = 0;
89041a1f8eaSYOSHIFUJI Hideaki 			*tclass = tc;
89141a1f8eaSYOSHIFUJI Hideaki 
89241a1f8eaSYOSHIFUJI Hideaki 			break;
89341a1f8eaSYOSHIFUJI Hideaki 		    }
89413b52cd4SBrian Haley 
89513b52cd4SBrian Haley 		case IPV6_DONTFRAG:
89613b52cd4SBrian Haley 		    {
89713b52cd4SBrian Haley 			int df;
89813b52cd4SBrian Haley 
89913b52cd4SBrian Haley 			err = -EINVAL;
900b5a4257cSEldad Zack 			if (cmsg->cmsg_len != CMSG_LEN(sizeof(int)))
90113b52cd4SBrian Haley 				goto exit_f;
90213b52cd4SBrian Haley 
90313b52cd4SBrian Haley 			df = *(int *)CMSG_DATA(cmsg);
90413b52cd4SBrian Haley 			if (df < 0 || df > 1)
90513b52cd4SBrian Haley 				goto exit_f;
90613b52cd4SBrian Haley 
90713b52cd4SBrian Haley 			err = 0;
90813b52cd4SBrian Haley 			*dontfrag = df;
90913b52cd4SBrian Haley 
91013b52cd4SBrian Haley 			break;
91113b52cd4SBrian Haley 		    }
9121da177e4SLinus Torvalds 		default:
913ba7a46f1SJoe Perches 			net_dbg_ratelimited("invalid cmsg type: %d\n",
91464ce2073SPatrick McHardy 					    cmsg->cmsg_type);
9151da177e4SLinus Torvalds 			err = -EINVAL;
9164a36702eSMiao Xie 			goto exit_f;
9173ff50b79SStephen Hemminger 		}
9181da177e4SLinus Torvalds 	}
9191da177e4SLinus Torvalds 
9201da177e4SLinus Torvalds exit_f:
9211da177e4SLinus Torvalds 	return err;
9221da177e4SLinus Torvalds }
92373df66f8STom Parkin EXPORT_SYMBOL_GPL(ip6_datagram_send_ctl);
92417ef66afSLorenzo Colitti 
92517ef66afSLorenzo Colitti void ip6_dgram_sock_seq_show(struct seq_file *seq, struct sock *sp,
92617ef66afSLorenzo Colitti 			     __u16 srcp, __u16 destp, int bucket)
92717ef66afSLorenzo Colitti {
92817ef66afSLorenzo Colitti 	const struct in6_addr *dest, *src;
92917ef66afSLorenzo Colitti 
930efe4208fSEric Dumazet 	dest  = &sp->sk_v6_daddr;
931efe4208fSEric Dumazet 	src   = &sp->sk_v6_rcv_saddr;
93217ef66afSLorenzo Colitti 	seq_printf(seq,
93317ef66afSLorenzo Colitti 		   "%5d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
934d14c5ab6SFrancesco Fusco 		   "%02X %08X:%08X %02X:%08lX %08X %5u %8d %lu %d %pK %d\n",
93517ef66afSLorenzo Colitti 		   bucket,
93617ef66afSLorenzo Colitti 		   src->s6_addr32[0], src->s6_addr32[1],
93717ef66afSLorenzo Colitti 		   src->s6_addr32[2], src->s6_addr32[3], srcp,
93817ef66afSLorenzo Colitti 		   dest->s6_addr32[0], dest->s6_addr32[1],
93917ef66afSLorenzo Colitti 		   dest->s6_addr32[2], dest->s6_addr32[3], destp,
94017ef66afSLorenzo Colitti 		   sp->sk_state,
94117ef66afSLorenzo Colitti 		   sk_wmem_alloc_get(sp),
94217ef66afSLorenzo Colitti 		   sk_rmem_alloc_get(sp),
94317ef66afSLorenzo Colitti 		   0, 0L, 0,
94417ef66afSLorenzo Colitti 		   from_kuid_munged(seq_user_ns(seq), sock_i_uid(sp)),
94517ef66afSLorenzo Colitti 		   0,
94617ef66afSLorenzo Colitti 		   sock_i_ino(sp),
94717ef66afSLorenzo Colitti 		   atomic_read(&sp->sk_refcnt), sp,
94817ef66afSLorenzo Colitti 		   atomic_read(&sp->sk_drops));
94917ef66afSLorenzo Colitti }
950