icmp.c 22.0 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 32 33 34 35 36 37 38 39 40 41
/*
 *	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
 */

#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>
42
#include <linux/netfilter.h>
43
#include <linux/slab.h>
L
Linus Torvalds 已提交
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64

#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>
65
#include <net/xfrm.h>
66
#include <net/inet_common.h>
L
Linus Torvalds 已提交
67 68 69 70 71 72 73 74 75 76 77

#include <asm/uaccess.h>
#include <asm/system.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.
 */
78 79 80 81
static inline struct sock *icmpv6_sk(struct net *net)
{
	return net->ipv6.icmp_sk[smp_processor_id()];
}
L
Linus Torvalds 已提交
82

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

85
static const struct inet6_protocol icmpv6_protocol = {
L
Linus Torvalds 已提交
86
	.handler	=	icmpv6_rcv,
87
	.flags		=	INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
L
Linus Torvalds 已提交
88 89
};

90
static __inline__ struct sock *icmpv6_xmit_lock(struct net *net)
L
Linus Torvalds 已提交
91
{
92 93
	struct sock *sk;

L
Linus Torvalds 已提交
94 95
	local_bh_disable();

96
	sk = icmpv6_sk(net);
97
	if (unlikely(!spin_trylock(&sk->sk_lock.slock))) {
L
Linus Torvalds 已提交
98 99 100 101 102
		/* 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();
103
		return NULL;
L
Linus Torvalds 已提交
104
	}
105
	return sk;
L
Linus Torvalds 已提交
106 107
}

108
static __inline__ void icmpv6_xmit_unlock(struct sock *sk)
L
Linus Torvalds 已提交
109
{
110
	spin_unlock_bh(&sk->sk_lock.slock);
L
Linus Torvalds 已提交
111 112
}

113
/*
L
Linus Torvalds 已提交
114 115
 * Slightly more convenient version of icmpv6_send.
 */
116
void icmpv6_param_prob(struct sk_buff *skb, u8 code, int pos)
L
Linus Torvalds 已提交
117
{
118
	icmpv6_send(skb, ICMPV6_PARAMPROB, code, pos);
L
Linus Torvalds 已提交
119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
	kfree_skb(skb);
}

/*
 * 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)
 */

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

	if (len < 0)
		return 1;

143
	ptr = ipv6_skip_exthdr(skb, ptr, &nexthdr, &frag_off);
L
Linus Torvalds 已提交
144 145 146 147 148 149 150 151 152 153 154 155 156 157
	if (ptr < 0)
		return 0;
	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))
			return 1;
	}
	return 0;
}

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

	/* Informational messages are not limited. */
	if (type & ICMPV6_INFOMSG_MASK)
170
		return true;
L
Linus Torvalds 已提交
171 172 173

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

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

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

195 196 197
		if (!rt->rt6i_peer)
			rt6_bind_peer(rt, 1);
		res = inet_peer_xrlim_allow(rt->rt6i_peer, tmo);
L
Linus Torvalds 已提交
198 199 200 201 202 203 204 205
	}
	dst_release(dst);
	return res;
}

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

static __inline__ int opt_unrec(struct sk_buff *skb, __u32 offset)
{
	u8 _optval, *op;

214
	offset += skb_network_offset(skb);
L
Linus Torvalds 已提交
215 216 217 218 219 220
	op = skb_header_pointer(skb, offset, sizeof(_optval), &_optval);
	if (op == NULL)
		return 1;
	return (*op & 0xC0) == 0x80;
}

