| #include <linux/export.h> |
| #include <linux/icmpv6.h> |
| #include <linux/mutex.h> |
| #include <linux/netdevice.h> |
| #include <linux/spinlock.h> |
| |
| #include <net/ipv6.h> |
| |
| #if IS_ENABLED(CONFIG_IPV6) |
| |
| #if !IS_BUILTIN(CONFIG_IPV6) |
| |
| static ip6_icmp_send_t __rcu *ip6_icmp_send; |
| |
| int inet6_register_icmp_sender(ip6_icmp_send_t *fn) |
| { |
| return (cmpxchg((ip6_icmp_send_t **)&ip6_icmp_send, NULL, fn) == NULL) ? |
| 0 : -EBUSY; |
| } |
| EXPORT_SYMBOL(inet6_register_icmp_sender); |
| |
| int inet6_unregister_icmp_sender(ip6_icmp_send_t *fn) |
| { |
| int ret; |
| |
| ret = (cmpxchg((ip6_icmp_send_t **)&ip6_icmp_send, fn, NULL) == fn) ? |
| 0 : -EINVAL; |
| |
| synchronize_net(); |
| |
| return ret; |
| } |
| EXPORT_SYMBOL(inet6_unregister_icmp_sender); |
| |
| void __icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info, |
| const struct inet6_skb_parm *parm) |
| { |
| ip6_icmp_send_t *send; |
| |
| rcu_read_lock(); |
| send = rcu_dereference(ip6_icmp_send); |
| if (send) |
| send(skb, type, code, info, NULL, parm); |
| rcu_read_unlock(); |
| } |
| EXPORT_SYMBOL(__icmpv6_send); |
| #endif |
| |
| #if IS_ENABLED(CONFIG_NF_NAT) |
| #include <net/netfilter/nf_conntrack.h> |
| void icmpv6_ndo_send(struct sk_buff *skb_in, u8 type, u8 code, __u32 info) |
| { |
| struct inet6_skb_parm parm = { 0 }; |
| struct sk_buff *cloned_skb = NULL; |
| enum ip_conntrack_info ctinfo; |
| struct in6_addr orig_ip; |
| struct nf_conn *ct; |
| |
| ct = nf_ct_get(skb_in, &ctinfo); |
| if (!ct || !(ct->status & IPS_SRC_NAT)) { |
| __icmpv6_send(skb_in, type, code, info, &parm); |
| return; |
| } |
| |
| if (skb_shared(skb_in)) |
| skb_in = cloned_skb = skb_clone(skb_in, GFP_ATOMIC); |
| |
| if (unlikely(!skb_in || skb_network_header(skb_in) < skb_in->head || |
| (skb_network_header(skb_in) + sizeof(struct ipv6hdr)) > |
| skb_tail_pointer(skb_in) || skb_ensure_writable(skb_in, |
| skb_network_offset(skb_in) + sizeof(struct ipv6hdr)))) |
| goto out; |
| |
| orig_ip = ipv6_hdr(skb_in)->saddr; |
| ipv6_hdr(skb_in)->saddr = ct->tuplehash[0].tuple.src.u3.in6; |
| __icmpv6_send(skb_in, type, code, info, &parm); |
| ipv6_hdr(skb_in)->saddr = orig_ip; |
| out: |
| consume_skb(cloned_skb); |
| } |
| EXPORT_SYMBOL(icmpv6_ndo_send); |
| #endif |
| #endif |