io-wq.c 26.8 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
// SPDX-License-Identifier: GPL-2.0
/*
 * Basic worker thread pool for io_uring
 *
 * Copyright (C) 2019 Jens Axboe
 *
 */
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/sched/signal.h>
#include <linux/mm.h>
#include <linux/sched/mm.h>
#include <linux/percpu.h>
#include <linux/slab.h>
#include <linux/kthread.h>
#include <linux/rculist_nulls.h>
18
#include <linux/fs_struct.h>
19
#include <linux/task_work.h>
20 21 22 23 24 25 26 27 28 29 30

#include "io-wq.h"

#define WORKER_IDLE_TIMEOUT	(5 * HZ)

enum {
	IO_WORKER_F_UP		= 1,	/* up and active */
	IO_WORKER_F_RUNNING	= 2,	/* account as running */
	IO_WORKER_F_FREE	= 4,	/* worker on free list */
	IO_WORKER_F_EXITING	= 8,	/* worker exiting */
	IO_WORKER_F_FIXED	= 16,	/* static idle worker */
31
	IO_WORKER_F_BOUND	= 32,	/* is doing bounded work */
32 33 34 35 36
};

enum {
	IO_WQ_BIT_EXIT		= 0,	/* wq exiting */
	IO_WQ_BIT_CANCEL	= 1,	/* cancel work on list */
37
	IO_WQ_BIT_ERROR		= 2,	/* error on setup */
38 39 40 41 42 43 44 45 46 47 48 49 50
};

enum {
	IO_WQE_FLAG_STALLED	= 1,	/* stalled on hash */
};

/*
 * One for each thread in a wqe pool
 */
struct io_worker {
	refcount_t ref;
	unsigned flags;
	struct hlist_nulls_node nulls_node;
51
	struct list_head all_list;
52 53
	struct task_struct *task;
	struct io_wqe *wqe;
54

55
	struct io_wq_work *cur_work;
56
	spinlock_t lock;
57 58 59

	struct rcu_head rcu;
	struct mm_struct *mm;
60 61
	const struct cred *cur_creds;
	const struct cred *saved_creds;
62
	struct files_struct *restore_files;
63
	struct fs_struct *restore_fs;
64 65 66 67 68 69 70 71
};

#if BITS_PER_LONG == 64
#define IO_WQ_HASH_ORDER	6
#else
#define IO_WQ_HASH_ORDER	5
#endif

72 73
#define IO_WQ_NR_HASH_BUCKETS	(1u << IO_WQ_HASH_ORDER)

74 75 76 77 78 79 80 81 82 83 84
struct io_wqe_acct {
	unsigned nr_workers;
	unsigned max_workers;
	atomic_t nr_running;
};

enum {
	IO_WQ_ACCT_BOUND,
	IO_WQ_ACCT_UNBOUND,
};

85 86 87 88 89 90
/*
 * Per-node worker thread pool
 */
struct io_wqe {
	struct {
		spinlock_t lock;
J
Jens Axboe 已提交
91
		struct io_wq_work_list work_list;
92 93 94 95 96
		unsigned long hash_map;
		unsigned flags;
	} ____cacheline_aligned_in_smp;

	int node;
97
	struct io_wqe_acct acct[2];
98

99
	struct hlist_nulls_head free_list;
100
	struct list_head all_list;
101 102

	struct io_wq *wq;
103
	struct io_wq_work *hash_tail[IO_WQ_NR_HASH_BUCKETS];
104 105 106 107 108 109 110 111 112
};

/*
 * Per io_wq state
  */
struct io_wq {
	struct io_wqe **wqes;
	unsigned long state;

113
	free_work_fn *free_work;
114

115
	struct task_struct *manager;
116
	struct user_struct *user;
117 118
	refcount_t refs;
	struct completion done;
J
Jens Axboe 已提交
119 120

	refcount_t use_refs;
121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140
};

static bool io_worker_get(struct io_worker *worker)
{
	return refcount_inc_not_zero(&worker->ref);
}

static void io_worker_release(struct io_worker *worker)
{
	if (refcount_dec_and_test(&worker->ref))
		wake_up_process(worker->task);
}

/*
 * Note: drops the wqe->lock if returning true! The caller must re-acquire
 * the lock in that case. Some callers need to restart handling if this
 * happens, so we can't just re-acquire the lock on behalf of the caller.
 */
static bool __io_worker_unuse(struct io_wqe *wqe, struct io_worker *worker)
{
141 142
	bool dropped_lock = false;

143 144 145
	if (worker->saved_creds) {
		revert_creds(worker->saved_creds);
		worker->cur_creds = worker->saved_creds = NULL;
146 147
	}

148 149 150 151 152 153 154 155 156 157
	if (current->files != worker->restore_files) {
		__acquire(&wqe->lock);
		spin_unlock_irq(&wqe->lock);
		dropped_lock = true;

		task_lock(current);
		current->files = worker->restore_files;
		task_unlock(current);
	}

158 159 160
	if (current->fs != worker->restore_fs)
		current->fs = worker->restore_fs;

161 162 163 164 165
	/*
	 * If we have an active mm, we need to drop the wq lock before unusing
	 * it. If we do, return true and let the caller retry the idle loop.
	 */
	if (worker->mm) {
166 167 168 169 170
		if (!dropped_lock) {
			__acquire(&wqe->lock);
			spin_unlock_irq(&wqe->lock);
			dropped_lock = true;
		}
171
		__set_current_state(TASK_RUNNING);
172
		kthread_unuse_mm(worker->mm);
173 174 175 176
		mmput(worker->mm);
		worker->mm = NULL;
	}

177
	return dropped_lock;
178 179
}

