icmp.c 22.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
/*
 *	Internet Control Message Protocol (ICMPv6)
 *	Linux INET6 implementation
 *
 *	Authors:
 *	Pedro Roque		<roque@di.fc.ul.pt>
 *
 *	Based on net/ipv4/icmp.c
 *
 *	RFC 1885
 *
 *	This program is free software; you can redistribute it and/or
 *      modify it under the terms of the GNU General Public License
 *      as published by the Free Software Foundation; either version
 *      2 of the License, or (at your option) any later version.
 */

/*
 *	Changes:
 *
 *	Andi Kleen		:	exception handling
 *	Andi Kleen			add rate limits. never reply to a icmp.
 *					add more length checks and other fixes.
 *	yoshfuji		:	ensure to sent parameter problem for
 *					fragments.
 *	YOSHIFUJI Hideaki @USAGI:	added sysctl for icmp rate limit.
 *	Randy Dunlap and
 *	YOSHIFUJI Hideaki @USAGI:	Per-interface statistics support
 *	Kazunori MIYAZAWA @USAGI:       change output process to use ip6_append_data
 */

32 33
#define pr_fmt(fmt) "IPv6: " fmt

L
Linus Torvalds 已提交
34 35 36 37 38 39 40 41 42 43
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/in.h>
#include <linux/kernel.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <linux/skbuff.h>
#include <linux/init.h>
44
#include <linux/netfilter.h>
45
#include <linux/slab.h>
L
Linus Torvalds 已提交
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66

#ifdef CONFIG_SYSCTL
#include <linux/sysctl.h>
#endif

#include <linux/inet.h>
#include <linux/netdevice.h>
#include <linux/icmpv6.h>

#include <net/ip.h>
#include <net/sock.h>

#include <net/ipv6.h>
#include <net/ip6_checksum.h>
#include <net/protocol.h>
#include <net/raw.h>
#include <net/rawv6.h>
#include <net/transp_v6.h>
#include <net/ip6_route.h>
#include <net/addrconf.h>
#include <net/icmp.h>
67
#include <net/xfrm.h>
68
#include <net/inet_common.h>
L
Linus Torvalds 已提交
69 70 71 72 73 74 75 76 77 78

#include <asm/uaccess.h>

/*
 *	The ICMP socket(s). This is the most convenient way to flow control
 *	our ICMP output as well as maintain a clean interface throughout
 *	all layers. All Socketless IP sends will soon be gone.
 *
 *	On SMP we have one ICMP socket per-cpu.
 */
79 80 81 82
static inline struct sock *icmpv6_sk(struct net *net)
{
	return net->ipv6.icmp_sk[smp_processor_id()];
}
L
Linus Torvalds 已提交
83

84 85 86 87 88 89 90 91 92 93 94
static void icmpv6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
		       u8 type, u8 code, int offset, __be32 info)
{
	struct net *net = dev_net(skb->dev);

	if (type == ICMPV6_PKT_TOOBIG)
		ip6_update_pmtu(skb, net, info, 0, 0);
	else if (type == NDISC_REDIRECT)
		ip6_redirect(skb, net, 0, 0);
}

95
static int icmpv6_rcv(struct sk_buff *skb);
L
Linus Torvalds 已提交
96

97
static const struct inet6_protocol icmpv6_protocol = {
L
Linus Torvalds 已提交
98
	.handler	=	icmpv6_rcv,
99
	.err_handler	=	icmpv6_err,
100
	.flags		=	INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
L
Linus Torvalds 已提交
101 102
};

103
static __inline__ struct sock *icmpv6_xmit_lock(struct net *net)
L
Linus Torvalds 已提交
104
{
105 106
	struct sock *sk;

L
Linus Torvalds 已提交
107 108
	local_bh_disable();

109
	sk = icmpv6_sk(net);
110
	if (unlikely(!spin_trylock(&sk->sk_lock.slock))) {
L
Linus Torvalds 已提交
111 112 113 114 115
		/* This can happen if the output path (f.e. SIT or
		 * ip6ip6 tunnel) signals dst_link_failure() for an
		 * outgoing ICMP6 packet.
		 */
		local_bh_enable();
116
		return NULL;
L
Linus Torvalds 已提交
117
	}
118
	return sk;
L
Linus Torvalds 已提交
119 120
}

121
static __inline__ void icmpv6_xmit_unlock(struct sock *sk)
L
Linus Torvalds 已提交
122
{
123
	spin_unlock_bh(&sk->sk_lock.slock);
L
Linus Torvalds 已提交
124 125 126 127 128 129 130 131 132 133 134 135 136
}

/*
 * Figure out, may we reply to this packet with icmp error.
 *
 * We do not reply, if:
 *	- it was icmp error message.
 *	- it is truncated, so that it is known, that protocol is ICMPV6
 *	  (i.e. in the middle of some exthdr)
 *
 *	--ANK (980726)
 */

