Linux Audio

Check our new training course

Loading...
v4.6
 
  1/*
  2 * To speed up listener socket lookup, create an array to store all sockets
  3 * listening on the same port.  This allows a decision to be made after finding
  4 * the first socket.  An optional BPF program can also be configured for
  5 * selecting the socket index from the array of available sockets.
  6 */
  7
 
  8#include <net/sock_reuseport.h>
  9#include <linux/bpf.h>
 
 
 10#include <linux/rcupdate.h>
 11
 12#define INIT_SOCKS 128
 13
 14static DEFINE_SPINLOCK(reuseport_lock);
 15
 16static struct sock_reuseport *__reuseport_alloc(u16 max_socks)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 17{
 18	size_t size = sizeof(struct sock_reuseport) +
 19		      sizeof(struct sock *) * max_socks;
 20	struct sock_reuseport *reuse = kzalloc(size, GFP_ATOMIC);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 21
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 22	if (!reuse)
 23		return NULL;
 24
 25	reuse->max_socks = max_socks;
 26
 27	RCU_INIT_POINTER(reuse->prog, NULL);
 28	return reuse;
 29}
 30
 31int reuseport_alloc(struct sock *sk)
 32{
 33	struct sock_reuseport *reuse;
 
 34
 35	/* bh lock used since this function call may precede hlist lock in
 36	 * soft irq of receive path or setsockopt from process context
 37	 */
 38	spin_lock_bh(&reuseport_lock);
 39	WARN_ONCE(rcu_dereference_protected(sk->sk_reuseport_cb,
 40					    lockdep_is_held(&reuseport_lock)),
 41		  "multiple allocations for the same socket");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 42	reuse = __reuseport_alloc(INIT_SOCKS);
 43	if (!reuse) {
 44		spin_unlock_bh(&reuseport_lock);
 45		return -ENOMEM;
 46	}
 47
 
 
 
 
 
 
 
 
 
 48	reuse->socks[0] = sk;
 49	reuse->num_socks = 1;
 
 50	rcu_assign_pointer(sk->sk_reuseport_cb, reuse);
 51
 
 52	spin_unlock_bh(&reuseport_lock);
 53
 54	return 0;
 55}
 56EXPORT_SYMBOL(reuseport_alloc);
 57
 58static struct sock_reuseport *reuseport_grow(struct sock_reuseport *reuse)
 59{
 60	struct sock_reuseport *more_reuse;
 61	u32 more_socks_size, i;
 62
 63	more_socks_size = reuse->max_socks * 2U;
 64	if (more_socks_size > U16_MAX)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 65		return NULL;
 
 66
 67	more_reuse = __reuseport_alloc(more_socks_size);
 68	if (!more_reuse)
 69		return NULL;
 70
 71	more_reuse->max_socks = more_socks_size;
 72	more_reuse->num_socks = reuse->num_socks;
 
 73	more_reuse->prog = reuse->prog;
 
 
 
 
 74
 75	memcpy(more_reuse->socks, reuse->socks,
 76	       reuse->num_socks * sizeof(struct sock *));
 
 
 
 
 
 77
 78	for (i = 0; i < reuse->num_socks; ++i)
 79		rcu_assign_pointer(reuse->socks[i]->sk_reuseport_cb,
 80				   more_reuse);
 81
 82	/* Note: we use kfree_rcu here instead of reuseport_free_rcu so
 83	 * that reuse and more_reuse can temporarily share a reference
 84	 * to prog.
 85	 */
 86	kfree_rcu(reuse, rcu);
 87	return more_reuse;
 88}
 89
 
 
 
 
 
 
 
 
 
 
 90/**
 91 *  reuseport_add_sock - Add a socket to the reuseport group of another.
 92 *  @sk:  New socket to add to the group.
 93 *  @sk2: Socket belonging to the existing reuseport group.
 
 
 94 *  May return ENOMEM and not add socket to group under memory pressure.
 95 */
 96int reuseport_add_sock(struct sock *sk, struct sock *sk2)
 97{
 98	struct sock_reuseport *reuse;
 99
100	if (!rcu_access_pointer(sk2->sk_reuseport_cb)) {
101		int err = reuseport_alloc(sk2);
102
103		if (err)
104			return err;
105	}
106
107	spin_lock_bh(&reuseport_lock);
108	reuse = rcu_dereference_protected(sk2->sk_reuseport_cb,
109					  lockdep_is_held(&reuseport_lock)),
110	WARN_ONCE(rcu_dereference_protected(sk->sk_reuseport_cb,
111					    lockdep_is_held(&reuseport_lock)),
112		  "socket already in reuseport group");
 
 
113
114	if (reuse->num_socks == reuse->max_socks) {
 
 
 
 
 
 
 
 
 
115		reuse = reuseport_grow(reuse);
116		if (!reuse) {
117			spin_unlock_bh(&reuseport_lock);
118			return -ENOMEM;
119		}
120	}
121
122	reuse->socks[reuse->num_socks] = sk;
123	/* paired with smp_rmb() in reuseport_select_sock() */
124	smp_wmb();
125	reuse->num_socks++;
126	rcu_assign_pointer(sk->sk_reuseport_cb, reuse);
127
128	spin_unlock_bh(&reuseport_lock);
129
 
 
130	return 0;
131}
132EXPORT_SYMBOL(reuseport_add_sock);
133
134static void reuseport_free_rcu(struct rcu_head *head)
 