180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197
static inline struct io_wqe_acct *io_work_get_acct(struct io_wqe *wqe,
						   struct io_wq_work *work)
{
	if (work->flags & IO_WQ_WORK_UNBOUND)
		return &wqe->acct[IO_WQ_ACCT_UNBOUND];

	return &wqe->acct[IO_WQ_ACCT_BOUND];
}

static inline struct io_wqe_acct *io_wqe_get_acct(struct io_wqe *wqe,
						  struct io_worker *worker)
{
	if (worker->flags & IO_WORKER_F_BOUND)
		return &wqe->acct[IO_WQ_ACCT_BOUND];

	return &wqe->acct[IO_WQ_ACCT_UNBOUND];
}

198 199 200
static void io_worker_exit(struct io_worker *worker)
{
	struct io_wqe *wqe = worker->wqe;
201 202
	struct io_wqe_acct *acct = io_wqe_get_acct(wqe, worker);
	unsigned nr_workers;
203 204 205 206 207 208 209 210 211 212 213 214 215

	/*
	 * If we're not at zero, someone else is holding a brief reference
	 * to the worker. Wait for that to go away.
	 */
	set_current_state(TASK_INTERRUPTIBLE);
	if (!refcount_dec_and_test(&worker->ref))
		schedule();
	__set_current_state(TASK_RUNNING);

	preempt_disable();
	current->flags &= ~PF_IO_WORKER;
	if (worker->flags & IO_WORKER_F_RUNNING)
216 217 218
		atomic_dec(&acct->nr_running);
	if (!(worker->flags & IO_WORKER_F_BOUND))
		atomic_dec(&wqe->wq->user->processes);
219 220 221 222 223
	worker->flags = 0;
	preempt_enable();

	spin_lock_irq(&wqe->lock);
	hlist_nulls_del_rcu(&worker->nulls_node);
224
	list_del_rcu(&worker->all_list);
225 226 227 228
	if (__io_worker_unuse(wqe, worker)) {
		__release(&wqe->lock);
		spin_lock_irq(&wqe->lock);
	}
229 230 231
	acct->nr_workers--;
	nr_workers = wqe->acct[IO_WQ_ACCT_BOUND].nr_workers +
			wqe->acct[IO_WQ_ACCT_UNBOUND].nr_workers;
232 233 234
	spin_unlock_irq(&wqe->lock);

	/* all workers gone, wq exit can proceed */
235
	if (!nr_workers && refcount_dec_and_test(&wqe->wq->refs))
236 237
		complete(&wqe->wq->done);

238
	kfree_rcu(worker, rcu);
239 240
}

241 242 243
static inline bool io_wqe_run_queue(struct io_wqe *wqe)
	__must_hold(wqe->lock)
{
J
Jens Axboe 已提交
244 245
	if (!wq_list_empty(&wqe->work_list) &&
	    !(wqe->flags & IO_WQE_FLAG_STALLED))
246 247 248 249 250 251 252 253 254 255 256 257 258 259
		return true;
	return false;
}

/*
 * Check head of free list for an available worker. If one isn't available,
 * caller must wake up the wq manager to create one.
 */
static bool io_wqe_activate_free_worker(struct io_wqe *wqe)
	__must_hold(RCU)
{
	struct hlist_nulls_node *n;
	struct io_worker *worker;

260
	n = rcu_dereference(hlist_nulls_first_rcu(&wqe->free_list));
261 262 263 264 265
	if (is_a_nulls(n))
		return false;

	worker = hlist_nulls_entry(n, struct io_worker, nulls_node);
	if (io_worker_get(worker)) {
J
Jens Axboe 已提交
266
		wake_up_process(worker->task);
267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311
		io_worker_release(worker);
		return true;
	}

	return false;
}

/*
 * We need a worker. If we find a free one, we're good. If not, and we're
 * below the max number of workers, wake up the manager to create one.
 */
static void io_wqe_wake_worker(struct io_wqe *wqe, struct io_wqe_acct *acct)
{
	bool ret;

	/*
	 * Most likely an attempt to queue unbounded work on an io_wq that
	 * wasn't setup with any unbounded workers.
	 */
	WARN_ON_ONCE(!acct->max_workers);

	rcu_read_lock();
	ret = io_wqe_activate_free_worker(wqe);
	rcu_read_unlock();

	if (!ret && acct->nr_workers < acct->max_workers)
		wake_up_process(wqe->wq->manager);
}

static void io_wqe_inc_running(struct io_wqe *wqe, struct io_worker *worker)
{
	struct io_wqe_acct *acct = io_wqe_get_acct(wqe, worker);

	atomic_inc(&acct->nr_running);
}

static void io_wqe_dec_running(struct io_wqe *wqe, struct io_worker *worker)
	__must_hold(wqe->lock)
{
	struct io_wqe_acct *acct = io_wqe_get_acct(wqe, worker);

	if (atomic_dec_and_test(&acct->nr_running) && io_wqe_run_queue(wqe))
		io_wqe_wake_worker(wqe, acct);
}