137
static bool is_ineligible(const struct sk_buff *skb)
L
Linus Torvalds 已提交
138
{
139
	int ptr = (u8 *)(ipv6_hdr(skb) + 1) - skb->data;
L
Linus Torvalds 已提交
140
	int len = skb->len - ptr;
141
	__u8 nexthdr = ipv6_hdr(skb)->nexthdr;
142
	__be16 frag_off;
L
Linus Torvalds 已提交
143 144

	if (len < 0)
145
		return true;
L
Linus Torvalds 已提交
146

147
	ptr = ipv6_skip_exthdr(skb, ptr, &nexthdr, &frag_off);
L
Linus Torvalds 已提交
148
	if (ptr < 0)
149
		return false;
L
Linus Torvalds 已提交
150 151 152 153 154 155 156
	if (nexthdr == IPPROTO_ICMPV6) {
		u8 _type, *tp;
		tp = skb_header_pointer(skb,
			ptr+offsetof(struct icmp6hdr, icmp6_type),
			sizeof(_type), &_type);
		if (tp == NULL ||
		    !(*tp & ICMPV6_INFOMSG_MASK))
157
			return true;
L
Linus Torvalds 已提交
158
	}
159
	return false;
L
Linus Torvalds 已提交
160 161
}

162 163
/*
 * Check the ICMP output rate limit
L
Linus Torvalds 已提交
164
 */
165
static inline bool icmpv6_xrlim_allow(struct sock *sk, u8 type,
166
				      struct flowi6 *fl6)
L
Linus Torvalds 已提交
167 168
{
	struct dst_entry *dst;
169
	struct net *net = sock_net(sk);
170
	bool res = false;
L
Linus Torvalds 已提交
171 172 173

	/* Informational messages are not limited. */
	if (type & ICMPV6_INFOMSG_MASK)
174
		return true;
L
Linus Torvalds 已提交
175 176 177

	/* Do not limit pmtu discovery, it would break it. */
	if (type == ICMPV6_PKT_TOOBIG)
178
		return true;
L
Linus Torvalds 已提交
179

180
	/*
L
Linus Torvalds 已提交
181 182 183 184
	 * Look up the output route.
	 * XXX: perhaps the expire for routing entries cloned by
	 * this lookup should be more aggressive (not longer than timeout).
	 */
185
	dst = ip6_route_output(net, sk, fl6);
L
Linus Torvalds 已提交
186
	if (dst->error) {
187
		IP6_INC_STATS(net, ip6_dst_idev(dst),
188
			      IPSTATS_MIB_OUTNOROUTES);
L
Linus Torvalds 已提交
189
	} else if (dst->dev && (dst->dev->flags&IFF_LOOPBACK)) {
190
		res = true;
L
Linus Torvalds 已提交
191 192
	} else {
		struct rt6_info *rt = (struct rt6_info *)dst;
193
		int tmo = net->ipv6.sysctl.icmpv6_time;
194
		struct inet_peer *peer;
L
Linus Torvalds 已提交
195 196 197 198 199

		/* Give more bandwidth to wider prefixes. */
		if (rt->rt6i_dst.plen < 128)
			tmo >>= ((128 - rt->rt6i_dst.plen)>>5);

200
		peer = inet_getpeer_v6(net->ipv6.peers, &rt->rt6i_dst.addr, 1);
201
		res = inet_peer_xrlim_allow(peer, tmo);
202 203
		if (peer)
			inet_putpeer(peer);
L
Linus Torvalds 已提交
204 205 206 207 208 209 210 211
	}
	dst_release(dst);
	return res;
}

/*
 *	an inline helper for the "simple" if statement below
 *	checks if parameter problem report is caused by an
212
 *	unrecognized IPv6 option that has the Option Type
L
Linus Torvalds 已提交
213 214 215
 *	highest-order two bits set to 10
 */

216
static bool opt_unrec(struct sk_buff *skb, __u32 offset)
L
Linus Torvalds 已提交
217 218 219
{
	u8 _optval, *op;

220
	offset += skb_network_offset(skb);
L
Linus Torvalds 已提交
221 222
	op = skb_header_pointer(skb, offset, sizeof(_optval), &_optval);
	if (op == NULL)
223
		return true;
L
Linus Torvalds 已提交
224 225 226
	return (*op & 0xC0) == 0x80;
}

227
static int icmpv6_push_pending_frames(struct sock *sk, struct flowi6 *fl6, struct icmp6hdr *thdr, int len)
L
Linus Torvalds 已提交
228 229 230 231 232 233 234 235
{
	struct sk_buff *skb;
	struct icmp6hdr *icmp6h;
	int err = 0;

	if ((skb = skb_peek(&sk->sk_write_queue)) == NULL)
		goto out;

236
	icmp6h = icmp6_hdr(skb);
L
Linus Torvalds 已提交
237 238 239 240
	memcpy(icmp6h, thdr, sizeof(struct icmp6hdr));
	icmp6h->icmp6_cksum = 0;

	if (skb_queue_len(&sk->sk_write_queue) == 1) {
241
		skb->csum = csum_partial(icmp6h,
L
Linus Torvalds 已提交
242
					sizeof(struct icmp6hdr), skb->csum);
243 244 245
		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
						      &fl6->daddr,
						      len, fl6->flowi6_proto,
L
Linus Torvalds 已提交
246 247
						      skb->csum);
	} else {
248
		__wsum tmp_csum = 0;
L
Linus Torvalds 已提交
249 250 251 252 253

		skb_queue_walk(&sk->sk_write_queue, skb) {
			tmp_csum = csum_add(tmp_csum, skb->csum);
		}

254
		tmp_csum = csum_partial(icmp6h,
L
Linus Torvalds 已提交
255
					sizeof(struct icmp6hdr), tmp_csum);
256 257 258
		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
						      &fl6->daddr,
						      len, fl6->flowi6_proto,
259
						      tmp_csum);