135{
136	struct sock_reuseport *reuse;
 
 
 
 
 
 
 
137
138	reuse = container_of(head, struct sock_reuseport, rcu);
139	if (reuse->prog)
140		bpf_prog_destroy(reuse->prog);
141	kfree(reuse);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
142}
143
144void reuseport_detach_sock(struct sock *sk)
145{
146	struct sock_reuseport *reuse;
147	int i;
148
149	spin_lock_bh(&reuseport_lock);
150	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
151					  lockdep_is_held(&reuseport_lock));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
152	rcu_assign_pointer(sk->sk_reuseport_cb, NULL);
153
154	for (i = 0; i < reuse->num_socks; i++) {
155		if (reuse->socks[i] == sk) {
156			reuse->socks[i] = reuse->socks[reuse->num_socks - 1];
157			reuse->num_socks--;
158			if (reuse->num_socks == 0)
159				call_rcu(&reuse->rcu, reuseport_free_rcu);
160			break;
161		}
162	}
163	spin_unlock_bh(&reuseport_lock);
164}
165EXPORT_SYMBOL(reuseport_detach_sock);
166
167static struct sock *run_bpf(struct sock_reuseport *reuse, u16 socks,
168			    struct bpf_prog *prog, struct sk_buff *skb,
169			    int hdr_len)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
170{
171	struct sk_buff *nskb = NULL;
172	u32 index;
173
174	if (skb_shared(skb)) {
175		nskb = skb_clone(skb, GFP_ATOMIC);
176		if (!nskb)
177			return NULL;
178		skb = nskb;
179	}
180
181	/* temporarily advance data past protocol header */
182	if (!pskb_pull(skb, hdr_len)) {
183		kfree_skb(nskb);
184		return NULL;
185	}
186	index = bpf_prog_run_save_cb(prog, skb);
187	__skb_push(skb, hdr_len);
188
189	consume_skb(nskb);
190
191	if (index >= socks)
192		return NULL;
193
194	return reuse->socks[index];
195}
196
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
197/**
198 *  reuseport_select_sock - Select a socket from an SO_REUSEPORT group.
199 *  @sk: First socket in the group.
200 *  @hash: When no BPF filter is available, use this hash to select.
201 *  @skb: skb to run through BPF filter.
202 *  @hdr_len: BPF filter expects skb data pointer at payload data.  If
203 *    the skb does not yet point at the payload, this parameter represents
204 *    how far the pointer needs to advance to reach the payload.
205 *  Returns a socket that should receive the packet (or NULL on error).
206 */
207struct sock *reuseport_select_sock(struct sock *sk,
208				   u32 hash,
209				   struct sk_buff *skb,
210				   int hdr_len)
211{
212	struct sock_reuseport *reuse;
213	struct bpf_prog *prog;
214	struct sock *sk2 = NULL;
215	u16 socks;
216
217	rcu_read_lock();
218	reuse = rcu_dereference(sk->sk_reuseport_cb);
219
220	/* if memory allocation failed or add call is not yet complete */
221	if (!reuse)
222		goto out;
223
224	prog = rcu_dereference(reuse->prog);
225	socks = READ_ONCE(reuse->num_socks);
226	if (likely(socks)) {
227		/* paired with smp_wmb() in reuseport_add_sock() */
228		smp_rmb();
229
230		if (prog && skb)
231			sk2 = run_bpf(reuse, socks, prog, skb, hdr_len);
 
 
 
232		else
233			sk2 = reuse->socks[reciprocal_scale(hash, socks)];
 
 
 
 
 
234	}
235
236out:
237	rcu_read_unlock();
238	return sk2;
239}
240EXPORT_SYMBOL(reuseport_select_sock);
241
242struct bpf_prog *
243reuseport_attach_prog(struct sock *sk, struct bpf_prog *prog)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
244{
245	struct sock_reuseport *reuse;
246	struct bpf_prog *old_prog;
247
 
 
 
 
 
 
 
 
 
 
 
 
 
 
248	spin_lock_bh(&reuseport_lock);
249	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
250					  lockdep_is_held(&reuseport_lock));
251	old_prog = rcu_dereference_protected(reuse->prog,
252					     lockdep_is_held(&reuseport_lock));
253	rcu_assign_pointer(reuse->prog, prog);
254	spin_unlock_bh(&reuseport_lock);
255
256	return old_prog;
 