312 313 314 315 316 317 318
static void io_worker_start(struct io_wqe *wqe, struct io_worker *worker)
{
	allow_kernel_signal(SIGINT);

	current->flags |= PF_IO_WORKER;

	worker->flags |= (IO_WORKER_F_UP | IO_WORKER_F_RUNNING);
319
	worker->restore_files = current->files;
320
	worker->restore_fs = current->fs;
321
	io_wqe_inc_running(wqe, worker);
322 323 324 325 326 327 328 329 330 331
}

/*
 * Worker will start processing some work. Move it to the busy list, if
 * it's currently on the freelist
 */
static void __io_worker_busy(struct io_wqe *wqe, struct io_worker *worker,
			     struct io_wq_work *work)
	__must_hold(wqe->lock)
{
332 333
	bool worker_bound, work_bound;

334 335 336 337
	if (worker->flags & IO_WORKER_F_FREE) {
		worker->flags &= ~IO_WORKER_F_FREE;
		hlist_nulls_del_init_rcu(&worker->nulls_node);
	}
338 339 340 341 342

	/*
	 * If worker is moving from bound to unbound (or vice versa), then
	 * ensure we update the running accounting.
	 */
343 344 345
	worker_bound = (worker->flags & IO_WORKER_F_BOUND) != 0;
	work_bound = (work->flags & IO_WQ_WORK_UNBOUND) == 0;
	if (worker_bound != work_bound) {
346 347 348 349 350 351 352 353 354 355 356 357 358 359
		io_wqe_dec_running(wqe, worker);
		if (work_bound) {
			worker->flags |= IO_WORKER_F_BOUND;
			wqe->acct[IO_WQ_ACCT_UNBOUND].nr_workers--;
			wqe->acct[IO_WQ_ACCT_BOUND].nr_workers++;
			atomic_dec(&wqe->wq->user->processes);
		} else {
			worker->flags &= ~IO_WORKER_F_BOUND;
			wqe->acct[IO_WQ_ACCT_UNBOUND].nr_workers++;
			wqe->acct[IO_WQ_ACCT_BOUND].nr_workers--;
			atomic_inc(&wqe->wq->user->processes);
		}
		io_wqe_inc_running(wqe, worker);
	 }
360 361 362 363 364 365 366 367 368 369 370 371 372 373
}

/*
 * No work, worker going to sleep. Move to freelist, and unuse mm if we
 * have one attached. Dropping the mm may potentially sleep, so we drop
 * the lock in that case and return success. Since the caller has to
 * retry the loop in that case (we changed task state), we don't regrab
 * the lock if we return success.
 */
static bool __io_worker_idle(struct io_wqe *wqe, struct io_worker *worker)
	__must_hold(wqe->lock)
{
	if (!(worker->flags & IO_WORKER_F_FREE)) {
		worker->flags |= IO_WORKER_F_FREE;
374
		hlist_nulls_add_head_rcu(&worker->nulls_node, &wqe->free_list);
375 376 377 378 379
	}

	return __io_worker_unuse(wqe, worker);
}

P
Pavel Begunkov 已提交
380 381 382 383 384 385
static inline unsigned int io_get_work_hash(struct io_wq_work *work)
{
	return work->flags >> IO_WQ_HASH_SHIFT;
}

static struct io_wq_work *io_get_next_work(struct io_wqe *wqe)
386 387
	__must_hold(wqe->lock)
{
J
Jens Axboe 已提交
388
	struct io_wq_work_node *node, *prev;
389
	struct io_wq_work *work, *tail;
P
Pavel Begunkov 已提交
390
	unsigned int hash;
391

J
Jens Axboe 已提交
392 393 394
	wq_list_for_each(node, prev, &wqe->work_list) {
		work = container_of(node, struct io_wq_work, list);

395
		/* not hashed, can run anytime */
396
		if (!io_wq_is_hashed(work)) {
397
			wq_list_del(&wqe->work_list, node, prev);
398 399 400 401
			return work;
		}

		/* hashed, can run if not already running */
P
Pavel Begunkov 已提交
402 403 404
		hash = io_get_work_hash(work);
		if (!(wqe->hash_map & BIT(hash))) {
			wqe->hash_map |= BIT(hash);
405 406 407 408
			/* all items with this hash lie in [work, tail] */
			tail = wqe->hash_tail[hash];
			wqe->hash_tail[hash] = NULL;
			wq_list_cut(&wqe->work_list, &tail->list, prev);
409 410 411 412 413 414 415
			return work;
		}
	}

	return NULL;
}

416 417 418
static void io_wq_switch_mm(struct io_worker *worker, struct io_wq_work *work)
{
	if (worker->mm) {
419
		kthread_unuse_mm(worker->mm);
420 421 422
		mmput(worker->mm);
		worker->mm = NULL;
	}
423
	if (!work->mm)
424
		return;
425

426
	if (mmget_not_zero(work->mm)) {
427
		kthread_use_mm(work->mm);
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
		worker->mm = work->mm;
		/* hang on to this mm */
		work->mm = NULL;
		return;
	}

	/* failed grabbing mm, ensure work gets cancelled */
	work->flags |= IO_WQ_WORK_CANCEL;
}