221
static int icmpv6_push_pending_frames(struct sock *sk, struct flowi6 *fl6, struct icmp6hdr *thdr, int len)
L
Linus Torvalds 已提交
222 223 224 225 226 227 228 229
{
	struct sk_buff *skb;
	struct icmp6hdr *icmp6h;
	int err = 0;

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

230
	icmp6h = icmp6_hdr(skb);
L
Linus Torvalds 已提交
231 232 233 234
	memcpy(icmp6h, thdr, sizeof(struct icmp6hdr));
	icmp6h->icmp6_cksum = 0;

	if (skb_queue_len(&sk->sk_write_queue) == 1) {
235
		skb->csum = csum_partial(icmp6h,
L
Linus Torvalds 已提交
236
					sizeof(struct icmp6hdr), skb->csum);
237 238 239
		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
						      &fl6->daddr,
						      len, fl6->flowi6_proto,
L
Linus Torvalds 已提交
240 241
						      skb->csum);
	} else {
242
		__wsum tmp_csum = 0;
L
Linus Torvalds 已提交
243 244 245 246 247

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

248
		tmp_csum = csum_partial(icmp6h,
L
Linus Torvalds 已提交
249
					sizeof(struct icmp6hdr), tmp_csum);
250 251 252
		icmp6h->icmp6_cksum = csum_ipv6_magic(&fl6->saddr,
						      &fl6->daddr,
						      len, fl6->flowi6_proto,
253
						      tmp_csum);
L
Linus Torvalds 已提交
254 255 256 257 258 259 260 261 262
	}
	ip6_push_pending_frames(sk);
out:
	return err;
}

struct icmpv6_msg {
	struct sk_buff	*skb;
	int		offset;
263
	uint8_t		type;
L
Linus Torvalds 已提交
264 265 266 267 268 269
};

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;
270
	__wsum csum = 0;
L
Linus Torvalds 已提交
271 272 273 274

	csum = skb_copy_and_csum_bits(org_skb, msg->offset + offset,
				      to, len, csum);
	skb->csum = csum_block_add(skb->csum, csum, odd);
275 276
	if (!(msg->type & ICMPV6_INFOMSG_MASK))
		nf_ct_attach(skb, org_skb);
L
Linus Torvalds 已提交
277 278 279
	return 0;
}

280
#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
281 282
static void mip6_addr_swap(struct sk_buff *skb)
{
283
	struct ipv6hdr *iph = ipv6_hdr(skb);
284 285 286 287 288 289 290 291
	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)) {
292 293
			hao = (struct ipv6_destopt_hao *)
					(skb_network_header(skb) + off);
A
Alexey Dobriyan 已提交
294 295 296
			tmp = iph->saddr;
			iph->saddr = hao->addr;
			hao->addr = tmp;
297 298 299 300 301 302 303
		}
	}
}
#else
static inline void mip6_addr_swap(struct sk_buff *skb) {}
#endif

304
static struct dst_entry *icmpv6_route_lookup(struct net *net, struct sk_buff *skb,
305
					     struct sock *sk, struct flowi6 *fl6)
306 307
{
	struct dst_entry *dst, *dst2;
308
	struct flowi6 fl2;
309 310
	int err;

311
	err = ip6_dst_lookup(sk, &dst, fl6);
312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327
	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) {
		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: acast source\n");
		dst_release(dst);
		return ERR_PTR(-EINVAL);
	}

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

328
	dst = xfrm_lookup(net, dst, flowi6_to_flowi(fl6), sk, 0);
329
	if (!IS_ERR(dst)) {
330 331
		if (dst != dst2)
			return dst;
332 333 334 335 336
	} else {
		if (PTR_ERR(dst) == -EPERM)
			dst = NULL;
		else
			return dst;
337 338
	}

339
	err = xfrm_decode_session_reverse(skb, flowi6_to_flowi(&fl2), AF_INET6);
340 341 342 343 344 345 346
	if (err)
		goto relookup_failed;

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

347
	dst2 = xfrm_lookup(net, dst2, flowi6_to_flowi(&fl2), sk, XFRM_LOOKUP_ICMP);
348
	if (!IS_ERR(dst2)) {
349 350
		dst_release(dst);
		dst = dst2;
351 352 353 354 355 356 357
	} else {
		err = PTR_ERR(dst2);
		if (err == -EPERM) {
			dst_release(dst);
			return dst2;
		} else
			goto relookup_failed;
358 359 360 361 362 363 364 365
	}

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

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

387 388
	if ((u8 *)hdr < skb->head ||
	    (skb->network_header + sizeof(*hdr)) > skb->tail)
L
Linus Torvalds 已提交
389 390 391
		return;

	/*
392
	 *	Make sure we respect the rules
L
Linus Torvalds 已提交
393 394 395 396 397 398
	 *	i.e. RFC 1885 2.4(e)
	 *	Rule (e.1) is enforced by not using icmpv6_send
	 *	in any code that processes icmp errors.
	 */
	addr_type = ipv6_addr_type(&hdr->daddr);