257}
258EXPORT_SYMBOL(reuseport_attach_prog);
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * To speed up listener socket lookup, create an array to store all sockets
  4 * listening on the same port.  This allows a decision to be made after finding
  5 * the first socket.  An optional BPF program can also be configured for
  6 * selecting the socket index from the array of available sockets.
  7 */
  8
  9#include <net/ip.h>
 10#include <net/sock_reuseport.h>
 11#include <linux/bpf.h>
 12#include <linux/idr.h>
 13#include <linux/filter.h>
 14#include <linux/rcupdate.h>
 15
 16#define INIT_SOCKS 128
 17
 18DEFINE_SPINLOCK(reuseport_lock);
 19
 20static DEFINE_IDA(reuseport_ida);
 21static int reuseport_resurrect(struct sock *sk, struct sock_reuseport *old_reuse,
 22			       struct sock_reuseport *reuse, bool bind_inany);
 23
 24void reuseport_has_conns_set(struct sock *sk)
 25{
 26	struct sock_reuseport *reuse;
 27
 28	if (!rcu_access_pointer(sk->sk_reuseport_cb))
 29		return;
 30
 31	spin_lock_bh(&reuseport_lock);
 32	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
 33					  lockdep_is_held(&reuseport_lock));
 34	if (likely(reuse))
 35		reuse->has_conns = 1;
 36	spin_unlock_bh(&reuseport_lock);
 37}
 38EXPORT_SYMBOL(reuseport_has_conns_set);
 39
 40static void __reuseport_get_incoming_cpu(struct sock_reuseport *reuse)
 41{
 42	/* Paired with READ_ONCE() in reuseport_select_sock_by_hash(). */
 43	WRITE_ONCE(reuse->incoming_cpu, reuse->incoming_cpu + 1);
 44}
 45
 46static void __reuseport_put_incoming_cpu(struct sock_reuseport *reuse)
 47{
 48	/* Paired with READ_ONCE() in reuseport_select_sock_by_hash(). */
 49	WRITE_ONCE(reuse->incoming_cpu, reuse->incoming_cpu - 1);
 50}
 51
 52static void reuseport_get_incoming_cpu(struct sock *sk, struct sock_reuseport *reuse)
 53{
 54	if (sk->sk_incoming_cpu >= 0)
 55		__reuseport_get_incoming_cpu(reuse);
 56}
 57
 58static void reuseport_put_incoming_cpu(struct sock *sk, struct sock_reuseport *reuse)
 59{
 60	if (sk->sk_incoming_cpu >= 0)
 61		__reuseport_put_incoming_cpu(reuse);
 62}
 63
 64void reuseport_update_incoming_cpu(struct sock *sk, int val)
 65{
 66	struct sock_reuseport *reuse;
 67	int old_sk_incoming_cpu;
 68
 69	if (unlikely(!rcu_access_pointer(sk->sk_reuseport_cb))) {
 70		/* Paired with REAE_ONCE() in sk_incoming_cpu_update()
 71		 * and compute_score().
 72		 */
 73		WRITE_ONCE(sk->sk_incoming_cpu, val);
 74		return;
 75	}
 76
 77	spin_lock_bh(&reuseport_lock);
 78
 79	/* This must be done under reuseport_lock to avoid a race with
 80	 * reuseport_grow(), which accesses sk->sk_incoming_cpu without
 81	 * lock_sock() when detaching a shutdown()ed sk.
 82	 *
 83	 * Paired with READ_ONCE() in reuseport_select_sock_by_hash().
 84	 */
 85	old_sk_incoming_cpu = sk->sk_incoming_cpu;
 86	WRITE_ONCE(sk->sk_incoming_cpu, val);
 87
 88	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
 89					  lockdep_is_held(&reuseport_lock));
 90
 91	/* reuseport_grow() has detached a closed sk. */
 92	if (!reuse)
 93		goto out;
 94
 95	if (old_sk_incoming_cpu < 0 && val >= 0)
 96		__reuseport_get_incoming_cpu(reuse);
 97	else if (old_sk_incoming_cpu >= 0 && val < 0)
 98		__reuseport_put_incoming_cpu(reuse);
 99