L
Linus Torvalds 已提交
260 261 262 263 264 265 266 267 268
	}
	ip6_push_pending_frames(sk);
out:
	return err;
}

struct icmpv6_msg {
	struct sk_buff	*skb;
	int		offset;
269
	uint8_t		type;
L
Linus Torvalds 已提交
270 271 272 273 274 275
};

static int icmpv6_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
{
	struct icmpv6_msg *msg = (struct icmpv6_msg *) from;
	struct sk_buff *org_skb = msg->skb;
276
	__wsum csum = 0;
L
Linus Torvalds 已提交
277 278 279 280

	csum = skb_copy_and_csum_bits(org_skb, msg->offset + offset,
				      to, len, csum);
	skb->csum = csum_block_add(skb->csum, csum, odd);
281 282
	if (!(msg->type & ICMPV6_INFOMSG_MASK))
		nf_ct_attach(skb, org_skb);
L
Linus Torvalds 已提交
283 284 285
	return 0;
}

A
Amerigo Wang 已提交
286
#if IS_ENABLED(CONFIG_IPV6_MIP6)
287 288
static void mip6_addr_swap(struct sk_buff *skb)
{
289
	struct ipv6hdr *iph = ipv6_hdr(skb);
290 291 292 293 294 295 296 297
	struct inet6_skb_parm *opt = IP6CB(skb);
	struct ipv6_destopt_hao *hao;
	struct in6_addr tmp;
	int off;

	if (opt->dsthao) {
		off = ipv6_find_tlv(skb, opt->dsthao, IPV6_TLV_HAO);
		if (likely(off >= 0)) {
298 299
			hao = (struct ipv6_destopt_hao *)
					(skb_network_header(skb) + off);
A
Alexey Dobriyan 已提交
300 301 302
			tmp = iph->saddr;
			iph->saddr = hao->addr;
			hao->addr = tmp;
303 304 305 306 307 308 309
		}
	}
}
#else
static inline void mip6_addr_swap(struct sk_buff *skb) {}
#endif

310
static struct dst_entry *icmpv6_route_lookup(struct net *net, struct sk_buff *skb,
311
					     struct sock *sk, struct flowi6 *fl6)
312 313
{
	struct dst_entry *dst, *dst2;
314
	struct flowi6 fl2;
315 316
	int err;

317
	err = ip6_dst_lookup(sk, &dst, fl6);
318 319 320 321 322 323 324 325
	if (err)
		return ERR_PTR(err);

	/*
	 * We won't send icmp if the destination is known
	 * anycast.
	 */
	if (((struct rt6_info *)dst)->rt6i_flags & RTF_ANYCAST) {
326
		LIMIT_NETDEBUG(KERN_DEBUG "icmp6_send: acast source\n");
327 328 329 330 331 332 333
		dst_release(dst);
		return ERR_PTR(-EINVAL);
	}

	/* No need to clone since we're just using its address. */
	dst2 = dst;

334
	dst = xfrm_lookup(net, dst, flowi6_to_flowi(fl6), sk, 0);
335
	if (!IS_ERR(dst)) {
336 337
		if (dst != dst2)
			return dst;
338 339 340 341 342
	} else {
		if (PTR_ERR(dst) == -EPERM)
			dst = NULL;
		else
			return dst;
343 344
	}

345
	err = xfrm_decode_session_reverse(skb, flowi6_to_flowi(&fl2), AF_INET6);
346 347 348 349 350 351 352
	if (err)
		goto relookup_failed;

	err = ip6_dst_lookup(sk, &dst2, &fl2);
	if (err)
		goto relookup_failed;

353
	dst2 = xfrm_lookup(net, dst2, flowi6_to_flowi(&fl2), sk, XFRM_LOOKUP_ICMP);
354
	if (!IS_ERR(dst2)) {
355 356
		dst_release(dst);
		dst = dst2;
357 358 359 360 361 362 363
	} else {
		err = PTR_ERR(dst2);
		if (err == -EPERM) {
			dst_release(dst);
			return dst2;
		} else
			goto relookup_failed;
364 365 366 367 368 369 370 371
	}

relookup_failed:
	if (dst)
		return dst;
	return ERR_PTR(err);
}

L
Linus Torvalds 已提交
372 373 374
/*
 *	Send an ICMP message in response to a packet in error
 */