399
	if (ipv6_chk_addr(net, &hdr->daddr, skb->dev, 0))
L
Linus Torvalds 已提交
400 401 402 403 404 405 406 407
		saddr = &hdr->daddr;

	/*
	 *	Dest addr check
	 */

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

		saddr = NULL;
	}

	addr_type = ipv6_addr_type(&hdr->saddr);

	/*
	 *	Source addr check
	 */

	if (addr_type & IPV6_ADDR_LINKLOCAL)
		iif = skb->dev->ifindex;

	/*
426 427 428 429
	 *	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 已提交
430 431
	 */
	if ((addr_type == IPV6_ADDR_ANY) || (addr_type & IPV6_ADDR_MULTICAST)) {
432
		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: addr_any/mcast source\n");
L
Linus Torvalds 已提交
433 434 435
		return;
	}

436
	/*
L
Linus Torvalds 已提交
437 438 439
	 *	Never answer to a ICMP packet.
	 */
	if (is_ineligible(skb)) {
440
		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: no reply to icmp error\n");
L
Linus Torvalds 已提交
441 442 443
		return;
	}

444 445
	mip6_addr_swap(skb);

446 447
	memset(&fl6, 0, sizeof(fl6));
	fl6.flowi6_proto = IPPROTO_ICMPV6;
A
Alexey Dobriyan 已提交
448
	fl6.daddr = hdr->saddr;
L
Linus Torvalds 已提交
449
	if (saddr)
A
Alexey Dobriyan 已提交
450
		fl6.saddr = *saddr;
451
	fl6.flowi6_oif = iif;
452 453
	fl6.fl6_icmp_type = type;
	fl6.fl6_icmp_code = code;
454
	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
L
Linus Torvalds 已提交
455

456 457
	sk = icmpv6_xmit_lock(net);
	if (sk == NULL)
458
		return;
459
	np = inet6_sk(sk);
460

461
	if (!icmpv6_xrlim_allow(sk, type, &fl6))
L
Linus Torvalds 已提交
462 463 464 465 466 467 468
		goto out;

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

469 470
	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
		fl6.flowi6_oif = np->mcast_oif;
471 472
	else if (!fl6.flowi6_oif)
		fl6.flowi6_oif = np->ucast_oif;
L
Linus Torvalds 已提交
473

474
	dst = icmpv6_route_lookup(net, skb, sk, &fl6);
475
	if (IS_ERR(dst))
L
Linus Torvalds 已提交
476
		goto out;
477

478
	if (ipv6_addr_is_multicast(&fl6.daddr))
L
Linus Torvalds 已提交
479 480 481 482
		hlimit = np->mcast_hops;
	else
		hlimit = np->hop_limit;
	if (hlimit < 0)
483
		hlimit = ip6_dst_hoplimit(dst);
L
Linus Torvalds 已提交
484 485

	msg.skb = skb;
486
	msg.offset = skb_network_offset(skb);
487
	msg.type = type;
L
Linus Torvalds 已提交
488 489 490 491

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

E
Eric Dumazet 已提交
496 497
	rcu_read_lock();
	idev = __in6_dev_get(skb->dev);
L
Linus Torvalds 已提交
498 499 500

	err = ip6_append_data(sk, icmpv6_getfrag, &msg,
			      len + sizeof(struct icmp6hdr),
G
Gerrit Renker 已提交
501
			      sizeof(struct icmp6hdr), hlimit,
502
			      np->tclass, NULL, &fl6, (struct rt6_info *)dst,
503
			      MSG_DONTWAIT, np->dontfrag);
L
Linus Torvalds 已提交
504
	if (err) {
E
Eric Dumazet 已提交
505
		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
L
Linus Torvalds 已提交
506
		ip6_flush_pending_frames(sk);
E
Eric Dumazet 已提交
507 508 509
	} else {
		err = icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
						 len + sizeof(struct icmp6hdr));
L
Linus Torvalds 已提交
510
	}
E
Eric Dumazet 已提交
511
	rcu_read_unlock();
L
Linus Torvalds 已提交
512 513 514
out_dst_release:
	dst_release(dst);