static void io_wq_switch_creds(struct io_worker *worker,
			       struct io_wq_work *work)
{
	const struct cred *old_creds = override_creds(work->creds);

	worker->cur_creds = work->creds;
	if (worker->saved_creds)
		put_cred(old_creds); /* creds set by previous switch */
	else
		worker->saved_creds = old_creds;
}

450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468
static void io_impersonate_work(struct io_worker *worker,
				struct io_wq_work *work)
{
	if (work->files && current->files != work->files) {
		task_lock(current);
		current->files = work->files;
		task_unlock(current);
	}
	if (work->fs && current->fs != work->fs)
		current->fs = work->fs;
	if (work->mm != worker->mm)
		io_wq_switch_mm(worker, work);
	if (worker->cur_creds != work->creds)
		io_wq_switch_creds(worker, work);
}

static void io_assign_current_work(struct io_worker *worker,
				   struct io_wq_work *work)
{
469 470 471 472 473 474
	if (work) {
		/* flush pending signals before assigning new work */
		if (signal_pending(current))
			flush_signals(current);
		cond_resched();
	}
475 476 477 478 479 480

	spin_lock_irq(&worker->lock);
	worker->cur_work = work;
	spin_unlock_irq(&worker->lock);
}

P
Pavel Begunkov 已提交
481 482
static void io_wqe_enqueue(struct io_wqe *wqe, struct io_wq_work *work);

483 484 485 486 487 488 489
static void io_worker_handle_work(struct io_worker *worker)
	__releases(wqe->lock)
{
	struct io_wqe *wqe = worker->wqe;
	struct io_wq *wq = wqe->wq;

	do {
490
		struct io_wq_work *work;
P
Pavel Begunkov 已提交
491
		unsigned int hash;
492
get_next:
493 494 495 496 497 498 499
		/*
		 * If we got some work, mark us as busy. If we didn't, but
		 * the list isn't empty, it means we stalled on hashed work.
		 * Mark us stalled so we don't keep looking for work when we
		 * can't make progress, any work completion or insertion will
		 * clear the stalled flag.
		 */
P
Pavel Begunkov 已提交
500
		work = io_get_next_work(wqe);
501 502
		if (work)
			__io_worker_busy(wqe, worker, work);
J
Jens Axboe 已提交
503
		else if (!wq_list_empty(&wqe->work_list))
504 505 506 507 508
			wqe->flags |= IO_WQE_FLAG_STALLED;

		spin_unlock_irq(&wqe->lock);
		if (!work)
			break;
509
		io_assign_current_work(worker, work);
510

511 512
		/* handle a whole dependent link */
		do {
513
			struct io_wq_work *old_work, *next_hashed, *linked;
514

515
			next_hashed = wq_next_work(work);
516
			io_impersonate_work(worker, work);
517 518 519 520 521 522 523
			/*
			 * OK to set IO_WQ_WORK_CANCEL even for uncancellable
			 * work, the worker function will do the right thing.
			 */
			if (test_bit(IO_WQ_BIT_CANCEL, &wq->state))
				work->flags |= IO_WQ_WORK_CANCEL;

P
Pavel Begunkov 已提交
524
			hash = io_get_work_hash(work);
525 526 527 528 529 530 531 532 533 534
			linked = old_work = work;
			linked->func(&linked);
			linked = (old_work == linked) ? NULL : linked;

			work = next_hashed;
			if (!work && linked && !io_wq_is_hashed(linked)) {
				work = linked;
				linked = NULL;
			}
			io_assign_current_work(worker, work);
535
			wq->free_work(old_work);
536

537 538 539 540
			if (linked)
				io_wqe_enqueue(wqe, linked);

			if (hash != -1U && !next_hashed) {
541 542 543 544 545
				spin_lock_irq(&wqe->lock);
				wqe->hash_map &= ~BIT_ULL(hash);
				wqe->flags &= ~IO_WQE_FLAG_STALLED;
				/* dependent work is not hashed */
				hash = -1U;
546 547 548 549
				/* skip unnecessary unlock-lock wqe->lock */
				if (!work)
					goto get_next;
				spin_unlock_irq(&wqe->lock);
550
			}
551
		} while (work);
552

553
		spin_lock_irq(&wqe->lock);
554 555 556 557 558 559 560 561 562 563 564 565
	} while (1);
}

static int io_wqe_worker(void *data)
{
	struct io_worker *worker = data;
	struct io_wqe *wqe = worker->wqe;
	struct io_wq *wq = wqe->wq;

	io_worker_start(wqe, worker);

	while (!test_bit(IO_WQ_BIT_EXIT, &wq->state)) {
J
Jens Axboe 已提交
566
		set_current_state(TASK_INTERRUPTIBLE);
567
loop:
568 569 570 571
		spin_lock_irq(&wqe->lock);
		if (io_wqe_run_queue(wqe)) {
			__set_current_state(TASK_RUNNING);
			io_worker_handle_work(worker);
572
			goto loop;
573 574 575 576
		}
		/* drops the lock on success, retry */
		if (__io_worker_idle(wqe, worker)) {
			__release(&wqe->lock);
577
			goto loop;
578 579 580 581 582 583 584 585 586 587 588 589 590 591
		}
		spin_unlock_irq(&wqe->lock);
		if (signal_pending(current))
			flush_signals(current);
		if (schedule_timeout(WORKER_IDLE_TIMEOUT))
			continue;
		/* timed out, exit unless we're the fixed worker */
		if (test_bit(IO_WQ_BIT_EXIT, &wq->state) ||
		    !(worker->flags & IO_WORKER_F_FIXED))
			break;
	}

	if (test_bit(IO_WQ_BIT_EXIT, &wq->state)) {
		spin_lock_irq(&wqe->lock);
J
Jens Axboe 已提交
592
		if (!wq_list_empty(&wqe->work_list))
593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614
			io_worker_handle_work(worker);
		else
			spin_unlock_irq(&wqe->lock);
	}

	io_worker_exit(worker);
	return 0;
}