375
static void icmp6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info)
L
Linus Torvalds 已提交
376
{
377
	struct net *net = dev_net(skb->dev);
L
Linus Torvalds 已提交
378
	struct inet6_dev *idev = NULL;
379
	struct ipv6hdr *hdr = ipv6_hdr(skb);
380 381
	struct sock *sk;
	struct ipv6_pinfo *np;
382
	const struct in6_addr *saddr = NULL;
L
Linus Torvalds 已提交
383 384
	struct dst_entry *dst;
	struct icmp6hdr tmp_hdr;
385
	struct flowi6 fl6;
L
Linus Torvalds 已提交
386 387 388 389
	struct icmpv6_msg msg;
	int iif = 0;
	int addr_type = 0;
	int len;
G
Gerrit Renker 已提交
390
	int hlimit;
L
Linus Torvalds 已提交
391 392
	int err = 0;

393 394
	if ((u8 *)hdr < skb->head ||
	    (skb->network_header + sizeof(*hdr)) > skb->tail)
L
Linus Torvalds 已提交
395 396 397
		return;

	/*
398
	 *	Make sure we respect the rules
L
Linus Torvalds 已提交
399
	 *	i.e. RFC 1885 2.4(e)
400
	 *	Rule (e.1) is enforced by not using icmp6_send
L
Linus Torvalds 已提交
401 402 403 404
	 *	in any code that processes icmp errors.
	 */
	addr_type = ipv6_addr_type(&hdr->daddr);

405
	if (ipv6_chk_addr(net, &hdr->daddr, skb->dev, 0))
L
Linus Torvalds 已提交
406 407 408 409 410 411 412 413
		saddr = &hdr->daddr;

	/*
	 *	Dest addr check
	 */

	if ((addr_type & IPV6_ADDR_MULTICAST || skb->pkt_type != PACKET_HOST)) {
		if (type != ICMPV6_PKT_TOOBIG &&
414 415
		    !(type == ICMPV6_PARAMPROB &&
		      code == ICMPV6_UNK_OPTION &&
L
Linus Torvalds 已提交
416 417 418 419 420 421 422 423 424 425 426 427
		      (opt_unrec(skb, info))))
			return;

		saddr = NULL;
	}

	addr_type = ipv6_addr_type(&hdr->saddr);

	/*
	 *	Source addr check
	 */

428
	if (__ipv6_addr_needs_scope_id(addr_type))
L
Linus Torvalds 已提交
429 430 431
		iif = skb->dev->ifindex;

	/*
432 433 434 435
	 *	Must not send error if the source does not uniquely
	 *	identify a single node (RFC2463 Section 2.4).
	 *	We check unspecified / multicast addresses here,
	 *	and anycast addresses will be checked later.
L
Linus Torvalds 已提交
436 437
	 */
	if ((addr_type == IPV6_ADDR_ANY) || (addr_type & IPV6_ADDR_MULTICAST)) {
438
		LIMIT_NETDEBUG(KERN_DEBUG "icmp6_send: addr_any/mcast source\n");
L
Linus Torvalds 已提交
439 440 441
		return;
	}

442
	/*
L
Linus Torvalds 已提交
443 444 445
	 *	Never answer to a ICMP packet.
	 */
	if (is_ineligible(skb)) {
446
		LIMIT_NETDEBUG(KERN_DEBUG "icmp6_send: no reply to icmp error\n");
L
Linus Torvalds 已提交
447 448 449
		return;
	}

450 451
	mip6_addr_swap(skb);

452 453
	memset(&fl6, 0, sizeof(fl6));
	fl6.flowi6_proto = IPPROTO_ICMPV6;
A
Alexey Dobriyan 已提交
454
	fl6.daddr = hdr->saddr;
L
Linus Torvalds 已提交
455
	if (saddr)
A
Alexey Dobriyan 已提交
456
		fl6.saddr = *saddr;
457
	fl6.flowi6_oif = iif;
458 459
	fl6.fl6_icmp_type = type;
	fl6.fl6_icmp_code = code;
460
	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
L
Linus Torvalds 已提交
461

462 463
	sk = icmpv6_xmit_lock(net);
	if (sk == NULL)
464
		return;
465
	np = inet6_sk(sk);
466

467
	if (!icmpv6_xrlim_allow(sk, type, &fl6))
L
Linus Torvalds 已提交
468 469 470 471 472 473 474
		goto out;

	tmp_hdr.icmp6_type = type;
	tmp_hdr.icmp6_code = code;
	tmp_hdr.icmp6_cksum = 0;
	tmp_hdr.icmp6_pointer = htonl(info);

475 476
	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
		fl6.flowi6_oif = np->mcast_oif;
477 478
	else if (!fl6.flowi6_oif)
		fl6.flowi6_oif = np->ucast_oif;
L
Linus Torvalds 已提交
479

480
	dst = icmpv6_route_lookup(net, skb, sk, &fl6);
481
	if (IS_ERR(dst))
L
Linus Torvalds 已提交
482
		goto out;
483

484
	if (ipv6_addr_is_multicast(&fl6.daddr))
L
Linus Torvalds 已提交
485 486 487 488
		hlimit = np->mcast_hops;
	else
		hlimit = np->hop_limit;
	if (hlimit < 0)
489
		hlimit = ip6_dst_hoplimit(dst);
L
Linus Torvalds 已提交
490 491

	msg.skb = skb;
492
	msg.offset = skb_network_offset(skb);
493
	msg.type = type;
L
Linus Torvalds 已提交
494 495 496 497

	len = skb->len - msg.offset;
	len = min_t(unsigned int, len, IPV6_MIN_MTU - sizeof(struct ipv6hdr) -sizeof(struct icmp6hdr));
	if (len < 0) {
498
		LIMIT_NETDEBUG(KERN_DEBUG "icmp: len problem\n");
L
Linus Torvalds 已提交
499 500 501
		goto out_dst_release;
	}

E
Eric Dumazet 已提交
502 503
	rcu_read_lock();
	idev = __in6_dev_get(skb->dev);
L
Linus Torvalds 已提交
504 505 506

	err = ip6_append_data(sk, icmpv6_getfrag, &msg,
			      len + sizeof(struct icmp6hdr),
G
Gerrit Renker 已提交
507
			      sizeof(struct icmp6hdr), hlimit,
508
			      np->tclass, NULL, &fl6, (struct rt6_info *)dst,
509
			      MSG_DONTWAIT, np->dontfrag);
L
Linus Torvalds 已提交
510
	if (err) {
E
Eric Dumazet 已提交
511
		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
L
Linus Torvalds 已提交
512
		ip6_flush_pending_frames(sk);
E
Eric Dumazet 已提交
513 514 515
	} else {
		err = icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
						 len + sizeof(struct icmp6hdr));
L
Linus Torvalds 已提交
516
	}