100out:
101	spin_unlock_bh(&reuseport_lock);
102}
103
104static int reuseport_sock_index(struct sock *sk,
105				const struct sock_reuseport *reuse,
106				bool closed)
107{
108	int left, right;
109
110	if (!closed) {
111		left = 0;
112		right = reuse->num_socks;
113	} else {
114		left = reuse->max_socks - reuse->num_closed_socks;
115		right = reuse->max_socks;
116	}
117
118	for (; left < right; left++)
119		if (reuse->socks[left] == sk)
120			return left;
121	return -1;
122}
123
124static void __reuseport_add_sock(struct sock *sk,
125				 struct sock_reuseport *reuse)
126{
127	reuse->socks[reuse->num_socks] = sk;
128	/* paired with smp_rmb() in reuseport_(select|migrate)_sock() */
129	smp_wmb();
130	reuse->num_socks++;
131	reuseport_get_incoming_cpu(sk, reuse);
132}
133
134static bool __reuseport_detach_sock(struct sock *sk,
135				    struct sock_reuseport *reuse)
136{
137	int i = reuseport_sock_index(sk, reuse, false);
138
139	if (i == -1)
140		return false;
141
142	reuse->socks[i] = reuse->socks[reuse->num_socks - 1];
143	reuse->num_socks--;
144	reuseport_put_incoming_cpu(sk, reuse);
145
146	return true;
147}
148
149static void __reuseport_add_closed_sock(struct sock *sk,
150					struct sock_reuseport *reuse)
151{
152	reuse->socks[reuse->max_socks - reuse->num_closed_socks - 1] = sk;
153	/* paired with READ_ONCE() in inet_csk_bind_conflict() */
154	WRITE_ONCE(reuse->num_closed_socks, reuse->num_closed_socks + 1);
155	reuseport_get_incoming_cpu(sk, reuse);
156}
157
158static bool __reuseport_detach_closed_sock(struct sock *sk,
159					   struct sock_reuseport *reuse)
160{
161	int i = reuseport_sock_index(sk, reuse, true);
162
163	if (i == -1)
164		return false;
165
166	reuse->socks[i] = reuse->socks[reuse->max_socks - reuse->num_closed_socks];
167	/* paired with READ_ONCE() in inet_csk_bind_conflict() */
168	WRITE_ONCE(reuse->num_closed_socks, reuse->num_closed_socks - 1);
169	reuseport_put_incoming_cpu(sk, reuse);
170
171	return true;
172}
173
174static struct sock_reuseport *__reuseport_alloc(unsigned int max_socks)
175{
176	struct sock_reuseport *reuse;
177
178	reuse = kzalloc(struct_size(reuse, socks, max_socks), GFP_ATOMIC);
179	if (!reuse)
180		return NULL;
181
182	reuse->max_socks = max_socks;
183
184	RCU_INIT_POINTER(reuse->prog, NULL);
185	return reuse;
186}
187
188int reuseport_alloc(struct sock *sk, bool bind_inany)
189{
190	struct sock_reuseport *reuse;
191	int id, ret = 0;
192
193	/* bh lock used since this function call may precede hlist lock in
194	 * soft irq of receive path or setsockopt from process context
195	 */
196	spin_lock_bh(&reuseport_lock);
197
198	/* Allocation attempts can occur concurrently via the setsockopt path
199	 * and the bind/hash path.  Nothing to do when we lose the race.
200	 */
201	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
202					  lockdep_is_held(&reuseport_lock));
203	if (reuse) {
204		if (reuse->num_closed_socks) {
205			/* sk was shutdown()ed before */
206			ret = reuseport_resurrect(sk, reuse, NULL, bind_inany);
207			goto out;
208		}
209
210		/* Only set reuse->bind_inany if the bind_inany is true.
211		 * Otherwise, it will overwrite the reuse->bind_inany
212		 * which was set by the bind/hash path.
213		 */
214		if (bind_inany)
215			reuse->bind_inany = bind_inany;
216		goto out;
217	}
218
219	reuse = __reuseport_alloc(INIT_SOCKS);
220	if (!reuse) {
221		ret = -ENOMEM;
222		goto out;
223	}
224
225	id = ida_alloc(&reuseport_ida, GFP_ATOMIC);
226	if (id < 0) {
227		kfree(reuse);
228		ret = id;
229		goto out;
230	}
231
232	reuse->reuseport_id = id;
233	reuse->bind_inany = bind_inany;
234	reuse->socks[0] = sk;
235	reuse->num_socks = 1;
236	reuseport_get_incoming_cpu(sk, reuse);
237	rcu_assign_pointer(sk->sk_reuseport_cb, reuse);
238
239out:
240	spin_unlock_bh(&reuseport_lock);
241
242	return ret;
243}
244EXPORT_SYMBOL(reuseport_alloc);
245
246static struct sock_reuseport *reuseport_grow(struct sock_reuseport *reuse)
247{
248	struct sock_reuseport *more_reuse;
249	u32 more_socks_size, i;
250
251	more_socks_size = reuse->max_socks * 2U;
252	if (more_socks_size > U16_MAX) {
253		if (reuse->num_closed_socks) {
254			/* Make room by removing a closed sk.
255			 * The child has already been migrated.
256			 * Only reqsk left at this point.
257			 */
258			struct sock *sk;
259
260			sk = reuse->socks[reuse->max_socks - reuse->num_closed_socks];
261			RCU_INIT_POINTER(sk->sk_reuseport_cb, NULL);
262			__reuseport_detach_closed_sock(sk, reuse);
263
264			return reuse;
265		}
266
267		return NULL;
268	}
269
270	more_reuse = __reuseport_alloc(more_socks_size);
271	if (!more_reuse)
272		return NULL;
273
 
274	more_reuse->num_socks = reuse->num_socks;
275	more_reuse->num_closed_socks = reuse->num_closed_socks;
276	more_reuse->prog = reuse->prog;
277	more_reuse->reuseport_id = reuse->reuseport_id;
278	more_reuse->bind_inany = reuse->bind_inany;
279	more_reuse->has_conns = reuse->has_conns;
280	more_reuse->incoming_cpu = reuse->incoming_cpu;
281
282	memcpy(more_reuse->socks, reuse->socks,
283	       reuse->num_socks * sizeof(struct sock *));
284	memcpy(more_reuse->socks +
285	       (more_reuse->max_socks - more_reuse->num_closed_socks),
286	       reuse->socks + (reuse->max_socks - reuse->num_closed_socks),
287	       reuse->num_closed_socks * sizeof(struct sock *));
288	more_reuse->synq_overflow_ts = READ_ONCE(reuse->synq_overflow_ts);
289
290	for (i = 0; i < reuse->max_socks; ++i)
291		rcu_assign_pointer(reuse->socks[i]->sk_reuseport_cb,
292				   more_reuse);
293
294	/* Note: we use kfree_rcu here instead of reuseport_free_rcu so
295	 * that reuse and more_reuse can temporarily share a reference
296	 * to prog.
297	 */
298	kfree_rcu(reuse, rcu);
299	return more_reuse;
300}
301
302static void reuseport_free_rcu(struct rcu_head *head)
303{
304	struct sock_reuseport *reuse;
305
306	reuse = container_of(head, struct sock_reuseport, rcu);
307	sk_reuseport_prog_free(rcu_dereference_protected(reuse->prog, 1));
308	ida_free(&reuseport_ida, reuse->reuseport_id);
309	kfree(reuse);
310}
311
312/**
313 *  reuseport_add_sock - Add a socket to the reuseport group of another.
314 *  @sk:  New socket to add to the group.
315 *  @sk2: Socket belonging to the existing reuseport group.
316 *  @bind_inany: Whether or not the group is bound to a local INANY address.
317 *
318 *  May return ENOMEM and not add socket to group under memory pressure.
319 */
320int reuseport_add_sock(struct sock *sk, struct sock *sk2, bool bind_inany)
321{
322	struct sock_reuseport *old_reuse, *reuse;
323
324	if (!rcu_access_pointer(sk2->sk_reuseport_cb)) {
325		int err = reuseport_alloc(sk2, bind_inany);
326
327		if (err)
328			return err;
329	}
330
331	spin_lock_bh(&reuseport_lock);
332	reuse = rcu_dereference_protected(sk2->sk_reuseport_cb,
333					  lockdep_is_held(&reuseport_lock));
334	old_reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
335					      lockdep_is_held(&reuseport_lock));
336	if (old_reuse && old_reuse->num_closed_socks) {
337		/* sk was shutdown()ed before */
338		int err = reuseport_resurrect(sk, old_reuse, reuse, reuse->bind_inany);
339
340		spin_unlock_bh(&reuseport_lock);
341		return err;
342	}
343
344	if (old_reuse && old_reuse->num_socks != 1) {
345		spin_unlock_bh(&reuseport_lock);
346		return -EBUSY;
347	}
348
349	if (reuse->num_socks + reuse->num_closed_socks == reuse->max_socks) {
350		reuse = reuseport_grow(reuse);
351		if (!reuse) {
352			spin_unlock_bh(&reuseport_lock);
353			return -ENOMEM;
354		}
355	}
356
357	__reuseport_add_sock(sk, reuse);
 
 
 
