Branch data     Line data    Source code

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