E
Eric Dumazet 已提交
517
	rcu_read_unlock();
L
Linus Torvalds 已提交
518 519 520
out_dst_release:
	dst_release(dst);
out:
521
	icmpv6_xmit_unlock(sk);
L
Linus Torvalds 已提交
522
}
523 524 525 526 527 528 529 530

/* Slightly more convenient version of icmp6_send.
 */
void icmpv6_param_prob(struct sk_buff *skb, u8 code, int pos)
{
	icmp6_send(skb, ICMPV6_PARAMPROB, code, pos);
	kfree_skb(skb);
}
531

L
Linus Torvalds 已提交
532 533
static void icmpv6_echo_reply(struct sk_buff *skb)
{
534
	struct net *net = dev_net(skb->dev);
535
	struct sock *sk;
L
Linus Torvalds 已提交
536
	struct inet6_dev *idev;
537
	struct ipv6_pinfo *np;
538
	const struct in6_addr *saddr = NULL;
539
	struct icmp6hdr *icmph = icmp6_hdr(skb);
L
Linus Torvalds 已提交
540
	struct icmp6hdr tmp_hdr;
541
	struct flowi6 fl6;
L
Linus Torvalds 已提交
542 543 544 545 546
	struct icmpv6_msg msg;
	struct dst_entry *dst;
	int err = 0;
	int hlimit;

547
	saddr = &ipv6_hdr(skb)->daddr;
L
Linus Torvalds 已提交
548 549 550 551 552 553 554

	if (!ipv6_unicast_destination(skb))
		saddr = NULL;

	memcpy(&tmp_hdr, icmph, sizeof(tmp_hdr));
	tmp_hdr.icmp6_type = ICMPV6_ECHO_REPLY;

555 556
	memset(&fl6, 0, sizeof(fl6));
	fl6.flowi6_proto = IPPROTO_ICMPV6;
A
Alexey Dobriyan 已提交
557
	fl6.daddr = ipv6_hdr(skb)->saddr;
L
Linus Torvalds 已提交
558
	if (saddr)
A
Alexey Dobriyan 已提交
559
		fl6.saddr = *saddr;
560
	fl6.flowi6_oif = skb->dev->ifindex;
561
	fl6.fl6_icmp_type = ICMPV6_ECHO_REPLY;
562
	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
L
Linus Torvalds 已提交
563

564 565
	sk = icmpv6_xmit_lock(net);
	if (sk == NULL)
566
		return;
567
	np = inet6_sk(sk);
568

569 570
	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
		fl6.flowi6_oif = np->mcast_oif;
571 572
	else if (!fl6.flowi6_oif)
		fl6.flowi6_oif = np->ucast_oif;
L
Linus Torvalds 已提交
573

574
	err = ip6_dst_lookup(sk, &dst, &fl6);
L
Linus Torvalds 已提交
575 576
	if (err)
		goto out;
577
	dst = xfrm_lookup(net, dst, flowi6_to_flowi(&fl6), sk, 0);
578
	if (IS_ERR(dst))
579
		goto out;
L
Linus Torvalds 已提交
580

581
	if (ipv6_addr_is_multicast(&fl6.daddr))
L
Linus Torvalds 已提交
582 583 584 585
		hlimit = np->mcast_hops;
	else
		hlimit = np->hop_limit;
	if (hlimit < 0)
586
		hlimit = ip6_dst_hoplimit(dst);
L
Linus Torvalds 已提交
587

E
Eric Dumazet 已提交
588
	idev = __in6_dev_get(skb->dev);
L
Linus Torvalds 已提交
589 590 591

	msg.skb = skb;
	msg.offset = 0;
592
	msg.type = ICMPV6_ECHO_REPLY;
L
Linus Torvalds 已提交
593 594

	err = ip6_append_data(sk, icmpv6_getfrag, &msg, skb->len + sizeof(struct icmp6hdr),
595
				sizeof(struct icmp6hdr), hlimit, np->tclass, NULL, &fl6,
596
				(struct rt6_info *)dst, MSG_DONTWAIT,
597
				np->dontfrag);
L
Linus Torvalds 已提交
598 599

	if (err) {
E
Eric Dumazet 已提交
600
		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
L
Linus Torvalds 已提交
601
		ip6_flush_pending_frames(sk);
E
Eric Dumazet 已提交
602 603 604
	} else {
		err = icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
						 skb->len + sizeof(struct icmp6hdr));
L
Linus Torvalds 已提交
605 606
	}
	dst_release(dst);
