xref: /openbmc/linux/net/ipv6/icmp.c (revision c4062dfc)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *	Internet Control Message Protocol (ICMPv6)
31da177e4SLinus Torvalds  *	Linux INET6 implementation
41da177e4SLinus Torvalds  *
51da177e4SLinus Torvalds  *	Authors:
61da177e4SLinus Torvalds  *	Pedro Roque		<roque@di.fc.ul.pt>
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  *	Based on net/ipv4/icmp.c
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *	RFC 1885
111da177e4SLinus Torvalds  *
121da177e4SLinus Torvalds  *	This program is free software; you can redistribute it and/or
131da177e4SLinus Torvalds  *      modify it under the terms of the GNU General Public License
141da177e4SLinus Torvalds  *      as published by the Free Software Foundation; either version
151da177e4SLinus Torvalds  *      2 of the License, or (at your option) any later version.
161da177e4SLinus Torvalds  */
171da177e4SLinus Torvalds 
181da177e4SLinus Torvalds /*
191da177e4SLinus Torvalds  *	Changes:
201da177e4SLinus Torvalds  *
211da177e4SLinus Torvalds  *	Andi Kleen		:	exception handling
221da177e4SLinus Torvalds  *	Andi Kleen			add rate limits. never reply to a icmp.
231da177e4SLinus Torvalds  *					add more length checks and other fixes.
241da177e4SLinus Torvalds  *	yoshfuji		:	ensure to sent parameter problem for
251da177e4SLinus Torvalds  *					fragments.
261da177e4SLinus Torvalds  *	YOSHIFUJI Hideaki @USAGI:	added sysctl for icmp rate limit.
271da177e4SLinus Torvalds  *	Randy Dunlap and
281da177e4SLinus Torvalds  *	YOSHIFUJI Hideaki @USAGI:	Per-interface statistics support
291da177e4SLinus Torvalds  *	Kazunori MIYAZAWA @USAGI:       change output process to use ip6_append_data
301da177e4SLinus Torvalds  */
311da177e4SLinus Torvalds 
321da177e4SLinus Torvalds #include <linux/module.h>
331da177e4SLinus Torvalds #include <linux/errno.h>
341da177e4SLinus Torvalds #include <linux/types.h>
351da177e4SLinus Torvalds #include <linux/socket.h>
361da177e4SLinus Torvalds #include <linux/in.h>
371da177e4SLinus Torvalds #include <linux/kernel.h>
381da177e4SLinus Torvalds #include <linux/sockios.h>
391da177e4SLinus Torvalds #include <linux/net.h>
401da177e4SLinus Torvalds #include <linux/skbuff.h>
411da177e4SLinus Torvalds #include <linux/init.h>
42763ecff1SYasuyuki Kozakai #include <linux/netfilter.h>
435a0e3ad6STejun Heo #include <linux/slab.h>
441da177e4SLinus Torvalds 
451da177e4SLinus Torvalds #ifdef CONFIG_SYSCTL
461da177e4SLinus Torvalds #include <linux/sysctl.h>
471da177e4SLinus Torvalds #endif
481da177e4SLinus Torvalds 
491da177e4SLinus Torvalds #include <linux/inet.h>
501da177e4SLinus Torvalds #include <linux/netdevice.h>
511da177e4SLinus Torvalds #include <linux/icmpv6.h>
521da177e4SLinus Torvalds 
531da177e4SLinus Torvalds #include <net/ip.h>
541da177e4SLinus Torvalds #include <net/sock.h>
551da177e4SLinus Torvalds 
561da177e4SLinus Torvalds #include <net/ipv6.h>
571da177e4SLinus Torvalds #include <net/ip6_checksum.h>
581da177e4SLinus Torvalds #include <net/protocol.h>
591da177e4SLinus Torvalds #include <net/raw.h>
601da177e4SLinus Torvalds #include <net/rawv6.h>
611da177e4SLinus Torvalds #include <net/transp_v6.h>
621da177e4SLinus Torvalds #include <net/ip6_route.h>
631da177e4SLinus Torvalds #include <net/addrconf.h>
641da177e4SLinus Torvalds #include <net/icmp.h>
658b7817f3SHerbert Xu #include <net/xfrm.h>
661ed8516fSDenis V. Lunev #include <net/inet_common.h>
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds #include <asm/uaccess.h>
691da177e4SLinus Torvalds #include <asm/system.h>
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds /*
721da177e4SLinus Torvalds  *	The ICMP socket(s). This is the most convenient way to flow control
731da177e4SLinus Torvalds  *	our ICMP output as well as maintain a clean interface throughout
741da177e4SLinus Torvalds  *	all layers. All Socketless IP sends will soon be gone.
751da177e4SLinus Torvalds  *
761da177e4SLinus Torvalds  *	On SMP we have one ICMP socket per-cpu.
771da177e4SLinus Torvalds  */
7898c6d1b2SDenis V. Lunev static inline struct sock *icmpv6_sk(struct net *net)
7998c6d1b2SDenis V. Lunev {
8098c6d1b2SDenis V. Lunev 	return net->ipv6.icmp_sk[smp_processor_id()];
8198c6d1b2SDenis V. Lunev }
821da177e4SLinus Torvalds 
83e5bbef20SHerbert Xu static int icmpv6_rcv(struct sk_buff *skb);
841da177e4SLinus Torvalds 
8541135cc8SAlexey Dobriyan static const struct inet6_protocol icmpv6_protocol = {
861da177e4SLinus Torvalds 	.handler	=	icmpv6_rcv,
878b7817f3SHerbert Xu 	.flags		=	INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
881da177e4SLinus Torvalds };
891da177e4SLinus Torvalds 
90fdc0bde9SDenis V. Lunev static __inline__ struct sock *icmpv6_xmit_lock(struct net *net)
911da177e4SLinus Torvalds {
92fdc0bde9SDenis V. Lunev 	struct sock *sk;
93fdc0bde9SDenis V. Lunev 
941da177e4SLinus Torvalds 	local_bh_disable();
951da177e4SLinus Torvalds 
96fdc0bde9SDenis V. Lunev 	sk = icmpv6_sk(net);
97405666dbSDenis V. Lunev 	if (unlikely(!spin_trylock(&sk->sk_lock.slock))) {
981da177e4SLinus Torvalds 		/* This can happen if the output path (f.e. SIT or
991da177e4SLinus Torvalds 		 * ip6ip6 tunnel) signals dst_link_failure() for an
1001da177e4SLinus Torvalds 		 * outgoing ICMP6 packet.
1011da177e4SLinus Torvalds 		 */
1021da177e4SLinus Torvalds 		local_bh_enable();
103fdc0bde9SDenis V. Lunev 		return NULL;
1041da177e4SLinus Torvalds 	}
105fdc0bde9SDenis V. Lunev 	return sk;
1061da177e4SLinus Torvalds }
1071da177e4SLinus Torvalds 
108405666dbSDenis V. Lunev static __inline__ void icmpv6_xmit_unlock(struct sock *sk)
1091da177e4SLinus Torvalds {
110405666dbSDenis V. Lunev 	spin_unlock_bh(&sk->sk_lock.slock);
1111da177e4SLinus Torvalds }
1121da177e4SLinus Torvalds 
1131da177e4SLinus Torvalds /*
1141da177e4SLinus Torvalds  * Slightly more convenient version of icmpv6_send.
1151da177e4SLinus Torvalds  */
116d5fdd6baSBrian Haley void icmpv6_param_prob(struct sk_buff *skb, u8 code, int pos)
1171da177e4SLinus Torvalds {
1183ffe533cSAlexey Dobriyan 	icmpv6_send(skb, ICMPV6_PARAMPROB, code, pos);
1191da177e4SLinus Torvalds 	kfree_skb(skb);
1201da177e4SLinus Torvalds }
1211da177e4SLinus Torvalds 
1221da177e4SLinus Torvalds /*
1231da177e4SLinus Torvalds  * Figure out, may we reply to this packet with icmp error.
1241da177e4SLinus Torvalds  *
1251da177e4SLinus Torvalds  * We do not reply, if:
1261da177e4SLinus Torvalds  *	- it was icmp error message.
1271da177e4SLinus Torvalds  *	- it is truncated, so that it is known, that protocol is ICMPV6
1281da177e4SLinus Torvalds  *	  (i.e. in the middle of some exthdr)
1291da177e4SLinus Torvalds  *
1301da177e4SLinus Torvalds  *	--ANK (980726)
1311da177e4SLinus Torvalds  */
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds static int is_ineligible(struct sk_buff *skb)
1341da177e4SLinus Torvalds {
1350660e03fSArnaldo Carvalho de Melo 	int ptr = (u8 *)(ipv6_hdr(skb) + 1) - skb->data;
1361da177e4SLinus Torvalds 	int len = skb->len - ptr;
1370660e03fSArnaldo Carvalho de Melo 	__u8 nexthdr = ipv6_hdr(skb)->nexthdr;
13875f2811cSJesse Gross 	__be16 frag_off;
1391da177e4SLinus Torvalds 
1401da177e4SLinus Torvalds 	if (len < 0)
1411da177e4SLinus Torvalds 		return 1;
1421da177e4SLinus Torvalds 
14375f2811cSJesse Gross 	ptr = ipv6_skip_exthdr(skb, ptr, &nexthdr, &frag_off);
1441da177e4SLinus Torvalds 	if (ptr < 0)
1451da177e4SLinus Torvalds 		return 0;
1461da177e4SLinus Torvalds 	if (nexthdr == IPPROTO_ICMPV6) {
1471da177e4SLinus Torvalds 		u8 _type, *tp;
1481da177e4SLinus Torvalds 		tp = skb_header_pointer(skb,
1491da177e4SLinus Torvalds 			ptr+offsetof(struct icmp6hdr, icmp6_type),
1501da177e4SLinus Torvalds 			sizeof(_type), &_type);
1511da177e4SLinus Torvalds 		if (tp == NULL ||
1521da177e4SLinus Torvalds 		    !(*tp & ICMPV6_INFOMSG_MASK))
1531da177e4SLinus Torvalds 			return 1;
1541da177e4SLinus Torvalds 	}
1551da177e4SLinus Torvalds 	return 0;
1561da177e4SLinus Torvalds }
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds /*
1591da177e4SLinus Torvalds  * Check the ICMP output rate limit
1601da177e4SLinus Torvalds  */
16192d86829SDavid S. Miller static inline bool icmpv6_xrlim_allow(struct sock *sk, u8 type,
1624c9483b2SDavid S. Miller 				      struct flowi6 *fl6)
1631da177e4SLinus Torvalds {
1641da177e4SLinus Torvalds 	struct dst_entry *dst;
1653b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(sk);
16692d86829SDavid S. Miller 	bool res = false;
1671da177e4SLinus Torvalds 
1681da177e4SLinus Torvalds 	/* Informational messages are not limited. */
1691da177e4SLinus Torvalds 	if (type & ICMPV6_INFOMSG_MASK)
17092d86829SDavid S. Miller 		return true;
1711da177e4SLinus Torvalds 
1721da177e4SLinus Torvalds 	/* Do not limit pmtu discovery, it would break it. */
1731da177e4SLinus Torvalds 	if (type == ICMPV6_PKT_TOOBIG)
17492d86829SDavid S. Miller 		return true;
1751da177e4SLinus Torvalds 
1761da177e4SLinus Torvalds 	/*
1771da177e4SLinus Torvalds 	 * Look up the output route.
1781da177e4SLinus Torvalds 	 * XXX: perhaps the expire for routing entries cloned by
1791da177e4SLinus Torvalds 	 * this lookup should be more aggressive (not longer than timeout).
1801da177e4SLinus Torvalds 	 */
1814c9483b2SDavid S. Miller 	dst = ip6_route_output(net, sk, fl6);
1821da177e4SLinus Torvalds 	if (dst->error) {
1833bd653c8SDenis V. Lunev 		IP6_INC_STATS(net, ip6_dst_idev(dst),
184a11d206dSYOSHIFUJI Hideaki 			      IPSTATS_MIB_OUTNOROUTES);
1851da177e4SLinus Torvalds 	} else if (dst->dev && (dst->dev->flags&IFF_LOOPBACK)) {
18692d86829SDavid S. Miller 		res = true;
1871da177e4SLinus Torvalds 	} else {
1881da177e4SLinus Torvalds 		struct rt6_info *rt = (struct rt6_info *)dst;
1899a43b709SBenjamin Thery 		int tmo = net->ipv6.sysctl.icmpv6_time;
1901da177e4SLinus Torvalds 
1911da177e4SLinus Torvalds 		/* Give more bandwidth to wider prefixes. */
1921da177e4SLinus Torvalds 		if (rt->rt6i_dst.plen < 128)
1931da177e4SLinus Torvalds 			tmo >>= ((128 - rt->rt6i_dst.plen)>>5);
1941da177e4SLinus Torvalds 
19592d86829SDavid S. Miller 		if (!rt->rt6i_peer)
19692d86829SDavid S. Miller 			rt6_bind_peer(rt, 1);
19792d86829SDavid S. Miller 		res = inet_peer_xrlim_allow(rt->rt6i_peer, tmo);
1981da177e4SLinus Torvalds 	}
1991da177e4SLinus Torvalds 	dst_release(dst);
2001da177e4SLinus Torvalds 	return res;
2011da177e4SLinus Torvalds }
2021da177e4SLinus Torvalds 
2031da177e4SLinus Torvalds /*
2041da177e4SLinus Torvalds  *	an inline helper for the "simple" if statement below
2051da177e4SLinus Torvalds  *	checks if parameter problem report is caused by an
2061da177e4SLinus Torvalds  *	unrecognized IPv6 option that has the Option Type
2071da177e4SLinus Torvalds  *	highest-order two bits set to 10
2081da177e4SLinus Torvalds  */
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds static __inline__ int opt_unrec(struct sk_buff *skb, __u32 offset)
2111da177e4SLinus Torvalds {
2121da177e4SLinus Torvalds 	u8 _optval, *op;
2131da177e4SLinus Torvalds 
214bbe735e4SArnaldo Carvalho de Melo 	offset += skb_network_offset(skb);
2151da177e4SLinus Torvalds 	op = skb_header_pointer(skb, offset, sizeof(_optval), &_optval);
2161da177e4SLinus Torvalds 	if (op == NULL)
2171da177e4SLinus Torvalds 		return 1;
2181da177e4SLinus Torvalds 	return (*op & 0xC0) == 0x80;
2191da177e4SLinus Torvalds }
2201da177e4SLinus Torvalds 
2214c9483b2SDavid S. Miller static int icmpv6_push_pending_frames(struct sock *sk, struct flowi6 *fl6, struct icmp6hdr *thdr, int len)
2221da177e4SLinus Torvalds {
2231da177e4SLinus Torvalds 	struct sk_buff *skb;
2241da177e4SLinus Torvalds 	struct icmp6hdr *icmp6h;
2251da177e4SLinus Torvalds 	int err = 0;
2261da177e4SLinus Torvalds 
2271da177e4SLinus Torvalds 	if ((skb = skb_peek(&sk->sk_write_queue)) == NULL)
2281da177e4SLinus Torvalds 		goto out;
2291da177e4SLinus Torvalds 
230cc70ab26SArnaldo Carvalho de Melo 	icmp6h = icmp6_hdr(skb);
2311da177e4SLinus Torvalds 	memcpy(icmp6h, thdr, sizeof(struct icmp6hdr));
2321da177e4SLinus Torvalds 	icmp6h->icmp6_cksum = 0;
2331da177e4SLinus Torvalds 
2341da177e4SLinus Torvalds 	if (skb_queue_len(&sk->sk_write_queue) == 1) {
23507f0757aSJoe Perches 		skb->csum = csum_partial(icmp6h,
2361da177e4SLinus Torvalds 					sizeof(struct icmp6hdr), skb->csum);
2374c9483b2SDavid S. Miller 		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
2384c9483b2SDavid S. Miller 						      &fl6->daddr,
2394c9483b2SDavid S. Miller 						      len, fl6->flowi6_proto,
2401da177e4SLinus Torvalds 						      skb->csum);
2411da177e4SLinus Torvalds 	} else {
242868c86bcSAl Viro 		__wsum tmp_csum = 0;
2431da177e4SLinus Torvalds 
2441da177e4SLinus Torvalds 		skb_queue_walk(&sk->sk_write_queue, skb) {
2451da177e4SLinus Torvalds 			tmp_csum = csum_add(tmp_csum, skb->csum);
2461da177e4SLinus Torvalds 		}
2471da177e4SLinus Torvalds 
24807f0757aSJoe Perches 		tmp_csum = csum_partial(icmp6h,
2491da177e4SLinus Torvalds 					sizeof(struct icmp6hdr), tmp_csum);
2504c9483b2SDavid S. Miller 		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
2514c9483b2SDavid S. Miller 						      &fl6->daddr,
2524c9483b2SDavid S. Miller 						      len, fl6->flowi6_proto,
253868c86bcSAl Viro 						      tmp_csum);
2541da177e4SLinus Torvalds 	}
2551da177e4SLinus Torvalds 	ip6_push_pending_frames(sk);
2561da177e4SLinus Torvalds out:
2571da177e4SLinus Torvalds 	return err;
2581da177e4SLinus Torvalds }
2591da177e4SLinus Torvalds 
2601da177e4SLinus Torvalds struct icmpv6_msg {
2611da177e4SLinus Torvalds 	struct sk_buff	*skb;
2621da177e4SLinus Torvalds 	int		offset;
263763ecff1SYasuyuki Kozakai 	uint8_t		type;
2641da177e4SLinus Torvalds };
2651da177e4SLinus Torvalds 
2661da177e4SLinus Torvalds static int icmpv6_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
2671da177e4SLinus Torvalds {
2681da177e4SLinus Torvalds 	struct icmpv6_msg *msg = (struct icmpv6_msg *) from;
2691da177e4SLinus Torvalds 	struct sk_buff *org_skb = msg->skb;
2705f92a738SAl Viro 	__wsum csum = 0;
2711da177e4SLinus Torvalds 
2721da177e4SLinus Torvalds 	csum = skb_copy_and_csum_bits(org_skb, msg->offset + offset,
2731da177e4SLinus Torvalds 				      to, len, csum);
2741da177e4SLinus Torvalds 	skb->csum = csum_block_add(skb->csum, csum, odd);
275763ecff1SYasuyuki Kozakai 	if (!(msg->type & ICMPV6_INFOMSG_MASK))
276763ecff1SYasuyuki Kozakai 		nf_ct_attach(skb, org_skb);
2771da177e4SLinus Torvalds 	return 0;
2781da177e4SLinus Torvalds }
2791da177e4SLinus Torvalds 
28059fbb3a6SMasahide NAKAMURA #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
28179383236SMasahide NAKAMURA static void mip6_addr_swap(struct sk_buff *skb)
28279383236SMasahide NAKAMURA {
2830660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *iph = ipv6_hdr(skb);
28479383236SMasahide NAKAMURA 	struct inet6_skb_parm *opt = IP6CB(skb);
28579383236SMasahide NAKAMURA 	struct ipv6_destopt_hao *hao;
28679383236SMasahide NAKAMURA 	struct in6_addr tmp;
28779383236SMasahide NAKAMURA 	int off;
28879383236SMasahide NAKAMURA 
28979383236SMasahide NAKAMURA 	if (opt->dsthao) {
29079383236SMasahide NAKAMURA 		off = ipv6_find_tlv(skb, opt->dsthao, IPV6_TLV_HAO);
29179383236SMasahide NAKAMURA 		if (likely(off >= 0)) {
292d56f90a7SArnaldo Carvalho de Melo 			hao = (struct ipv6_destopt_hao *)
293d56f90a7SArnaldo Carvalho de Melo 					(skb_network_header(skb) + off);
2944e3fd7a0SAlexey Dobriyan 			tmp = iph->saddr;
2954e3fd7a0SAlexey Dobriyan 			iph->saddr = hao->addr;
2964e3fd7a0SAlexey Dobriyan 			hao->addr = tmp;
29779383236SMasahide NAKAMURA 		}
29879383236SMasahide NAKAMURA 	}
29979383236SMasahide NAKAMURA }
30079383236SMasahide NAKAMURA #else
30179383236SMasahide NAKAMURA static inline void mip6_addr_swap(struct sk_buff *skb) {}
30279383236SMasahide NAKAMURA #endif
30379383236SMasahide NAKAMURA 
304b42835dbSDavid S. Miller static struct dst_entry *icmpv6_route_lookup(struct net *net, struct sk_buff *skb,
3054c9483b2SDavid S. Miller 					     struct sock *sk, struct flowi6 *fl6)
306b42835dbSDavid S. Miller {
307b42835dbSDavid S. Miller 	struct dst_entry *dst, *dst2;
3084c9483b2SDavid S. Miller 	struct flowi6 fl2;
309b42835dbSDavid S. Miller 	int err;
310b42835dbSDavid S. Miller 
3114c9483b2SDavid S. Miller 	err = ip6_dst_lookup(sk, &dst, fl6);
312b42835dbSDavid S. Miller 	if (err)
313b42835dbSDavid S. Miller 		return ERR_PTR(err);
314b42835dbSDavid S. Miller 
315b42835dbSDavid S. Miller 	/*
316b42835dbSDavid S. Miller 	 * We won't send icmp if the destination is known
317b42835dbSDavid S. Miller 	 * anycast.
318b42835dbSDavid S. Miller 	 */
319b42835dbSDavid S. Miller 	if (((struct rt6_info *)dst)->rt6i_flags & RTF_ANYCAST) {
320b42835dbSDavid S. Miller 		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: acast source\n");
321b42835dbSDavid S. Miller 		dst_release(dst);
322b42835dbSDavid S. Miller 		return ERR_PTR(-EINVAL);
323b42835dbSDavid S. Miller 	}
324b42835dbSDavid S. Miller 
325b42835dbSDavid S. Miller 	/* No need to clone since we're just using its address. */
326b42835dbSDavid S. Miller 	dst2 = dst;
327b42835dbSDavid S. Miller 
3284c9483b2SDavid S. Miller 	dst = xfrm_lookup(net, dst, flowi6_to_flowi(fl6), sk, 0);
329452edd59SDavid S. Miller 	if (!IS_ERR(dst)) {
330b42835dbSDavid S. Miller 		if (dst != dst2)
331b42835dbSDavid S. Miller 			return dst;
332452edd59SDavid S. Miller 	} else {
333452edd59SDavid S. Miller 		if (PTR_ERR(dst) == -EPERM)
334b42835dbSDavid S. Miller 			dst = NULL;
335452edd59SDavid S. Miller 		else
336452edd59SDavid S. Miller 			return dst;
337b42835dbSDavid S. Miller 	}
338b42835dbSDavid S. Miller 
3394c9483b2SDavid S. Miller 	err = xfrm_decode_session_reverse(skb, flowi6_to_flowi(&fl2), AF_INET6);
340b42835dbSDavid S. Miller 	if (err)
341b42835dbSDavid S. Miller 		goto relookup_failed;
342b42835dbSDavid S. Miller 
343b42835dbSDavid S. Miller 	err = ip6_dst_lookup(sk, &dst2, &fl2);
344b42835dbSDavid S. Miller 	if (err)
345b42835dbSDavid S. Miller 		goto relookup_failed;
346b42835dbSDavid S. Miller 
3474c9483b2SDavid S. Miller 	dst2 = xfrm_lookup(net, dst2, flowi6_to_flowi(&fl2), sk, XFRM_LOOKUP_ICMP);
348452edd59SDavid S. Miller 	if (!IS_ERR(dst2)) {
349b42835dbSDavid S. Miller 		dst_release(dst);
350b42835dbSDavid S. Miller 		dst = dst2;
351452edd59SDavid S. Miller 	} else {
352452edd59SDavid S. Miller 		err = PTR_ERR(dst2);
353452edd59SDavid S. Miller 		if (err == -EPERM) {
354b42835dbSDavid S. Miller 			dst_release(dst);
355452edd59SDavid S. Miller 			return dst2;
356452edd59SDavid S. Miller 		} else
357b42835dbSDavid S. Miller 			goto relookup_failed;
358b42835dbSDavid S. Miller 	}
359b42835dbSDavid S. Miller 
360b42835dbSDavid S. Miller relookup_failed:
361b42835dbSDavid S. Miller 	if (dst)
362b42835dbSDavid S. Miller 		return dst;
363b42835dbSDavid S. Miller 	return ERR_PTR(err);
364b42835dbSDavid S. Miller }
365b42835dbSDavid S. Miller 
3661da177e4SLinus Torvalds /*
3671da177e4SLinus Torvalds  *	Send an ICMP message in response to a packet in error
3681da177e4SLinus Torvalds  */
3693ffe533cSAlexey Dobriyan void icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info)
3701da177e4SLinus Torvalds {
371c346dca1SYOSHIFUJI Hideaki 	struct net *net = dev_net(skb->dev);
3721da177e4SLinus Torvalds 	struct inet6_dev *idev = NULL;
3730660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
37484427d53SYOSHIFUJI Hideaki 	struct sock *sk;
37584427d53SYOSHIFUJI Hideaki 	struct ipv6_pinfo *np;
376b71d1d42SEric Dumazet 	const struct in6_addr *saddr = NULL;
3771da177e4SLinus Torvalds 	struct dst_entry *dst;
3781da177e4SLinus Torvalds 	struct icmp6hdr tmp_hdr;
3794c9483b2SDavid S. Miller 	struct flowi6 fl6;
3801da177e4SLinus Torvalds 	struct icmpv6_msg msg;
3811da177e4SLinus Torvalds 	int iif = 0;
3821da177e4SLinus Torvalds 	int addr_type = 0;
3831da177e4SLinus Torvalds 	int len;
384e651f03aSGerrit Renker 	int hlimit;
3851da177e4SLinus Torvalds 	int err = 0;
3861da177e4SLinus Torvalds 
38727a884dcSArnaldo Carvalho de Melo 	if ((u8 *)hdr < skb->head ||
38827a884dcSArnaldo Carvalho de Melo 	    (skb->network_header + sizeof(*hdr)) > skb->tail)
3891da177e4SLinus Torvalds 		return;
3901da177e4SLinus Torvalds 
3911da177e4SLinus Torvalds 	/*
3921da177e4SLinus Torvalds 	 *	Make sure we respect the rules
3931da177e4SLinus Torvalds 	 *	i.e. RFC 1885 2.4(e)
3941da177e4SLinus Torvalds 	 *	Rule (e.1) is enforced by not using icmpv6_send
3951da177e4SLinus Torvalds 	 *	in any code that processes icmp errors.
3961da177e4SLinus Torvalds 	 */
3971da177e4SLinus Torvalds 	addr_type = ipv6_addr_type(&hdr->daddr);
3981da177e4SLinus Torvalds 
3999a43b709SBenjamin Thery 	if (ipv6_chk_addr(net, &hdr->daddr, skb->dev, 0))
4001da177e4SLinus Torvalds 		saddr = &hdr->daddr;
4011da177e4SLinus Torvalds 
4021da177e4SLinus Torvalds 	/*
4031da177e4SLinus Torvalds 	 *	Dest addr check
4041da177e4SLinus Torvalds 	 */
4051da177e4SLinus Torvalds 
4061da177e4SLinus Torvalds 	if ((addr_type & IPV6_ADDR_MULTICAST || skb->pkt_type != PACKET_HOST)) {
4071da177e4SLinus Torvalds 		if (type != ICMPV6_PKT_TOOBIG &&
4081da177e4SLinus Torvalds 		    !(type == ICMPV6_PARAMPROB &&
4091da177e4SLinus Torvalds 		      code == ICMPV6_UNK_OPTION &&
4101da177e4SLinus Torvalds 		      (opt_unrec(skb, info))))
4111da177e4SLinus Torvalds 			return;
4121da177e4SLinus Torvalds 
4131da177e4SLinus Torvalds 		saddr = NULL;
4141da177e4SLinus Torvalds 	}
4151da177e4SLinus Torvalds 
4161da177e4SLinus Torvalds 	addr_type = ipv6_addr_type(&hdr->saddr);
4171da177e4SLinus Torvalds 
4181da177e4SLinus Torvalds 	/*
4191da177e4SLinus Torvalds 	 *	Source addr check
4201da177e4SLinus Torvalds 	 */
4211da177e4SLinus Torvalds 
4221da177e4SLinus Torvalds 	if (addr_type & IPV6_ADDR_LINKLOCAL)
4231da177e4SLinus Torvalds 		iif = skb->dev->ifindex;
4241da177e4SLinus Torvalds 
4251da177e4SLinus Torvalds 	/*
4268de3351eSYOSHIFUJI Hideaki 	 *	Must not send error if the source does not uniquely
4278de3351eSYOSHIFUJI Hideaki 	 *	identify a single node (RFC2463 Section 2.4).
4288de3351eSYOSHIFUJI Hideaki 	 *	We check unspecified / multicast addresses here,
4298de3351eSYOSHIFUJI Hideaki 	 *	and anycast addresses will be checked later.
4301da177e4SLinus Torvalds 	 */
4311da177e4SLinus Torvalds 	if ((addr_type == IPV6_ADDR_ANY) || (addr_type & IPV6_ADDR_MULTICAST)) {
43264ce2073SPatrick McHardy 		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: addr_any/mcast source\n");
4331da177e4SLinus Torvalds 		return;
4341da177e4SLinus Torvalds 	}
4351da177e4SLinus Torvalds 
4361da177e4SLinus Torvalds 	/*
4371da177e4SLinus Torvalds 	 *	Never answer to a ICMP packet.
4381da177e4SLinus Torvalds 	 */
4391da177e4SLinus Torvalds 	if (is_ineligible(skb)) {
44064ce2073SPatrick McHardy 		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: no reply to icmp error\n");
4411da177e4SLinus Torvalds 		return;
4421da177e4SLinus Torvalds 	}
4431da177e4SLinus Torvalds 
44479383236SMasahide NAKAMURA 	mip6_addr_swap(skb);
44579383236SMasahide NAKAMURA 
4464c9483b2SDavid S. Miller 	memset(&fl6, 0, sizeof(fl6));
4474c9483b2SDavid S. Miller 	fl6.flowi6_proto = IPPROTO_ICMPV6;
4484e3fd7a0SAlexey Dobriyan 	fl6.daddr = hdr->saddr;
4491da177e4SLinus Torvalds 	if (saddr)
4504e3fd7a0SAlexey Dobriyan 		fl6.saddr = *saddr;
4514c9483b2SDavid S. Miller 	fl6.flowi6_oif = iif;
4521958b856SDavid S. Miller 	fl6.fl6_icmp_type = type;
4531958b856SDavid S. Miller 	fl6.fl6_icmp_code = code;
4544c9483b2SDavid S. Miller 	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
4551da177e4SLinus Torvalds 
456fdc0bde9SDenis V. Lunev 	sk = icmpv6_xmit_lock(net);
457fdc0bde9SDenis V. Lunev 	if (sk == NULL)
458405666dbSDenis V. Lunev 		return;
459fdc0bde9SDenis V. Lunev 	np = inet6_sk(sk);
460405666dbSDenis V. Lunev 
4614c9483b2SDavid S. Miller 	if (!icmpv6_xrlim_allow(sk, type, &fl6))
4621da177e4SLinus Torvalds 		goto out;
4631da177e4SLinus Torvalds 
4641da177e4SLinus Torvalds 	tmp_hdr.icmp6_type = type;
4651da177e4SLinus Torvalds 	tmp_hdr.icmp6_code = code;
4661da177e4SLinus Torvalds 	tmp_hdr.icmp6_cksum = 0;
4671da177e4SLinus Torvalds 	tmp_hdr.icmp6_pointer = htonl(info);
4681da177e4SLinus Torvalds 
4694c9483b2SDavid S. Miller 	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
4704c9483b2SDavid S. Miller 		fl6.flowi6_oif = np->mcast_oif;
471c4062dfcSErich E. Hoover 	else if (!fl6.flowi6_oif)
472c4062dfcSErich E. Hoover 		fl6.flowi6_oif = np->ucast_oif;
4731da177e4SLinus Torvalds 
4744c9483b2SDavid S. Miller 	dst = icmpv6_route_lookup(net, skb, sk, &fl6);
475b42835dbSDavid S. Miller 	if (IS_ERR(dst))
4761da177e4SLinus Torvalds 		goto out;
4778de3351eSYOSHIFUJI Hideaki 
4784c9483b2SDavid S. Miller 	if (ipv6_addr_is_multicast(&fl6.daddr))
4791da177e4SLinus Torvalds 		hlimit = np->mcast_hops;
4801da177e4SLinus Torvalds 	else
4811da177e4SLinus Torvalds 		hlimit = np->hop_limit;
4821da177e4SLinus Torvalds 	if (hlimit < 0)
4836b75d090SYOSHIFUJI Hideaki 		hlimit = ip6_dst_hoplimit(dst);
4841da177e4SLinus Torvalds 
4851da177e4SLinus Torvalds 	msg.skb = skb;
486bbe735e4SArnaldo Carvalho de Melo 	msg.offset = skb_network_offset(skb);
487763ecff1SYasuyuki Kozakai 	msg.type = type;
4881da177e4SLinus Torvalds 
4891da177e4SLinus Torvalds 	len = skb->len - msg.offset;
4901da177e4SLinus Torvalds 	len = min_t(unsigned int, len, IPV6_MIN_MTU - sizeof(struct ipv6hdr) -sizeof(struct icmp6hdr));
4911da177e4SLinus Torvalds 	if (len < 0) {
49264ce2073SPatrick McHardy 		LIMIT_NETDEBUG(KERN_DEBUG "icmp: len problem\n");
4931da177e4SLinus Torvalds 		goto out_dst_release;
4941da177e4SLinus Torvalds 	}
4951da177e4SLinus Torvalds 
496cfdf7647SEric Dumazet 	rcu_read_lock();
497cfdf7647SEric Dumazet 	idev = __in6_dev_get(skb->dev);
4981da177e4SLinus Torvalds 
4991da177e4SLinus Torvalds 	err = ip6_append_data(sk, icmpv6_getfrag, &msg,
5001da177e4SLinus Torvalds 			      len + sizeof(struct icmp6hdr),
501e651f03aSGerrit Renker 			      sizeof(struct icmp6hdr), hlimit,
5024c9483b2SDavid S. Miller 			      np->tclass, NULL, &fl6, (struct rt6_info*)dst,
50313b52cd4SBrian Haley 			      MSG_DONTWAIT, np->dontfrag);
5041da177e4SLinus Torvalds 	if (err) {
50500d9d6a1SEric Dumazet 		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
5061da177e4SLinus Torvalds 		ip6_flush_pending_frames(sk);
507cfdf7647SEric Dumazet 	} else {
508cfdf7647SEric Dumazet 		err = icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
509cfdf7647SEric Dumazet 						 len + sizeof(struct icmp6hdr));
5101da177e4SLinus Torvalds 	}
511cfdf7647SEric Dumazet 	rcu_read_unlock();
5121da177e4SLinus Torvalds out_dst_release:
5131da177e4SLinus Torvalds 	dst_release(dst);
5141da177e4SLinus Torvalds out:
515405666dbSDenis V. Lunev 	icmpv6_xmit_unlock(sk);
5161da177e4SLinus Torvalds }
5177159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(icmpv6_send);
5187159039aSYOSHIFUJI Hideaki 
5191da177e4SLinus Torvalds static void icmpv6_echo_reply(struct sk_buff *skb)
5201da177e4SLinus Torvalds {
521c346dca1SYOSHIFUJI Hideaki 	struct net *net = dev_net(skb->dev);
52284427d53SYOSHIFUJI Hideaki 	struct sock *sk;
5231da177e4SLinus Torvalds 	struct inet6_dev *idev;
52484427d53SYOSHIFUJI Hideaki 	struct ipv6_pinfo *np;
525b71d1d42SEric Dumazet 	const struct in6_addr *saddr = NULL;
526cc70ab26SArnaldo Carvalho de Melo 	struct icmp6hdr *icmph = icmp6_hdr(skb);
5271da177e4SLinus Torvalds 	struct icmp6hdr tmp_hdr;
5284c9483b2SDavid S. Miller 	struct flowi6 fl6;
5291da177e4SLinus Torvalds 	struct icmpv6_msg msg;
5301da177e4SLinus Torvalds 	struct dst_entry *dst;
5311da177e4SLinus Torvalds 	int err = 0;
5321da177e4SLinus Torvalds 	int hlimit;
5331da177e4SLinus Torvalds 
5340660e03fSArnaldo Carvalho de Melo 	saddr = &ipv6_hdr(skb)->daddr;
5351da177e4SLinus Torvalds 
5361da177e4SLinus Torvalds 	if (!ipv6_unicast_destination(skb))
5371da177e4SLinus Torvalds 		saddr = NULL;
5381da177e4SLinus Torvalds 
5391da177e4SLinus Torvalds 	memcpy(&tmp_hdr, icmph, sizeof(tmp_hdr));
5401da177e4SLinus Torvalds 	tmp_hdr.icmp6_type = ICMPV6_ECHO_REPLY;
5411da177e4SLinus Torvalds 
5424c9483b2SDavid S. Miller 	memset(&fl6, 0, sizeof(fl6));
5434c9483b2SDavid S. Miller 	fl6.flowi6_proto = IPPROTO_ICMPV6;
5444e3fd7a0SAlexey Dobriyan 	fl6.daddr = ipv6_hdr(skb)->saddr;
5451da177e4SLinus Torvalds 	if (saddr)
5464e3fd7a0SAlexey Dobriyan 		fl6.saddr = *saddr;
5474c9483b2SDavid S. Miller 	fl6.flowi6_oif = skb->dev->ifindex;
5481958b856SDavid S. Miller 	fl6.fl6_icmp_type = ICMPV6_ECHO_REPLY;
5494c9483b2SDavid S. Miller 	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
5501da177e4SLinus Torvalds 
551fdc0bde9SDenis V. Lunev 	sk = icmpv6_xmit_lock(net);
552fdc0bde9SDenis V. Lunev 	if (sk == NULL)
553405666dbSDenis V. Lunev 		return;
554fdc0bde9SDenis V. Lunev 	np = inet6_sk(sk);
555405666dbSDenis V. Lunev 
5564c9483b2SDavid S. Miller 	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
5574c9483b2SDavid S. Miller 		fl6.flowi6_oif = np->mcast_oif;
558c4062dfcSErich E. Hoover 	else if (!fl6.flowi6_oif)
559c4062dfcSErich E. Hoover 		fl6.flowi6_oif = np->ucast_oif;
5601da177e4SLinus Torvalds 
5614c9483b2SDavid S. Miller 	err = ip6_dst_lookup(sk, &dst, &fl6);
5621da177e4SLinus Torvalds 	if (err)
5631da177e4SLinus Torvalds 		goto out;
5644c9483b2SDavid S. Miller 	dst = xfrm_lookup(net, dst, flowi6_to_flowi(&fl6), sk, 0);
565452edd59SDavid S. Miller 	if (IS_ERR(dst))
566e104411bSPatrick McHardy 		goto out;
5671da177e4SLinus Torvalds 
5684c9483b2SDavid S. Miller 	if (ipv6_addr_is_multicast(&fl6.daddr))
5691da177e4SLinus Torvalds 		hlimit = np->mcast_hops;
5701da177e4SLinus Torvalds 	else
5711da177e4SLinus Torvalds 		hlimit = np->hop_limit;
5721da177e4SLinus Torvalds 	if (hlimit < 0)
5736b75d090SYOSHIFUJI Hideaki 		hlimit = ip6_dst_hoplimit(dst);
5741da177e4SLinus Torvalds 
575cfdf7647SEric Dumazet 	idev = __in6_dev_get(skb->dev);
5761da177e4SLinus Torvalds 
5771da177e4SLinus Torvalds 	msg.skb = skb;
5781da177e4SLinus Torvalds 	msg.offset = 0;
579763ecff1SYasuyuki Kozakai 	msg.type = ICMPV6_ECHO_REPLY;
5801da177e4SLinus Torvalds 
5811da177e4SLinus Torvalds 	err = ip6_append_data(sk, icmpv6_getfrag, &msg, skb->len + sizeof(struct icmp6hdr),
5824c9483b2SDavid S. Miller 				sizeof(struct icmp6hdr), hlimit, np->tclass, NULL, &fl6,
58313b52cd4SBrian Haley 				(struct rt6_info*)dst, MSG_DONTWAIT,
58413b52cd4SBrian Haley 				np->dontfrag);
5851da177e4SLinus Torvalds 
5861da177e4SLinus Torvalds 	if (err) {
58700d9d6a1SEric Dumazet 		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
5881da177e4SLinus Torvalds 		ip6_flush_pending_frames(sk);
589cfdf7647SEric Dumazet 	} else {
590cfdf7647SEric Dumazet 		err = icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
591cfdf7647SEric Dumazet 						 skb->len + sizeof(struct icmp6hdr));
5921da177e4SLinus Torvalds 	}
5931da177e4SLinus Torvalds 	dst_release(dst);
5941da177e4SLinus Torvalds out:
595405666dbSDenis V. Lunev 	icmpv6_xmit_unlock(sk);
5961da177e4SLinus Torvalds }
5971da177e4SLinus Torvalds 
598d5fdd6baSBrian Haley static void icmpv6_notify(struct sk_buff *skb, u8 type, u8 code, __be32 info)
5991da177e4SLinus Torvalds {
60041135cc8SAlexey Dobriyan 	const struct inet6_protocol *ipprot;
6011da177e4SLinus Torvalds 	int inner_offset;
6021da177e4SLinus Torvalds 	int hash;
6031da177e4SLinus Torvalds 	u8 nexthdr;
60475f2811cSJesse Gross 	__be16 frag_off;
6051da177e4SLinus Torvalds 
6061da177e4SLinus Torvalds 	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
6071da177e4SLinus Torvalds 		return;
6081da177e4SLinus Torvalds 
6091da177e4SLinus Torvalds 	nexthdr = ((struct ipv6hdr *)skb->data)->nexthdr;
6101da177e4SLinus Torvalds 	if (ipv6_ext_hdr(nexthdr)) {
6111da177e4SLinus Torvalds 		/* now skip over extension headers */
61275f2811cSJesse Gross 		inner_offset = ipv6_skip_exthdr(skb, sizeof(struct ipv6hdr),
61375f2811cSJesse Gross 						&nexthdr, &frag_off);
6141da177e4SLinus Torvalds 		if (inner_offset<0)
6151da177e4SLinus Torvalds 			return;
6161da177e4SLinus Torvalds 	} else {
6171da177e4SLinus Torvalds 		inner_offset = sizeof(struct ipv6hdr);
6181da177e4SLinus Torvalds 	}
6191da177e4SLinus Torvalds 
6201da177e4SLinus Torvalds 	/* Checkin header including 8 bytes of inner protocol header. */
6211da177e4SLinus Torvalds 	if (!pskb_may_pull(skb, inner_offset+8))
6221da177e4SLinus Torvalds 		return;
6231da177e4SLinus Torvalds 
6241da177e4SLinus Torvalds 	/* BUGGG_FUTURE: we should try to parse exthdrs in this packet.
6251da177e4SLinus Torvalds 	   Without this we will not able f.e. to make source routed
6261da177e4SLinus Torvalds 	   pmtu discovery.
6271da177e4SLinus Torvalds 	   Corresponding argument (opt) to notifiers is already added.
6281da177e4SLinus Torvalds 	   --ANK (980726)
6291da177e4SLinus Torvalds 	 */
6301da177e4SLinus Torvalds 
6311da177e4SLinus Torvalds 	hash = nexthdr & (MAX_INET_PROTOS - 1);
6321da177e4SLinus Torvalds 
6331da177e4SLinus Torvalds 	rcu_read_lock();
6341da177e4SLinus Torvalds 	ipprot = rcu_dereference(inet6_protos[hash]);
6351da177e4SLinus Torvalds 	if (ipprot && ipprot->err_handler)
6361da177e4SLinus Torvalds 		ipprot->err_handler(skb, NULL, type, code, inner_offset, info);
6371da177e4SLinus Torvalds 	rcu_read_unlock();
6381da177e4SLinus Torvalds 
63969d6da0bSPavel Emelyanov 	raw6_icmp_error(skb, nexthdr, type, code, inner_offset, info);
6401da177e4SLinus Torvalds }
6411da177e4SLinus Torvalds 
6421da177e4SLinus Torvalds /*
6431da177e4SLinus Torvalds  *	Handle icmp messages
6441da177e4SLinus Torvalds  */
6451da177e4SLinus Torvalds 
646e5bbef20SHerbert Xu static int icmpv6_rcv(struct sk_buff *skb)
6471da177e4SLinus Torvalds {
6481da177e4SLinus Torvalds 	struct net_device *dev = skb->dev;
6491da177e4SLinus Torvalds 	struct inet6_dev *idev = __in6_dev_get(dev);
650b71d1d42SEric Dumazet 	const struct in6_addr *saddr, *daddr;
651b71d1d42SEric Dumazet 	const struct ipv6hdr *orig_hdr;
6521da177e4SLinus Torvalds 	struct icmp6hdr *hdr;
653d5fdd6baSBrian Haley 	u8 type;
6541da177e4SLinus Torvalds 
655aebcf82cSHerbert Xu 	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
656def8b4faSAlexey Dobriyan 		struct sec_path *sp = skb_sec_path(skb);
6578b7817f3SHerbert Xu 		int nh;
6588b7817f3SHerbert Xu 
659def8b4faSAlexey Dobriyan 		if (!(sp && sp->xvec[sp->len - 1]->props.flags &
660aebcf82cSHerbert Xu 				 XFRM_STATE_ICMP))
661aebcf82cSHerbert Xu 			goto drop_no_count;
662aebcf82cSHerbert Xu 
6638b7817f3SHerbert Xu 		if (!pskb_may_pull(skb, sizeof(*hdr) + sizeof(*orig_hdr)))
6648b7817f3SHerbert Xu 			goto drop_no_count;
6658b7817f3SHerbert Xu 
6668b7817f3SHerbert Xu 		nh = skb_network_offset(skb);
6678b7817f3SHerbert Xu 		skb_set_network_header(skb, sizeof(*hdr));
6688b7817f3SHerbert Xu 
6698b7817f3SHerbert Xu 		if (!xfrm6_policy_check_reverse(NULL, XFRM_POLICY_IN, skb))
6708b7817f3SHerbert Xu 			goto drop_no_count;
6718b7817f3SHerbert Xu 
6728b7817f3SHerbert Xu 		skb_set_network_header(skb, nh);
6738b7817f3SHerbert Xu 	}
6748b7817f3SHerbert Xu 
675e41b5368SDenis V. Lunev 	ICMP6_INC_STATS_BH(dev_net(dev), idev, ICMP6_MIB_INMSGS);
6761da177e4SLinus Torvalds 
6770660e03fSArnaldo Carvalho de Melo 	saddr = &ipv6_hdr(skb)->saddr;
6780660e03fSArnaldo Carvalho de Melo 	daddr = &ipv6_hdr(skb)->daddr;
6791da177e4SLinus Torvalds 
6801da177e4SLinus Torvalds 	/* Perform checksum. */
681fb286bb2SHerbert Xu 	switch (skb->ip_summed) {
68284fa7933SPatrick McHardy 	case CHECKSUM_COMPLETE:
683fb286bb2SHerbert Xu 		if (!csum_ipv6_magic(saddr, daddr, skb->len, IPPROTO_ICMPV6,
684fb286bb2SHerbert Xu 				     skb->csum))
685fb286bb2SHerbert Xu 			break;
686fb286bb2SHerbert Xu 		/* fall through */
687fb286bb2SHerbert Xu 	case CHECKSUM_NONE:
688868c86bcSAl Viro 		skb->csum = ~csum_unfold(csum_ipv6_magic(saddr, daddr, skb->len,
689868c86bcSAl Viro 					     IPPROTO_ICMPV6, 0));
690fb286bb2SHerbert Xu 		if (__skb_checksum_complete(skb)) {
6915b095d98SHarvey Harrison 			LIMIT_NETDEBUG(KERN_DEBUG "ICMPv6 checksum failed [%pI6 > %pI6]\n",
6920c6ce78aSHarvey Harrison 				       saddr, daddr);
6931da177e4SLinus Torvalds 			goto discard_it;
6941da177e4SLinus Torvalds 		}
6951da177e4SLinus Torvalds 	}
6961da177e4SLinus Torvalds 
6978cf22943SHerbert Xu 	if (!pskb_pull(skb, sizeof(*hdr)))
6988cf22943SHerbert Xu 		goto discard_it;
6991da177e4SLinus Torvalds 
700cc70ab26SArnaldo Carvalho de Melo 	hdr = icmp6_hdr(skb);
7011da177e4SLinus Torvalds 
7021da177e4SLinus Torvalds 	type = hdr->icmp6_type;
7031da177e4SLinus Torvalds 
70455d43808SDenis V. Lunev 	ICMP6MSGIN_INC_STATS_BH(dev_net(dev), idev, type);
7051da177e4SLinus Torvalds 
7061da177e4SLinus Torvalds 	switch (type) {
7071da177e4SLinus Torvalds 	case ICMPV6_ECHO_REQUEST:
7081da177e4SLinus Torvalds 		icmpv6_echo_reply(skb);
7091da177e4SLinus Torvalds 		break;
7101da177e4SLinus Torvalds 
7111da177e4SLinus Torvalds 	case ICMPV6_ECHO_REPLY:
7121da177e4SLinus Torvalds 		/* we couldn't care less */
7131da177e4SLinus Torvalds 		break;
7141da177e4SLinus Torvalds 
7151da177e4SLinus Torvalds 	case ICMPV6_PKT_TOOBIG:
7161da177e4SLinus Torvalds 		/* BUGGG_FUTURE: if packet contains rthdr, we cannot update
7171da177e4SLinus Torvalds 		   standard destination cache. Seems, only "advanced"
7181da177e4SLinus Torvalds 		   destination cache will allow to solve this problem
7191da177e4SLinus Torvalds 		   --ANK (980726)
7201da177e4SLinus Torvalds 		 */
7211da177e4SLinus Torvalds 		if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
7221da177e4SLinus Torvalds 			goto discard_it;
723cc70ab26SArnaldo Carvalho de Melo 		hdr = icmp6_hdr(skb);
7241da177e4SLinus Torvalds 		orig_hdr = (struct ipv6hdr *) (hdr + 1);
7251da177e4SLinus Torvalds 		rt6_pmtu_discovery(&orig_hdr->daddr, &orig_hdr->saddr, dev,
7261da177e4SLinus Torvalds 				   ntohl(hdr->icmp6_mtu));
7271da177e4SLinus Torvalds 
7281da177e4SLinus Torvalds 		/*
7291da177e4SLinus Torvalds 		 *	Drop through to notify
7301da177e4SLinus Torvalds 		 */
7311da177e4SLinus Torvalds 
7321da177e4SLinus Torvalds 	case ICMPV6_DEST_UNREACH:
7331da177e4SLinus Torvalds 	case ICMPV6_TIME_EXCEED:
7341da177e4SLinus Torvalds 	case ICMPV6_PARAMPROB:
7351da177e4SLinus Torvalds 		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
7361da177e4SLinus Torvalds 		break;
7371da177e4SLinus Torvalds 
7381da177e4SLinus Torvalds 	case NDISC_ROUTER_SOLICITATION:
7391da177e4SLinus Torvalds 	case NDISC_ROUTER_ADVERTISEMENT:
7401da177e4SLinus Torvalds 	case NDISC_NEIGHBOUR_SOLICITATION:
7411da177e4SLinus Torvalds 	case NDISC_NEIGHBOUR_ADVERTISEMENT:
7421da177e4SLinus Torvalds 	case NDISC_REDIRECT:
7431da177e4SLinus Torvalds 		ndisc_rcv(skb);
7441da177e4SLinus Torvalds 		break;
7451da177e4SLinus Torvalds 
7461da177e4SLinus Torvalds 	case ICMPV6_MGM_QUERY:
7471da177e4SLinus Torvalds 		igmp6_event_query(skb);
7481da177e4SLinus Torvalds 		break;
7491da177e4SLinus Torvalds 
7501da177e4SLinus Torvalds 	case ICMPV6_MGM_REPORT:
7511da177e4SLinus Torvalds 		igmp6_event_report(skb);
7521da177e4SLinus Torvalds 		break;
7531da177e4SLinus Torvalds 
7541da177e4SLinus Torvalds 	case ICMPV6_MGM_REDUCTION:
7551da177e4SLinus Torvalds 	case ICMPV6_NI_QUERY:
7561da177e4SLinus Torvalds 	case ICMPV6_NI_REPLY:
7571da177e4SLinus Torvalds 	case ICMPV6_MLD2_REPORT:
7581da177e4SLinus Torvalds 	case ICMPV6_DHAAD_REQUEST:
7591da177e4SLinus Torvalds 	case ICMPV6_DHAAD_REPLY:
7601da177e4SLinus Torvalds 	case ICMPV6_MOBILE_PREFIX_SOL:
7611da177e4SLinus Torvalds 	case ICMPV6_MOBILE_PREFIX_ADV:
7621da177e4SLinus Torvalds 		break;
7631da177e4SLinus Torvalds 
7641da177e4SLinus Torvalds 	default:
76564ce2073SPatrick McHardy 		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6: msg of unknown type\n");
7661da177e4SLinus Torvalds 
7671da177e4SLinus Torvalds 		/* informational */
7681da177e4SLinus Torvalds 		if (type & ICMPV6_INFOMSG_MASK)
7691da177e4SLinus Torvalds 			break;
7701da177e4SLinus Torvalds 
7711da177e4SLinus Torvalds 		/*
7721da177e4SLinus Torvalds 		 * error of unknown type.
7731da177e4SLinus Torvalds 		 * must pass to upper level
7741da177e4SLinus Torvalds 		 */
7751da177e4SLinus Torvalds 
7761da177e4SLinus Torvalds 		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
7773ff50b79SStephen Hemminger 	}
7783ff50b79SStephen Hemminger 
7791da177e4SLinus Torvalds 	kfree_skb(skb);
7801da177e4SLinus Torvalds 	return 0;
7811da177e4SLinus Torvalds 
7821da177e4SLinus Torvalds discard_it:
783e41b5368SDenis V. Lunev 	ICMP6_INC_STATS_BH(dev_net(dev), idev, ICMP6_MIB_INERRORS);
7848b7817f3SHerbert Xu drop_no_count:
7851da177e4SLinus Torvalds 	kfree_skb(skb);
7861da177e4SLinus Torvalds 	return 0;
7871da177e4SLinus Torvalds }
7881da177e4SLinus Torvalds 
7894c9483b2SDavid S. Miller void icmpv6_flow_init(struct sock *sk, struct flowi6 *fl6,
79095e41e93SYOSHIFUJI Hideaki 		      u8 type,
79195e41e93SYOSHIFUJI Hideaki 		      const struct in6_addr *saddr,
79295e41e93SYOSHIFUJI Hideaki 		      const struct in6_addr *daddr,
79395e41e93SYOSHIFUJI Hideaki 		      int oif)
79495e41e93SYOSHIFUJI Hideaki {
7954c9483b2SDavid S. Miller 	memset(fl6, 0, sizeof(*fl6));
7964e3fd7a0SAlexey Dobriyan 	fl6->saddr = *saddr;
7974e3fd7a0SAlexey Dobriyan 	fl6->daddr = *daddr;
7984c9483b2SDavid S. Miller 	fl6->flowi6_proto 	= IPPROTO_ICMPV6;
7991958b856SDavid S. Miller 	fl6->fl6_icmp_type	= type;
8001958b856SDavid S. Miller 	fl6->fl6_icmp_code	= 0;
8014c9483b2SDavid S. Miller 	fl6->flowi6_oif		= oif;
8024c9483b2SDavid S. Miller 	security_sk_classify_flow(sk, flowi6_to_flowi(fl6));
80395e41e93SYOSHIFUJI Hideaki }
80495e41e93SYOSHIFUJI Hideaki 
805640c41c7SIngo Molnar /*
806b7e729c4SDenis V. Lunev  * Special lock-class for __icmpv6_sk:
807640c41c7SIngo Molnar  */
808640c41c7SIngo Molnar static struct lock_class_key icmpv6_socket_sk_dst_lock_key;
809640c41c7SIngo Molnar 
81098c6d1b2SDenis V. Lunev static int __net_init icmpv6_sk_init(struct net *net)
8111da177e4SLinus Torvalds {
8121da177e4SLinus Torvalds 	struct sock *sk;
8131da177e4SLinus Torvalds 	int err, i, j;
8141da177e4SLinus Torvalds 
81598c6d1b2SDenis V. Lunev 	net->ipv6.icmp_sk =
81698c6d1b2SDenis V. Lunev 		kzalloc(nr_cpu_ids * sizeof(struct sock *), GFP_KERNEL);
81798c6d1b2SDenis V. Lunev 	if (net->ipv6.icmp_sk == NULL)
81879c91159SDenis V. Lunev 		return -ENOMEM;
81979c91159SDenis V. Lunev 
8206f912042SKAMEZAWA Hiroyuki 	for_each_possible_cpu(i) {
8211ed8516fSDenis V. Lunev 		err = inet_ctl_sock_create(&sk, PF_INET6,
8221ed8516fSDenis V. Lunev 					   SOCK_RAW, IPPROTO_ICMPV6, net);
8231da177e4SLinus Torvalds 		if (err < 0) {
8241da177e4SLinus Torvalds 			printk(KERN_ERR
8251da177e4SLinus Torvalds 			       "Failed to initialize the ICMP6 control socket "
8261da177e4SLinus Torvalds 			       "(err %d).\n",
8271da177e4SLinus Torvalds 			       err);
8281da177e4SLinus Torvalds 			goto fail;
8291da177e4SLinus Torvalds 		}
8301da177e4SLinus Torvalds 
8311ed8516fSDenis V. Lunev 		net->ipv6.icmp_sk[i] = sk;
8325c8cafd6SDenis V. Lunev 
833640c41c7SIngo Molnar 		/*
834640c41c7SIngo Molnar 		 * Split off their lock-class, because sk->sk_dst_lock
835640c41c7SIngo Molnar 		 * gets used from softirqs, which is safe for
836b7e729c4SDenis V. Lunev 		 * __icmpv6_sk (because those never get directly used
837640c41c7SIngo Molnar 		 * via userspace syscalls), but unsafe for normal sockets.
838640c41c7SIngo Molnar 		 */
839640c41c7SIngo Molnar 		lockdep_set_class(&sk->sk_dst_lock,
840640c41c7SIngo Molnar 				  &icmpv6_socket_sk_dst_lock_key);
8411da177e4SLinus Torvalds 
8421da177e4SLinus Torvalds 		/* Enough space for 2 64K ICMP packets, including
8431da177e4SLinus Torvalds 		 * sk_buff struct overhead.
8441da177e4SLinus Torvalds 		 */
84587fb4b7bSEric Dumazet 		sk->sk_sndbuf = 2 * SKB_TRUESIZE(64 * 1024);
8461da177e4SLinus Torvalds 	}
8471da177e4SLinus Torvalds 	return 0;
8481da177e4SLinus Torvalds 
8491da177e4SLinus Torvalds  fail:
8505c8cafd6SDenis V. Lunev 	for (j = 0; j < i; j++)
8511ed8516fSDenis V. Lunev 		inet_ctl_sock_destroy(net->ipv6.icmp_sk[j]);
85298c6d1b2SDenis V. Lunev 	kfree(net->ipv6.icmp_sk);
8531da177e4SLinus Torvalds 	return err;
8541da177e4SLinus Torvalds }
8551da177e4SLinus Torvalds 
85698c6d1b2SDenis V. Lunev static void __net_exit icmpv6_sk_exit(struct net *net)
8571da177e4SLinus Torvalds {
8581da177e4SLinus Torvalds 	int i;
8591da177e4SLinus Torvalds 
8606f912042SKAMEZAWA Hiroyuki 	for_each_possible_cpu(i) {
8611ed8516fSDenis V. Lunev 		inet_ctl_sock_destroy(net->ipv6.icmp_sk[i]);
8621da177e4SLinus Torvalds 	}
86398c6d1b2SDenis V. Lunev 	kfree(net->ipv6.icmp_sk);
86498c6d1b2SDenis V. Lunev }
86598c6d1b2SDenis V. Lunev 
8668ed7edceSAlexey Dobriyan static struct pernet_operations icmpv6_sk_ops = {
86798c6d1b2SDenis V. Lunev        .init = icmpv6_sk_init,
86898c6d1b2SDenis V. Lunev        .exit = icmpv6_sk_exit,
86998c6d1b2SDenis V. Lunev };
87098c6d1b2SDenis V. Lunev 
87198c6d1b2SDenis V. Lunev int __init icmpv6_init(void)
87298c6d1b2SDenis V. Lunev {
87398c6d1b2SDenis V. Lunev 	int err;
87498c6d1b2SDenis V. Lunev 
87598c6d1b2SDenis V. Lunev 	err = register_pernet_subsys(&icmpv6_sk_ops);
87698c6d1b2SDenis V. Lunev 	if (err < 0)
87798c6d1b2SDenis V. Lunev 		return err;
87898c6d1b2SDenis V. Lunev 
87998c6d1b2SDenis V. Lunev 	err = -EAGAIN;
88098c6d1b2SDenis V. Lunev 	if (inet6_add_protocol(&icmpv6_protocol, IPPROTO_ICMPV6) < 0)
88198c6d1b2SDenis V. Lunev 		goto fail;
88298c6d1b2SDenis V. Lunev 	return 0;
88398c6d1b2SDenis V. Lunev 
88498c6d1b2SDenis V. Lunev fail:
88598c6d1b2SDenis V. Lunev 	printk(KERN_ERR "Failed to register ICMP6 protocol\n");
88698c6d1b2SDenis V. Lunev 	unregister_pernet_subsys(&icmpv6_sk_ops);
88798c6d1b2SDenis V. Lunev 	return err;
88898c6d1b2SDenis V. Lunev }
88998c6d1b2SDenis V. Lunev 
8908ed7edceSAlexey Dobriyan void icmpv6_cleanup(void)
89198c6d1b2SDenis V. Lunev {
89298c6d1b2SDenis V. Lunev 	unregister_pernet_subsys(&icmpv6_sk_ops);
8931da177e4SLinus Torvalds 	inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
8941da177e4SLinus Torvalds }
8951da177e4SLinus Torvalds 
89698c6d1b2SDenis V. Lunev 
8979b5b5cffSArjan van de Ven static const struct icmp6_err {
8981da177e4SLinus Torvalds 	int err;
8991da177e4SLinus Torvalds 	int fatal;
9001da177e4SLinus Torvalds } tab_unreach[] = {
9011da177e4SLinus Torvalds 	{	/* NOROUTE */
9021da177e4SLinus Torvalds 		.err	= ENETUNREACH,
9031da177e4SLinus Torvalds 		.fatal	= 0,
9041da177e4SLinus Torvalds 	},
9051da177e4SLinus Torvalds 	{	/* ADM_PROHIBITED */
9061da177e4SLinus Torvalds 		.err	= EACCES,
9071da177e4SLinus Torvalds 		.fatal	= 1,
9081da177e4SLinus Torvalds 	},
9091da177e4SLinus Torvalds 	{	/* Was NOT_NEIGHBOUR, now reserved */
9101da177e4SLinus Torvalds 		.err	= EHOSTUNREACH,
9111da177e4SLinus Torvalds 		.fatal	= 0,
9121da177e4SLinus Torvalds 	},
9131da177e4SLinus Torvalds 	{	/* ADDR_UNREACH	*/
9141da177e4SLinus Torvalds 		.err	= EHOSTUNREACH,
9151da177e4SLinus Torvalds 		.fatal	= 0,
9161da177e4SLinus Torvalds 	},
9171da177e4SLinus Torvalds 	{	/* PORT_UNREACH	*/
9181da177e4SLinus Torvalds 		.err	= ECONNREFUSED,
9191da177e4SLinus Torvalds 		.fatal	= 1,
9201da177e4SLinus Torvalds 	},
9211da177e4SLinus Torvalds };
9221da177e4SLinus Torvalds 
923d5fdd6baSBrian Haley int icmpv6_err_convert(u8 type, u8 code, int *err)
9241da177e4SLinus Torvalds {
9251da177e4SLinus Torvalds 	int fatal = 0;
9261da177e4SLinus Torvalds 
9271da177e4SLinus Torvalds 	*err = EPROTO;
9281da177e4SLinus Torvalds 
9291da177e4SLinus Torvalds 	switch (type) {
9301da177e4SLinus Torvalds 	case ICMPV6_DEST_UNREACH:
9311da177e4SLinus Torvalds 		fatal = 1;
9321da177e4SLinus Torvalds 		if (code <= ICMPV6_PORT_UNREACH) {
9331da177e4SLinus Torvalds 			*err  = tab_unreach[code].err;
9341da177e4SLinus Torvalds 			fatal = tab_unreach[code].fatal;
9351da177e4SLinus Torvalds 		}
9361da177e4SLinus Torvalds 		break;
9371da177e4SLinus Torvalds 
9381da177e4SLinus Torvalds 	case ICMPV6_PKT_TOOBIG:
9391da177e4SLinus Torvalds 		*err = EMSGSIZE;
9401da177e4SLinus Torvalds 		break;
9411da177e4SLinus Torvalds 
9421da177e4SLinus Torvalds 	case ICMPV6_PARAMPROB:
9431da177e4SLinus Torvalds 		*err = EPROTO;
9441da177e4SLinus Torvalds 		fatal = 1;
9451da177e4SLinus Torvalds 		break;
9461da177e4SLinus Torvalds 
9471da177e4SLinus Torvalds 	case ICMPV6_TIME_EXCEED:
9481da177e4SLinus Torvalds 		*err = EHOSTUNREACH;
9491da177e4SLinus Torvalds 		break;
9503ff50b79SStephen Hemminger 	}
9511da177e4SLinus Torvalds 
9521da177e4SLinus Torvalds 	return fatal;
9531da177e4SLinus Torvalds }
9541da177e4SLinus Torvalds 
9557159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(icmpv6_err_convert);
9567159039aSYOSHIFUJI Hideaki 
9571da177e4SLinus Torvalds #ifdef CONFIG_SYSCTL
958760f2d01SDaniel Lezcano ctl_table ipv6_icmp_table_template[] = {
9591da177e4SLinus Torvalds 	{
9601da177e4SLinus Torvalds 		.procname	= "ratelimit",
96141a76906SDaniel Lezcano 		.data		= &init_net.ipv6.sysctl.icmpv6_time,
9621da177e4SLinus Torvalds 		.maxlen		= sizeof(int),
9631da177e4SLinus Torvalds 		.mode		= 0644,
9646d9f239aSAlexey Dobriyan 		.proc_handler	= proc_dointvec_ms_jiffies,
9651da177e4SLinus Torvalds 	},
966f8572d8fSEric W. Biederman 	{ },
9671da177e4SLinus Torvalds };
968760f2d01SDaniel Lezcano 
9692c8c1e72SAlexey Dobriyan struct ctl_table * __net_init ipv6_icmp_sysctl_init(struct net *net)
970760f2d01SDaniel Lezcano {
971760f2d01SDaniel Lezcano 	struct ctl_table *table;
972760f2d01SDaniel Lezcano 
973760f2d01SDaniel Lezcano 	table = kmemdup(ipv6_icmp_table_template,
974760f2d01SDaniel Lezcano 			sizeof(ipv6_icmp_table_template),
975760f2d01SDaniel Lezcano 			GFP_KERNEL);
9765ee09105SYOSHIFUJI Hideaki 
9775ee09105SYOSHIFUJI Hideaki 	if (table)
9785ee09105SYOSHIFUJI Hideaki 		table[0].data = &net->ipv6.sysctl.icmpv6_time;
9795ee09105SYOSHIFUJI Hideaki 
980760f2d01SDaniel Lezcano 	return table;
981760f2d01SDaniel Lezcano }
9821da177e4SLinus Torvalds #endif
9831da177e4SLinus Torvalds 
984