icmp.c 21.8 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;
L
Linus Torvalds 已提交
138 139 140 141

	if (len < 0)
		return 1;

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

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

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

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

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

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

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

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

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

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

static int icmpv6_push_pending_frames(struct sock *sk, struct flowi *fl, struct icmp6hdr *thdr, int len)
{
	struct sk_buff *skb;
	struct icmp6hdr *icmp6h;
	int err = 0;

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

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

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

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

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

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

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

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

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

303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366
static struct dst_entry *icmpv6_route_lookup(struct net *net, struct sk_buff *skb,
					     struct sock *sk, struct flowi *fl)
{
	struct dst_entry *dst, *dst2;
	struct flowi fl2;
	int err;

	err = ip6_dst_lookup(sk, &dst, fl);
	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;

	err = xfrm_lookup(net, &dst, fl, sk, 0);
	switch (err) {
	case 0:
		if (dst != dst2)
			return dst;
		break;
	case -EPERM:
		dst = NULL;
		break;
	default:
		return ERR_PTR(err);
	}

	err = xfrm_decode_session_reverse(skb, &fl2, AF_INET6);
	if (err)
		goto relookup_failed;

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

	err = xfrm_lookup(net, &dst2, &fl2, sk, XFRM_LOOKUP_ICMP);
	switch (err) {
	case 0:
		dst_release(dst);
		dst = dst2;
		break;
	case -EPERM:
		dst_release(dst);
		return ERR_PTR(err);
	default:
		goto relookup_failed;
	}

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

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

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

	/*
393
	 *	Make sure we respect the rules
L
Linus Torvalds 已提交
394 395 396 397 398 399
	 *	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);

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

	/*
	 *	Dest addr check
	 */

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

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

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

445 446
	mip6_addr_swap(skb);

L
Linus Torvalds 已提交
447 448 449 450 451 452 453 454
	memset(&fl, 0, sizeof(fl));
	fl.proto = IPPROTO_ICMPV6;
	ipv6_addr_copy(&fl.fl6_dst, &hdr->saddr);
	if (saddr)
		ipv6_addr_copy(&fl.fl6_src, saddr);
	fl.oif = iif;
	fl.fl_icmp_type = type;
	fl.fl_icmp_code = code;
V
Venkat Yekkirala 已提交
455
	security_skb_classify_flow(skb, &fl);
L
Linus Torvalds 已提交
456

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

L
Linus Torvalds 已提交
462 463 464 465 466 467 468 469 470 471 472
	if (!icmpv6_xrlim_allow(sk, type, &fl))
		goto out;

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

	if (!fl.oif && ipv6_addr_is_multicast(&fl.fl6_dst))
		fl.oif = np->mcast_oif;

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

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

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

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

	idev = in6_dev_get(skb->dev);

	err = ip6_append_data(sk, icmpv6_getfrag, &msg,
			      len + sizeof(struct icmp6hdr),
G
Gerrit Renker 已提交
499 500
			      sizeof(struct icmp6hdr), hlimit,
			      np->tclass, NULL, &fl, (struct rt6_info*)dst,
501
			      MSG_DONTWAIT, np->dontfrag);
L
Linus Torvalds 已提交
502
	if (err) {
E
Eric Dumazet 已提交
503
		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
L
Linus Torvalds 已提交
504 505 506 507 508 509 510 511 512 513 514
		ip6_flush_pending_frames(sk);
		goto out_put;
	}
	err = icmpv6_push_pending_frames(sk, &fl, &tmp_hdr, len + sizeof(struct icmp6hdr));

out_put:
	if (likely(idev != NULL))
		in6_dev_put(idev);
out_dst_release:
	dst_release(dst);
out:
515
	icmpv6_xmit_unlock(sk);
L
Linus Torvalds 已提交
516 517
}

518 519
EXPORT_SYMBOL(icmpv6_send);

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

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

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

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

	memset(&fl, 0, sizeof(fl));
	fl.proto = IPPROTO_ICMPV6;
545
	ipv6_addr_copy(&fl.fl6_dst, &ipv6_hdr(skb)->saddr);
L
Linus Torvalds 已提交
546 547 548 549
	if (saddr)
		ipv6_addr_copy(&fl.fl6_src, saddr);
	fl.oif = skb->dev->ifindex;
	fl.fl_icmp_type = ICMPV6_ECHO_REPLY;
V
Venkat Yekkirala 已提交
550
	security_skb_classify_flow(skb, &fl);
L
Linus Torvalds 已提交
551

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

L
Linus Torvalds 已提交
557 558 559 560 561 562
	if (!fl.oif && ipv6_addr_is_multicast(&fl.fl6_dst))
		fl.oif = np->mcast_oif;

	err = ip6_dst_lookup(sk, &dst, &fl);
	if (err)
		goto out;
A
Alexey Dobriyan 已提交
563
	if ((err = xfrm_lookup(net, &dst, &fl, sk, 0)) < 0)
564
		goto out;
L
Linus Torvalds 已提交
565 566 567 568 569 570

	if (ipv6_addr_is_multicast(&fl.fl6_dst))
		hlimit = np->mcast_hops;
	else
		hlimit = np->hop_limit;
	if (hlimit < 0)
571
		hlimit = ip6_dst_hoplimit(dst);
L
Linus Torvalds 已提交
572 573 574 575 576

	idev = in6_dev_get(skb->dev);

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

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

	if (err) {
E
Eric Dumazet 已提交
585
		ICMP6_INC_STATS_BH(net, idev, ICMP6_MIB_OUTERRORS);
L
Linus Torvalds 已提交
586 587 588 589 590
		ip6_flush_pending_frames(sk);
		goto out_put;
	}
	err = icmpv6_push_pending_frames(sk, &fl, &tmp_hdr, skb->len + sizeof(struct icmp6hdr));

591
out_put:
L
Linus Torvalds 已提交
592 593 594
	if (likely(idev != NULL))
		in6_dev_put(idev);
	dst_release(dst);
595
out:
596
	icmpv6_xmit_unlock(sk);
L
Linus Torvalds 已提交
597 598
}

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

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

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

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

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

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

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

662 663 664 665 666 667 668 669 670 671 672 673
		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);
	}

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

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

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

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

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

	type = hdr->icmp6_type;

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

	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;
722
		hdr = icmp6_hdr(skb);
L
Linus Torvalds 已提交
723 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
		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:
764
		LIMIT_NETDEBUG(KERN_DEBUG "icmpv6: msg of unknown type\n");
L
Linus Torvalds 已提交
765 766 767 768 769

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

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

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

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

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

788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803
void icmpv6_flow_init(struct sock *sk, struct flowi *fl,
		      u8 type,
		      const struct in6_addr *saddr,
		      const struct in6_addr *daddr,
		      int oif)
{
	memset(fl, 0, sizeof(*fl));
	ipv6_addr_copy(&fl->fl6_src, saddr);
	ipv6_addr_copy(&fl->fl6_dst, daddr);
	fl->proto	 	= IPPROTO_ICMPV6;
	fl->fl_icmp_type	= type;
	fl->fl_icmp_code	= 0;
	fl->oif			= oif;
	security_sk_classify_flow(sk, fl);
}

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

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

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

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

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

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

		/* Enough space for 2 64K ICMP packets, including
		 * sk_buff struct overhead.
		 */
		sk->sk_sndbuf =
			(2 * ((64 * 1024) + sizeof(struct sk_buff)));
	}
	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 954

	return fatal;
}

955 956
EXPORT_SYMBOL(icmpv6_err_convert);

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

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

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

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

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