net/ipv6/icmp.c

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