/*
 * Called when a worker is scheduled in. Mark us as currently running.
 */
void io_wq_worker_running(struct task_struct *tsk)
{
	struct io_worker *worker = kthread_data(tsk);
	struct io_wqe *wqe = worker->wqe;

	if (!(worker->flags & IO_WORKER_F_UP))
		return;
	if (worker->flags & IO_WORKER_F_RUNNING)
		return;
	worker->flags |= IO_WORKER_F_RUNNING;
615
	io_wqe_inc_running(wqe, worker);
616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635
}

/*
 * Called when worker is going to sleep. If there are no workers currently
 * running and we have work pending, wake up a free one or have the manager
 * set one up.
 */
void io_wq_worker_sleeping(struct task_struct *tsk)
{
	struct io_worker *worker = kthread_data(tsk);
	struct io_wqe *wqe = worker->wqe;

	if (!(worker->flags & IO_WORKER_F_UP))
		return;
	if (!(worker->flags & IO_WORKER_F_RUNNING))
		return;

	worker->flags &= ~IO_WORKER_F_RUNNING;

	spin_lock_irq(&wqe->lock);
636
	io_wqe_dec_running(wqe, worker);
637 638 639
	spin_unlock_irq(&wqe->lock);
}

640
static bool create_io_worker(struct io_wq *wq, struct io_wqe *wqe, int index)
641
{
642
	struct io_wqe_acct *acct =&wqe->acct[index];
643 644
	struct io_worker *worker;

645
	worker = kzalloc_node(sizeof(*worker), GFP_KERNEL, wqe->node);
646
	if (!worker)
647
		return false;
648 649 650 651

	refcount_set(&worker->ref, 1);
	worker->nulls_node.pprev = NULL;
	worker->wqe = wqe;
652
	spin_lock_init(&worker->lock);
653 654

	worker->task = kthread_create_on_node(io_wqe_worker, worker, wqe->node,
655
				"io_wqe_worker-%d/%d", index, wqe->node);
656 657
	if (IS_ERR(worker->task)) {
		kfree(worker);
658
		return false;
659 660 661
	}

	spin_lock_irq(&wqe->lock);
662
	hlist_nulls_add_head_rcu(&worker->nulls_node, &wqe->free_list);
663
	list_add_tail_rcu(&worker->all_list, &wqe->all_list);
664
	worker->flags |= IO_WORKER_F_FREE;
665 666 667
	if (index == IO_WQ_ACCT_BOUND)
		worker->flags |= IO_WORKER_F_BOUND;
	if (!acct->nr_workers && (worker->flags & IO_WORKER_F_BOUND))
668
		worker->flags |= IO_WORKER_F_FIXED;
669
	acct->nr_workers++;
670 671
	spin_unlock_irq(&wqe->lock);

672 673 674
	if (index == IO_WQ_ACCT_UNBOUND)
		atomic_inc(&wq->user->processes);

675
	wake_up_process(worker->task);
676
	return true;
677 678
}

679
static inline bool io_wqe_need_worker(struct io_wqe *wqe, int index)
680 681
	__must_hold(wqe->lock)
{
682
	struct io_wqe_acct *acct = &wqe->acct[index];
683

684
	/* if we have available workers or no work, no need */
685
	if (!hlist_nulls_empty(&wqe->free_list) || !io_wqe_run_queue(wqe))
686 687
		return false;
	return acct->nr_workers < acct->max_workers;
688 689 690 691 692 693 694 695
}

/*
 * Manager thread. Tasked with creating new workers, if we need them.
 */