358	rcu_assign_pointer(sk->sk_reuseport_cb, reuse);
359
360	spin_unlock_bh(&reuseport_lock);
361
362	if (old_reuse)
363		call_rcu(&old_reuse->rcu, reuseport_free_rcu);
364	return 0;
365}
366EXPORT_SYMBOL(reuseport_add_sock);
367
368static int reuseport_resurrect(struct sock *sk, struct sock_reuseport *old_reuse,
369			       struct sock_reuseport *reuse, bool bind_inany)
370{
371	if (old_reuse == reuse) {
372		/* If sk was in the same reuseport group, just pop sk out of
373		 * the closed section and push sk into the listening section.
374		 */
375		__reuseport_detach_closed_sock(sk, old_reuse);
376		__reuseport_add_sock(sk, old_reuse);
377		return 0;
378	}
379
380	if (!reuse) {
381		/* In bind()/listen() path, we cannot carry over the eBPF prog
382		 * for the shutdown()ed socket. In setsockopt() path, we should
383		 * not change the eBPF prog of listening sockets by attaching a
384		 * prog to the shutdown()ed socket. Thus, we will allocate a new
385		 * reuseport group and detach sk from the old group.
386		 */
387		int id;
388
389		reuse = __reuseport_alloc(INIT_SOCKS);
390		if (!reuse)
391			return -ENOMEM;
392
393		id = ida_alloc(&reuseport_ida, GFP_ATOMIC);
394		if (id < 0) {
395			kfree(reuse);
396			return id;
397		}
398
399		reuse->reuseport_id = id;
400		reuse->bind_inany = bind_inany;
401	} else {
402		/* Move sk from the old group to the new one if
403		 * - all the other listeners in the old group were close()d or
404		 *   shutdown()ed, and then sk2 has listen()ed on the same port
405		 * OR
406		 * - sk listen()ed without bind() (or with autobind), was
407		 *   shutdown()ed, and then listen()s on another port which
408		 *   sk2 listen()s on.
409		 */
410		if (reuse->num_socks + reuse->num_closed_socks == reuse->max_socks) {
411			reuse = reuseport_grow(reuse);
412			if (!reuse)
413				return -ENOMEM;
414		}
415	}
416
417	__reuseport_detach_closed_sock(sk, old_reuse);
418	__reuseport_add_sock(sk, reuse);
419	rcu_assign_pointer(sk->sk_reuseport_cb, reuse);
420
421	if (old_reuse->num_socks + old_reuse->num_closed_socks == 0)
422		call_rcu(&old_reuse->rcu, reuseport_free_rcu);
423
424	return 0;
425}
426
427void reuseport_detach_sock(struct sock *sk)
428{
429	struct sock_reuseport *reuse;
 
430
431	spin_lock_bh(&reuseport_lock);
432	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
433					  lockdep_is_held(&reuseport_lock));
434
435	/* reuseport_grow() has detached a closed sk */
436	if (!reuse)
437		goto out;
438
439	/* Notify the bpf side. The sk may be added to a sockarray
440	 * map. If so, sockarray logic will remove it from the map.
441	 *
442	 * Other bpf map types that work with reuseport, like sockmap,
443	 * don't need an explicit callback from here. They override sk
444	 * unhash/close ops to remove the sk from the map before we
445	 * get to this point.
446	 */
447	bpf_sk_reuseport_detach(sk);
448
449	rcu_assign_pointer(sk->sk_reuseport_cb, NULL);
450
451	if (!__reuseport_detach_closed_sock(sk, reuse))
452		__reuseport_detach_sock(sk, reuse);
453
454	if (reuse->num_socks + reuse->num_closed_socks == 0)
455		call_rcu(&reuse->rcu, reuseport_free_rcu);
456
457out:
 
 
458	spin_unlock_bh(&reuseport_lock);
459}
460EXPORT_SYMBOL(reuseport_detach_sock);
461
462void reuseport_stop_listen_sock(struct sock *sk)
463{
464	if (sk->sk_protocol == IPPROTO_TCP) {
465		struct sock_reuseport *reuse;
466		struct bpf_prog *prog;
467
468		spin_lock_bh(&reuseport_lock);
469
470		reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
471						  lockdep_is_held(&reuseport_lock));
472		prog = rcu_dereference_protected(reuse->prog,
473						 lockdep_is_held(&reuseport_lock));
474
475		if (READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_migrate_req) ||
476		    (prog && prog->expected_attach_type == BPF_SK_REUSEPORT_SELECT_OR_MIGRATE)) {
477			/* Migration capable, move sk from the listening section
478			 * to the closed section.
479			 */
480			bpf_sk_reuseport_detach(sk);
481
482			__reuseport_detach_sock(sk, reuse);
483			__reuseport_add_closed_sock(sk, reuse);
484
485			spin_unlock_bh(&reuseport_lock);
486			return;
487		}
488
489		spin_unlock_bh(&reuseport_lock);
490	}
491
492	/* Not capable to do migration, detach immediately */
493	reuseport_detach_sock(sk);
494}
495EXPORT_SYMBOL(reuseport_stop_listen_sock);
496
497static struct sock *run_bpf_filter(struct sock_reuseport *reuse, u16 socks,
498				   struct bpf_prog *prog, struct sk_buff *skb,
499				   int hdr_len)
500{
501	struct sk_buff *nskb = NULL;
502	u32 index;
503
504	if (skb_shared(skb)) {
505		nskb = skb_clone(skb, GFP_ATOMIC);
506		if (!nskb)
507			return NULL;
508		skb = nskb;
509	}
510
511	/* temporarily advance data past protocol header */
512	if (!pskb_pull(skb, hdr_len)) {
513		kfree_skb(nskb);
514		return NULL;
515	}
516	index = bpf_prog_run_save_cb(prog, skb);
517	__skb_push(skb, hdr_len);
518
519	consume_skb(nskb);
520
521	if (index >= socks)
522		return NULL;
523
524	return reuse->socks[index];
525}
526
527static struct sock *reuseport_select_sock_by_hash(struct sock_reuseport *reuse,
528						  u32 hash, u16 num_socks)
529{
530	struct sock *first_valid_sk = NULL;
531	int i, j;
532
533	i = j = reciprocal_scale(hash, num_socks);
534	do {
535		struct sock *sk = reuse->socks[i];
536
537		if (sk->sk_state != TCP_ESTABLISHED) {
538			/* Paired with WRITE_ONCE() in __reuseport_(get|put)_incoming_cpu(). */
539			if (!READ_ONCE(reuse->incoming_cpu))
540				return sk;
541
542			/* Paired with WRITE_ONCE() in reuseport_update_incoming_cpu(). */
543			if (READ_ONCE(sk->sk_incoming_cpu) == raw_smp_processor_id())
544				return sk;
545
546			if (!first_valid_sk)
547				first_valid_sk = sk;
548		}
549
550		i++;
551		if (i >= num_socks)
552			i = 0;
553	} while (i != j);
554
555	return first_valid_sk;
556}
557
558/**
559 *  reuseport_select_sock - Select a socket from an SO_REUSEPORT group.
560 *  @sk: First socket in the group.
561 *  @hash: When no BPF filter is available, use this hash to select.
562 *  @skb: skb to run through BPF filter.
563 *  @hdr_len: BPF filter expects skb data pointer at payload data.  If
564 *    the skb does not yet point at the payload, this parameter represents
565 *    how far the pointer needs to advance to reach the payload.
566 *  Returns a socket that should receive the packet (or NULL on error).
567 */
568struct sock *reuseport_select_sock(struct sock *sk,
569				   u32 hash,
570				   struct sk_buff *skb,
571				   int hdr_len)
572{
573	struct sock_reuseport *reuse;
574	struct bpf_prog *prog;
575	struct sock *sk2 = NULL;
576	u16 socks;
577
578	rcu_read_lock();
579	reuse = rcu_dereference(sk->sk_reuseport_cb);
580
581	/* if memory allocation failed or add call is not yet complete */
582	if (!reuse)
583		goto out;
584
585	prog = rcu_dereference(reuse->prog);
586	socks = READ_ONCE(reuse->num_socks);
587	if (likely(socks)) {
588		/* paired with smp_wmb() in __reuseport_add_sock() */
589		smp_rmb();
590
591		if (!prog || !skb)
592			goto select_by_hash;
593
594		if (prog->type == BPF_PROG_TYPE_SK_REUSEPORT)
595			sk2 = bpf_run_sk_reuseport(reuse, sk, prog, skb, NULL, hash);
596		else
597			sk2 = run_bpf_filter(reuse, socks, prog, skb, hdr_len);
598
599select_by_hash:
600		/* no bpf or invalid bpf result: fall back to hash usage */
601		if (!sk2)
602			sk2 = reuseport_select_sock_by_hash(reuse, hash, socks);
603	}
604
605out:
606	rcu_read_unlock();
607	return sk2;
608}
609EXPORT_SYMBOL(reuseport_select_sock);
610
611/**
612 *  reuseport_migrate_sock - Select a socket from an SO_REUSEPORT group.
613 *  @sk: close()ed or shutdown()ed socket in the group.
614 *  @migrating_sk: ESTABLISHED/SYN_RECV full socket in the accept queue or
615 *    NEW_SYN_RECV request socket during 3WHS.
616 *  @skb: skb to run through BPF filter.
617 *  Returns a socket (with sk_refcnt +1) that should accept the child socket
618 *  (or NULL on error).
619 */
620struct sock *reuseport_migrate_sock(struct sock *sk,
621				    struct sock *migrating_sk,
622				    struct sk_buff *skb)
623{
624	struct sock_reuseport *reuse;
625	struct sock *nsk = NULL;
626	bool allocated = false;
627	struct bpf_prog *prog;
628	u16 socks;
629	u32 hash;
630
631	rcu_read_lock();
632
633	reuse = rcu_dereference(sk->sk_reuseport_cb);
634	if (!reuse)
635		goto out;
636
637	socks = READ_ONCE(reuse->num_socks);
638	if (unlikely(!socks))
639		goto failure;
640
641	/* paired with smp_wmb() in __reuseport_add_sock() */
642	smp_rmb();
643
644	hash = migrating_sk->sk_hash;
645	prog = rcu_dereference(reuse->prog);
646	if (!prog || prog->expected_attach_type != BPF_SK_REUSEPORT_SELECT_OR_MIGRATE) {
647		if (READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_migrate_req))
648			goto select_by_hash;
649		goto failure;
650	}
651
652	if (!skb) {
653		skb = alloc_skb(0, GFP_ATOMIC);
654		if (!skb)
655			goto failure;
656		allocated = true;
657	}
658
659	nsk = bpf_run_sk_reuseport(reuse, sk, prog, skb, migrating_sk, hash);
660
661	if (allocated)
662		kfree_skb(skb);
663
664select_by_hash:
665	if (!nsk)
666		nsk = reuseport_select_sock_by_hash(reuse, hash, socks);
667
668	if (IS_ERR_OR_NULL(nsk) || unlikely(!refcount_inc_not_zero(&nsk->sk_refcnt))) {
669		nsk = NULL;
670		goto failure;
671	}
672
673out:
674	rcu_read_unlock();
675	return nsk;
676
677failure:
678	__NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMIGRATEREQFAILURE);
679	goto out;
680}
681EXPORT_SYMBOL(reuseport_migrate_sock);
682
683int reuseport_attach_prog(struct sock *sk, struct bpf_prog *prog)
684{
685	struct sock_reuseport *reuse;
686	struct bpf_prog *old_prog;
687
688	if (sk_unhashed(sk)) {
689		int err;
690
691		if (!sk->sk_reuseport)
692			return -EINVAL;
693
694		err = reuseport_alloc(sk, false);
695		if (err)
696			return err;
697	} else if (!rcu_access_pointer(sk->sk_reuseport_cb)) {
698		/* The socket wasn't bound with SO_REUSEPORT */
699		return -EINVAL;
700	}
701
702	spin_lock_bh(&reuseport_lock);
703	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
704					  lockdep_is_held(&reuseport_lock));
705	old_prog = rcu_dereference_protected(reuse->prog,
706					     lockdep_is_held(&reuseport_lock));
707	rcu_assign_pointer(reuse->prog, prog);
708	spin_unlock_bh(&reuseport_lock);
709
710	sk_reuseport_prog_free(old_prog);
711	return 0;
712}
713EXPORT_SYMBOL(reuseport_attach_prog);
714
715int reuseport_detach_prog(struct sock *sk)
716{
717	struct sock_reuseport *reuse;
718	struct bpf_prog *old_prog;
719
720	old_prog = NULL;
721	spin_lock_bh(&reuseport_lock);
722	reuse = rcu_dereference_protected(sk->sk_reuseport_cb,
723					  lockdep_is_held(&reuseport_lock));
724
725	/* reuse must be checked after acquiring the reuseport_lock
726	 * because reuseport_grow() can detach a closed sk.
727	 */
728	if (!reuse) {
729		spin_unlock_bh(&reuseport_lock);
730		return sk->sk_reuseport ? -ENOENT : -EINVAL;
731	}
732
733	if (sk_unhashed(sk) && reuse->num_closed_socks) {
734		spin_unlock_bh(&reuseport_lock);
735		return -ENOENT;
736	}
737
738	old_prog = rcu_replace_pointer(reuse->prog, old_prog,
739				       lockdep_is_held(&reuseport_lock));
740	spin_unlock_bh(&reuseport_lock);
741
742	if (!old_prog)
743		return -ENOENT;
744
745	sk_reuseport_prog_free(old_prog);
746	return 0;
747}
748EXPORT_SYMBOL(reuseport_detach_prog);