net/ipv6/ip6_icmp.c

   1 #include <linux/export.h>
   2 #include <linux/icmpv6.h>
   3 #include <linux/mutex.h>
   4 #include <linux/netdevice.h>
   5 #include <linux/spinlock.h>
   6
   7 #include <net/ipv6.h>
   8
   9 #if IS_ENABLED(CONFIG_IPV6)
  10
  11 #if !IS_BUILTIN(CONFIG_IPV6)
  12
  13 static ip6_icmp_send_t __rcu *ip6_icmp_send;
  14
  15 int inet6_register_icmp_sender(ip6_icmp_send_t *fn)
  16 {
  17         return (cmpxchg((ip6_icmp_send_t **)&ip6_icmp_send, NULL, fn) == NULL) ?
  18                 0 : -EBUSY;
  19 }
  20 EXPORT_SYMBOL(inet6_register_icmp_sender);
  21
  22 int inet6_unregister_icmp_sender(ip6_icmp_send_t *fn)
  23 {
  24         int ret;
  25
  26         ret = (cmpxchg((ip6_icmp_send_t **)&ip6_icmp_send, fn, NULL) == fn) ?
  27               0 : -EINVAL;
  28
  29         synchronize_net();
  30
  31         return ret;
  32 }
  33 EXPORT_SYMBOL(inet6_unregister_icmp_sender);
  34
  35 void __icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info,
  36                    const struct inet6_skb_parm *parm)
  37 {
  38         ip6_icmp_send_t *send;
  39
  40         rcu_read_lock();
  41         send = rcu_dereference(ip6_icmp_send);
  42         if (send)
  43                 send(skb, type, code, info, NULL, parm);
  44         rcu_read_unlock();
  45 }
  46 EXPORT_SYMBOL(__icmpv6_send);
  47 #endif
  48
  49 #if IS_ENABLED(CONFIG_NF_NAT)
  50 #include <net/netfilter/nf_conntrack.h>
  51 void icmpv6_ndo_send(struct sk_buff *skb_in, u8 type, u8 code, __u32 info)
  52 {
  53         struct inet6_skb_parm parm = { 0 };
  54         struct sk_buff *cloned_skb = NULL;
  55         enum ip_conntrack_info ctinfo;
  56         struct in6_addr orig_ip;
  57         struct nf_conn *ct;
  58
  59         ct = nf_ct_get(skb_in, &ctinfo);
  60         if (!ct || !(ct->status & IPS_SRC_NAT)) {
  61                 __icmpv6_send(skb_in, type, code, info, &parm);
  62                 return;
  63         }
  64
  65         if (skb_shared(skb_in))
  66                 skb_in = cloned_skb = skb_clone(skb_in, GFP_ATOMIC);
  67
  68         if (unlikely(!skb_in || skb_network_header(skb_in) < skb_in->head ||
  69             (skb_network_header(skb_in) + sizeof(struct ipv6hdr)) >
  70             skb_tail_pointer(skb_in) || skb_ensure_writable(skb_in,
  71             skb_network_offset(skb_in) + sizeof(struct ipv6hdr))))
  72                 goto out;
  73
  74         orig_ip = ipv6_hdr(skb_in)->saddr;
  75         ipv6_hdr(skb_in)->saddr = ct->tuplehash[0].tuple.src.u3.in6;
  76         __icmpv6_send(skb_in, type, code, info, &parm);
  77         ipv6_hdr(skb_in)->saddr = orig_ip;
  78 out:
  79         consume_skb(cloned_skb);
  80 }
  81 EXPORT_SYMBOL(icmpv6_ndo_send);
  82 #endif
  83 #endif