607
out:
608
	icmpv6_xmit_unlock(sk);
L
Linus Torvalds 已提交
609 610
}

611
void icmpv6_notify(struct sk_buff *skb, u8 type, u8 code, __be32 info)
L
Linus Torvalds 已提交
612
{
613
	const struct inet6_protocol *ipprot;
L
Linus Torvalds 已提交
614
	int inner_offset;
615
	__be16 frag_off;
616
	u8 nexthdr;
L
Linus Torvalds 已提交
617 618 619 620 621 622 623

	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
		return;

	nexthdr = ((struct ipv6hdr *)skb->data)->nexthdr;
	if (ipv6_ext_hdr(nexthdr)) {
		/* now skip over extension headers */
624 625
		inner_offset = ipv6_skip_exthdr(skb, sizeof(struct ipv6hdr),
						&nexthdr, &frag_off);
L
Linus Torvalds 已提交
626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643
		if (inner_offset<0)
			return;
	} else {
		inner_offset = sizeof(struct ipv6hdr);
	}

	/* Checkin header including 8 bytes of inner protocol header. */
	if (!pskb_may_pull(skb, inner_offset+8))
		return;

	/* BUGGG_FUTURE: we should try to parse exthdrs in this packet.
	   Without this we will not able f.e. to make source routed
	   pmtu discovery.
	   Corresponding argument (opt) to notifiers is already added.
	   --ANK (980726)
	 */

	rcu_read_lock();
644
	ipprot = rcu_dereference(inet6_protos[nexthdr]);
L
Linus Torvalds 已提交
645 646 647 648
	if (ipprot && ipprot->err_handler)
		ipprot->err_handler(skb, NULL, type, code, inner_offset, info);
	rcu_read_unlock();

649
	raw6_icmp_error(skb, nexthdr, type, code, inner_offset, info);
L
Linus Torvalds 已提交
650
}
651

L
Linus Torvalds 已提交
652 653 654 655
/*
 *	Handle icmp messages
 */

656
static int icmpv6_rcv(struct sk_buff *skb)
L
Linus Torvalds 已提交
657 658 659
{
	struct net_device *dev = skb->dev;
	struct inet6_dev *idev = __in6_dev_get(dev);
660
	const struct in6_addr *saddr, *daddr;
L
Linus Torvalds 已提交
661
	struct icmp6hdr *hdr;
662
	u8 type;
L
Linus Torvalds 已提交
663

664
	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
665
		struct sec_path *sp = skb_sec_path(skb);
666 667
		int nh;

668
		if (!(sp && sp->xvec[sp->len - 1]->props.flags &
669 670 671
				 XFRM_STATE_ICMP))
			goto drop_no_count;

672
		if (!pskb_may_pull(skb, sizeof(*hdr) + sizeof(struct ipv6hdr)))
673 674 675 676 677 678 679 680 681 682 683
			goto drop_no_count;

		nh = skb_network_offset(skb);
		skb_set_network_header(skb, sizeof(*hdr));

		if (!xfrm6_policy_check_reverse(NULL, XFRM_POLICY_IN, skb))
			goto drop_no_count;

		skb_set_network_header(skb, nh);
	}

684
	ICMP6_INC_STATS_BH(dev_net(dev), idev, ICMP6_MIB_INMSGS);
L
Linus Torvalds 已提交
685

686 687
	saddr = &ipv6_hdr(skb)->saddr;
	daddr = &ipv6_hdr(skb)->daddr;
L
Linus Torvalds 已提交
688 689

	/* Perform checksum. */
690
	switch (skb->ip_summed) {
691
	case CHECKSUM_COMPLETE:
692 693 694 695 696
		if (!csum_ipv6_magic(saddr, daddr, skb->len, IPPROTO_ICMPV6,
				     skb->csum))
			break;
		/* fall through */
	case CHECKSUM_NONE:
697 698
		skb->csum = ~csum_unfold(csum_ipv6_magic(saddr, daddr, skb->len,
					     IPPROTO_ICMPV6, 0));
699
		if (__skb_checksum_complete(skb)) {
H
Harvey Harrison 已提交
700
			LIMIT_NETDEBUG(KERN_DEBUG "ICMPv6 checksum failed [%pI6 > %pI6]\n",
701
				       saddr, daddr);
L
Linus Torvalds 已提交
702 703 704 705
			goto discard_it;
		}
	}

