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