out:
515
	icmpv6_xmit_unlock(sk);
L
Linus Torvalds 已提交
516
}
517 518
EXPORT_SYMBOL(icmpv6_send);

L
Linus Torvalds 已提交
519 520
static void icmpv6_echo_reply(struct sk_buff *skb)
{
521
	struct net *net = dev_net(skb->dev);
522
	struct sock *sk;
L
Linus Torvalds 已提交
523
	struct inet6_dev *idev;
524
	struct ipv6_pinfo *np;
525
	const struct in6_addr *saddr = NULL;
526
	struct icmp6hdr *icmph = icmp6_hdr(skb);
L
Linus Torvalds 已提交
527
	struct icmp6hdr tmp_hdr;
528
	struct flowi6 fl6;
L
Linus Torvalds 已提交
529 530 531 532 533
	struct icmpv6_msg msg;
	struct dst_entry *dst;
	int err = 0;
	int hlimit;

534
	saddr = &ipv6_hdr(skb)->daddr;
L
Linus Torvalds 已提交
535 536 537 538 539 540 541

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

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

542 543
	memset(&fl6, 0, sizeof(fl6));
	fl6.flowi6_proto = IPPROTO_ICMPV6;
A
Alexey Dobriyan 已提交
544
	fl6.daddr = ipv6_hdr(skb)->saddr;
L
Linus Torvalds 已提交
545
	if (saddr)
A
Alexey Dobriyan 已提交
546
		fl6.saddr = *saddr;
547
	fl6.flowi6_oif = skb->dev->ifindex;
548
	fl6.fl6_icmp_type = ICMPV6_ECHO_REPLY;
549
	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
L
Linus Torvalds 已提交
550

551 552
	sk = icmpv6_xmit_lock(net);
	if (sk == NULL)
553
		return;
554
	np = inet6_sk(sk);
555

556 557
	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr))
		fl6.flowi6_oif = np->mcast_oif;
558 559
	else if (!fl6.flowi6_oif)
		fl6.flowi6_oif = np->ucast_oif;
L
Linus Torvalds 已提交
560

561
	err = ip6_dst_lookup(sk, &dst, &fl6);
L
Linus Torvalds 已提交
562 563
	if (err)
		goto out;
564
	dst = xfrm_lookup(net, dst, flowi6_to_flowi(&fl6), sk, 0);
565
	if (IS_ERR(dst))
566
		goto out;
L
Linus Torvalds 已提交
567

568
	if (ipv6_addr_is_multicast(&fl6.daddr))
L
Linus Torvalds 已提交
569 570 571 572
		hlimit = np->mcast_hops;
	else
		hlimit = np->hop_limit;
	if (hlimit < 0)
573
		hlimit = ip6_dst_hoplimit(dst);
L
Linus Torvalds 已提交
574

E
Eric Dumazet 已提交
575
	idev = __in6_dev_get(skb->dev);
L
Linus Torvalds 已提交
576 577 578

	msg.skb = skb;
	msg.offset = 0;
579
	msg.type = ICMPV6_ECHO_REPLY;
L
Linus Torvalds 已提交
580 581

	err = ip6_append_data(sk, icmpv6_getfrag, &msg, skb->len + sizeof(struct icmp6hdr),
582
				sizeof(struct icmp6hdr), hlimit, np->tclass, NULL, &fl6,
583
				(struct rt6_info *)dst, MSG_DONTWAIT,
584
				np->dontfrag);
L
Linus Torvalds 已提交
585 586

	if (err) {
E
Eric Dumazet 已提交
587
		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
L
Linus Torvalds 已提交
588
		ip6_flush_pending_frames(sk);
E
Eric Dumazet 已提交
589 590 591
	} else {
		err = icmpv6_push_pending_frames(sk, &fl6, &tmp_hdr,
						 skb->len + sizeof(struct icmp6hdr));
L
Linus Torvalds 已提交
592 593
	}
	dst_release(dst);
594
out:
595
	icmpv6_xmit_unlock(sk);
L
Linus Torvalds 已提交
596 597
}