static int io_wq_manager(void *data)
{
	struct io_wq *wq = data;
J
Jann Horn 已提交
696 697
	int workers_to_create = num_possible_nodes();
	int node;
698

699
	/* create fixed workers */
J
Jann Horn 已提交
700 701
	refcount_set(&wq->refs, workers_to_create);
	for_each_node(node) {
702 703
		if (!node_online(node))
			continue;
J
Jann Horn 已提交
704 705 706
		if (!create_io_worker(wq, wq->wqes[node], IO_WQ_ACCT_BOUND))
			goto err;
		workers_to_create--;
707
	}
708

709 710 711
	while (workers_to_create--)
		refcount_dec(&wq->refs);

712 713 714
	complete(&wq->done);

	while (!kthread_should_stop()) {
715 716 717
		if (current->task_works)
			task_work_run();

J
Jann Horn 已提交
718 719
		for_each_node(node) {
			struct io_wqe *wqe = wq->wqes[node];
720
			bool fork_worker[2] = { false, false };
721

722 723 724
			if (!node_online(node))
				continue;

725
			spin_lock_irq(&wqe->lock);
726 727 728 729
			if (io_wqe_need_worker(wqe, IO_WQ_ACCT_BOUND))
				fork_worker[IO_WQ_ACCT_BOUND] = true;
			if (io_wqe_need_worker(wqe, IO_WQ_ACCT_UNBOUND))
				fork_worker[IO_WQ_ACCT_UNBOUND] = true;
730
			spin_unlock_irq(&wqe->lock);
731 732 733 734
			if (fork_worker[IO_WQ_ACCT_BOUND])
				create_io_worker(wq, wqe, IO_WQ_ACCT_BOUND);
			if (fork_worker[IO_WQ_ACCT_UNBOUND])
				create_io_worker(wq, wqe, IO_WQ_ACCT_UNBOUND);
735 736 737 738 739
		}
		set_current_state(TASK_INTERRUPTIBLE);
		schedule_timeout(HZ);
	}

740 741 742
	if (current->task_works)
		task_work_run();

743
	return 0;
744 745 746
err:
	set_bit(IO_WQ_BIT_ERROR, &wq->state);
	set_bit(IO_WQ_BIT_EXIT, &wq->state);
J
Jann Horn 已提交
747
	if (refcount_sub_and_test(workers_to_create, &wq->refs))
748 749
		complete(&wq->done);
	return 0;
750 751
}

752 753 754 755 756 757 758 759 760 761 762
static bool io_wq_can_queue(struct io_wqe *wqe, struct io_wqe_acct *acct,
			    struct io_wq_work *work)
{
	bool free_worker;

	if (!(work->flags & IO_WQ_WORK_UNBOUND))
		return true;
	if (atomic_read(&acct->nr_running))
		return true;

	rcu_read_lock();
763
	free_worker = !hlist_nulls_empty(&wqe->free_list);
764 765 766 767 768 769 770 771 772 773 774
	rcu_read_unlock();
	if (free_worker)
		return true;

	if (atomic_read(&wqe->wq->user->processes) >= acct->max_workers &&
	    !(capable(CAP_SYS_RESOURCE) || capable(CAP_SYS_ADMIN)))
		return false;

	return true;
}

775
static void io_run_cancel(struct io_wq_work *work, struct io_wqe *wqe)
776
{
777 778
	struct io_wq *wq = wqe->wq;

779 780 781 782 783 784
	do {
		struct io_wq_work *old_work = work;

		work->flags |= IO_WQ_WORK_CANCEL;
		work->func(&work);
		work = (work == old_work) ? NULL : work;
785
		wq->free_work(old_work);
786 787 788
	} while (work);
}

789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808
static void io_wqe_insert_work(struct io_wqe *wqe, struct io_wq_work *work)
{
	unsigned int hash;
	struct io_wq_work *tail;

	if (!io_wq_is_hashed(work)) {
append:
		wq_list_add_tail(&work->list, &wqe->work_list);
		return;
	}

	hash = io_get_work_hash(work);
	tail = wqe->hash_tail[hash];
	wqe->hash_tail[hash] = work;
	if (!tail)
		goto append;

	wq_list_add_after(&work->list, &tail->list, &wqe->work_list);
}

809 810
static void io_wqe_enqueue(struct io_wqe *wqe, struct io_wq_work *work)
{
811
	struct io_wqe_acct *acct = io_work_get_acct(wqe, work);
812
	int work_flags;
813 814
	unsigned long flags;

815 816 817 818 819 820 821
	/*
	 * Do early check to see if we need a new unbound worker, and if we do,
	 * if we're allowed to do so. This isn't 100% accurate as there's a
	 * gap between this check and incrementing the value, but that's OK.
	 * It's close enough to not be an issue, fork() has the same delay.
	 */
	if (unlikely(!io_wq_can_queue(wqe, acct, work))) {
822
		io_run_cancel(work, wqe);
823 824 825
		return;
	}

826
	work_flags = work->flags;
827
	spin_lock_irqsave(&wqe->lock, flags);
828
	io_wqe_insert_work(wqe, work);
829 830 831
	wqe->flags &= ~IO_WQE_FLAG_STALLED;
	spin_unlock_irqrestore(&wqe->lock, flags);

832 833
	if ((work_flags & IO_WQ_WORK_CONCURRENT) ||
	    !atomic_read(&acct->nr_running))
834
		io_wqe_wake_worker(wqe, acct);
835 836 837 838 839 840 841 842 843 844
}

void io_wq_enqueue(struct io_wq *wq, struct io_wq_work *work)
{
	struct io_wqe *wqe = wq->wqes[numa_node_id()];

	io_wqe_enqueue(wqe, work);
}

/*
845 846
 * Work items that hash to the same value will not be done in parallel.
 * Used to limit concurrent writes, generally hashed by inode.
847
 */
848
void io_wq_hash_work(struct io_wq_work *work, void *val)
849
{
850
	unsigned int bit;
851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872

	bit = hash_ptr(val, IO_WQ_HASH_ORDER);
	work->flags |= (IO_WQ_WORK_HASHED | (bit << IO_WQ_HASH_SHIFT));
}

static bool io_wqe_worker_send_sig(struct io_worker *worker, void *data)
{
	send_sig(SIGINT, worker->task, 1);
	return false;
}