706 707
	if (!pskb_pull(skb, sizeof(*hdr)))
		goto discard_it;
L
Linus Torvalds 已提交
708

709
	hdr = icmp6_hdr(skb);
L
Linus Torvalds 已提交
710 711 712

	type = hdr->icmp6_type;

713
	ICMP6MSGIN_INC_STATS_BH(dev_net(dev), idev, type);
L
Linus Torvalds 已提交
714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731

	switch (type) {
	case ICMPV6_ECHO_REQUEST:
		icmpv6_echo_reply(skb);
		break;

	case ICMPV6_ECHO_REPLY:
		/* we couldn't care less */
		break;

	case ICMPV6_PKT_TOOBIG:
		/* BUGGG_FUTURE: if packet contains rthdr, we cannot update
		   standard destination cache. Seems, only "advanced"
		   destination cache will allow to solve this problem
		   --ANK (980726)
		 */
		if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
			goto discard_it;
732
		hdr = icmp6_hdr(skb);
L
Linus Torvalds 已提交
733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770

		/*
		 *	Drop through to notify
		 */

	case ICMPV6_DEST_UNREACH:
	case ICMPV6_TIME_EXCEED:
	case ICMPV6_PARAMPROB:
		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
		break;

	case NDISC_ROUTER_SOLICITATION:
	case NDISC_ROUTER_ADVERTISEMENT:
	case NDISC_NEIGHBOUR_SOLICITATION:
	case NDISC_NEIGHBOUR_ADVERTISEMENT:
	case NDISC_REDIRECT:
		ndisc_rcv(skb);
		break;

	case ICMPV6_MGM_QUERY:
		igmp6_event_query(skb);
		break;

	case ICMPV6_MGM_REPORT:
		igmp6_event_report(skb);
		break;

	case ICMPV6_MGM_REDUCTION:
	case ICMPV6_NI_QUERY:
	case ICMPV6_NI_REPLY:
	case ICMPV6_MLD2_REPORT:
	case ICMPV6_DHAAD_REQUEST:
	case ICMPV6_DHAAD_REPLY:
	case ICMPV6_MOBILE_PREFIX_SOL:
	case ICMPV6_MOBILE_PREFIX_ADV:
		break;

	default:
771
		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6: msg of unknown type\n");
L
Linus Torvalds 已提交
772 773 774 775 776

		/* informational */
		if (type & ICMPV6_INFOMSG_MASK)
			break;

777 778 779
		/*
		 * error of unknown type.
		 * must pass to upper level
L
Linus Torvalds 已提交
780 781 782
		 */

		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
783 784
	}

L
Linus Torvalds 已提交
785 786 787 788
	kfree_skb(skb);
	return 0;

discard_it:
789
	ICMP6_INC_STATS_BH(dev_net(dev), idev, ICMP6_MIB_INERRORS);
790
drop_no_count:
L
Linus Torvalds 已提交
791 792 793 794
	kfree_skb(skb);
	return 0;
}

795
void icmpv6_flow_init(struct sock *sk, struct flowi6 *fl6,
796 797 798 799 800
		      u8 type,
		      const struct in6_addr *saddr,
		      const struct in6_addr *daddr,
		      int oif)
{
801
	memset(fl6, 0, sizeof(*fl6));
A
Alexey Dobriyan 已提交
802 803
	fl6->saddr = *saddr;
	fl6->daddr = *daddr;
804
	fl6->flowi6_proto 	= IPPROTO_ICMPV6;
805 806
	fl6->fl6_icmp_type	= type;
	fl6->fl6_icmp_code	= 0;
807 808
	fl6->flowi6_oif		= oif;
	security_sk_classify_flow(sk, flowi6_to_flowi(fl6));
809 810
}

811
/*
812
 * Special lock-class for __icmpv6_sk:
813 814 815
 */
static struct lock_class_key icmpv6_socket_sk_dst_lock_key;

816
static int __net_init icmpv6_sk_init(struct net *net)
L
Linus Torvalds 已提交
817 818 819 820
{
	struct sock *sk;
	int err, i, j;

821 822 823
	net->ipv6.icmp_sk =
		kzalloc(nr_cpu_ids * sizeof(struct sock *), GFP_KERNEL);
	if (net->ipv6.icmp_sk == NULL)
824 825
		return -ENOMEM;

826
	for_each_possible_cpu(i) {
827 828
		err = inet_ctl_sock_create(&sk, PF_INET6,
					   SOCK_RAW, IPPROTO_ICMPV6, net);
L
Linus Torvalds 已提交
829
		if (err < 0) {
830
			pr_err("Failed to initialize the ICMP6 control socket (err %d)\n",
L
Linus Torvalds 已提交
831 832 833 834
			       err);
			goto fail;
		}

835
		net->ipv6.icmp_sk[i] = sk;
836

837 838 839
		/*
		 * Split off their lock-class, because sk->sk_dst_lock
		 * gets used from softirqs, which is safe for
840
		 * __icmpv6_sk (because those never get directly used
841 842 843 844
		 * via userspace syscalls), but unsafe for normal sockets.
		 */
		lockdep_set_class(&sk->sk_dst_lock,
				  &icmpv6_socket_sk_dst_lock_key);
L
Linus Torvalds 已提交
845 846 847 848

		/* Enough space for 2 64K ICMP packets, including
		 * sk_buff struct overhead.
		 */
E
Eric Dumazet 已提交
849
		sk->sk_sndbuf = 2 * SKB_TRUESIZE(64 * 1024);
L
Linus Torvalds 已提交
850 851 852 853
	}
	return 0;

 fail:
854
	for (j = 0; j < i; j++)
855
		inet_ctl_sock_destroy(net->ipv6.icmp_sk[j]);
856
	kfree(net->ipv6.icmp_sk);
L
Linus Torvalds 已提交
857 858 859
	return err;
}