598
static void icmpv6_notify(struct sk_buff *skb, u8 type, u8 code, __be32 info)
L
Linus Torvalds 已提交
599
{
600
	const struct inet6_protocol *ipprot;
L
Linus Torvalds 已提交
601 602 603
	int inner_offset;
	int hash;
	u8 nexthdr;
604
	__be16 frag_off;
L
Linus Torvalds 已提交
605 606 607 608 609 610 611

	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 */
612 613
		inner_offset = ipv6_skip_exthdr(skb, sizeof(struct ipv6hdr),
						&nexthdr, &frag_off);
L
Linus Torvalds 已提交
614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638
		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)
	 */

	hash = nexthdr & (MAX_INET_PROTOS - 1);

	rcu_read_lock();
	ipprot = rcu_dereference(inet6_protos[hash]);
	if (ipprot && ipprot->err_handler)
		ipprot->err_handler(skb, NULL, type, code, inner_offset, info);
	rcu_read_unlock();

639
	raw6_icmp_error(skb, nexthdr, type, code, inner_offset, info);
L
Linus Torvalds 已提交
640
}
641

L
Linus Torvalds 已提交
642 643 644 645
/*
 *	Handle icmp messages
 */

646
static int icmpv6_rcv(struct sk_buff *skb)
L
Linus Torvalds 已提交
647 648 649
{
	struct net_device *dev = skb->dev;
	struct inet6_dev *idev = __in6_dev_get(dev);
650 651
	const struct in6_addr *saddr, *daddr;
	const struct ipv6hdr *orig_hdr;
L
Linus Torvalds 已提交
652
	struct icmp6hdr *hdr;
653
	u8 type;
L
Linus Torvalds 已提交
654

655
	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
656
		struct sec_path *sp = skb_sec_path(skb);
657 658
		int nh;

659
		if (!(sp && sp->xvec[sp->len - 1]->props.flags &
660 661 662
				 XFRM_STATE_ICMP))
			goto drop_no_count;

663 664 665 666 667 668 669 670 671 672 673 674
		if (!pskb_may_pull(skb, sizeof(*hdr) + sizeof(*orig_hdr)))
			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);
	}

675
	ICMP6_INC_STATS_BH(dev_net(dev), idev, ICMP6_MIB_INMSGS);
L
Linus Torvalds 已提交
676

677 678
	saddr = &ipv6_hdr(skb)->saddr;
	daddr = &ipv6_hdr(skb)->daddr;
L
Linus Torvalds 已提交
679 680

	/* Perform checksum. */
681
	switch (skb->ip_summed) {
682
	case CHECKSUM_COMPLETE:
683 684 685 686 687
		if (!csum_ipv6_magic(saddr, daddr, skb->len, IPPROTO_ICMPV6,
				     skb->csum))
			break;
		/* fall through */
	case CHECKSUM_NONE:
688 689
		skb->csum = ~csum_unfold(csum_ipv6_magic(saddr, daddr, skb->len,
					     IPPROTO_ICMPV6, 0));
690
		if (__skb_checksum_complete(skb)) {
H
Harvey Harrison 已提交
691
			LIMIT_NETDEBUG(KERN_DEBUG "ICMPv6 checksum failed [%pI6 > %pI6]\n",
692
				       saddr, daddr);
L
Linus Torvalds 已提交
693 694 695 696
			goto discard_it;
		}
	}

697 698
	if (!pskb_pull(skb, sizeof(*hdr)))
		goto discard_it;
L
Linus Torvalds 已提交
699

700
	hdr = icmp6_hdr(skb);
L
Linus Torvalds 已提交
701 702 703

	type = hdr->icmp6_type;

704
	ICMP6MSGIN_INC_STATS_BH(dev_net(dev), idev, type);
L
Linus Torvalds 已提交
705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722

	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;
723
		hdr = icmp6_hdr(skb);
L
Linus Torvalds 已提交
724 725 726 727 728 729 730 731 732 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
		orig_hdr = (struct ipv6hdr *) (hdr + 1);
		rt6_pmtu_discovery(&orig_hdr->daddr, &orig_hdr->saddr, dev,
				   ntohl(hdr->icmp6_mtu));

		/*
		 *	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:
765
		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6: msg of unknown type\n");
L
Linus Torvalds 已提交
766 767 768 769 770

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

771 772 773
		/*
		 * error of unknown type.
		 * must pass to upper level
L
Linus Torvalds 已提交
774 775 776
		 */

		icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
