xref: /openbmc/linux/net/ipv6/icmp.c (revision dd1431e5)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *	Internet Control Message Protocol (ICMPv6)
4  *	Linux INET6 implementation
5  *
6  *	Authors:
7  *	Pedro Roque		<roque@di.fc.ul.pt>
8  *
9  *	Based on net/ipv4/icmp.c
10  *
11  *	RFC 1885
12  */
13 
14 /*
15  *	Changes:
16  *
17  *	Andi Kleen		:	exception handling
18  *	Andi Kleen			add rate limits. never reply to a icmp.
19  *					add more length checks and other fixes.
20  *	yoshfuji		:	ensure to sent parameter problem for
21  *					fragments.
22  *	YOSHIFUJI Hideaki @USAGI:	added sysctl for icmp rate limit.
23  *	Randy Dunlap and
24  *	YOSHIFUJI Hideaki @USAGI:	Per-interface statistics support
25  *	Kazunori MIYAZAWA @USAGI:       change output process to use ip6_append_data
26  */
27 
28 #define pr_fmt(fmt) "IPv6: " fmt
29 
30 #include <linux/module.h>
31 #include <linux/errno.h>
32 #include <linux/types.h>
33 #include <linux/socket.h>
34 #include <linux/in.h>
35 #include <linux/kernel.h>
36 #include <linux/sockios.h>
37 #include <linux/net.h>
38 #include <linux/skbuff.h>
39 #include <linux/init.h>
40 #include <linux/netfilter.h>
41 #include <linux/slab.h>
42 
43 #ifdef CONFIG_SYSCTL
44 #include <linux/sysctl.h>
45 #endif
46 
47 #include <linux/inet.h>
48 #include <linux/netdevice.h>
49 #include <linux/icmpv6.h>
50 
51 #include <net/ip.h>
52 #include <net/sock.h>
53 
54 #include <net/ipv6.h>
55 #include <net/ip6_checksum.h>
56 #include <net/ping.h>
57 #include <net/protocol.h>
58 #include <net/raw.h>
59 #include <net/rawv6.h>
60 #include <net/transp_v6.h>
61 #include <net/ip6_route.h>
62 #include <net/addrconf.h>
63 #include <net/icmp.h>
64 #include <net/xfrm.h>
65 #include <net/inet_common.h>
66 #include <net/dsfield.h>
67 #include <net/l3mdev.h>
68 
69 #include <linux/uaccess.h>
70 
71 /*
72  *	The ICMP socket(s). This is the most convenient way to flow control
73  *	our ICMP output as well as maintain a clean interface throughout
74  *	all layers. All Socketless IP sends will soon be gone.
75  *
76  *	On SMP we have one ICMP socket per-cpu.
77  */
78 static struct sock *icmpv6_sk(struct net *net)
79 {
80 	return this_cpu_read(*net->ipv6.icmp_sk);
81 }
82 
83 static int icmpv6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
84 		       u8 type, u8 code, int offset, __be32 info)
85 {
86 	/* icmpv6_notify checks 8 bytes can be pulled, icmp6hdr is 8 bytes */
87 	struct icmp6hdr *icmp6 = (struct icmp6hdr *) (skb->data + offset);
88 	struct net *net = dev_net(skb->dev);
89 
90 	if (type == ICMPV6_PKT_TOOBIG)
91 		ip6_update_pmtu(skb, net, info, skb->dev->ifindex, 0, sock_net_uid(net, NULL));
92 	else if (type == NDISC_REDIRECT)
93 		ip6_redirect(skb, net, skb->dev->ifindex, 0,
94 			     sock_net_uid(net, NULL));
95 
96 	if (!(type & ICMPV6_INFOMSG_MASK))
97 		if (icmp6->icmp6_type == ICMPV6_ECHO_REQUEST)
98 			ping_err(skb, offset, ntohl(info));
99 
100 	return 0;
101 }
102 
103 static int icmpv6_rcv(struct sk_buff *skb);
104 
105 static const struct inet6_protocol icmpv6_protocol = {
106 	.handler	=	icmpv6_rcv,
107 	.err_handler	=	icmpv6_err,
108 	.flags		=	INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
109 };
110 
111 /* Called with BH disabled */
112 static __inline__ struct sock *icmpv6_xmit_lock(struct net *net)
113 {
114 	struct sock *sk;
115 
116 	sk = icmpv6_sk(net);
117 	if (unlikely(!spin_trylock(&sk->sk_lock.slock))) {
118 		/* This can happen if the output path (f.e. SIT or
119 		 * ip6ip6 tunnel) signals dst_link_failure() for an
120 		 * outgoing ICMP6 packet.
121 		 */
122 		return NULL;
123 	}
124 	return sk;
125 }
126 
127 static __inline__ void icmpv6_xmit_unlock(struct sock *sk)
128 {
129 	spin_unlock(&sk->sk_lock.slock);
130 }
131 
132 /*
133  * Figure out, may we reply to this packet with icmp error.
134  *
135  * We do not reply, if:
136  *	- it was icmp error message.
137  *	- it is truncated, so that it is known, that protocol is ICMPV6
138  *	  (i.e. in the middle of some exthdr)
139  *
140  *	--ANK (980726)
141  */
142 
143 static bool is_ineligible(const struct sk_buff *skb)
144 {
145 	int ptr = (u8 *)(ipv6_hdr(skb) + 1) - skb->data;
146 	int len = skb->len - ptr;
147 	__u8 nexthdr = ipv6_hdr(skb)->nexthdr;
148 	__be16 frag_off;
149 
150 	if (len < 0)
151 		return true;
152 
153 	ptr = ipv6_skip_exthdr(skb, ptr, &nexthdr, &frag_off);
154 	if (ptr < 0)
155 		return false;
156 	if (nexthdr == IPPROTO_ICMPV6) {
157 		u8 _type, *tp;
158 		tp = skb_header_pointer(skb,
159 			ptr+offsetof(struct icmp6hdr, icmp6_type),
160 			sizeof(_type), &_type);
161 
162 		/* Based on RFC 8200, Section 4.5 Fragment Header, return
163 		 * false if this is a fragment packet with no icmp header info.
164 		 */
165 		if (!tp && frag_off != 0)
166 			return false;
167 		else if (!tp || !(*tp & ICMPV6_INFOMSG_MASK))
168 			return true;
169 	}
170 	return false;
171 }
172 
173 static bool icmpv6_mask_allow(struct net *net, int type)
174 {
175 	if (type > ICMPV6_MSG_MAX)
176 		return true;
177 
178 	/* Limit if icmp type is set in ratemask. */
179 	if (!test_bit(type, net->ipv6.sysctl.icmpv6_ratemask))
180 		return true;
181 
182 	return false;
183 }
184 
185 static bool icmpv6_global_allow(struct net *net, int type)
186 {
187 	if (icmpv6_mask_allow(net, type))
188 		return true;
189 
190 	if (icmp_global_allow())
191 		return true;
192 
193 	return false;
194 }
195 
196 /*
197  * Check the ICMP output rate limit
198  */
199 static bool icmpv6_xrlim_allow(struct sock *sk, u8 type,
200 			       struct flowi6 *fl6)
201 {
202 	struct net *net = sock_net(sk);
203 	struct dst_entry *dst;
204 	bool res = false;
205 
206 	if (icmpv6_mask_allow(net, type))
207 		return true;
208 
209 	/*
210 	 * Look up the output route.
211 	 * XXX: perhaps the expire for routing entries cloned by
212 	 * this lookup should be more aggressive (not longer than timeout).
213 	 */
214 	dst = ip6_route_output(net, sk, fl6);
215 	if (dst->error) {
216 		IP6_INC_STATS(net, ip6_dst_idev(dst),
217 			      IPSTATS_MIB_OUTNOROUTES);
218 	} else if (dst->dev && (dst->dev->flags&IFF_LOOPBACK)) {
219 		res = true;
220 	} else {
221 		struct rt6_info *rt = (struct rt6_info *)dst;
222 		int tmo = net->ipv6.sysctl.icmpv6_time;
223 		struct inet_peer *peer;
224 
225 		/* Give more bandwidth to wider prefixes. */
226 		if (rt->rt6i_dst.plen < 128)
227 			tmo >>= ((128 - rt->rt6i_dst.plen)>>5);
228 
229 		peer = inet_getpeer_v6(net->ipv6.peers, &fl6->daddr, 1);
230 		res = inet_peer_xrlim_allow(peer, tmo);
231 		if (peer)
232 			inet_putpeer(peer);
233 	}
234 	dst_release(dst);
235 	return res;
236 }
237 
238 static bool icmpv6_rt_has_prefsrc(struct sock *sk, u8 type,
239 				  struct flowi6 *fl6)
240 {
241 	struct net *net = sock_net(sk);
242 	struct dst_entry *dst;
243 	bool res = false;
244 
245 	dst = ip6_route_output(net, sk, fl6);
246 	if (!dst->error) {
247 		struct rt6_info *rt = (struct rt6_info *)dst;
248 		struct in6_addr prefsrc;
249 
250 		rt6_get_prefsrc(rt, &prefsrc);
251 		res = !ipv6_addr_any(&prefsrc);
252 	}
253 	dst_release(dst);
254 	return res;
255 }
256 
257 /*
258  *	an inline helper for the "simple" if statement below
259  *	checks if parameter problem report is caused by an
260  *	unrecognized IPv6 option that has the Option Type
261  *	highest-order two bits set to 10
262  */
263 
264 static bool opt_unrec(struct sk_buff *skb, __u32 offset)
265 {
266 	u8 _optval, *op;
267 
268 	offset += skb_network_offset(skb);
269 	op = skb_header_pointer(skb, offset, sizeof(_optval), &_optval);
270 	if (!op)
271 		return true;
272 	return (*op & 0xC0) == 0x80;
273 }
274 
275 void icmpv6_push_pending_frames(struct sock *sk, struct flowi6 *fl6,
276 				struct icmp6hdr *thdr, int len)
277 {
278 	struct sk_buff *skb;
279 	struct icmp6hdr *icmp6h;
280 
281 	skb = skb_peek(&sk->sk_write_queue);
282 	if (!skb)
283 		return;
284 
285 	icmp6h = icmp6_hdr(skb);
286 	memcpy(icmp6h, thdr, sizeof(struct icmp6hdr));
287 	icmp6h->icmp6_cksum = 0;
288 
289 	if (skb_queue_len(&sk->sk_write_queue) == 1) {
290 		skb->csum = csum_partial(icmp6h,
291 					sizeof(struct icmp6hdr), skb->csum);
292 		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
293 						      &fl6->daddr,
294 						      len, fl6->flowi6_proto,
295 						      skb->csum);
296 	} else {
297 		__wsum tmp_csum = 0;
298 
299 		skb_queue_walk(&sk->sk_write_queue, skb) {
300 			tmp_csum = csum_add(tmp_csum, skb->csum);
301 		}
302 
303 		tmp_csum = csum_partial(icmp6h,
304 					sizeof(struct icmp6hdr), tmp_csum);
305 		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
306 						      &fl6->daddr,
307 						      len, fl6->flowi6_proto,
308 						      tmp_csum);
309 	}
310 	ip6_push_pending_frames(sk);
311 }
312 
313 struct icmpv6_msg {
314 	struct sk_buff	*skb;
315 	int		offset;
316 	uint8_t		type;
317 };
318 
319 static int icmpv6_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
320 {
321 	struct icmpv6_msg *msg = (struct icmpv6_msg *) from;
322 	struct sk_buff *org_skb = msg->skb;
323 	__wsum csum;
324 
325 	csum = skb_copy_and_csum_bits(org_skb, msg->offset + offset,
326 				      to, len);
327 	skb->csum = csum_block_add(skb->csum, csum, odd);
328 	if (!(msg->type & ICMPV6_INFOMSG_MASK))
329 		nf_ct_attach(skb, org_skb);
330 	return 0;
331 }
332 
333 #if IS_ENABLED(CONFIG_IPV6_MIP6)
334 static void mip6_addr_swap(struct sk_buff *skb, const struct inet6_skb_parm *opt)
335 {
336 	struct ipv6hdr *iph = ipv6_hdr(skb);
337 	struct ipv6_destopt_hao *hao;
338 	struct in6_addr tmp;
339 	int off;
340 
341 	if (opt->dsthao) {
342 		off = ipv6_find_tlv(skb, opt->dsthao, IPV6_TLV_HAO);
343 		if (likely(off >= 0)) {
344 			hao = (struct ipv6_destopt_hao *)
345 					(skb_network_header(skb) + off);
346 			tmp = iph->saddr;
347 			iph->saddr = hao->addr;
348 			hao->addr = tmp;
349 		}
350 	}
351 }
352 #else
353 static inline void mip6_addr_swap(struct sk_buff *skb, const struct inet6_skb_parm *opt) {}
354 #endif
355 
356 static struct dst_entry *icmpv6_route_lookup(struct net *net,
357 					     struct sk_buff *skb,
358 					     struct sock *sk,
359 					     struct flowi6 *fl6)
360 {
361 	struct dst_entry *dst, *dst2;
362 	struct flowi6 fl2;
363 	int err;
364 
365 	err = ip6_dst_lookup(net, sk, &dst, fl6);
366 	if (err)
367 		return ERR_PTR(err);
368 
369 	/*
370 	 * We won't send icmp if the destination is known
371 	 * anycast.
372 	 */
373 	if (ipv6_anycast_destination(dst, &fl6->daddr)) {
374 		net_dbg_ratelimited("icmp6_send: acast source\n");
375 		dst_release(dst);
376 		return ERR_PTR(-EINVAL);
377 	}
378 
379 	/* No need to clone since we're just using its address. */
380 	dst2 = dst;
381 
382 	dst = xfrm_lookup(net, dst, flowi6_to_flowi(fl6), sk, 0);
383 	if (!IS_ERR(dst)) {
384 		if (dst != dst2)
385 			return dst;
386 	} else {
387 		if (PTR_ERR(dst) == -EPERM)
388 			dst = NULL;
389 		else
390 			return dst;
391 	}
392 
393 	err = xfrm_decode_session_reverse(skb, flowi6_to_flowi(&fl2), AF_INET6);
394 	if (err)
395 		goto relookup_failed;
396 
397 	err = ip6_dst_lookup(net, sk, &dst2, &fl2);
398 	if (err)
399 		goto relookup_failed;
400 
401 	dst2 = xfrm_lookup(net, dst2, flowi6_to_flowi(&fl2), sk, XFRM_LOOKUP_ICMP);
402 	if (!IS_ERR(dst2)) {
403 		dst_release(dst);
404 		dst = dst2;
405 	} else {
406 		err = PTR_ERR(dst2);
407 		if (err == -EPERM) {
408 			dst_release(dst);
409 			return dst2;
410 		} else
411 			goto relookup_failed;
412 	}
413 
414 relookup_failed:
415 	if (dst)
416 		return dst;
417 	return ERR_PTR(err);
418 }
419 
420 static struct net_device *icmp6_dev(const struct sk_buff *skb)
421 {
422 	struct net_device *dev = skb->dev;
423 
424 	/* for local traffic to local address, skb dev is the loopback
425 	 * device. Check if there is a dst attached to the skb and if so
426 	 * get the real device index. Same is needed for replies to a link
427 	 * local address on a device enslaved to an L3 master device
428 	 */
429 	if (unlikely(dev->ifindex == LOOPBACK_IFINDEX || netif_is_l3_master(skb->dev))) {
430 		const struct rt6_info *rt6 = skb_rt6_info(skb);
431 
432 		if (rt6)
433 			dev = rt6->rt6i_idev->dev;
434 	}
435 
436 	return dev;
437 }
438 
439 static int icmp6_iif(const struct sk_buff *skb)
440 {
441 	return icmp6_dev(skb)->ifindex;
442 }
443 
444 /*
445  *	Send an ICMP message in response to a packet in error
446  */
447 void icmp6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info,
448 		const struct in6_addr *force_saddr,
449 		const struct inet6_skb_parm *parm)
450 {
451 	struct inet6_dev *idev = NULL;
452 	struct ipv6hdr *hdr = ipv6_hdr(skb);
453 	struct sock *sk;
454 	struct net *net;
455 	struct ipv6_pinfo *np;
456 	const struct in6_addr *saddr = NULL;
457 	struct dst_entry *dst;
458 	struct icmp6hdr tmp_hdr;
459 	struct flowi6 fl6;
460 	struct icmpv6_msg msg;
461 	struct ipcm6_cookie ipc6;
462 	int iif = 0;
463 	int addr_type = 0;
464 	int len;
465 	u32 mark;
466 
467 	if ((u8 *)hdr < skb->head ||
468 	    (skb_network_header(skb) + sizeof(*hdr)) > skb_tail_pointer(skb))
469 		return;
470 
471 	if (!skb->dev)
472 		return;
473 	net = dev_net(skb->dev);
474 	mark = IP6_REPLY_MARK(net, skb->mark);
475 	/*
476 	 *	Make sure we respect the rules
477 	 *	i.e. RFC 1885 2.4(e)
478 	 *	Rule (e.1) is enforced by not using icmp6_send
479 	 *	in any code that processes icmp errors.
480 	 */
481 	addr_type = ipv6_addr_type(&hdr->daddr);
482 
483 	if (ipv6_chk_addr(net, &hdr->daddr, skb->dev, 0) ||
484 	    ipv6_chk_acast_addr_src(net, skb->dev, &hdr->daddr))
485 		saddr = &hdr->daddr;
486 
487 	/*
488 	 *	Dest addr check
489 	 */
490 
491 	if (addr_type & IPV6_ADDR_MULTICAST || skb->pkt_type != PACKET_HOST) {
492 		if (type != ICMPV6_PKT_TOOBIG &&
493 		    !(type == ICMPV6_PARAMPROB &&
494 		      code == ICMPV6_UNK_OPTION &&
495 		      (opt_unrec(skb, info))))
496 			return;
497 
498 		saddr = NULL;
499 	}
500 
501 	addr_type = ipv6_addr_type(&hdr->saddr);
502 
503 	/*
504 	 *	Source addr check
505 	 */
506 
507 	if (__ipv6_addr_needs_scope_id(addr_type)) {
508 		iif = icmp6_iif(skb);
509 	} else {
510 		/*
511 		 * The source device is used for looking up which routing table
512 		 * to use for sending an ICMP error.
513 		 */
514 		iif = l3mdev_master_ifindex(skb->dev);
515 	}
516 
517 	/*
518 	 *	Must not send error if the source does not uniquely
519 	 *	identify a single node (RFC2463 Section 2.4).
520 	 *	We check unspecified / multicast addresses here,
521 	 *	and anycast addresses will be checked later.
522 	 */
523 	if ((addr_type == IPV6_ADDR_ANY) || (addr_type & IPV6_ADDR_MULTICAST)) {
524 		net_dbg_ratelimited("icmp6_send: addr_any/mcast source [%pI6c > %pI6c]\n",
525 				    &hdr->saddr, &hdr->daddr);
526 		return;
527 	}
528 
529 	/*
530 	 *	Never answer to a ICMP packet.
531 	 */
532 	if (is_ineligible(skb)) {
533 		net_dbg_ratelimited("icmp6_send: no reply to icmp error [%pI6c > %pI6c]\n",
534 				    &hdr->saddr, &hdr->daddr);
535 		return;
536 	}
537 
538 	/* Needed by both icmp_global_allow and icmpv6_xmit_lock */
539 	local_bh_disable();
540 
541 	/* Check global sysctl_icmp_msgs_per_sec ratelimit */
542 	if (!(skb->dev->flags & IFF_LOOPBACK) && !icmpv6_global_allow(net, type))
543 		goto out_bh_enable;
544 
545 	mip6_addr_swap(skb, parm);
546 
547 	sk = icmpv6_xmit_lock(net);
548 	if (!sk)
549 		goto out_bh_enable;
550 
551 	memset(&fl6, 0, sizeof(fl6));
552 	fl6.flowi6_proto = IPPROTO_ICMPV6;
553 	fl6.daddr = hdr->saddr;
554 	if (force_saddr)
555 		saddr = force_saddr;
556 	if (saddr) {
557 		fl6.saddr = *saddr;
558 	} else if (!icmpv6_rt_has_prefsrc(sk, type, &fl6)) {
559 		/* select a more meaningful saddr from input if */
560 		struct net_device *in_netdev;
561 
562 		in_netdev = dev_get_by_index(net, parm->iif);
563 		if (in_netdev) {
564 			ipv6_dev_get_saddr(net, in_netdev, &fl6.daddr,
565 					   inet6_sk(sk)->srcprefs,
566 					   &fl6.saddr);
567 			dev_put(in_netdev);
568 		}
569 	}
570 	fl6.flowi6_mark = mark;
571 	fl6.flowi6_oif = iif;
572 	fl6.fl6_icmp_type = type;
573 	fl6.fl6_icmp_code = code;
574 	fl6.flowi6_uid = sock_net_uid(net, NULL);
575 	fl6.mp_hash = rt6_multipath_hash(net, &fl6, skb, NULL);
576 	security_skb_classify_flow(skb, flowi6_to_flowi_common(&fl6));
577 
578 	np = inet6_sk(sk);
579 
580 	if (!icmpv6_xrlim_allow(sk, type, &fl6))
581 		goto out;
582 
583 	tmp_hdr.icmp6_type = type;
584 	tmp_hdr.icmp6_code = code;
585 	tmp_hdr.icmp6_cksum = 0;
586 	tmp_hdr.icmp6_pointer = htonl(info);
587 
588 	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
589 		fl6.flowi6_oif = np->mcast_oif;
590 	else if (!fl6.flowi6_oif)
591 		fl6.flowi6_oif = np->ucast_oif;
592 
593 	ipcm6_init_sk(&ipc6, np);
594 	ipc6.sockc.mark = mark;
595 	fl6.flowlabel = ip6_make_flowinfo(ipc6.tclass, fl6.flowlabel);
596 
597 	dst = icmpv6_route_lookup(net, skb, sk, &fl6);
598 	if (IS_ERR(dst))
599 		goto out;
600 
601 	ipc6.hlimit = ip6_sk_dst_hoplimit(np, &fl6, dst);
602 
603 	msg.skb = skb;
604 	msg.offset = skb_network_offset(skb);
605 	msg.type = type;
606 
607 	len = skb->len - msg.offset;
608 	len = min_t(unsigned int, len, IPV6_MIN_MTU - sizeof(struct ipv6hdr) - sizeof(struct icmp6hdr));
609 	if (len < 0) {
610 		net_dbg_ratelimited("icmp: len problem [%pI6c > %pI6c]\n",
611 				    &hdr->saddr, &hdr->daddr);
612 		goto out_dst_release;
613 	}
614 
615 	rcu_read_lock();
616 	idev = __in6_dev_get(skb->dev);
617 
618 	if (ip6_append_data(sk, icmpv6_getfrag, &msg,
619 			    len + sizeof(struct icmp6hdr),
620 			    sizeof(struct icmp6hdr),
621 			    &ipc6, &fl6, (struct rt6_info *)dst,
622 			    MSG_DONTWAIT)) {
623 		ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTERRORS);
624 		ip6_flush_pending_frames(sk);
625 	} else {
626 		icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
627 					   len + sizeof(struct icmp6hdr));
628 	}
629 	rcu_read_unlock();
630 out_dst_release:
631 	dst_release(dst);
632 out:
633 	icmpv6_xmit_unlock(sk);
634 out_bh_enable:
635 	local_bh_enable();
636 }
637 EXPORT_SYMBOL(icmp6_send);
638 
639 /* Slightly more convenient version of icmp6_send.
640  */
641 void icmpv6_param_prob(struct sk_buff *skb, u8 code, int pos)
642 {
643 	icmp6_send(skb, ICMPV6_PARAMPROB, code, pos, NULL, IP6CB(skb));
644 	kfree_skb(skb);
645 }
646 
647 /* Generate icmpv6 with type/code ICMPV6_DEST_UNREACH/ICMPV6_ADDR_UNREACH
648  * if sufficient data bytes are available
649  * @nhs is the size of the tunnel header(s) :
650  *  Either an IPv4 header for SIT encap
651  *         an IPv4 header + GRE header for GRE encap
652  */
653 int ip6_err_gen_icmpv6_unreach(struct sk_buff *skb, int nhs, int type,
654 			       unsigned int data_len)
655 {
656 	struct in6_addr temp_saddr;
657 	struct rt6_info *rt;
658 	struct sk_buff *skb2;
659 	u32 info = 0;
660 
661 	if (!pskb_may_pull(skb, nhs + sizeof(struct ipv6hdr) + 8))
662 		return 1;
663 
664 	/* RFC 4884 (partial) support for ICMP extensions */
665 	if (data_len < 128 || (data_len & 7) || skb->len < data_len)
666 		data_len = 0;
667 
668 	skb2 = data_len ? skb_copy(skb, GFP_ATOMIC) : skb_clone(skb, GFP_ATOMIC);
669 
670 	if (!skb2)
671 		return 1;
672 
673 	skb_dst_drop(skb2);
674 	skb_pull(skb2, nhs);
675 	skb_reset_network_header(skb2);
676 
677 	rt = rt6_lookup(dev_net(skb->dev), &ipv6_hdr(skb2)->saddr, NULL, 0,
678 			skb, 0);
679 
680 	if (rt && rt->dst.dev)
681 		skb2->dev = rt->dst.dev;
682 
683 	ipv6_addr_set_v4mapped(ip_hdr(skb)->saddr, &temp_saddr);
684 
685 	if (data_len) {
686 		/* RFC 4884 (partial) support :
687 		 * insert 0 padding at the end, before the extensions
688 		 */
689 		__skb_push(skb2, nhs);
690 		skb_reset_network_header(skb2);
691 		memmove(skb2->data, skb2->data + nhs, data_len - nhs);
692 		memset(skb2->data + data_len - nhs, 0, nhs);
693 		/* RFC 4884 4.5 : Length is measured in 64-bit words,
694 		 * and stored in reserved[0]
695 		 */
696 		info = (data_len/8) << 24;
697 	}
698 	if (type == ICMP_TIME_EXCEEDED)
699 		icmp6_send(skb2, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT,
700 			   info, &temp_saddr, IP6CB(skb2));
701 	else
702 		icmp6_send(skb2, ICMPV6_DEST_UNREACH, ICMPV6_ADDR_UNREACH,
703 			   info, &temp_saddr, IP6CB(skb2));
704 	if (rt)
705 		ip6_rt_put(rt);
706 
707 	kfree_skb(skb2);
708 
709 	return 0;
710 }
711 EXPORT_SYMBOL(ip6_err_gen_icmpv6_unreach);
712 
713 static void icmpv6_echo_reply(struct sk_buff *skb)
714 {
715 	struct net *net = dev_net(skb->dev);
716 	struct sock *sk;
717 	struct inet6_dev *idev;
718 	struct ipv6_pinfo *np;
719 	const struct in6_addr *saddr = NULL;
720 	struct icmp6hdr *icmph = icmp6_hdr(skb);
721 	struct icmp6hdr tmp_hdr;
722 	struct flowi6 fl6;
723 	struct icmpv6_msg msg;
724 	struct dst_entry *dst;
725 	struct ipcm6_cookie ipc6;
726 	u32 mark = IP6_REPLY_MARK(net, skb->mark);
727 	bool acast;
728 
729 	if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr) &&
730 	    net->ipv6.sysctl.icmpv6_echo_ignore_multicast)
731 		return;
732 
733 	saddr = &ipv6_hdr(skb)->daddr;
734 
735 	acast = ipv6_anycast_destination(skb_dst(skb), saddr);
736 	if (acast && net->ipv6.sysctl.icmpv6_echo_ignore_anycast)
737 		return;
738 
739 	if (!ipv6_unicast_destination(skb) &&
740 	    !(net->ipv6.sysctl.anycast_src_echo_reply && acast))
741 		saddr = NULL;
742 
743 	memcpy(&tmp_hdr, icmph, sizeof(tmp_hdr));
744 	tmp_hdr.icmp6_type = ICMPV6_ECHO_REPLY;
745 
746 	memset(&fl6, 0, sizeof(fl6));
747 	if (net->ipv6.sysctl.flowlabel_reflect & FLOWLABEL_REFLECT_ICMPV6_ECHO_REPLIES)
748 		fl6.flowlabel = ip6_flowlabel(ipv6_hdr(skb));
749 
750 	fl6.flowi6_proto = IPPROTO_ICMPV6;
751 	fl6.daddr = ipv6_hdr(skb)->saddr;
752 	if (saddr)
753 		fl6.saddr = *saddr;
754 	fl6.flowi6_oif = icmp6_iif(skb);
755 	fl6.fl6_icmp_type = ICMPV6_ECHO_REPLY;
756 	fl6.flowi6_mark = mark;
757 	fl6.flowi6_uid = sock_net_uid(net, NULL);
758 	security_skb_classify_flow(skb, flowi6_to_flowi_common(&fl6));
759 
760 	local_bh_disable();
761 	sk = icmpv6_xmit_lock(net);
762 	if (!sk)
763 		goto out_bh_enable;
764 	np = inet6_sk(sk);
765 
766 	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
767 		fl6.flowi6_oif = np->mcast_oif;
768 	else if (!fl6.flowi6_oif)
769 		fl6.flowi6_oif = np->ucast_oif;
770 
771 	if (ip6_dst_lookup(net, sk, &dst, &fl6))
772 		goto out;
773 	dst = xfrm_lookup(net, dst, flowi6_to_flowi(&fl6), sk, 0);
774 	if (IS_ERR(dst))
775 		goto out;
776 
777 	/* Check the ratelimit */
778 	if ((!(skb->dev->flags & IFF_LOOPBACK) && !icmpv6_global_allow(net, ICMPV6_ECHO_REPLY)) ||
779 	    !icmpv6_xrlim_allow(sk, ICMPV6_ECHO_REPLY, &fl6))
780 		goto out_dst_release;
781 
782 	idev = __in6_dev_get(skb->dev);
783 
784 	msg.skb = skb;
785 	msg.offset = 0;
786 	msg.type = ICMPV6_ECHO_REPLY;
787 
788 	ipcm6_init_sk(&ipc6, np);
789 	ipc6.hlimit = ip6_sk_dst_hoplimit(np, &fl6, dst);
790 	ipc6.tclass = ipv6_get_dsfield(ipv6_hdr(skb));
791 	ipc6.sockc.mark = mark;
792 
793 	if (ip6_append_data(sk, icmpv6_getfrag, &msg,
794 			    skb->len + sizeof(struct icmp6hdr),
795 			    sizeof(struct icmp6hdr), &ipc6, &fl6,
796 			    (struct rt6_info *)dst, MSG_DONTWAIT)) {
797 		__ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTERRORS);
798 		ip6_flush_pending_frames(sk);
799 	} else {
800 		icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
801 					   skb->len + sizeof(struct icmp6hdr));
802 	}
803 out_dst_release:
804 	dst_release(dst);
805 out:
806 	icmpv6_xmit_unlock(sk);
807 out_bh_enable:
808 	local_bh_enable();
809 }
810 
811 void icmpv6_notify(struct sk_buff *skb, u8 type, u8 code, __be32 info)
812 {
813 	const struct inet6_protocol *ipprot;
814 	int inner_offset;
815 	__be16 frag_off;
816 	u8 nexthdr;
817 	struct net *net = dev_net(skb->dev);
818 
819 	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
820 		goto out;
821 
822 	nexthdr = ((struct ipv6hdr *)skb->data)->nexthdr;
823 	if (ipv6_ext_hdr(nexthdr)) {
824 		/* now skip over extension headers */
825 		inner_offset = ipv6_skip_exthdr(skb, sizeof(struct ipv6hdr),
826 						&nexthdr, &frag_off);
827 		if (inner_offset < 0)
828 			goto out;
829 	} else {
830 		inner_offset = sizeof(struct ipv6hdr);
831 	}
832 
833 	/* Checkin header including 8 bytes of inner protocol header. */
834 	if (!pskb_may_pull(skb, inner_offset+8))
835 		goto out;
836 
837 	/* BUGGG_FUTURE: we should try to parse exthdrs in this packet.
838 	   Without this we will not able f.e. to make source routed
839 	   pmtu discovery.
840 	   Corresponding argument (opt) to notifiers is already added.
841 	   --ANK (980726)
842 	 */
843 
844 	ipprot = rcu_dereference(inet6_protos[nexthdr]);
845 	if (ipprot && ipprot->err_handler)
846 		ipprot->err_handler(skb, NULL, type, code, inner_offset, info);
847 
848 	raw6_icmp_error(skb, nexthdr, type, code, inner_offset, info);
849 	return;
850 
851 out:
852 	__ICMP6_INC_STATS(net, __in6_dev_get(skb->dev), ICMP6_MIB_INERRORS);
853 }
854 
855 /*
856  *	Handle icmp messages
857  */
858 
859 static int icmpv6_rcv(struct sk_buff *skb)
860 {
861 	struct net *net = dev_net(skb->dev);
862 	struct net_device *dev = icmp6_dev(skb);
863 	struct inet6_dev *idev = __in6_dev_get(dev);
864 	const struct in6_addr *saddr, *daddr;
865 	struct icmp6hdr *hdr;
866 	u8 type;
867 	bool success = false;
868 
869 	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
870 		struct sec_path *sp = skb_sec_path(skb);
871 		int nh;
872 
873 		if (!(sp && sp->xvec[sp->len - 1]->props.flags &
874 				 XFRM_STATE_ICMP))
875 			goto drop_no_count;
876 
877 		if (!pskb_may_pull(skb, sizeof(*hdr) + sizeof(struct ipv6hdr)))
878 			goto drop_no_count;
879 
880 		nh = skb_network_offset(skb);
881 		skb_set_network_header(skb, sizeof(*hdr));
882 
883 		if (!xfrm6_policy_check_reverse(NULL, XFRM_POLICY_IN, skb))
884 			goto drop_no_count;
885 
886 		skb_set_network_header(skb, nh);
887 	}
888 
889 	__ICMP6_INC_STATS(dev_net(dev), idev, ICMP6_MIB_INMSGS);
890 
891 	saddr = &ipv6_hdr(skb)->saddr;
892 	daddr = &ipv6_hdr(skb)->daddr;
893 
894 	if (skb_checksum_validate(skb, IPPROTO_ICMPV6, ip6_compute_pseudo)) {
895 		net_dbg_ratelimited("ICMPv6 checksum failed [%pI6c > %pI6c]\n",
896 				    saddr, daddr);
897 		goto csum_error;
898 	}
899 
900 	if (!pskb_pull(skb, sizeof(*hdr)))
901 		goto discard_it;
902 
903 	hdr = icmp6_hdr(skb);
904 
905 	type = hdr->icmp6_type;
906 
907 	ICMP6MSGIN_INC_STATS(dev_net(dev), idev, type);
908 
909 	switch (type) {
910 	case ICMPV6_ECHO_REQUEST:
911 		if (!net->ipv6.sysctl.icmpv6_echo_ignore_all)
912 			icmpv6_echo_reply(skb);
913 		break;
914 
915 	case ICMPV6_ECHO_REPLY:
916 		success = ping_rcv(skb);
917 		break;
918 
919 	case ICMPV6_EXT_ECHO_REPLY:
920 		success = ping_rcv(skb);
921 		break;
922 
923 	case ICMPV6_PKT_TOOBIG:
924 		/* BUGGG_FUTURE: if packet contains rthdr, we cannot update
925 		   standard destination cache. Seems, only "advanced"
926 		   destination cache will allow to solve this problem
927 		   --ANK (980726)
928 		 */
929 		if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
930 			goto discard_it;
931 		hdr = icmp6_hdr(skb);
932 
933 		/* to notify */
934 		fallthrough;
935 	case ICMPV6_DEST_UNREACH:
936 	case ICMPV6_TIME_EXCEED:
937 	case ICMPV6_PARAMPROB:
938 		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
939 		break;
940 
941 	case NDISC_ROUTER_SOLICITATION:
942 	case NDISC_ROUTER_ADVERTISEMENT:
943 	case NDISC_NEIGHBOUR_SOLICITATION:
944 	case NDISC_NEIGHBOUR_ADVERTISEMENT:
945 	case NDISC_REDIRECT:
946 		ndisc_rcv(skb);
947 		break;
948 
949 	case ICMPV6_MGM_QUERY:
950 		igmp6_event_query(skb);
951 		return 0;
952 
953 	case ICMPV6_MGM_REPORT:
954 		igmp6_event_report(skb);
955 		return 0;
956 
957 	case ICMPV6_MGM_REDUCTION:
958 	case ICMPV6_NI_QUERY:
959 	case ICMPV6_NI_REPLY:
960 	case ICMPV6_MLD2_REPORT:
961 	case ICMPV6_DHAAD_REQUEST:
962 	case ICMPV6_DHAAD_REPLY:
963 	case ICMPV6_MOBILE_PREFIX_SOL:
964 	case ICMPV6_MOBILE_PREFIX_ADV:
965 		break;
966 
967 	default:
968 		/* informational */
969 		if (type & ICMPV6_INFOMSG_MASK)
970 			break;
971 
972 		net_dbg_ratelimited("icmpv6: msg of unknown type [%pI6c > %pI6c]\n",
973 				    saddr, daddr);
974 
975 		/*
976 		 * error of unknown type.
977 		 * must pass to upper level
978 		 */
979 
980 		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
981 	}
982 
983 	/* until the v6 path can be better sorted assume failure and
984 	 * preserve the status quo behaviour for the rest of the paths to here
985 	 */
986 	if (success)
987 		consume_skb(skb);
988 	else
989 		kfree_skb(skb);
990 
991 	return 0;
992 
993 csum_error:
994 	__ICMP6_INC_STATS(dev_net(dev), idev, ICMP6_MIB_CSUMERRORS);
995 discard_it:
996 	__ICMP6_INC_STATS(dev_net(dev), idev, ICMP6_MIB_INERRORS);
997 drop_no_count:
998 	kfree_skb(skb);
999 	return 0;
1000 }
1001 
1002 void icmpv6_flow_init(struct sock *sk, struct flowi6 *fl6,
1003 		      u8 type,
1004 		      const struct in6_addr *saddr,
1005 		      const struct in6_addr *daddr,
1006 		      int oif)
1007 {
1008 	memset(fl6, 0, sizeof(*fl6));
1009 	fl6->saddr = *saddr;
1010 	fl6->daddr = *daddr;
1011 	fl6->flowi6_proto	= IPPROTO_ICMPV6;
1012 	fl6->fl6_icmp_type	= type;
1013 	fl6->fl6_icmp_code	= 0;
1014 	fl6->flowi6_oif		= oif;
1015 	security_sk_classify_flow(sk, flowi6_to_flowi_common(fl6));
1016 }
1017 
1018 static void __net_exit icmpv6_sk_exit(struct net *net)
1019 {
1020 	int i;
1021 
1022 	for_each_possible_cpu(i)
1023 		inet_ctl_sock_destroy(*per_cpu_ptr(net->ipv6.icmp_sk, i));
1024 	free_percpu(net->ipv6.icmp_sk);
1025 }
1026 
1027 static int __net_init icmpv6_sk_init(struct net *net)
1028 {
1029 	struct sock *sk;
1030 	int err, i;
1031 
1032 	net->ipv6.icmp_sk = alloc_percpu(struct sock *);
1033 	if (!net->ipv6.icmp_sk)
1034 		return -ENOMEM;
1035 
1036 	for_each_possible_cpu(i) {
1037 		err = inet_ctl_sock_create(&sk, PF_INET6,
1038 					   SOCK_RAW, IPPROTO_ICMPV6, net);
1039 		if (err < 0) {
1040 			pr_err("Failed to initialize the ICMP6 control socket (err %d)\n",
1041 			       err);
1042 			goto fail;
1043 		}
1044 
1045 		*per_cpu_ptr(net->ipv6.icmp_sk, i) = sk;
1046 
1047 		/* Enough space for 2 64K ICMP packets, including
1048 		 * sk_buff struct overhead.
1049 		 */
1050 		sk->sk_sndbuf = 2 * SKB_TRUESIZE(64 * 1024);
1051 	}
1052 	return 0;
1053 
1054  fail:
1055 	icmpv6_sk_exit(net);
1056 	return err;
1057 }
1058 
1059 static struct pernet_operations icmpv6_sk_ops = {
1060 	.init = icmpv6_sk_init,
1061 	.exit = icmpv6_sk_exit,
1062 };
1063 
1064 int __init icmpv6_init(void)
1065 {
1066 	int err;
1067 
1068 	err = register_pernet_subsys(&icmpv6_sk_ops);
1069 	if (err < 0)
1070 		return err;
1071 
1072 	err = -EAGAIN;
1073 	if (inet6_add_protocol(&icmpv6_protocol, IPPROTO_ICMPV6) < 0)
1074 		goto fail;
1075 
1076 	err = inet6_register_icmp_sender(icmp6_send);
1077 	if (err)
1078 		goto sender_reg_err;
1079 	return 0;
1080 
1081 sender_reg_err:
1082 	inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
1083 fail:
1084 	pr_err("Failed to register ICMP6 protocol\n");
1085 	unregister_pernet_subsys(&icmpv6_sk_ops);
1086 	return err;
1087 }
1088 
1089 void icmpv6_cleanup(void)
1090 {
1091 	inet6_unregister_icmp_sender(icmp6_send);
1092 	unregister_pernet_subsys(&icmpv6_sk_ops);
1093 	inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
1094 }
1095 
1096 
1097 static const struct icmp6_err {
1098 	int err;
1099 	int fatal;
1100 } tab_unreach[] = {
1101 	{	/* NOROUTE */
1102 		.err	= ENETUNREACH,
1103 		.fatal	= 0,
1104 	},
1105 	{	/* ADM_PROHIBITED */
1106 		.err	= EACCES,
1107 		.fatal	= 1,
1108 	},
1109 	{	/* Was NOT_NEIGHBOUR, now reserved */
1110 		.err	= EHOSTUNREACH,
1111 		.fatal	= 0,
1112 	},
1113 	{	/* ADDR_UNREACH	*/
1114 		.err	= EHOSTUNREACH,
1115 		.fatal	= 0,
1116 	},
1117 	{	/* PORT_UNREACH	*/
1118 		.err	= ECONNREFUSED,
1119 		.fatal	= 1,
1120 	},
1121 	{	/* POLICY_FAIL */
1122 		.err	= EACCES,
1123 		.fatal	= 1,
1124 	},
1125 	{	/* REJECT_ROUTE	*/
1126 		.err	= EACCES,
1127 		.fatal	= 1,
1128 	},
1129 };
1130 
1131 int icmpv6_err_convert(u8 type, u8 code, int *err)
1132 {
1133 	int fatal = 0;
1134 
1135 	*err = EPROTO;
1136 
1137 	switch (type) {
1138 	case ICMPV6_DEST_UNREACH:
1139 		fatal = 1;
1140 		if (code < ARRAY_SIZE(tab_unreach)) {
1141 			*err  = tab_unreach[code].err;
1142 			fatal = tab_unreach[code].fatal;
1143 		}
1144 		break;
1145 
1146 	case ICMPV6_PKT_TOOBIG:
1147 		*err = EMSGSIZE;
1148 		break;
1149 
1150 	case ICMPV6_PARAMPROB:
1151 		*err = EPROTO;
1152 		fatal = 1;
1153 		break;
1154 
1155 	case ICMPV6_TIME_EXCEED:
1156 		*err = EHOSTUNREACH;
1157 		break;
1158 	}
1159 
1160 	return fatal;
1161 }
1162 EXPORT_SYMBOL(icmpv6_err_convert);
1163 
1164 #ifdef CONFIG_SYSCTL
1165 static struct ctl_table ipv6_icmp_table_template[] = {
1166 	{
1167 		.procname	= "ratelimit",
1168 		.data		= &init_net.ipv6.sysctl.icmpv6_time,
1169 		.maxlen		= sizeof(int),
1170 		.mode		= 0644,
1171 		.proc_handler	= proc_dointvec_ms_jiffies,
1172 	},
1173 	{
1174 		.procname	= "echo_ignore_all",
1175 		.data		= &init_net.ipv6.sysctl.icmpv6_echo_ignore_all,
1176 		.maxlen		= sizeof(u8),
1177 		.mode		= 0644,
1178 		.proc_handler = proc_dou8vec_minmax,
1179 	},
1180 	{
1181 		.procname	= "echo_ignore_multicast",
1182 		.data		= &init_net.ipv6.sysctl.icmpv6_echo_ignore_multicast,
1183 		.maxlen		= sizeof(u8),
1184 		.mode		= 0644,
1185 		.proc_handler = proc_dou8vec_minmax,
1186 	},
1187 	{
1188 		.procname	= "echo_ignore_anycast",
1189 		.data		= &init_net.ipv6.sysctl.icmpv6_echo_ignore_anycast,
1190 		.maxlen		= sizeof(u8),
1191 		.mode		= 0644,
1192 		.proc_handler = proc_dou8vec_minmax,
1193 	},
1194 	{
1195 		.procname	= "ratemask",
1196 		.data		= &init_net.ipv6.sysctl.icmpv6_ratemask_ptr,
1197 		.maxlen		= ICMPV6_MSG_MAX + 1,
1198 		.mode		= 0644,
1199 		.proc_handler = proc_do_large_bitmap,
1200 	},
1201 	{ },
1202 };
1203 
1204 struct ctl_table * __net_init ipv6_icmp_sysctl_init(struct net *net)
1205 {
1206 	struct ctl_table *table;
1207 
1208 	table = kmemdup(ipv6_icmp_table_template,
1209 			sizeof(ipv6_icmp_table_template),
1210 			GFP_KERNEL);
1211 
1212 	if (table) {
1213 		table[0].data = &net->ipv6.sysctl.icmpv6_time;
1214 		table[1].data = &net->ipv6.sysctl.icmpv6_echo_ignore_all;
1215 		table[2].data = &net->ipv6.sysctl.icmpv6_echo_ignore_multicast;
1216 		table[3].data = &net->ipv6.sysctl.icmpv6_echo_ignore_anycast;
1217 		table[4].data = &net->ipv6.sysctl.icmpv6_ratemask_ptr;
1218 	}
1219 	return table;
1220 }
1221 #endif
1222