Revert "Bluetooth: Store advertising handle so it can be re-enabled"
[platform/kernel/linux-rpi.git] / io_uring / io-wq.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Basic worker thread pool for io_uring
4  *
5  * Copyright (C) 2019 Jens Axboe
6  *
7  */
8 #include <linux/kernel.h>
9 #include <linux/init.h>
10 #include <linux/errno.h>
11 #include <linux/sched/signal.h>
12 #include <linux/percpu.h>
13 #include <linux/slab.h>
14 #include <linux/rculist_nulls.h>
15 #include <linux/cpu.h>
16 #include <linux/task_work.h>
17 #include <linux/audit.h>
18 #include <linux/mmu_context.h>
19 #include <uapi/linux/io_uring.h>
20
21 #include "io-wq.h"
22 #include "slist.h"
23 #include "io_uring.h"
24
25 #define WORKER_IDLE_TIMEOUT     (5 * HZ)
26
27 enum {
28         IO_WORKER_F_UP          = 1,    /* up and active */
29         IO_WORKER_F_RUNNING     = 2,    /* account as running */
30         IO_WORKER_F_FREE        = 4,    /* worker on free list */
31         IO_WORKER_F_BOUND       = 8,    /* is doing bounded work */
32 };
33
34 enum {
35         IO_WQ_BIT_EXIT          = 0,    /* wq exiting */
36 };
37
38 enum {
39         IO_ACCT_STALLED_BIT     = 0,    /* stalled on hash */
40 };
41
42 /*
43  * One for each thread in a wq pool
44  */
45 struct io_worker {
46         refcount_t ref;
47         unsigned flags;
48         struct hlist_nulls_node nulls_node;
49         struct list_head all_list;
50         struct task_struct *task;
51         struct io_wq *wq;
52
53         struct io_wq_work *cur_work;
54         struct io_wq_work *next_work;
55         raw_spinlock_t lock;
56
57         struct completion ref_done;
58
59         unsigned long create_state;
60         struct callback_head create_work;
61         int create_index;
62
63         union {
64                 struct rcu_head rcu;
65                 struct work_struct work;
66         };
67 };
68
69 #if BITS_PER_LONG == 64
70 #define IO_WQ_HASH_ORDER        6
71 #else
72 #define IO_WQ_HASH_ORDER        5
73 #endif
74
75 #define IO_WQ_NR_HASH_BUCKETS   (1u << IO_WQ_HASH_ORDER)
76
77 struct io_wq_acct {
78         unsigned nr_workers;
79         unsigned max_workers;
80         int index;
81         atomic_t nr_running;
82         raw_spinlock_t lock;
83         struct io_wq_work_list work_list;
84         unsigned long flags;
85 };
86
87 enum {
88         IO_WQ_ACCT_BOUND,
89         IO_WQ_ACCT_UNBOUND,
90         IO_WQ_ACCT_NR,
91 };
92
93 /*
94  * Per io_wq state
95   */
96 struct io_wq {
97         unsigned long state;
98
99         free_work_fn *free_work;
100         io_wq_work_fn *do_work;
101
102         struct io_wq_hash *hash;
103
104         atomic_t worker_refs;
105         struct completion worker_done;
106
107         struct hlist_node cpuhp_node;
108
109         struct task_struct *task;
110
111         struct io_wq_acct acct[IO_WQ_ACCT_NR];
112
113         /* lock protects access to elements below */
114         raw_spinlock_t lock;
115
116         struct hlist_nulls_head free_list;
117         struct list_head all_list;
118
119         struct wait_queue_entry wait;
120
121         struct io_wq_work *hash_tail[IO_WQ_NR_HASH_BUCKETS];
122
123         cpumask_var_t cpu_mask;
124 };
125
126 static enum cpuhp_state io_wq_online;
127
128 struct io_cb_cancel_data {
129         work_cancel_fn *fn;
130         void *data;
131         int nr_running;
132         int nr_pending;
133         bool cancel_all;
134 };
135
136 static bool create_io_worker(struct io_wq *wq, int index);
137 static void io_wq_dec_running(struct io_worker *worker);
138 static bool io_acct_cancel_pending_work(struct io_wq *wq,
139                                         struct io_wq_acct *acct,
140                                         struct io_cb_cancel_data *match);
141 static void create_worker_cb(struct callback_head *cb);
142 static void io_wq_cancel_tw_create(struct io_wq *wq);
143
144 static bool io_worker_get(struct io_worker *worker)
145 {
146         return refcount_inc_not_zero(&worker->ref);
147 }
148
149 static void io_worker_release(struct io_worker *worker)
150 {
151         if (refcount_dec_and_test(&worker->ref))
152                 complete(&worker->ref_done);
153 }
154
155 static inline struct io_wq_acct *io_get_acct(struct io_wq *wq, bool bound)
156 {
157         return &wq->acct[bound ? IO_WQ_ACCT_BOUND : IO_WQ_ACCT_UNBOUND];
158 }
159
160 static inline struct io_wq_acct *io_work_get_acct(struct io_wq *wq,
161                                                   struct io_wq_work *work)
162 {
163         return io_get_acct(wq, !(work->flags & IO_WQ_WORK_UNBOUND));
164 }
165
166 static inline struct io_wq_acct *io_wq_get_acct(struct io_worker *worker)
167 {
168         return io_get_acct(worker->wq, worker->flags & IO_WORKER_F_BOUND);
169 }
170
171 static void io_worker_ref_put(struct io_wq *wq)
172 {
173         if (atomic_dec_and_test(&wq->worker_refs))
174                 complete(&wq->worker_done);
175 }
176
177 bool io_wq_worker_stopped(void)
178 {
179         struct io_worker *worker = current->worker_private;
180
181         if (WARN_ON_ONCE(!io_wq_current_is_worker()))
182                 return true;
183
184         return test_bit(IO_WQ_BIT_EXIT, &worker->wq->state);
185 }
186
187 static void io_worker_cancel_cb(struct io_worker *worker)
188 {
189         struct io_wq_acct *acct = io_wq_get_acct(worker);
190         struct io_wq *wq = worker->wq;
191
192         atomic_dec(&acct->nr_running);
193         raw_spin_lock(&wq->lock);
194         acct->nr_workers--;
195         raw_spin_unlock(&wq->lock);
196         io_worker_ref_put(wq);
197         clear_bit_unlock(0, &worker->create_state);
198         io_worker_release(worker);
199 }
200
201 static bool io_task_worker_match(struct callback_head *cb, void *data)
202 {
203         struct io_worker *worker;
204
205         if (cb->func != create_worker_cb)
206                 return false;
207         worker = container_of(cb, struct io_worker, create_work);
208         return worker == data;
209 }
210
211 static void io_worker_exit(struct io_worker *worker)
212 {
213         struct io_wq *wq = worker->wq;
214
215         while (1) {
216                 struct callback_head *cb = task_work_cancel_match(wq->task,
217                                                 io_task_worker_match, worker);
218
219                 if (!cb)
220                         break;
221                 io_worker_cancel_cb(worker);
222         }
223
224         io_worker_release(worker);
225         wait_for_completion(&worker->ref_done);
226
227         raw_spin_lock(&wq->lock);
228         if (worker->flags & IO_WORKER_F_FREE)
229                 hlist_nulls_del_rcu(&worker->nulls_node);
230         list_del_rcu(&worker->all_list);
231         raw_spin_unlock(&wq->lock);
232         io_wq_dec_running(worker);
233         /*
234          * this worker is a goner, clear ->worker_private to avoid any
235          * inc/dec running calls that could happen as part of exit from
236          * touching 'worker'.
237          */
238         current->worker_private = NULL;
239
240         kfree_rcu(worker, rcu);
241         io_worker_ref_put(wq);
242         do_exit(0);
243 }
244
245 static inline bool __io_acct_run_queue(struct io_wq_acct *acct)
246 {
247         return !test_bit(IO_ACCT_STALLED_BIT, &acct->flags) &&
248                 !wq_list_empty(&acct->work_list);
249 }
250
251 /*
252  * If there's work to do, returns true with acct->lock acquired. If not,
253  * returns false with no lock held.
254  */
255 static inline bool io_acct_run_queue(struct io_wq_acct *acct)
256         __acquires(&acct->lock)
257 {
258         raw_spin_lock(&acct->lock);
259         if (__io_acct_run_queue(acct))
260                 return true;
261
262         raw_spin_unlock(&acct->lock);
263         return false;
264 }
265
266 /*
267  * Check head of free list for an available worker. If one isn't available,
268  * caller must create one.
269  */
270 static bool io_wq_activate_free_worker(struct io_wq *wq,
271                                         struct io_wq_acct *acct)
272         __must_hold(RCU)
273 {
274         struct hlist_nulls_node *n;
275         struct io_worker *worker;
276
277         /*
278          * Iterate free_list and see if we can find an idle worker to
279          * activate. If a given worker is on the free_list but in the process
280          * of exiting, keep trying.
281          */
282         hlist_nulls_for_each_entry_rcu(worker, n, &wq->free_list, nulls_node) {
283                 if (!io_worker_get(worker))
284                         continue;
285                 if (io_wq_get_acct(worker) != acct) {
286                         io_worker_release(worker);
287                         continue;
288                 }
289                 /*
290                  * If the worker is already running, it's either already
291                  * starting work or finishing work. In either case, if it does
292                  * to go sleep, we'll kick off a new task for this work anyway.
293                  */
294                 wake_up_process(worker->task);
295                 io_worker_release(worker);
296                 return true;
297         }
298
299         return false;
300 }
301
302 /*
303  * We need a worker. If we find a free one, we're good. If not, and we're
304  * below the max number of workers, create one.
305  */
306 static bool io_wq_create_worker(struct io_wq *wq, struct io_wq_acct *acct)
307 {
308         /*
309          * Most likely an attempt to queue unbounded work on an io_wq that
310          * wasn't setup with any unbounded workers.
311          */
312         if (unlikely(!acct->max_workers))
313                 pr_warn_once("io-wq is not configured for unbound workers");
314
315         raw_spin_lock(&wq->lock);
316         if (acct->nr_workers >= acct->max_workers) {
317                 raw_spin_unlock(&wq->lock);
318                 return true;
319         }
320         acct->nr_workers++;
321         raw_spin_unlock(&wq->lock);
322         atomic_inc(&acct->nr_running);
323         atomic_inc(&wq->worker_refs);
324         return create_io_worker(wq, acct->index);
325 }
326
327 static void io_wq_inc_running(struct io_worker *worker)
328 {
329         struct io_wq_acct *acct = io_wq_get_acct(worker);
330
331         atomic_inc(&acct->nr_running);
332 }
333
334 static void create_worker_cb(struct callback_head *cb)
335 {
336         struct io_worker *worker;
337         struct io_wq *wq;
338
339         struct io_wq_acct *acct;
340         bool do_create = false;
341
342         worker = container_of(cb, struct io_worker, create_work);
343         wq = worker->wq;
344         acct = &wq->acct[worker->create_index];
345         raw_spin_lock(&wq->lock);
346
347         if (acct->nr_workers < acct->max_workers) {
348                 acct->nr_workers++;
349                 do_create = true;
350         }
351         raw_spin_unlock(&wq->lock);
352         if (do_create) {
353                 create_io_worker(wq, worker->create_index);
354         } else {
355                 atomic_dec(&acct->nr_running);
356                 io_worker_ref_put(wq);
357         }
358         clear_bit_unlock(0, &worker->create_state);
359         io_worker_release(worker);
360 }
361
362 static bool io_queue_worker_create(struct io_worker *worker,
363                                    struct io_wq_acct *acct,
364                                    task_work_func_t func)
365 {
366         struct io_wq *wq = worker->wq;
367
368         /* raced with exit, just ignore create call */
369         if (test_bit(IO_WQ_BIT_EXIT, &wq->state))
370                 goto fail;
371         if (!io_worker_get(worker))
372                 goto fail;
373         /*
374          * create_state manages ownership of create_work/index. We should
375          * only need one entry per worker, as the worker going to sleep
376          * will trigger the condition, and waking will clear it once it
377          * runs the task_work.
378          */
379         if (test_bit(0, &worker->create_state) ||
380             test_and_set_bit_lock(0, &worker->create_state))
381                 goto fail_release;
382
383         atomic_inc(&wq->worker_refs);
384         init_task_work(&worker->create_work, func);
385         worker->create_index = acct->index;
386         if (!task_work_add(wq->task, &worker->create_work, TWA_SIGNAL)) {
387                 /*
388                  * EXIT may have been set after checking it above, check after
389                  * adding the task_work and remove any creation item if it is
390                  * now set. wq exit does that too, but we can have added this
391                  * work item after we canceled in io_wq_exit_workers().
392                  */
393                 if (test_bit(IO_WQ_BIT_EXIT, &wq->state))
394                         io_wq_cancel_tw_create(wq);
395                 io_worker_ref_put(wq);
396                 return true;
397         }
398         io_worker_ref_put(wq);
399         clear_bit_unlock(0, &worker->create_state);
400 fail_release:
401         io_worker_release(worker);
402 fail:
403         atomic_dec(&acct->nr_running);
404         io_worker_ref_put(wq);
405         return false;
406 }
407
408 static void io_wq_dec_running(struct io_worker *worker)
409 {
410         struct io_wq_acct *acct = io_wq_get_acct(worker);
411         struct io_wq *wq = worker->wq;
412
413         if (!(worker->flags & IO_WORKER_F_UP))
414                 return;
415
416         if (!atomic_dec_and_test(&acct->nr_running))
417                 return;
418         if (!io_acct_run_queue(acct))
419                 return;
420
421         raw_spin_unlock(&acct->lock);
422         atomic_inc(&acct->nr_running);
423         atomic_inc(&wq->worker_refs);
424         io_queue_worker_create(worker, acct, create_worker_cb);
425 }
426
427 /*
428  * Worker will start processing some work. Move it to the busy list, if
429  * it's currently on the freelist
430  */
431 static void __io_worker_busy(struct io_wq *wq, struct io_worker *worker)
432 {
433         if (worker->flags & IO_WORKER_F_FREE) {
434                 worker->flags &= ~IO_WORKER_F_FREE;
435                 raw_spin_lock(&wq->lock);
436                 hlist_nulls_del_init_rcu(&worker->nulls_node);
437                 raw_spin_unlock(&wq->lock);
438         }
439 }
440
441 /*
442  * No work, worker going to sleep. Move to freelist.
443  */
444 static void __io_worker_idle(struct io_wq *wq, struct io_worker *worker)
445         __must_hold(wq->lock)
446 {
447         if (!(worker->flags & IO_WORKER_F_FREE)) {
448                 worker->flags |= IO_WORKER_F_FREE;
449                 hlist_nulls_add_head_rcu(&worker->nulls_node, &wq->free_list);
450         }
451 }
452
453 static inline unsigned int io_get_work_hash(struct io_wq_work *work)
454 {
455         return work->flags >> IO_WQ_HASH_SHIFT;
456 }
457
458 static bool io_wait_on_hash(struct io_wq *wq, unsigned int hash)
459 {
460         bool ret = false;
461
462         spin_lock_irq(&wq->hash->wait.lock);
463         if (list_empty(&wq->wait.entry)) {
464                 __add_wait_queue(&wq->hash->wait, &wq->wait);
465                 if (!test_bit(hash, &wq->hash->map)) {
466                         __set_current_state(TASK_RUNNING);
467                         list_del_init(&wq->wait.entry);
468                         ret = true;
469                 }
470         }
471         spin_unlock_irq(&wq->hash->wait.lock);
472         return ret;
473 }
474
475 static struct io_wq_work *io_get_next_work(struct io_wq_acct *acct,
476                                            struct io_worker *worker)
477         __must_hold(acct->lock)
478 {
479         struct io_wq_work_node *node, *prev;
480         struct io_wq_work *work, *tail;
481         unsigned int stall_hash = -1U;
482         struct io_wq *wq = worker->wq;
483
484         wq_list_for_each(node, prev, &acct->work_list) {
485                 unsigned int hash;
486
487                 work = container_of(node, struct io_wq_work, list);
488
489                 /* not hashed, can run anytime */
490                 if (!io_wq_is_hashed(work)) {
491                         wq_list_del(&acct->work_list, node, prev);
492                         return work;
493                 }
494
495                 hash = io_get_work_hash(work);
496                 /* all items with this hash lie in [work, tail] */
497                 tail = wq->hash_tail[hash];
498
499                 /* hashed, can run if not already running */
500                 if (!test_and_set_bit(hash, &wq->hash->map)) {
501                         wq->hash_tail[hash] = NULL;
502                         wq_list_cut(&acct->work_list, &tail->list, prev);
503                         return work;
504                 }
505                 if (stall_hash == -1U)
506                         stall_hash = hash;
507                 /* fast forward to a next hash, for-each will fix up @prev */
508                 node = &tail->list;
509         }
510
511         if (stall_hash != -1U) {
512                 bool unstalled;
513
514                 /*
515                  * Set this before dropping the lock to avoid racing with new
516                  * work being added and clearing the stalled bit.
517                  */
518                 set_bit(IO_ACCT_STALLED_BIT, &acct->flags);
519                 raw_spin_unlock(&acct->lock);
520                 unstalled = io_wait_on_hash(wq, stall_hash);
521                 raw_spin_lock(&acct->lock);
522                 if (unstalled) {
523                         clear_bit(IO_ACCT_STALLED_BIT, &acct->flags);
524                         if (wq_has_sleeper(&wq->hash->wait))
525                                 wake_up(&wq->hash->wait);
526                 }
527         }
528
529         return NULL;
530 }
531
532 static void io_assign_current_work(struct io_worker *worker,
533                                    struct io_wq_work *work)
534 {
535         if (work) {
536                 io_run_task_work();
537                 cond_resched();
538         }
539
540         raw_spin_lock(&worker->lock);
541         worker->cur_work = work;
542         worker->next_work = NULL;
543         raw_spin_unlock(&worker->lock);
544 }
545
546 /*
547  * Called with acct->lock held, drops it before returning
548  */
549 static void io_worker_handle_work(struct io_wq_acct *acct,
550                                   struct io_worker *worker)
551         __releases(&acct->lock)
552 {
553         struct io_wq *wq = worker->wq;
554         bool do_kill = test_bit(IO_WQ_BIT_EXIT, &wq->state);
555
556         do {
557                 struct io_wq_work *work;
558
559                 /*
560                  * If we got some work, mark us as busy. If we didn't, but
561                  * the list isn't empty, it means we stalled on hashed work.
562                  * Mark us stalled so we don't keep looking for work when we
563                  * can't make progress, any work completion or insertion will
564                  * clear the stalled flag.
565                  */
566                 work = io_get_next_work(acct, worker);
567                 raw_spin_unlock(&acct->lock);
568                 if (work) {
569                         __io_worker_busy(wq, worker);
570
571                         /*
572                          * Make sure cancelation can find this, even before
573                          * it becomes the active work. That avoids a window
574                          * where the work has been removed from our general
575                          * work list, but isn't yet discoverable as the
576                          * current work item for this worker.
577                          */
578                         raw_spin_lock(&worker->lock);
579                         worker->next_work = work;
580                         raw_spin_unlock(&worker->lock);
581                 } else {
582                         break;
583                 }
584                 io_assign_current_work(worker, work);
585                 __set_current_state(TASK_RUNNING);
586
587                 /* handle a whole dependent link */
588                 do {
589                         struct io_wq_work *next_hashed, *linked;
590                         unsigned int hash = io_get_work_hash(work);
591
592                         next_hashed = wq_next_work(work);
593
594                         if (unlikely(do_kill) && (work->flags & IO_WQ_WORK_UNBOUND))
595                                 work->flags |= IO_WQ_WORK_CANCEL;
596                         wq->do_work(work);
597                         io_assign_current_work(worker, NULL);
598
599                         linked = wq->free_work(work);
600                         work = next_hashed;
601                         if (!work && linked && !io_wq_is_hashed(linked)) {
602                                 work = linked;
603                                 linked = NULL;
604                         }
605                         io_assign_current_work(worker, work);
606                         if (linked)
607                                 io_wq_enqueue(wq, linked);
608
609                         if (hash != -1U && !next_hashed) {
610                                 /* serialize hash clear with wake_up() */
611                                 spin_lock_irq(&wq->hash->wait.lock);
612                                 clear_bit(hash, &wq->hash->map);
613                                 clear_bit(IO_ACCT_STALLED_BIT, &acct->flags);
614                                 spin_unlock_irq(&wq->hash->wait.lock);
615                                 if (wq_has_sleeper(&wq->hash->wait))
616                                         wake_up(&wq->hash->wait);
617                         }
618                 } while (work);
619
620                 if (!__io_acct_run_queue(acct))
621                         break;
622                 raw_spin_lock(&acct->lock);
623         } while (1);
624 }
625
626 static int io_wq_worker(void *data)
627 {
628         struct io_worker *worker = data;
629         struct io_wq_acct *acct = io_wq_get_acct(worker);
630         struct io_wq *wq = worker->wq;
631         bool exit_mask = false, last_timeout = false;
632         char buf[TASK_COMM_LEN];
633
634         worker->flags |= (IO_WORKER_F_UP | IO_WORKER_F_RUNNING);
635
636         snprintf(buf, sizeof(buf), "iou-wrk-%d", wq->task->pid);
637         set_task_comm(current, buf);
638
639         while (!test_bit(IO_WQ_BIT_EXIT, &wq->state)) {
640                 long ret;
641
642                 set_current_state(TASK_INTERRUPTIBLE);
643
644                 /*
645                  * If we have work to do, io_acct_run_queue() returns with
646                  * the acct->lock held. If not, it will drop it.
647                  */
648                 while (io_acct_run_queue(acct))
649                         io_worker_handle_work(acct, worker);
650
651                 raw_spin_lock(&wq->lock);
652                 /*
653                  * Last sleep timed out. Exit if we're not the last worker,
654                  * or if someone modified our affinity.
655                  */
656                 if (last_timeout && (exit_mask || acct->nr_workers > 1)) {
657                         acct->nr_workers--;
658                         raw_spin_unlock(&wq->lock);
659                         __set_current_state(TASK_RUNNING);
660                         break;
661                 }
662                 last_timeout = false;
663                 __io_worker_idle(wq, worker);
664                 raw_spin_unlock(&wq->lock);
665                 if (io_run_task_work())
666                         continue;
667                 ret = schedule_timeout(WORKER_IDLE_TIMEOUT);
668                 if (signal_pending(current)) {
669                         struct ksignal ksig;
670
671                         if (!get_signal(&ksig))
672                                 continue;
673                         break;
674                 }
675                 if (!ret) {
676                         last_timeout = true;
677                         exit_mask = !cpumask_test_cpu(raw_smp_processor_id(),
678                                                         wq->cpu_mask);
679                 }
680         }
681
682         if (test_bit(IO_WQ_BIT_EXIT, &wq->state) && io_acct_run_queue(acct))
683                 io_worker_handle_work(acct, worker);
684
685         io_worker_exit(worker);
686         return 0;
687 }
688
689 /*
690  * Called when a worker is scheduled in. Mark us as currently running.
691  */
692 void io_wq_worker_running(struct task_struct *tsk)
693 {
694         struct io_worker *worker = tsk->worker_private;
695
696         if (!worker)
697                 return;
698         if (!(worker->flags & IO_WORKER_F_UP))
699                 return;
700         if (worker->flags & IO_WORKER_F_RUNNING)
701                 return;
702         worker->flags |= IO_WORKER_F_RUNNING;
703         io_wq_inc_running(worker);
704 }
705
706 /*
707  * Called when worker is going to sleep. If there are no workers currently
708  * running and we have work pending, wake up a free one or create a new one.
709  */
710 void io_wq_worker_sleeping(struct task_struct *tsk)
711 {
712         struct io_worker *worker = tsk->worker_private;
713
714         if (!worker)
715                 return;
716         if (!(worker->flags & IO_WORKER_F_UP))
717                 return;
718         if (!(worker->flags & IO_WORKER_F_RUNNING))
719                 return;
720
721         worker->flags &= ~IO_WORKER_F_RUNNING;
722         io_wq_dec_running(worker);
723 }
724
725 static void io_init_new_worker(struct io_wq *wq, struct io_worker *worker,
726                                struct task_struct *tsk)
727 {
728         tsk->worker_private = worker;
729         worker->task = tsk;
730         set_cpus_allowed_ptr(tsk, wq->cpu_mask);
731
732         raw_spin_lock(&wq->lock);
733         hlist_nulls_add_head_rcu(&worker->nulls_node, &wq->free_list);
734         list_add_tail_rcu(&worker->all_list, &wq->all_list);
735         worker->flags |= IO_WORKER_F_FREE;
736         raw_spin_unlock(&wq->lock);
737         wake_up_new_task(tsk);
738 }
739
740 static bool io_wq_work_match_all(struct io_wq_work *work, void *data)
741 {
742         return true;
743 }
744
745 static inline bool io_should_retry_thread(long err)
746 {
747         /*
748          * Prevent perpetual task_work retry, if the task (or its group) is
749          * exiting.
750          */
751         if (fatal_signal_pending(current))
752                 return false;
753
754         switch (err) {
755         case -EAGAIN:
756         case -ERESTARTSYS:
757         case -ERESTARTNOINTR:
758         case -ERESTARTNOHAND:
759                 return true;
760         default:
761                 return false;
762         }
763 }
764
765 static void create_worker_cont(struct callback_head *cb)
766 {
767         struct io_worker *worker;
768         struct task_struct *tsk;
769         struct io_wq *wq;
770
771         worker = container_of(cb, struct io_worker, create_work);
772         clear_bit_unlock(0, &worker->create_state);
773         wq = worker->wq;
774         tsk = create_io_thread(io_wq_worker, worker, NUMA_NO_NODE);
775         if (!IS_ERR(tsk)) {
776                 io_init_new_worker(wq, worker, tsk);
777                 io_worker_release(worker);
778                 return;
779         } else if (!io_should_retry_thread(PTR_ERR(tsk))) {
780                 struct io_wq_acct *acct = io_wq_get_acct(worker);
781
782                 atomic_dec(&acct->nr_running);
783                 raw_spin_lock(&wq->lock);
784                 acct->nr_workers--;
785                 if (!acct->nr_workers) {
786                         struct io_cb_cancel_data match = {
787                                 .fn             = io_wq_work_match_all,
788                                 .cancel_all     = true,
789                         };
790
791                         raw_spin_unlock(&wq->lock);
792                         while (io_acct_cancel_pending_work(wq, acct, &match))
793                                 ;
794                 } else {
795                         raw_spin_unlock(&wq->lock);
796                 }
797                 io_worker_ref_put(wq);
798                 kfree(worker);
799                 return;
800         }
801
802         /* re-create attempts grab a new worker ref, drop the existing one */
803         io_worker_release(worker);
804         schedule_work(&worker->work);
805 }
806
807 static void io_workqueue_create(struct work_struct *work)
808 {
809         struct io_worker *worker = container_of(work, struct io_worker, work);
810         struct io_wq_acct *acct = io_wq_get_acct(worker);
811
812         if (!io_queue_worker_create(worker, acct, create_worker_cont))
813                 kfree(worker);
814 }
815
816 static bool create_io_worker(struct io_wq *wq, int index)
817 {
818         struct io_wq_acct *acct = &wq->acct[index];
819         struct io_worker *worker;
820         struct task_struct *tsk;
821
822         __set_current_state(TASK_RUNNING);
823
824         worker = kzalloc(sizeof(*worker), GFP_KERNEL);
825         if (!worker) {
826 fail:
827                 atomic_dec(&acct->nr_running);
828                 raw_spin_lock(&wq->lock);
829                 acct->nr_workers--;
830                 raw_spin_unlock(&wq->lock);
831                 io_worker_ref_put(wq);
832                 return false;
833         }
834
835         refcount_set(&worker->ref, 1);
836         worker->wq = wq;
837         raw_spin_lock_init(&worker->lock);
838         init_completion(&worker->ref_done);
839
840         if (index == IO_WQ_ACCT_BOUND)
841                 worker->flags |= IO_WORKER_F_BOUND;
842
843         tsk = create_io_thread(io_wq_worker, worker, NUMA_NO_NODE);
844         if (!IS_ERR(tsk)) {
845                 io_init_new_worker(wq, worker, tsk);
846         } else if (!io_should_retry_thread(PTR_ERR(tsk))) {
847                 kfree(worker);
848                 goto fail;
849         } else {
850                 INIT_WORK(&worker->work, io_workqueue_create);
851                 schedule_work(&worker->work);
852         }
853
854         return true;
855 }
856
857 /*
858  * Iterate the passed in list and call the specific function for each
859  * worker that isn't exiting
860  */
861 static bool io_wq_for_each_worker(struct io_wq *wq,
862                                   bool (*func)(struct io_worker *, void *),
863                                   void *data)
864 {
865         struct io_worker *worker;
866         bool ret = false;
867
868         list_for_each_entry_rcu(worker, &wq->all_list, all_list) {
869                 if (io_worker_get(worker)) {
870                         /* no task if node is/was offline */
871                         if (worker->task)
872                                 ret = func(worker, data);
873                         io_worker_release(worker);
874                         if (ret)
875                                 break;
876                 }
877         }
878
879         return ret;
880 }
881
882 static bool io_wq_worker_wake(struct io_worker *worker, void *data)
883 {
884         __set_notify_signal(worker->task);
885         wake_up_process(worker->task);
886         return false;
887 }
888
889 static void io_run_cancel(struct io_wq_work *work, struct io_wq *wq)
890 {
891         do {
892                 work->flags |= IO_WQ_WORK_CANCEL;
893                 wq->do_work(work);
894                 work = wq->free_work(work);
895         } while (work);
896 }
897
898 static void io_wq_insert_work(struct io_wq *wq, struct io_wq_work *work)
899 {
900         struct io_wq_acct *acct = io_work_get_acct(wq, work);
901         unsigned int hash;
902         struct io_wq_work *tail;
903
904         if (!io_wq_is_hashed(work)) {
905 append:
906                 wq_list_add_tail(&work->list, &acct->work_list);
907                 return;
908         }
909
910         hash = io_get_work_hash(work);
911         tail = wq->hash_tail[hash];
912         wq->hash_tail[hash] = work;
913         if (!tail)
914                 goto append;
915
916         wq_list_add_after(&work->list, &tail->list, &acct->work_list);
917 }
918
919 static bool io_wq_work_match_item(struct io_wq_work *work, void *data)
920 {
921         return work == data;
922 }
923
924 void io_wq_enqueue(struct io_wq *wq, struct io_wq_work *work)
925 {
926         struct io_wq_acct *acct = io_work_get_acct(wq, work);
927         struct io_cb_cancel_data match;
928         unsigned work_flags = work->flags;
929         bool do_create;
930
931         /*
932          * If io-wq is exiting for this task, or if the request has explicitly
933          * been marked as one that should not get executed, cancel it here.
934          */
935         if (test_bit(IO_WQ_BIT_EXIT, &wq->state) ||
936             (work->flags & IO_WQ_WORK_CANCEL)) {
937                 io_run_cancel(work, wq);
938                 return;
939         }
940
941         raw_spin_lock(&acct->lock);
942         io_wq_insert_work(wq, work);
943         clear_bit(IO_ACCT_STALLED_BIT, &acct->flags);
944         raw_spin_unlock(&acct->lock);
945
946         rcu_read_lock();
947         do_create = !io_wq_activate_free_worker(wq, acct);
948         rcu_read_unlock();
949
950         if (do_create && ((work_flags & IO_WQ_WORK_CONCURRENT) ||
951             !atomic_read(&acct->nr_running))) {
952                 bool did_create;
953
954                 did_create = io_wq_create_worker(wq, acct);
955                 if (likely(did_create))
956                         return;
957
958                 raw_spin_lock(&wq->lock);
959                 if (acct->nr_workers) {
960                         raw_spin_unlock(&wq->lock);
961                         return;
962                 }
963                 raw_spin_unlock(&wq->lock);
964
965                 /* fatal condition, failed to create the first worker */
966                 match.fn                = io_wq_work_match_item,
967                 match.data              = work,
968                 match.cancel_all        = false,
969
970                 io_acct_cancel_pending_work(wq, acct, &match);
971         }
972 }
973
974 /*
975  * Work items that hash to the same value will not be done in parallel.
976  * Used to limit concurrent writes, generally hashed by inode.
977  */
978 void io_wq_hash_work(struct io_wq_work *work, void *val)
979 {
980         unsigned int bit;
981
982         bit = hash_ptr(val, IO_WQ_HASH_ORDER);
983         work->flags |= (IO_WQ_WORK_HASHED | (bit << IO_WQ_HASH_SHIFT));
984 }
985
986 static bool __io_wq_worker_cancel(struct io_worker *worker,
987                                   struct io_cb_cancel_data *match,
988                                   struct io_wq_work *work)
989 {
990         if (work && match->fn(work, match->data)) {
991                 work->flags |= IO_WQ_WORK_CANCEL;
992                 __set_notify_signal(worker->task);
993                 return true;
994         }
995
996         return false;
997 }
998
999 static bool io_wq_worker_cancel(struct io_worker *worker, void *data)
1000 {
1001         struct io_cb_cancel_data *match = data;
1002
1003         /*
1004          * Hold the lock to avoid ->cur_work going out of scope, caller
1005          * may dereference the passed in work.
1006          */
1007         raw_spin_lock(&worker->lock);
1008         if (__io_wq_worker_cancel(worker, match, worker->cur_work) ||
1009             __io_wq_worker_cancel(worker, match, worker->next_work))
1010                 match->nr_running++;
1011         raw_spin_unlock(&worker->lock);
1012
1013         return match->nr_running && !match->cancel_all;
1014 }
1015
1016 static inline void io_wq_remove_pending(struct io_wq *wq,
1017                                          struct io_wq_work *work,
1018                                          struct io_wq_work_node *prev)
1019 {
1020         struct io_wq_acct *acct = io_work_get_acct(wq, work);
1021         unsigned int hash = io_get_work_hash(work);
1022         struct io_wq_work *prev_work = NULL;
1023
1024         if (io_wq_is_hashed(work) && work == wq->hash_tail[hash]) {
1025                 if (prev)
1026                         prev_work = container_of(prev, struct io_wq_work, list);
1027                 if (prev_work && io_get_work_hash(prev_work) == hash)
1028                         wq->hash_tail[hash] = prev_work;
1029                 else
1030                         wq->hash_tail[hash] = NULL;
1031         }
1032         wq_list_del(&acct->work_list, &work->list, prev);
1033 }
1034
1035 static bool io_acct_cancel_pending_work(struct io_wq *wq,
1036                                         struct io_wq_acct *acct,
1037                                         struct io_cb_cancel_data *match)
1038 {
1039         struct io_wq_work_node *node, *prev;
1040         struct io_wq_work *work;
1041
1042         raw_spin_lock(&acct->lock);
1043         wq_list_for_each(node, prev, &acct->work_list) {
1044                 work = container_of(node, struct io_wq_work, list);
1045                 if (!match->fn(work, match->data))
1046                         continue;
1047                 io_wq_remove_pending(wq, work, prev);
1048                 raw_spin_unlock(&acct->lock);
1049                 io_run_cancel(work, wq);
1050                 match->nr_pending++;
1051                 /* not safe to continue after unlock */
1052                 return true;
1053         }
1054         raw_spin_unlock(&acct->lock);
1055
1056         return false;
1057 }
1058
1059 static void io_wq_cancel_pending_work(struct io_wq *wq,
1060                                       struct io_cb_cancel_data *match)
1061 {
1062         int i;
1063 retry:
1064         for (i = 0; i < IO_WQ_ACCT_NR; i++) {
1065                 struct io_wq_acct *acct = io_get_acct(wq, i == 0);
1066
1067                 if (io_acct_cancel_pending_work(wq, acct, match)) {
1068                         if (match->cancel_all)
1069                                 goto retry;
1070                         break;
1071                 }
1072         }
1073 }
1074
1075 static void io_wq_cancel_running_work(struct io_wq *wq,
1076                                        struct io_cb_cancel_data *match)
1077 {
1078         rcu_read_lock();
1079         io_wq_for_each_worker(wq, io_wq_worker_cancel, match);
1080         rcu_read_unlock();
1081 }
1082
1083 enum io_wq_cancel io_wq_cancel_cb(struct io_wq *wq, work_cancel_fn *cancel,
1084                                   void *data, bool cancel_all)
1085 {
1086         struct io_cb_cancel_data match = {
1087                 .fn             = cancel,
1088                 .data           = data,
1089                 .cancel_all     = cancel_all,
1090         };
1091
1092         /*
1093          * First check pending list, if we're lucky we can just remove it
1094          * from there. CANCEL_OK means that the work is returned as-new,
1095          * no completion will be posted for it.
1096          *
1097          * Then check if a free (going busy) or busy worker has the work
1098          * currently running. If we find it there, we'll return CANCEL_RUNNING
1099          * as an indication that we attempt to signal cancellation. The
1100          * completion will run normally in this case.
1101          *
1102          * Do both of these while holding the wq->lock, to ensure that
1103          * we'll find a work item regardless of state.
1104          */
1105         io_wq_cancel_pending_work(wq, &match);
1106         if (match.nr_pending && !match.cancel_all)
1107                 return IO_WQ_CANCEL_OK;
1108
1109         raw_spin_lock(&wq->lock);
1110         io_wq_cancel_running_work(wq, &match);
1111         raw_spin_unlock(&wq->lock);
1112         if (match.nr_running && !match.cancel_all)
1113                 return IO_WQ_CANCEL_RUNNING;
1114
1115         if (match.nr_running)
1116                 return IO_WQ_CANCEL_RUNNING;
1117         if (match.nr_pending)
1118                 return IO_WQ_CANCEL_OK;
1119         return IO_WQ_CANCEL_NOTFOUND;
1120 }
1121
1122 static int io_wq_hash_wake(struct wait_queue_entry *wait, unsigned mode,
1123                             int sync, void *key)
1124 {
1125         struct io_wq *wq = container_of(wait, struct io_wq, wait);
1126         int i;
1127
1128         list_del_init(&wait->entry);
1129
1130         rcu_read_lock();
1131         for (i = 0; i < IO_WQ_ACCT_NR; i++) {
1132                 struct io_wq_acct *acct = &wq->acct[i];
1133
1134                 if (test_and_clear_bit(IO_ACCT_STALLED_BIT, &acct->flags))
1135                         io_wq_activate_free_worker(wq, acct);
1136         }
1137         rcu_read_unlock();
1138         return 1;
1139 }
1140
1141 struct io_wq *io_wq_create(unsigned bounded, struct io_wq_data *data)
1142 {
1143         int ret, i;
1144         struct io_wq *wq;
1145
1146         if (WARN_ON_ONCE(!data->free_work || !data->do_work))
1147                 return ERR_PTR(-EINVAL);
1148         if (WARN_ON_ONCE(!bounded))
1149                 return ERR_PTR(-EINVAL);
1150
1151         wq = kzalloc(sizeof(struct io_wq), GFP_KERNEL);
1152         if (!wq)
1153                 return ERR_PTR(-ENOMEM);
1154
1155         refcount_inc(&data->hash->refs);
1156         wq->hash = data->hash;
1157         wq->free_work = data->free_work;
1158         wq->do_work = data->do_work;
1159
1160         ret = -ENOMEM;
1161
1162         if (!alloc_cpumask_var(&wq->cpu_mask, GFP_KERNEL))
1163                 goto err;
1164         cpumask_copy(wq->cpu_mask, cpu_possible_mask);
1165         wq->acct[IO_WQ_ACCT_BOUND].max_workers = bounded;
1166         wq->acct[IO_WQ_ACCT_UNBOUND].max_workers =
1167                                 task_rlimit(current, RLIMIT_NPROC);
1168         INIT_LIST_HEAD(&wq->wait.entry);
1169         wq->wait.func = io_wq_hash_wake;
1170         for (i = 0; i < IO_WQ_ACCT_NR; i++) {
1171                 struct io_wq_acct *acct = &wq->acct[i];
1172
1173                 acct->index = i;
1174                 atomic_set(&acct->nr_running, 0);
1175                 INIT_WQ_LIST(&acct->work_list);
1176                 raw_spin_lock_init(&acct->lock);
1177         }
1178
1179         raw_spin_lock_init(&wq->lock);
1180         INIT_HLIST_NULLS_HEAD(&wq->free_list, 0);
1181         INIT_LIST_HEAD(&wq->all_list);
1182
1183         wq->task = get_task_struct(data->task);
1184         atomic_set(&wq->worker_refs, 1);
1185         init_completion(&wq->worker_done);
1186         ret = cpuhp_state_add_instance_nocalls(io_wq_online, &wq->cpuhp_node);
1187         if (ret)
1188                 goto err;
1189
1190         return wq;
1191 err:
1192         io_wq_put_hash(data->hash);
1193         free_cpumask_var(wq->cpu_mask);
1194         kfree(wq);
1195         return ERR_PTR(ret);
1196 }
1197
1198 static bool io_task_work_match(struct callback_head *cb, void *data)
1199 {
1200         struct io_worker *worker;
1201
1202         if (cb->func != create_worker_cb && cb->func != create_worker_cont)
1203                 return false;
1204         worker = container_of(cb, struct io_worker, create_work);
1205         return worker->wq == data;
1206 }
1207
1208 void io_wq_exit_start(struct io_wq *wq)
1209 {
1210         set_bit(IO_WQ_BIT_EXIT, &wq->state);
1211 }
1212
1213 static void io_wq_cancel_tw_create(struct io_wq *wq)
1214 {
1215         struct callback_head *cb;
1216
1217         while ((cb = task_work_cancel_match(wq->task, io_task_work_match, wq)) != NULL) {
1218                 struct io_worker *worker;
1219
1220                 worker = container_of(cb, struct io_worker, create_work);
1221                 io_worker_cancel_cb(worker);
1222                 /*
1223                  * Only the worker continuation helper has worker allocated and
1224                  * hence needs freeing.
1225                  */
1226                 if (cb->func == create_worker_cont)
1227                         kfree(worker);
1228         }
1229 }
1230
1231 static void io_wq_exit_workers(struct io_wq *wq)
1232 {
1233         if (!wq->task)
1234                 return;
1235
1236         io_wq_cancel_tw_create(wq);
1237
1238         rcu_read_lock();
1239         io_wq_for_each_worker(wq, io_wq_worker_wake, NULL);
1240         rcu_read_unlock();
1241         io_worker_ref_put(wq);
1242         wait_for_completion(&wq->worker_done);
1243
1244         spin_lock_irq(&wq->hash->wait.lock);
1245         list_del_init(&wq->wait.entry);
1246         spin_unlock_irq(&wq->hash->wait.lock);
1247
1248         put_task_struct(wq->task);
1249         wq->task = NULL;
1250 }
1251
1252 static void io_wq_destroy(struct io_wq *wq)
1253 {
1254         struct io_cb_cancel_data match = {
1255                 .fn             = io_wq_work_match_all,
1256                 .cancel_all     = true,
1257         };
1258
1259         cpuhp_state_remove_instance_nocalls(io_wq_online, &wq->cpuhp_node);
1260         io_wq_cancel_pending_work(wq, &match);
1261         free_cpumask_var(wq->cpu_mask);
1262         io_wq_put_hash(wq->hash);
1263         kfree(wq);
1264 }
1265
1266 void io_wq_put_and_exit(struct io_wq *wq)
1267 {
1268         WARN_ON_ONCE(!test_bit(IO_WQ_BIT_EXIT, &wq->state));
1269
1270         io_wq_exit_workers(wq);
1271         io_wq_destroy(wq);
1272 }
1273
1274 struct online_data {
1275         unsigned int cpu;
1276         bool online;
1277 };
1278
1279 static bool io_wq_worker_affinity(struct io_worker *worker, void *data)
1280 {
1281         struct online_data *od = data;
1282
1283         if (od->online)
1284                 cpumask_set_cpu(od->cpu, worker->wq->cpu_mask);
1285         else
1286                 cpumask_clear_cpu(od->cpu, worker->wq->cpu_mask);
1287         return false;
1288 }
1289
1290 static int __io_wq_cpu_online(struct io_wq *wq, unsigned int cpu, bool online)
1291 {
1292         struct online_data od = {
1293                 .cpu = cpu,
1294                 .online = online
1295         };
1296
1297         rcu_read_lock();
1298         io_wq_for_each_worker(wq, io_wq_worker_affinity, &od);
1299         rcu_read_unlock();
1300         return 0;
1301 }
1302
1303 static int io_wq_cpu_online(unsigned int cpu, struct hlist_node *node)
1304 {
1305         struct io_wq *wq = hlist_entry_safe(node, struct io_wq, cpuhp_node);
1306
1307         return __io_wq_cpu_online(wq, cpu, true);
1308 }
1309
1310 static int io_wq_cpu_offline(unsigned int cpu, struct hlist_node *node)
1311 {
1312         struct io_wq *wq = hlist_entry_safe(node, struct io_wq, cpuhp_node);
1313
1314         return __io_wq_cpu_online(wq, cpu, false);
1315 }
1316
1317 int io_wq_cpu_affinity(struct io_uring_task *tctx, cpumask_var_t mask)
1318 {
1319         if (!tctx || !tctx->io_wq)
1320                 return -EINVAL;
1321
1322         rcu_read_lock();
1323         if (mask)
1324                 cpumask_copy(tctx->io_wq->cpu_mask, mask);
1325         else
1326                 cpumask_copy(tctx->io_wq->cpu_mask, cpu_possible_mask);
1327         rcu_read_unlock();
1328
1329         return 0;
1330 }
1331
1332 /*
1333  * Set max number of unbounded workers, returns old value. If new_count is 0,
1334  * then just return the old value.
1335  */
1336 int io_wq_max_workers(struct io_wq *wq, int *new_count)
1337 {
1338         struct io_wq_acct *acct;
1339         int prev[IO_WQ_ACCT_NR];
1340         int i;
1341
1342         BUILD_BUG_ON((int) IO_WQ_ACCT_BOUND   != (int) IO_WQ_BOUND);
1343         BUILD_BUG_ON((int) IO_WQ_ACCT_UNBOUND != (int) IO_WQ_UNBOUND);
1344         BUILD_BUG_ON((int) IO_WQ_ACCT_NR      != 2);
1345
1346         for (i = 0; i < IO_WQ_ACCT_NR; i++) {
1347                 if (new_count[i] > task_rlimit(current, RLIMIT_NPROC))
1348                         new_count[i] = task_rlimit(current, RLIMIT_NPROC);
1349         }
1350
1351         for (i = 0; i < IO_WQ_ACCT_NR; i++)
1352                 prev[i] = 0;
1353
1354         rcu_read_lock();
1355
1356         raw_spin_lock(&wq->lock);
1357         for (i = 0; i < IO_WQ_ACCT_NR; i++) {
1358                 acct = &wq->acct[i];
1359                 prev[i] = max_t(int, acct->max_workers, prev[i]);
1360                 if (new_count[i])
1361                         acct->max_workers = new_count[i];
1362         }
1363         raw_spin_unlock(&wq->lock);
1364         rcu_read_unlock();
1365
1366         for (i = 0; i < IO_WQ_ACCT_NR; i++)
1367                 new_count[i] = prev[i];
1368
1369         return 0;
1370 }
1371
1372 static __init int io_wq_init(void)
1373 {
1374         int ret;
1375
1376         ret = cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, "io-wq/online",
1377                                         io_wq_cpu_online, io_wq_cpu_offline);
1378         if (ret < 0)
1379                 return ret;
1380         io_wq_online = ret;
1381         return 0;
1382 }
1383 subsys_initcall(io_wq_init);