777 778
	}

L
Linus Torvalds 已提交
779 780 781 782
	kfree_skb(skb);
	return 0;

discard_it:
783
	ICMP6_INC_STATS_BH(dev_net(dev), idev, ICMP6_MIB_INERRORS);
784
drop_no_count:
L
Linus Torvalds 已提交
785 786 787 788
	kfree_skb(skb);
	return 0;
}

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

805
/*
806
 * Special lock-class for __icmpv6_sk:
807 808 809
 */
static struct lock_class_key icmpv6_socket_sk_dst_lock_key;

810
static int __net_init icmpv6_sk_init(struct net *net)
L
Linus Torvalds 已提交
811 812 813 814
{
	struct sock *sk;
	int err, i, j;

815 816 817
	net->ipv6.icmp_sk =
		kzalloc(nr_cpu_ids * sizeof(struct sock *), GFP_KERNEL);
	if (net->ipv6.icmp_sk == NULL)
818 819
		return -ENOMEM;

820
	for_each_possible_cpu(i) {
821 822
		err = inet_ctl_sock_create(&sk, PF_INET6,
					   SOCK_RAW, IPPROTO_ICMPV6, net);
L
Linus Torvalds 已提交
823 824 825 826 827 828 829 830
		if (err < 0) {
			printk(KERN_ERR
			       "Failed to initialize the ICMP6 control socket "
			       "(err %d).\n",
			       err);
			goto fail;
		}

831
		net->ipv6.icmp_sk[i] = sk;
832

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

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

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

856
static void __net_exit icmpv6_sk_exit(struct net *net)
L
Linus Torvalds 已提交
857 858 859
{
	int i;

860
	for_each_possible_cpu(i) {
861
		inet_ctl_sock_destroy(net->ipv6.icmp_sk[i]);
L
Linus Torvalds 已提交
862
	}
863 864 865
	kfree(net->ipv6.icmp_sk);
}

866
static struct pernet_operations icmpv6_sk_ops = {
867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
       .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;
	return 0;

fail:
	printk(KERN_ERR "Failed to register ICMP6 protocol\n");
	unregister_pernet_subsys(&icmpv6_sk_ops);
	return err;
}

890
void icmpv6_cleanup(void)
891 892
{
	unregister_pernet_subsys(&icmpv6_sk_ops);
L
Linus Torvalds 已提交
893 894 895
	inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
}

896

897
static const struct icmp6_err {
L
Linus Torvalds 已提交
898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922
	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,
	},
};

923
int icmpv6_err_convert(u8 type, u8 code, int *err)
L
Linus Torvalds 已提交
924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940
{
	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;
941

L
Linus Torvalds 已提交
942 943 944 945 946 947 948 949
	case ICMPV6_PARAMPROB:
		*err = EPROTO;
		fatal = 1;
		break;

	case ICMPV6_TIME_EXCEED:
		*err = EHOSTUNREACH;
		break;
950
	}
L
Linus Torvalds 已提交
951 952 953

	return fatal;
}
954 955
EXPORT_SYMBOL(icmpv6_err_convert);

L
Linus Torvalds 已提交
956
#ifdef CONFIG_SYSCTL
957
ctl_table ipv6_icmp_table_template[] = {
L
Linus Torvalds 已提交
958 959
	{
		.procname	= "ratelimit",
960
		.data		= &init_net.ipv6.sysctl.icmpv6_time,
L
Linus Torvalds 已提交
961 962
		.maxlen		= sizeof(int),
		.mode		= 0644,
A
Alexey Dobriyan 已提交
963
		.proc_handler	= proc_dointvec_ms_jiffies,
L
Linus Torvalds 已提交
964
	},
965
	{ },
L
Linus Torvalds 已提交
966
};
967

968
struct ctl_table * __net_init ipv6_icmp_sysctl_init(struct net *net)
969 970 971 972 973 974
{
	struct ctl_table *table;

	table = kmemdup(ipv6_icmp_table_template,
			sizeof(ipv6_icmp_table_template),
			GFP_KERNEL);
975 976 977 978

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

979 980
	return table;
}
L
Linus Torvalds 已提交
981 982
#endif