blob: 05287bc36dbdf3dcc5504e5677910e10db027e69 [file] [log] [blame]
Pravin B Shelar5f5624c2013-04-25 11:08:30 +00001#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
Eric Dumazet8b572a52020-06-19 12:02:59 -070011#if !IS_BUILTIN(CONFIG_IPV6)
12
Pravin B Shelar5f5624c2013-04-25 11:08:30 +000013static ip6_icmp_send_t __rcu *ip6_icmp_send;
14
15int inet6_register_icmp_sender(ip6_icmp_send_t *fn)
16{
17 return (cmpxchg((ip6_icmp_send_t **)&ip6_icmp_send, NULL, fn) == NULL) ?
Ian Morris67ba4152014-08-24 21:53:10 +010018 0 : -EBUSY;
Pravin B Shelar5f5624c2013-04-25 11:08:30 +000019}
20EXPORT_SYMBOL(inet6_register_icmp_sender);
21
22int 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}
33EXPORT_SYMBOL(inet6_unregister_icmp_sender);
34
Jason A. Donenfeld0c5bdc22021-02-23 14:18:58 +010035void __icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info,
36 const struct inet6_skb_parm *parm)
Pravin B Shelar5f5624c2013-04-25 11:08:30 +000037{
38 ip6_icmp_send_t *send;
39
40 rcu_read_lock();
41 send = rcu_dereference(ip6_icmp_send);
Eric Dumazet8b572a52020-06-19 12:02:59 -070042 if (send)
Jason A. Donenfeld0c5bdc22021-02-23 14:18:58 +010043 send(skb, type, code, info, NULL, parm);
Pravin B Shelar5f5624c2013-04-25 11:08:30 +000044 rcu_read_unlock();
45}
Jason A. Donenfeld0c5bdc22021-02-23 14:18:58 +010046EXPORT_SYMBOL(__icmpv6_send);
Eric Dumazet8b572a52020-06-19 12:02:59 -070047#endif
Jason A. Donenfelde9b06762020-02-11 20:47:05 +010048
49#if IS_ENABLED(CONFIG_NF_NAT)
50#include <net/netfilter/nf_conntrack.h>
51void icmpv6_ndo_send(struct sk_buff *skb_in, u8 type, u8 code, __u32 info)
52{
Jason A. Donenfeld0c5bdc22021-02-23 14:18:58 +010053 struct inet6_skb_parm parm = { 0 };
Jason A. Donenfelde9b06762020-02-11 20:47:05 +010054 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)) {
Jason A. Donenfeld0c5bdc22021-02-23 14:18:58 +010061 __icmpv6_send(skb_in, type, code, info, &parm);
Jason A. Donenfelde9b06762020-02-11 20:47:05 +010062 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;
Jason A. Donenfeld0c5bdc22021-02-23 14:18:58 +010076 __icmpv6_send(skb_in, type, code, info, &parm);
Jason A. Donenfelde9b06762020-02-11 20:47:05 +010077 ipv6_hdr(skb_in)->saddr = orig_ip;
78out:
79 consume_skb(cloned_skb);
80}
81EXPORT_SYMBOL(icmpv6_ndo_send);
82#endif
Pravin B Shelar5f5624c2013-04-25 11:08:30 +000083#endif