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