blob: 93c96cfd5ee19052f27ecc2e559c2446ff4ef295 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Internet Control Message Protocol (ICMPv6)
3 * Linux INET6 implementation
4 *
5 * Authors:
6 * Pedro Roque <roque@di.fc.ul.pt>
7 *
8 * $Id: icmp.c,v 1.38 2002/02/08 03:57:19 davem Exp $
9 *
10 * Based on net/ipv4/icmp.c
11 *
12 * RFC 1885
13 *
14 * This program is free software; you can redistribute it and/or
15 * modify it under the terms of the GNU General Public License
16 * as published by the Free Software Foundation; either version
17 * 2 of the License, or (at your option) any later version.
18 */
19
20/*
21 * Changes:
22 *
23 * Andi Kleen : exception handling
24 * Andi Kleen add rate limits. never reply to a icmp.
25 * add more length checks and other fixes.
26 * yoshfuji : ensure to sent parameter problem for
27 * fragments.
28 * YOSHIFUJI Hideaki @USAGI: added sysctl for icmp rate limit.
29 * Randy Dunlap and
30 * YOSHIFUJI Hideaki @USAGI: Per-interface statistics support
31 * Kazunori MIYAZAWA @USAGI: change output process to use ip6_append_data
32 */
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>
Linus Torvalds1da177e2005-04-16 15:20:36 -070040#include <linux/sockios.h>
41#include <linux/net.h>
42#include <linux/skbuff.h>
43#include <linux/init.h>
Yasuyuki Kozakai763ecff2006-02-15 15:24:15 -080044#include <linux/netfilter.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045
46#ifdef CONFIG_SYSCTL
47#include <linux/sysctl.h>
48#endif
49
50#include <linux/inet.h>
51#include <linux/netdevice.h>
52#include <linux/icmpv6.h>
53
54#include <net/ip.h>
55#include <net/sock.h>
56
57#include <net/ipv6.h>
58#include <net/ip6_checksum.h>
59#include <net/protocol.h>
60#include <net/raw.h>
61#include <net/rawv6.h>
62#include <net/transp_v6.h>
63#include <net/ip6_route.h>
64#include <net/addrconf.h>
65#include <net/icmp.h>
66
67#include <asm/uaccess.h>
68#include <asm/system.h>
69
Eric Dumazetba899662005-08-26 12:05:31 -070070DEFINE_SNMP_STAT(struct icmpv6_mib, icmpv6_statistics) __read_mostly;
YOSHIFUJI Hideaki71590392007-02-22 22:05:40 +090071EXPORT_SYMBOL(icmpv6_statistics);
David L Stevens14878f72007-09-16 16:52:35 -070072DEFINE_SNMP_STAT(struct icmpv6msg_mib, icmpv6msg_statistics) __read_mostly;
73EXPORT_SYMBOL(icmpv6msg_statistics);
Linus Torvalds1da177e2005-04-16 15:20:36 -070074
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 */
82static DEFINE_PER_CPU(struct socket *, __icmpv6_socket) = NULL;
83#define icmpv6_socket __get_cpu_var(__icmpv6_socket)
84
Herbert Xue5bbef22007-10-15 12:50:28 -070085static int icmpv6_rcv(struct sk_buff *skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
87static struct inet6_protocol icmpv6_protocol = {
88 .handler = icmpv6_rcv,
89 .flags = INET6_PROTO_FINAL,
90};
91
92static __inline__ int icmpv6_xmit_lock(void)
93{
94 local_bh_disable();
95
96 if (unlikely(!spin_trylock(&icmpv6_socket->sk->sk_lock.slock))) {
97 /* This can happen if the output path (f.e. SIT or
98 * ip6ip6 tunnel) signals dst_link_failure() for an
99 * outgoing ICMP6 packet.
100 */
101 local_bh_enable();
102 return 1;
103 }
104 return 0;
105}
106
107static __inline__ void icmpv6_xmit_unlock(void)
108{
109 spin_unlock_bh(&icmpv6_socket->sk->sk_lock.slock);
110}
111
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900112/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 * Slightly more convenient version of icmpv6_send.
114 */
115void icmpv6_param_prob(struct sk_buff *skb, int code, int pos)
116{
117 icmpv6_send(skb, ICMPV6_PARAMPROB, code, pos, skb->dev);
118 kfree_skb(skb);
119}
120
121/*
122 * Figure out, may we reply to this packet with icmp error.
123 *
124 * We do not reply, if:
125 * - it was icmp error message.
126 * - it is truncated, so that it is known, that protocol is ICMPV6
127 * (i.e. in the middle of some exthdr)
128 *
129 * --ANK (980726)
130 */
131
132static int is_ineligible(struct sk_buff *skb)
133{
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700134 int ptr = (u8 *)(ipv6_hdr(skb) + 1) - skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 int len = skb->len - ptr;
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700136 __u8 nexthdr = ipv6_hdr(skb)->nexthdr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137
138 if (len < 0)
139 return 1;
140
Herbert Xu0d3d0772005-04-24 20:16:19 -0700141 ptr = ipv6_skip_exthdr(skb, ptr, &nexthdr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 if (ptr < 0)
143 return 0;
144 if (nexthdr == IPPROTO_ICMPV6) {
145 u8 _type, *tp;
146 tp = skb_header_pointer(skb,
147 ptr+offsetof(struct icmp6hdr, icmp6_type),
148 sizeof(_type), &_type);
149 if (tp == NULL ||
150 !(*tp & ICMPV6_INFOMSG_MASK))
151 return 1;
152 }
153 return 0;
154}
155
Brian Haleyab32ea52006-09-22 14:15:41 -0700156static int sysctl_icmpv6_time __read_mostly = 1*HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900158/*
159 * Check the ICMP output rate limit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160 */
161static inline int icmpv6_xrlim_allow(struct sock *sk, int type,
162 struct flowi *fl)
163{
164 struct dst_entry *dst;
165 int res = 0;
166
167 /* Informational messages are not limited. */
168 if (type & ICMPV6_INFOMSG_MASK)
169 return 1;
170
171 /* Do not limit pmtu discovery, it would break it. */
172 if (type == ICMPV6_PKT_TOOBIG)
173 return 1;
174
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900175 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 * Look up the output route.
177 * XXX: perhaps the expire for routing entries cloned by
178 * this lookup should be more aggressive (not longer than timeout).
179 */
180 dst = ip6_route_output(sk, fl);
181 if (dst->error) {
YOSHIFUJI Hideakia11d2062006-11-04 20:11:37 +0900182 IP6_INC_STATS(ip6_dst_idev(dst),
183 IPSTATS_MIB_OUTNOROUTES);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 } else if (dst->dev && (dst->dev->flags&IFF_LOOPBACK)) {
185 res = 1;
186 } else {
187 struct rt6_info *rt = (struct rt6_info *)dst;
188 int tmo = sysctl_icmpv6_time;
189
190 /* Give more bandwidth to wider prefixes. */
191 if (rt->rt6i_dst.plen < 128)
192 tmo >>= ((128 - rt->rt6i_dst.plen)>>5);
193
194 res = xrlim_allow(dst, tmo);
195 }
196 dst_release(dst);
197 return res;
198}
199
200/*
201 * an inline helper for the "simple" if statement below
202 * checks if parameter problem report is caused by an
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900203 * unrecognized IPv6 option that has the Option Type
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 * highest-order two bits set to 10
205 */
206
207static __inline__ int opt_unrec(struct sk_buff *skb, __u32 offset)
208{
209 u8 _optval, *op;
210
Arnaldo Carvalho de Melobbe735e2007-03-10 22:16:10 -0300211 offset += skb_network_offset(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212 op = skb_header_pointer(skb, offset, sizeof(_optval), &_optval);
213 if (op == NULL)
214 return 1;
215 return (*op & 0xC0) == 0x80;
216}
217
218static int icmpv6_push_pending_frames(struct sock *sk, struct flowi *fl, struct icmp6hdr *thdr, int len)
219{
220 struct sk_buff *skb;
221 struct icmp6hdr *icmp6h;
222 int err = 0;
223
224 if ((skb = skb_peek(&sk->sk_write_queue)) == NULL)
225 goto out;
226
Arnaldo Carvalho de Melocc70ab22007-03-13 14:03:22 -0300227 icmp6h = icmp6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 memcpy(icmp6h, thdr, sizeof(struct icmp6hdr));
229 icmp6h->icmp6_cksum = 0;
230
231 if (skb_queue_len(&sk->sk_write_queue) == 1) {
232 skb->csum = csum_partial((char *)icmp6h,
233 sizeof(struct icmp6hdr), skb->csum);
234 icmp6h->icmp6_cksum = csum_ipv6_magic(&fl->fl6_src,
235 &fl->fl6_dst,
236 len, fl->proto,
237 skb->csum);
238 } else {
Al Viro868c86b2006-11-14 21:35:48 -0800239 __wsum tmp_csum = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240
241 skb_queue_walk(&sk->sk_write_queue, skb) {
242 tmp_csum = csum_add(tmp_csum, skb->csum);
243 }
244
245 tmp_csum = csum_partial((char *)icmp6h,
246 sizeof(struct icmp6hdr), tmp_csum);
Al Viro868c86b2006-11-14 21:35:48 -0800247 icmp6h->icmp6_cksum = csum_ipv6_magic(&fl->fl6_src,
248 &fl->fl6_dst,
249 len, fl->proto,
250 tmp_csum);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 ip6_push_pending_frames(sk);
253out:
254 return err;
255}
256
257struct icmpv6_msg {
258 struct sk_buff *skb;
259 int offset;
Yasuyuki Kozakai763ecff2006-02-15 15:24:15 -0800260 uint8_t type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261};
262
263static int icmpv6_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
264{
265 struct icmpv6_msg *msg = (struct icmpv6_msg *) from;
266 struct sk_buff *org_skb = msg->skb;
Al Viro5f92a732006-11-14 21:36:54 -0800267 __wsum csum = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268
269 csum = skb_copy_and_csum_bits(org_skb, msg->offset + offset,
270 to, len, csum);
271 skb->csum = csum_block_add(skb->csum, csum, odd);
Yasuyuki Kozakai763ecff2006-02-15 15:24:15 -0800272 if (!(msg->type & ICMPV6_INFOMSG_MASK))
273 nf_ct_attach(skb, org_skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 return 0;
275}
276
Masahide NAKAMURA59fbb3a2007-06-26 23:56:32 -0700277#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
Masahide NAKAMURA79383232006-08-23 19:27:25 -0700278static void mip6_addr_swap(struct sk_buff *skb)
279{
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700280 struct ipv6hdr *iph = ipv6_hdr(skb);
Masahide NAKAMURA79383232006-08-23 19:27:25 -0700281 struct inet6_skb_parm *opt = IP6CB(skb);
282 struct ipv6_destopt_hao *hao;
283 struct in6_addr tmp;
284 int off;
285
286 if (opt->dsthao) {
287 off = ipv6_find_tlv(skb, opt->dsthao, IPV6_TLV_HAO);
288 if (likely(off >= 0)) {
Arnaldo Carvalho de Melod56f90a2007-04-10 20:50:43 -0700289 hao = (struct ipv6_destopt_hao *)
290 (skb_network_header(skb) + off);
Masahide NAKAMURA79383232006-08-23 19:27:25 -0700291 ipv6_addr_copy(&tmp, &iph->saddr);
292 ipv6_addr_copy(&iph->saddr, &hao->addr);
293 ipv6_addr_copy(&hao->addr, &tmp);
294 }
295 }
296}
297#else
298static inline void mip6_addr_swap(struct sk_buff *skb) {}
299#endif
300
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301/*
302 * Send an ICMP message in response to a packet in error
303 */
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900304void icmpv6_send(struct sk_buff *skb, int type, int code, __u32 info,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305 struct net_device *dev)
306{
307 struct inet6_dev *idev = NULL;
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700308 struct ipv6hdr *hdr = ipv6_hdr(skb);
YOSHIFUJI Hideaki84427d52005-06-13 14:59:44 -0700309 struct sock *sk;
310 struct ipv6_pinfo *np;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700311 struct in6_addr *saddr = NULL;
312 struct dst_entry *dst;
313 struct icmp6hdr tmp_hdr;
314 struct flowi fl;
315 struct icmpv6_msg msg;
316 int iif = 0;
317 int addr_type = 0;
318 int len;
YOSHIFUJI Hideaki41a1f8e2005-09-08 10:19:03 +0900319 int hlimit, tclass;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 int err = 0;
321
Arnaldo Carvalho de Melo27a884d2007-04-19 20:29:13 -0700322 if ((u8 *)hdr < skb->head ||
323 (skb->network_header + sizeof(*hdr)) > skb->tail)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 return;
325
326 /*
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900327 * Make sure we respect the rules
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328 * i.e. RFC 1885 2.4(e)
329 * Rule (e.1) is enforced by not using icmpv6_send
330 * in any code that processes icmp errors.
331 */
332 addr_type = ipv6_addr_type(&hdr->daddr);
333
334 if (ipv6_chk_addr(&hdr->daddr, skb->dev, 0))
335 saddr = &hdr->daddr;
336
337 /*
338 * Dest addr check
339 */
340
341 if ((addr_type & IPV6_ADDR_MULTICAST || skb->pkt_type != PACKET_HOST)) {
342 if (type != ICMPV6_PKT_TOOBIG &&
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900343 !(type == ICMPV6_PARAMPROB &&
344 code == ICMPV6_UNK_OPTION &&
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 (opt_unrec(skb, info))))
346 return;
347
348 saddr = NULL;
349 }
350
351 addr_type = ipv6_addr_type(&hdr->saddr);
352
353 /*
354 * Source addr check
355 */
356
357 if (addr_type & IPV6_ADDR_LINKLOCAL)
358 iif = skb->dev->ifindex;
359
360 /*
YOSHIFUJI Hideaki8de33512005-12-21 22:57:06 +0900361 * Must not send error if the source does not uniquely
362 * identify a single node (RFC2463 Section 2.4).
363 * We check unspecified / multicast addresses here,
364 * and anycast addresses will be checked later.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 */
366 if ((addr_type == IPV6_ADDR_ANY) || (addr_type & IPV6_ADDR_MULTICAST)) {
Patrick McHardy64ce2072005-08-09 20:50:53 -0700367 LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: addr_any/mcast source\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700368 return;
369 }
370
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900371 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372 * Never answer to a ICMP packet.
373 */
374 if (is_ineligible(skb)) {
Patrick McHardy64ce2072005-08-09 20:50:53 -0700375 LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: no reply to icmp error\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 return;
377 }
378
Masahide NAKAMURA79383232006-08-23 19:27:25 -0700379 mip6_addr_swap(skb);
380
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381 memset(&fl, 0, sizeof(fl));
382 fl.proto = IPPROTO_ICMPV6;
383 ipv6_addr_copy(&fl.fl6_dst, &hdr->saddr);
384 if (saddr)
385 ipv6_addr_copy(&fl.fl6_src, saddr);
386 fl.oif = iif;
387 fl.fl_icmp_type = type;
388 fl.fl_icmp_code = code;
Venkat Yekkiralabeb8d132006-08-04 23:12:42 -0700389 security_skb_classify_flow(skb, &fl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390
391 if (icmpv6_xmit_lock())
392 return;
393
YOSHIFUJI Hideaki84427d52005-06-13 14:59:44 -0700394 sk = icmpv6_socket->sk;
395 np = inet6_sk(sk);
396
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397 if (!icmpv6_xrlim_allow(sk, type, &fl))
398 goto out;
399
400 tmp_hdr.icmp6_type = type;
401 tmp_hdr.icmp6_code = code;
402 tmp_hdr.icmp6_cksum = 0;
403 tmp_hdr.icmp6_pointer = htonl(info);
404
405 if (!fl.oif && ipv6_addr_is_multicast(&fl.fl6_dst))
406 fl.oif = np->mcast_oif;
407
408 err = ip6_dst_lookup(sk, &dst, &fl);
409 if (err)
410 goto out;
YOSHIFUJI Hideaki8de33512005-12-21 22:57:06 +0900411
412 /*
413 * We won't send icmp if the destination is known
414 * anycast.
415 */
416 if (((struct rt6_info *)dst)->rt6i_flags & RTF_ANYCAST) {
417 LIMIT_NETDEBUG(KERN_DEBUG "icmpv6_send: acast source\n");
418 goto out_dst_release;
419 }
420
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421 if ((err = xfrm_lookup(&dst, &fl, sk, 0)) < 0)
Patrick McHardye1044112005-09-08 15:11:55 -0700422 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423
424 if (ipv6_addr_is_multicast(&fl.fl6_dst))
425 hlimit = np->mcast_hops;
426 else
427 hlimit = np->hop_limit;
428 if (hlimit < 0)
429 hlimit = dst_metric(dst, RTAX_HOPLIMIT);
430 if (hlimit < 0)
431 hlimit = ipv6_get_hoplimit(dst->dev);
432
YOSHIFUJI Hideakie012d512006-09-13 20:01:28 -0700433 tclass = np->tclass;
YOSHIFUJI Hideaki41a1f8e2005-09-08 10:19:03 +0900434 if (tclass < 0)
435 tclass = 0;
436
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437 msg.skb = skb;
Arnaldo Carvalho de Melobbe735e2007-03-10 22:16:10 -0300438 msg.offset = skb_network_offset(skb);
Yasuyuki Kozakai763ecff2006-02-15 15:24:15 -0800439 msg.type = type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440
441 len = skb->len - msg.offset;
442 len = min_t(unsigned int, len, IPV6_MIN_MTU - sizeof(struct ipv6hdr) -sizeof(struct icmp6hdr));
443 if (len < 0) {
Patrick McHardy64ce2072005-08-09 20:50:53 -0700444 LIMIT_NETDEBUG(KERN_DEBUG "icmp: len problem\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445 goto out_dst_release;
446 }
447
448 idev = in6_dev_get(skb->dev);
449
450 err = ip6_append_data(sk, icmpv6_getfrag, &msg,
451 len + sizeof(struct icmp6hdr),
452 sizeof(struct icmp6hdr),
YOSHIFUJI Hideaki41a1f8e2005-09-08 10:19:03 +0900453 hlimit, tclass, NULL, &fl, (struct rt6_info*)dst,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454 MSG_DONTWAIT);
455 if (err) {
456 ip6_flush_pending_frames(sk);
457 goto out_put;
458 }
459 err = icmpv6_push_pending_frames(sk, &fl, &tmp_hdr, len + sizeof(struct icmp6hdr));
460
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461out_put:
462 if (likely(idev != NULL))
463 in6_dev_put(idev);
464out_dst_release:
465 dst_release(dst);
466out:
467 icmpv6_xmit_unlock();
468}
469
YOSHIFUJI Hideaki71590392007-02-22 22:05:40 +0900470EXPORT_SYMBOL(icmpv6_send);
471
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472static void icmpv6_echo_reply(struct sk_buff *skb)
473{
YOSHIFUJI Hideaki84427d52005-06-13 14:59:44 -0700474 struct sock *sk;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 struct inet6_dev *idev;
YOSHIFUJI Hideaki84427d52005-06-13 14:59:44 -0700476 struct ipv6_pinfo *np;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477 struct in6_addr *saddr = NULL;
Arnaldo Carvalho de Melocc70ab22007-03-13 14:03:22 -0300478 struct icmp6hdr *icmph = icmp6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479 struct icmp6hdr tmp_hdr;
480 struct flowi fl;
481 struct icmpv6_msg msg;
482 struct dst_entry *dst;
483 int err = 0;
484 int hlimit;
YOSHIFUJI Hideaki41a1f8e2005-09-08 10:19:03 +0900485 int tclass;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700487 saddr = &ipv6_hdr(skb)->daddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488
489 if (!ipv6_unicast_destination(skb))
490 saddr = NULL;
491
492 memcpy(&tmp_hdr, icmph, sizeof(tmp_hdr));
493 tmp_hdr.icmp6_type = ICMPV6_ECHO_REPLY;
494
495 memset(&fl, 0, sizeof(fl));
496 fl.proto = IPPROTO_ICMPV6;
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700497 ipv6_addr_copy(&fl.fl6_dst, &ipv6_hdr(skb)->saddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498 if (saddr)
499 ipv6_addr_copy(&fl.fl6_src, saddr);
500 fl.oif = skb->dev->ifindex;
501 fl.fl_icmp_type = ICMPV6_ECHO_REPLY;
Venkat Yekkiralabeb8d132006-08-04 23:12:42 -0700502 security_skb_classify_flow(skb, &fl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503
504 if (icmpv6_xmit_lock())
505 return;
506
YOSHIFUJI Hideaki84427d52005-06-13 14:59:44 -0700507 sk = icmpv6_socket->sk;
508 np = inet6_sk(sk);
509
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 if (!fl.oif && ipv6_addr_is_multicast(&fl.fl6_dst))
511 fl.oif = np->mcast_oif;
512
513 err = ip6_dst_lookup(sk, &dst, &fl);
514 if (err)
515 goto out;
516 if ((err = xfrm_lookup(&dst, &fl, sk, 0)) < 0)
Patrick McHardye1044112005-09-08 15:11:55 -0700517 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518
519 if (ipv6_addr_is_multicast(&fl.fl6_dst))
520 hlimit = np->mcast_hops;
521 else
522 hlimit = np->hop_limit;
523 if (hlimit < 0)
524 hlimit = dst_metric(dst, RTAX_HOPLIMIT);
525 if (hlimit < 0)
526 hlimit = ipv6_get_hoplimit(dst->dev);
527
YOSHIFUJI Hideakie012d512006-09-13 20:01:28 -0700528 tclass = np->tclass;
YOSHIFUJI Hideaki41a1f8e2005-09-08 10:19:03 +0900529 if (tclass < 0)
530 tclass = 0;
531
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 idev = in6_dev_get(skb->dev);
533
534 msg.skb = skb;
535 msg.offset = 0;
Yasuyuki Kozakai763ecff2006-02-15 15:24:15 -0800536 msg.type = ICMPV6_ECHO_REPLY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537
538 err = ip6_append_data(sk, icmpv6_getfrag, &msg, skb->len + sizeof(struct icmp6hdr),
YOSHIFUJI Hideaki41a1f8e2005-09-08 10:19:03 +0900539 sizeof(struct icmp6hdr), hlimit, tclass, NULL, &fl,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540 (struct rt6_info*)dst, MSG_DONTWAIT);
541
542 if (err) {
543 ip6_flush_pending_frames(sk);
544 goto out_put;
545 }
546 err = icmpv6_push_pending_frames(sk, &fl, &tmp_hdr, skb->len + sizeof(struct icmp6hdr));
547
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900548out_put:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549 if (likely(idev != NULL))
550 in6_dev_put(idev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 dst_release(dst);
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900552out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553 icmpv6_xmit_unlock();
554}
555
Al Viro04ce6902006-11-08 00:21:01 -0800556static void icmpv6_notify(struct sk_buff *skb, int type, int code, __be32 info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 struct inet6_protocol *ipprot;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 int inner_offset;
560 int hash;
561 u8 nexthdr;
562
563 if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
564 return;
565
566 nexthdr = ((struct ipv6hdr *)skb->data)->nexthdr;
567 if (ipv6_ext_hdr(nexthdr)) {
568 /* now skip over extension headers */
Herbert Xu0d3d0772005-04-24 20:16:19 -0700569 inner_offset = ipv6_skip_exthdr(skb, sizeof(struct ipv6hdr), &nexthdr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570 if (inner_offset<0)
571 return;
572 } else {
573 inner_offset = sizeof(struct ipv6hdr);
574 }
575
576 /* Checkin header including 8 bytes of inner protocol header. */
577 if (!pskb_may_pull(skb, inner_offset+8))
578 return;
579
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580 /* BUGGG_FUTURE: we should try to parse exthdrs in this packet.
581 Without this we will not able f.e. to make source routed
582 pmtu discovery.
583 Corresponding argument (opt) to notifiers is already added.
584 --ANK (980726)
585 */
586
587 hash = nexthdr & (MAX_INET_PROTOS - 1);
588
589 rcu_read_lock();
590 ipprot = rcu_dereference(inet6_protos[hash]);
591 if (ipprot && ipprot->err_handler)
592 ipprot->err_handler(skb, NULL, type, code, inner_offset, info);
593 rcu_read_unlock();
594
Pavel Emelyanov69d6da02007-11-19 22:35:57 -0800595 raw6_icmp_error(skb, nexthdr, type, code, inner_offset, info);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596}
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900597
Linus Torvalds1da177e2005-04-16 15:20:36 -0700598/*
599 * Handle icmp messages
600 */
601
Herbert Xue5bbef22007-10-15 12:50:28 -0700602static int icmpv6_rcv(struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 struct net_device *dev = skb->dev;
605 struct inet6_dev *idev = __in6_dev_get(dev);
606 struct in6_addr *saddr, *daddr;
607 struct ipv6hdr *orig_hdr;
608 struct icmp6hdr *hdr;
609 int type;
610
611 ICMP6_INC_STATS_BH(idev, ICMP6_MIB_INMSGS);
612
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700613 saddr = &ipv6_hdr(skb)->saddr;
614 daddr = &ipv6_hdr(skb)->daddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615
616 /* Perform checksum. */
Herbert Xufb286bb2005-11-10 13:01:24 -0800617 switch (skb->ip_summed) {
Patrick McHardy84fa7932006-08-29 16:44:56 -0700618 case CHECKSUM_COMPLETE:
Herbert Xufb286bb2005-11-10 13:01:24 -0800619 if (!csum_ipv6_magic(saddr, daddr, skb->len, IPPROTO_ICMPV6,
620 skb->csum))
621 break;
622 /* fall through */
623 case CHECKSUM_NONE:
Al Viro868c86b2006-11-14 21:35:48 -0800624 skb->csum = ~csum_unfold(csum_ipv6_magic(saddr, daddr, skb->len,
625 IPPROTO_ICMPV6, 0));
Herbert Xufb286bb2005-11-10 13:01:24 -0800626 if (__skb_checksum_complete(skb)) {
Joe Perches46b86a22006-01-13 14:29:07 -0800627 LIMIT_NETDEBUG(KERN_DEBUG "ICMPv6 checksum failed [" NIP6_FMT " > " NIP6_FMT "]\n",
Patrick McHardy64ce2072005-08-09 20:50:53 -0700628 NIP6(*saddr), NIP6(*daddr));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629 goto discard_it;
630 }
631 }
632
633 if (!pskb_pull(skb, sizeof(struct icmp6hdr)))
634 goto discard_it;
635
Arnaldo Carvalho de Melocc70ab22007-03-13 14:03:22 -0300636 hdr = icmp6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637
638 type = hdr->icmp6_type;
639
David L Stevens14878f72007-09-16 16:52:35 -0700640 ICMP6MSGIN_INC_STATS_BH(idev, type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641
642 switch (type) {
643 case ICMPV6_ECHO_REQUEST:
644 icmpv6_echo_reply(skb);
645 break;
646
647 case ICMPV6_ECHO_REPLY:
648 /* we couldn't care less */
649 break;
650
651 case ICMPV6_PKT_TOOBIG:
652 /* BUGGG_FUTURE: if packet contains rthdr, we cannot update
653 standard destination cache. Seems, only "advanced"
654 destination cache will allow to solve this problem
655 --ANK (980726)
656 */
657 if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
658 goto discard_it;
Arnaldo Carvalho de Melocc70ab22007-03-13 14:03:22 -0300659 hdr = icmp6_hdr(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660 orig_hdr = (struct ipv6hdr *) (hdr + 1);
661 rt6_pmtu_discovery(&orig_hdr->daddr, &orig_hdr->saddr, dev,
662 ntohl(hdr->icmp6_mtu));
663
664 /*
665 * Drop through to notify
666 */
667
668 case ICMPV6_DEST_UNREACH:
669 case ICMPV6_TIME_EXCEED:
670 case ICMPV6_PARAMPROB:
671 icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
672 break;
673
674 case NDISC_ROUTER_SOLICITATION:
675 case NDISC_ROUTER_ADVERTISEMENT:
676 case NDISC_NEIGHBOUR_SOLICITATION:
677 case NDISC_NEIGHBOUR_ADVERTISEMENT:
678 case NDISC_REDIRECT:
679 ndisc_rcv(skb);
680 break;
681
682 case ICMPV6_MGM_QUERY:
683 igmp6_event_query(skb);
684 break;
685
686 case ICMPV6_MGM_REPORT:
687 igmp6_event_report(skb);
688 break;
689
690 case ICMPV6_MGM_REDUCTION:
691 case ICMPV6_NI_QUERY:
692 case ICMPV6_NI_REPLY:
693 case ICMPV6_MLD2_REPORT:
694 case ICMPV6_DHAAD_REQUEST:
695 case ICMPV6_DHAAD_REPLY:
696 case ICMPV6_MOBILE_PREFIX_SOL:
697 case ICMPV6_MOBILE_PREFIX_ADV:
698 break;
699
700 default:
Patrick McHardy64ce2072005-08-09 20:50:53 -0700701 LIMIT_NETDEBUG(KERN_DEBUG "icmpv6: msg of unknown type\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702
703 /* informational */
704 if (type & ICMPV6_INFOMSG_MASK)
705 break;
706
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900707 /*
708 * error of unknown type.
709 * must pass to upper level
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710 */
711
712 icmpv6_notify(skb, type, hdr->icmp6_code, hdr->icmp6_mtu);
Stephen Hemminger3ff50b72007-04-20 17:09:22 -0700713 }
714
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 kfree_skb(skb);
716 return 0;
717
718discard_it:
719 ICMP6_INC_STATS_BH(idev, ICMP6_MIB_INERRORS);
720 kfree_skb(skb);
721 return 0;
722}
723
Ingo Molnar640c41c2006-08-15 00:06:56 -0700724/*
725 * Special lock-class for __icmpv6_socket:
726 */
727static struct lock_class_key icmpv6_socket_sk_dst_lock_key;
728
Linus Torvalds1da177e2005-04-16 15:20:36 -0700729int __init icmpv6_init(struct net_proto_family *ops)
730{
731 struct sock *sk;
732 int err, i, j;
733
KAMEZAWA Hiroyuki6f912042006-04-10 22:52:50 -0700734 for_each_possible_cpu(i) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 err = sock_create_kern(PF_INET6, SOCK_RAW, IPPROTO_ICMPV6,
736 &per_cpu(__icmpv6_socket, i));
737 if (err < 0) {
738 printk(KERN_ERR
739 "Failed to initialize the ICMP6 control socket "
740 "(err %d).\n",
741 err);
742 goto fail;
743 }
744
745 sk = per_cpu(__icmpv6_socket, i)->sk;
746 sk->sk_allocation = GFP_ATOMIC;
Ingo Molnar640c41c2006-08-15 00:06:56 -0700747 /*
748 * Split off their lock-class, because sk->sk_dst_lock
749 * gets used from softirqs, which is safe for
750 * __icmpv6_socket (because those never get directly used
751 * via userspace syscalls), but unsafe for normal sockets.
752 */
753 lockdep_set_class(&sk->sk_dst_lock,
754 &icmpv6_socket_sk_dst_lock_key);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755
756 /* Enough space for 2 64K ICMP packets, including
757 * sk_buff struct overhead.
758 */
759 sk->sk_sndbuf =
760 (2 * ((64 * 1024) + sizeof(struct sk_buff)));
761
762 sk->sk_prot->unhash(sk);
763 }
764
765
766 if (inet6_add_protocol(&icmpv6_protocol, IPPROTO_ICMPV6) < 0) {
767 printk(KERN_ERR "Failed to register ICMP6 protocol\n");
768 err = -EAGAIN;
769 goto fail;
770 }
771
772 return 0;
773
774 fail:
775 for (j = 0; j < i; j++) {
776 if (!cpu_possible(j))
777 continue;
778 sock_release(per_cpu(__icmpv6_socket, j));
779 }
780
781 return err;
782}
783
784void icmpv6_cleanup(void)
785{
786 int i;
787
KAMEZAWA Hiroyuki6f912042006-04-10 22:52:50 -0700788 for_each_possible_cpu(i) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 sock_release(per_cpu(__icmpv6_socket, i));
790 }
791 inet6_del_protocol(&icmpv6_protocol, IPPROTO_ICMPV6);
792}
793
Arjan van de Ven9b5b5cf2005-11-29 16:21:38 -0800794static const struct icmp6_err {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 int err;
796 int fatal;
797} tab_unreach[] = {
798 { /* NOROUTE */
799 .err = ENETUNREACH,
800 .fatal = 0,
801 },
802 { /* ADM_PROHIBITED */
803 .err = EACCES,
804 .fatal = 1,
805 },
806 { /* Was NOT_NEIGHBOUR, now reserved */
807 .err = EHOSTUNREACH,
808 .fatal = 0,
809 },
810 { /* ADDR_UNREACH */
811 .err = EHOSTUNREACH,
812 .fatal = 0,
813 },
814 { /* PORT_UNREACH */
815 .err = ECONNREFUSED,
816 .fatal = 1,
817 },
818};
819
820int icmpv6_err_convert(int type, int code, int *err)
821{
822 int fatal = 0;
823
824 *err = EPROTO;
825
826 switch (type) {
827 case ICMPV6_DEST_UNREACH:
828 fatal = 1;
829 if (code <= ICMPV6_PORT_UNREACH) {
830 *err = tab_unreach[code].err;
831 fatal = tab_unreach[code].fatal;
832 }
833 break;
834
835 case ICMPV6_PKT_TOOBIG:
836 *err = EMSGSIZE;
837 break;
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +0900838
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 case ICMPV6_PARAMPROB:
840 *err = EPROTO;
841 fatal = 1;
842 break;
843
844 case ICMPV6_TIME_EXCEED:
845 *err = EHOSTUNREACH;
846 break;
Stephen Hemminger3ff50b72007-04-20 17:09:22 -0700847 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848
849 return fatal;
850}
851
YOSHIFUJI Hideaki71590392007-02-22 22:05:40 +0900852EXPORT_SYMBOL(icmpv6_err_convert);
853
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854#ifdef CONFIG_SYSCTL
855ctl_table ipv6_icmp_table[] = {
856 {
857 .ctl_name = NET_IPV6_ICMP_RATELIMIT,
858 .procname = "ratelimit",
859 .data = &sysctl_icmpv6_time,
860 .maxlen = sizeof(int),
861 .mode = 0644,
862 .proc_handler = &proc_dointvec
863 },
864 { .ctl_name = 0 },
865};
866#endif
867