860
static void __net_exit icmpv6_sk_exit(struct net *net)
L
Linus Torvalds 已提交
861 862 863
{
	int i;

864
	for_each_possible_cpu(i) {
865
		inet_ctl_sock_destroy(net->ipv6.icmp_sk[i]);
L
Linus Torvalds 已提交
866
	}
867 868 869
	kfree(net->ipv6.icmp_sk);
}

870
static struct pernet_operations icmpv6_sk_ops = {
871 872 873 874 875 876 877 878 879 880 881 882 883 884 885
       .init = icmpv6_sk_init,
       .exit = icmpv6_sk_exit,
};

int __init icmpv6_init(void)
{
	int err;

	err = register_pernet_subsys(&icmpv6_sk_ops);
	if (err < 0)
		return err;

	err = -EAGAIN;
	if (inet6_add_protocol(&icmpv6_protocol, IPPROTO_ICMPV6) < 0)
		goto fail;
886 887 888 889

	err = inet6_register_icmp_sender(icmp6_send);
	if (err)
		goto sender_reg_err;
890 891
	return 0;

892 893
sender_reg_err:
	inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
894
fail:
895
	pr_err("Failed to register ICMP6 protocol\n");
896 897 898 899
	unregister_pernet_subsys(&icmpv6_sk_ops);
	return err;
}

900
void icmpv6_cleanup(void)
901
{
902
	inet6_unregister_icmp_sender(icmp6_send);
903
	unregister_pernet_subsys(&icmpv6_sk_ops);
L
Linus Torvalds 已提交
904 905 906
	inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
}

907

908
static const struct icmp6_err {
L
Linus Torvalds 已提交
909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
	int err;
	int fatal;
} tab_unreach[] = {
	{	/* NOROUTE */
		.err	= ENETUNREACH,
		.fatal	= 0,
	},
	{	/* ADM_PROHIBITED */
		.err	= EACCES,
		.fatal	= 1,
	},
	{	/* Was NOT_NEIGHBOUR, now reserved */
		.err	= EHOSTUNREACH,
		.fatal	= 0,
	},
	{	/* ADDR_UNREACH	*/
		.err	= EHOSTUNREACH,
		.fatal	= 0,
	},
	{	/* PORT_UNREACH	*/
		.err	= ECONNREFUSED,
		.fatal	= 1,
	},
};

934
int icmpv6_err_convert(u8 type, u8 code, int *err)
L
Linus Torvalds 已提交
935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951
{
	int fatal = 0;

	*err = EPROTO;

	switch (type) {
	case ICMPV6_DEST_UNREACH:
		fatal = 1;
		if (code <= ICMPV6_PORT_UNREACH) {
			*err  = tab_unreach[code].err;
			fatal = tab_unreach[code].fatal;
		}
		break;

	case ICMPV6_PKT_TOOBIG:
		*err = EMSGSIZE;
		break;
952

L
Linus Torvalds 已提交
953 954 955 956 957 958 959 960
	case ICMPV6_PARAMPROB:
		*err = EPROTO;
		fatal = 1;
		break;

	case ICMPV6_TIME_EXCEED:
		*err = EHOSTUNREACH;
		break;
961
	}
L
Linus Torvalds 已提交
962 963 964

	return fatal;
}
965 966
EXPORT_SYMBOL(icmpv6_err_convert);

L
Linus Torvalds 已提交
967
#ifdef CONFIG_SYSCTL
968
ctl_table ipv6_icmp_table_template[] = {
L
Linus Torvalds 已提交
969 970
	{
		.procname	= "ratelimit",
971
		.data		= &init_net.ipv6.sysctl.icmpv6_time,
L
Linus Torvalds 已提交
972 973
		.maxlen		= sizeof(int),
		.mode		= 0644,
A
Alexey Dobriyan 已提交
974
		.proc_handler	= proc_dointvec_ms_jiffies,
L
Linus Torvalds 已提交
975
	},
976
	{ },
L
Linus Torvalds 已提交
977
};
978

979
struct ctl_table * __net_init ipv6_icmp_sysctl_init(struct net *net)
980 981 982 983 984 985
{
	struct ctl_table *table;

	table = kmemdup(ipv6_icmp_table_template,
			sizeof(ipv6_icmp_table_template),
			GFP_KERNEL);
986

987
	if (table)
988 989
		table[0].data = &net->ipv6.sysctl.icmpv6_time;

990 991
	return table;
}
L
Linus Torvalds 已提交
992 993
#endif