/*
 * Iterate the passed in list and call the specific function for each
 * worker that isn't exiting
 */
static bool io_wq_for_each_worker(struct io_wqe *wqe,
				  bool (*func)(struct io_worker *, void *),
				  void *data)
{
	struct io_worker *worker;
	bool ret = false;

873
	list_for_each_entry_rcu(worker, &wqe->all_list, all_list) {
874
		if (io_worker_get(worker)) {
875 876 877
			/* no task if node is/was offline */
			if (worker->task)
				ret = func(worker, data);
878 879 880 881 882
			io_worker_release(worker);
			if (ret)
				break;
		}
	}
883

884 885 886 887 888
	return ret;
}

void io_wq_cancel_all(struct io_wq *wq)
{
J
Jann Horn 已提交
889
	int node;
890 891 892 893

	set_bit(IO_WQ_BIT_CANCEL, &wq->state);

	rcu_read_lock();
J
Jann Horn 已提交
894 895
	for_each_node(node) {
		struct io_wqe *wqe = wq->wqes[node];
896

897
		io_wq_for_each_worker(wqe, io_wqe_worker_send_sig, NULL);
898 899 900 901
	}
	rcu_read_unlock();
}

902
struct io_cb_cancel_data {
903 904
	work_cancel_fn *fn;
	void *data;
905 906
};

907
static bool io_wq_worker_cancel(struct io_worker *worker, void *data)
908
{
909
	struct io_cb_cancel_data *match = data;
910
	unsigned long flags;
911 912 913 914
	bool ret = false;

	/*
	 * Hold the lock to avoid ->cur_work going out of scope, caller
915
	 * may dereference the passed in work.
916
	 */
917
	spin_lock_irqsave(&worker->lock, flags);
918
	if (worker->cur_work &&
919
	    !(worker->cur_work->flags & IO_WQ_WORK_NO_CANCEL) &&
920
	    match->fn(worker->cur_work, match->data)) {
921
		send_sig(SIGINT, worker->task, 1);
922
		ret = true;
923
	}
924
	spin_unlock_irqrestore(&worker->lock, flags);
925

926
	return ret;
927 928 929
}

static enum io_wq_cancel io_wqe_cancel_work(struct io_wqe *wqe,
930
					    struct io_cb_cancel_data *match)
931
{
J
Jens Axboe 已提交
932
	struct io_wq_work_node *node, *prev;
933
	struct io_wq_work *work;
934
	unsigned long flags;
935 936 937 938 939 940 941
	bool found = false;

	/*
	 * First check pending list, if we're lucky we can just remove it
	 * from there. CANCEL_OK means that the work is returned as-new,
	 * no completion will be posted for it.
	 */
942
	spin_lock_irqsave(&wqe->lock, flags);
J
Jens Axboe 已提交
943 944 945
	wq_list_for_each(node, prev, &wqe->work_list) {
		work = container_of(node, struct io_wq_work, list);

946
		if (match->fn(work, match->data)) {
947
			wq_list_del(&wqe->work_list, node, prev);
948 949 950 951
			found = true;
			break;
		}
	}
952
	spin_unlock_irqrestore(&wqe->lock, flags);
953 954

	if (found) {
955
		io_run_cancel(work, wqe);
956 957 958 959 960 961
		return IO_WQ_CANCEL_OK;
	}

	/*
	 * Now check if a free (going busy) or busy worker has the work
	 * currently running. If we find it there, we'll return CANCEL_RUNNING
962
	 * as an indication that we attempt to signal cancellation. The
963 964 965
	 * completion will run normally in this case.
	 */
	rcu_read_lock();
966
	found = io_wq_for_each_worker(wqe, io_wq_worker_cancel, match);
967 968 969 970
	rcu_read_unlock();
	return found ? IO_WQ_CANCEL_RUNNING : IO_WQ_CANCEL_NOTFOUND;
}

971 972
enum io_wq_cancel io_wq_cancel_cb(struct io_wq *wq, work_cancel_fn *cancel,
				  void *data)
973
{
974 975 976
	struct io_cb_cancel_data match = {
		.fn	= cancel,
		.data	= data,
977
	};
978
	enum io_wq_cancel ret = IO_WQ_CANCEL_NOTFOUND;
J
Jann Horn 已提交
979
	int node;
980

J
Jann Horn 已提交
981 982
	for_each_node(node) {
		struct io_wqe *wqe = wq->wqes[node];
983

984
		ret = io_wqe_cancel_work(wqe, &match);
985 986 987 988 989 990 991
		if (ret != IO_WQ_CANCEL_NOTFOUND)
			break;
	}

	return ret;
}

992 993 994 995 996 997 998 999 1000 1001
static bool io_wq_io_cb_cancel_data(struct io_wq_work *work, void *data)
{
	return work == data;
}

enum io_wq_cancel io_wq_cancel_work(struct io_wq *wq, struct io_wq_work *cwork)
{
	return io_wq_cancel_cb(wq, io_wq_io_cb_cancel_data, (void *)cwork);
}

1002 1003 1004 1005
static bool io_wq_pid_match(struct io_wq_work *work, void *data)
{
	pid_t pid = (pid_t) (unsigned long) data;

1006
	return work->task_pid == pid;
1007 1008 1009 1010
}

