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
inet6_register_icmp_sender(ip6_icmp_send_t * fn)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
inet6_unregister_icmp_sender(ip6_icmp_send_t * fn)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
__icmpv6_send(struct sk_buff * skb,u8 type,u8 code,__u32 info,const struct inet6_skb_parm * parm)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 /*
51 * ANDROID API HACK for android11-5.4 branch only
52 *
53 * Work around loss of icmpv6_send global symbol that got moved to __icmpv6_send
54 * in 5.4.102
55 */
icmpv6_send(struct sk_buff * skb,u8 type,u8 code,__u32 info)56 void icmpv6_send(struct sk_buff *skb, u8 type, u8 code, __u32 info)
57 {
58 __icmpv6_send(skb, type, code, info, IP6CB(skb));
59 }
60 EXPORT_SYMBOL(icmpv6_send);
61
62 #if IS_ENABLED(CONFIG_NF_NAT)
63 #include <net/netfilter/nf_conntrack.h>
icmpv6_ndo_send(struct sk_buff * skb_in,u8 type,u8 code,__u32 info)64 void icmpv6_ndo_send(struct sk_buff *skb_in, u8 type, u8 code, __u32 info)
65 {
66 struct inet6_skb_parm parm = { 0 };
67 struct sk_buff *cloned_skb = NULL;
68 enum ip_conntrack_info ctinfo;
69 struct in6_addr orig_ip;
70 struct nf_conn *ct;
71
72 ct = nf_ct_get(skb_in, &ctinfo);
73 if (!ct || !(ct->status & IPS_SRC_NAT)) {
74 __icmpv6_send(skb_in, type, code, info, &parm);
75 return;
76 }
77
78 if (skb_shared(skb_in))
79 skb_in = cloned_skb = skb_clone(skb_in, GFP_ATOMIC);
80
81 if (unlikely(!skb_in || skb_network_header(skb_in) < skb_in->head ||
82 (skb_network_header(skb_in) + sizeof(struct ipv6hdr)) >
83 skb_tail_pointer(skb_in) || skb_ensure_writable(skb_in,
84 skb_network_offset(skb_in) + sizeof(struct ipv6hdr))))
85 goto out;
86
87 orig_ip = ipv6_hdr(skb_in)->saddr;
88 ipv6_hdr(skb_in)->saddr = ct->tuplehash[0].tuple.src.u3.in6;
89 __icmpv6_send(skb_in, type, code, info, &parm);
90 ipv6_hdr(skb_in)->saddr = orig_ip;
91 out:
92 consume_skb(cloned_skb);
93 }
94 EXPORT_SYMBOL(icmpv6_ndo_send);
95 #endif
96 #endif
97