enum io_wq_cancel io_wq_cancel_pid(struct io_wq *wq, pid_t pid)
{
1011
	void *data = (void *) (unsigned long) pid;
1012

1013
	return io_wq_cancel_cb(wq, io_wq_pid_match, data);
1014 1015
}

1016
struct io_wq *io_wq_create(unsigned bounded, struct io_wq_data *data)
1017
{
J
Jann Horn 已提交
1018
	int ret = -ENOMEM, node;
1019 1020
	struct io_wq *wq;

1021 1022 1023
	if (WARN_ON_ONCE(!data->free_work))
		return ERR_PTR(-EINVAL);

1024
	wq = kzalloc(sizeof(*wq), GFP_KERNEL);
1025 1026 1027
	if (!wq)
		return ERR_PTR(-ENOMEM);

J
Jann Horn 已提交
1028
	wq->wqes = kcalloc(nr_node_ids, sizeof(struct io_wqe *), GFP_KERNEL);
1029 1030 1031 1032 1033
	if (!wq->wqes) {
		kfree(wq);
		return ERR_PTR(-ENOMEM);
	}

1034
	wq->free_work = data->free_work;
1035

1036
	/* caller must already hold a reference to this */
1037
	wq->user = data->user;
1038

J
Jann Horn 已提交
1039
	for_each_node(node) {
1040
		struct io_wqe *wqe;
1041
		int alloc_node = node;
1042

1043 1044 1045
		if (!node_online(alloc_node))
			alloc_node = NUMA_NO_NODE;
		wqe = kzalloc_node(sizeof(struct io_wqe), GFP_KERNEL, alloc_node);
1046
		if (!wqe)
J
Jann Horn 已提交
1047 1048
			goto err;
		wq->wqes[node] = wqe;
1049
		wqe->node = alloc_node;
1050 1051
		wqe->acct[IO_WQ_ACCT_BOUND].max_workers = bounded;
		atomic_set(&wqe->acct[IO_WQ_ACCT_BOUND].nr_running, 0);
1052
		if (wq->user) {
1053 1054 1055 1056
			wqe->acct[IO_WQ_ACCT_UNBOUND].max_workers =
					task_rlimit(current, RLIMIT_NPROC);
		}
		atomic_set(&wqe->acct[IO_WQ_ACCT_UNBOUND].nr_running, 0);
1057 1058
		wqe->wq = wq;
		spin_lock_init(&wqe->lock);
J
Jens Axboe 已提交
1059
		INIT_WQ_LIST(&wqe->work_list);
1060
		INIT_HLIST_NULLS_HEAD(&wqe->free_list, 0);
1061
		INIT_LIST_HEAD(&wqe->all_list);
1062 1063 1064 1065 1066 1067 1068
	}

	init_completion(&wq->done);

	wq->manager = kthread_create(io_wq_manager, wq, "io_wq_manager");
	if (!IS_ERR(wq->manager)) {
		wake_up_process(wq->manager);
1069 1070 1071 1072 1073
		wait_for_completion(&wq->done);
		if (test_bit(IO_WQ_BIT_ERROR, &wq->state)) {
			ret = -ENOMEM;
			goto err;
		}
J
Jens Axboe 已提交
1074
		refcount_set(&wq->use_refs, 1);
1075
		reinit_completion(&wq->done);
1076 1077 1078 1079 1080
		return wq;
	}

	ret = PTR_ERR(wq->manager);
	complete(&wq->done);
1081
err:
J
Jann Horn 已提交
1082 1083
	for_each_node(node)
		kfree(wq->wqes[node]);
1084 1085
	kfree(wq->wqes);
	kfree(wq);
1086 1087 1088
	return ERR_PTR(ret);
}

1089 1090
bool io_wq_get(struct io_wq *wq, struct io_wq_data *data)
{
1091
	if (data->free_work != wq->free_work)
1092 1093 1094 1095 1096
		return false;

	return refcount_inc_not_zero(&wq->use_refs);
}

1097 1098 1099 1100 1101 1102
static bool io_wq_worker_wake(struct io_worker *worker, void *data)
{
	wake_up_process(worker->task);
	return false;
}

J
Jens Axboe 已提交
1103
static void __io_wq_destroy(struct io_wq *wq)
1104
{
J
Jann Horn 已提交
1105
	int node;
1106

1107 1108
	set_bit(IO_WQ_BIT_EXIT, &wq->state);
	if (wq->manager)
1109 1110 1111
		kthread_stop(wq->manager);

	rcu_read_lock();
J
Jann Horn 已提交
1112 1113
	for_each_node(node)
		io_wq_for_each_worker(wq->wqes[node], io_wq_worker_wake, NULL);
1114 1115 1116 1117
	rcu_read_unlock();

	wait_for_completion(&wq->done);

J
Jann Horn 已提交
1118 1119
	for_each_node(node)
		kfree(wq->wqes[node]);
1120 1121 1122
	kfree(wq->wqes);
	kfree(wq);
}
J
Jens Axboe 已提交
1123 1124 1125 1126 1127 1128

void io_wq_destroy(struct io_wq *wq)
{
	if (refcount_dec_and_test(&wq->use_refs))
		__io_wq_destroy(wq);
}
1129 1130 1131 1132 1133

struct task_struct *io_wq_get_task(struct io_wq *wq)
{
	return wq->manager;
}