cfq-iosched.c 58.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6
/*
 *  CFQ, or complete fairness queueing, disk scheduler.
 *
 *  Based on ideas from a previously unfinished io
 *  scheduler (round robin per-process disk scheduling) and Andrea Arcangeli.
 *
7
 *  Copyright (C) 2003 Jens Axboe <axboe@kernel.dk>
L
Linus Torvalds 已提交
8 9
 */
#include <linux/module.h>
A
Al Viro 已提交
10 11
#include <linux/blkdev.h>
#include <linux/elevator.h>
L
Linus Torvalds 已提交
12
#include <linux/rbtree.h>
13
#include <linux/ioprio.h>
14
#include <linux/blktrace_api.h>
L
Linus Torvalds 已提交
15 16 17 18

/*
 * tunables
 */
19 20
/* max queue in one round of service */
static const int cfq_quantum = 4;
21
static const int cfq_fifo_expire[2] = { HZ / 4, HZ / 8 };
22 23 24 25
/* maximum backwards seek, in KiB */
static const int cfq_back_max = 16 * 1024;
/* penalty of a backwards seek */
static const int cfq_back_penalty = 2;
26
static const int cfq_slice_sync = HZ / 10;
J
Jens Axboe 已提交
27
static int cfq_slice_async = HZ / 25;
28
static const int cfq_slice_async_rq = 2;
29
static int cfq_slice_idle = HZ / 125;
30

31
/*
32
 * offset from end of service tree
33
 */
34
#define CFQ_IDLE_DELAY		(HZ / 5)
35 36 37 38 39 40

/*
 * below this threshold, we consider thinktime immediate
 */
#define CFQ_MIN_TT		(2)

41
#define CFQ_SLICE_SCALE		(5)
42
#define CFQ_HW_QUEUE_MIN	(5)
43

44 45
#define RQ_CIC(rq)		\
	((struct cfq_io_context *) (rq)->elevator_private)
46
#define RQ_CFQQ(rq)		(struct cfq_queue *) ((rq)->elevator_private2)
L
Linus Torvalds 已提交
47

48 49
static struct kmem_cache *cfq_pool;
static struct kmem_cache *cfq_ioc_pool;
L
Linus Torvalds 已提交
50

51
static DEFINE_PER_CPU(unsigned long, ioc_count);
52
static struct completion *ioc_gone;
53
static DEFINE_SPINLOCK(ioc_gone_lock);
54

55 56 57 58
#define CFQ_PRIO_LISTS		IOPRIO_BE_NR
#define cfq_class_idle(cfqq)	((cfqq)->ioprio_class == IOPRIO_CLASS_IDLE)
#define cfq_class_rt(cfqq)	((cfqq)->ioprio_class == IOPRIO_CLASS_RT)

59 60
#define sample_valid(samples)	((samples) > 80)

61 62 63 64 65 66 67 68 69 70 71 72
/*
 * Most of our rbtree usage is for sorting with min extraction, so
 * if we cache the leftmost node we don't have to walk down the tree
 * to find it. Idea borrowed from Ingo Molnars CFS scheduler. We should
 * move this into the elevator for the rq sorting as well.
 */
struct cfq_rb_root {
	struct rb_root rb;
	struct rb_node *left;
};
#define CFQ_RB_ROOT	(struct cfq_rb_root) { RB_ROOT, NULL, }

73 74 75
/*
 * Per block device queue structure
 */
L
Linus Torvalds 已提交
76
struct cfq_data {
77
	struct request_queue *queue;
78 79 80 81

	/*
	 * rr list of queues with requests and the count of them
	 */
82
	struct cfq_rb_root service_tree;
83
	unsigned int busy_queues;
84 85 86 87 88
	/*
	 * Used to track any pending rt requests so we can pre-empt current
	 * non-RT cfqq in service when this value is non-zero.
	 */
	unsigned int busy_rt_queues;
89 90

	int rq_in_driver;
91
	int sync_flight;
92 93 94 95 96

	/*
	 * queue-depth detection
	 */
	int rq_queued;
97
	int hw_tag;
98 99
	int hw_tag_samples;
	int rq_in_driver_peak;
L
Linus Torvalds 已提交
100

101 102 103 104 105
	/*
	 * idle window management
	 */
	struct timer_list idle_slice_timer;
	struct work_struct unplug_work;
L
Linus Torvalds 已提交
106

107 108 109
	struct cfq_queue *active_queue;
	struct cfq_io_context *active_cic;

110 111 112 113 114
	/*
	 * async queue for each priority case
	 */
	struct cfq_queue *async_cfqq[2][IOPRIO_BE_NR];
	struct cfq_queue *async_idle_cfqq;
115

J
Jens Axboe 已提交
116
	sector_t last_position;
117
	unsigned long last_end_request;
L
Linus Torvalds 已提交
118 119 120 121 122

	/*
	 * tunables, see top of file
	 */
	unsigned int cfq_quantum;
123
	unsigned int cfq_fifo_expire[2];
L
Linus Torvalds 已提交
124 125
	unsigned int cfq_back_penalty;
	unsigned int cfq_back_max;
126 127 128
	unsigned int cfq_slice[2];
	unsigned int cfq_slice_async_rq;
	unsigned int cfq_slice_idle;
129 130

	struct list_head cic_list;
L
Linus Torvalds 已提交
131 132
};

133 134 135
/*
 * Per process-grouping structure
 */
L
Linus Torvalds 已提交
136 137 138
struct cfq_queue {
	/* reference count */
	atomic_t ref;
139 140
	/* various state flags, see below */
	unsigned int flags;
L
Linus Torvalds 已提交
141 142
	/* parent cfq_data */
	struct cfq_data *cfqd;
143 144 145 146
	/* service_tree member */
	struct rb_node rb_node;
	/* service_tree key */
	unsigned long rb_key;
L
Linus Torvalds 已提交
147 148 149
	/* sorted list of pending requests */
	struct rb_root sort_list;
	/* if fifo isn't expired, next request to serve */
J
Jens Axboe 已提交
150
	struct request *next_rq;
L
Linus Torvalds 已提交
151 152 153 154 155
	/* requests queued in sort_list */
	int queued[2];
	/* currently allocated requests */
	int allocated[2];
	/* fifo list of requests in sort_list */
156
	struct list_head fifo;
L
Linus Torvalds 已提交
157

158
	unsigned long slice_end;
159
	long slice_resid;
160
	unsigned int slice_dispatch;
L
Linus Torvalds 已提交
161

162 163
	/* pending metadata requests */
	int meta_pending;
J
Jens Axboe 已提交
164 165
	/* number of requests that are on the dispatch list or inside driver */
	int dispatched;
166 167 168 169 170

	/* io prio of this group */
	unsigned short ioprio, org_ioprio;
	unsigned short ioprio_class, org_ioprio_class;

171
	pid_t pid;
L
Linus Torvalds 已提交
172 173
};

J
Jens Axboe 已提交
174
enum cfqq_state_flags {
175 176
	CFQ_CFQQ_FLAG_on_rr = 0,	/* on round-robin busy list */
	CFQ_CFQQ_FLAG_wait_request,	/* waiting for a request */
177
	CFQ_CFQQ_FLAG_must_dispatch,	/* must be allowed a dispatch */
178 179 180 181 182
	CFQ_CFQQ_FLAG_must_alloc,	/* must be allowed rq alloc */
	CFQ_CFQQ_FLAG_must_alloc_slice,	/* per-slice must_alloc flag */
	CFQ_CFQQ_FLAG_fifo_expire,	/* FIFO checked in this slice */
	CFQ_CFQQ_FLAG_idle_window,	/* slice idling enabled */
	CFQ_CFQQ_FLAG_prio_changed,	/* task priority has changed */
183
	CFQ_CFQQ_FLAG_slice_new,	/* no requests dispatched in slice */
184
	CFQ_CFQQ_FLAG_sync,		/* synchronous queue */
J
Jens Axboe 已提交
185 186 187 188 189
};

#define CFQ_CFQQ_FNS(name)						\
static inline void cfq_mark_cfqq_##name(struct cfq_queue *cfqq)		\
{									\
190
	(cfqq)->flags |= (1 << CFQ_CFQQ_FLAG_##name);			\
J
Jens Axboe 已提交
191 192 193
}									\
static inline void cfq_clear_cfqq_##name(struct cfq_queue *cfqq)	\
{									\
194
	(cfqq)->flags &= ~(1 << CFQ_CFQQ_FLAG_##name);			\
J
Jens Axboe 已提交
195 196 197
}									\
static inline int cfq_cfqq_##name(const struct cfq_queue *cfqq)		\
{									\
198
	return ((cfqq)->flags & (1 << CFQ_CFQQ_FLAG_##name)) != 0;	\
J
Jens Axboe 已提交
199 200 201 202
}

CFQ_CFQQ_FNS(on_rr);
CFQ_CFQQ_FNS(wait_request);
203
CFQ_CFQQ_FNS(must_dispatch);
J
Jens Axboe 已提交
204 205 206 207 208
CFQ_CFQQ_FNS(must_alloc);
CFQ_CFQQ_FNS(must_alloc_slice);
CFQ_CFQQ_FNS(fifo_expire);
CFQ_CFQQ_FNS(idle_window);
CFQ_CFQQ_FNS(prio_changed);
209
CFQ_CFQQ_FNS(slice_new);
210
CFQ_CFQQ_FNS(sync);
J
Jens Axboe 已提交
211 212
#undef CFQ_CFQQ_FNS

213 214 215 216 217
#define cfq_log_cfqq(cfqd, cfqq, fmt, args...)	\
	blk_add_trace_msg((cfqd)->queue, "cfq%d " fmt, (cfqq)->pid, ##args)
#define cfq_log(cfqd, fmt, args...)	\
	blk_add_trace_msg((cfqd)->queue, "cfq " fmt, ##args)

218
static void cfq_dispatch_insert(struct request_queue *, struct request *);
219
static struct cfq_queue *cfq_get_queue(struct cfq_data *, int,
220
				       struct io_context *, gfp_t);
221
static struct cfq_io_context *cfq_cic_lookup(struct cfq_data *,
222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246
						struct io_context *);

static inline struct cfq_queue *cic_to_cfqq(struct cfq_io_context *cic,
					    int is_sync)
{
	return cic->cfqq[!!is_sync];
}

static inline void cic_set_cfqq(struct cfq_io_context *cic,
				struct cfq_queue *cfqq, int is_sync)
{
	cic->cfqq[!!is_sync] = cfqq;
}

/*
 * We regard a request as SYNC, if it's either a read or has the SYNC bit
 * set (in which case it could also be direct WRITE).
 */
static inline int cfq_bio_sync(struct bio *bio)
{
	if (bio_data_dir(bio) == READ || bio_sync(bio))
		return 1;

	return 0;
}
L
Linus Torvalds 已提交
247

A
Andrew Morton 已提交
248 249 250 251 252 253
/*
 * scheduler run of queue, if there are requests pending and no one in the
 * driver that will restart queueing
 */
static inline void cfq_schedule_dispatch(struct cfq_data *cfqd)
{
254 255
	if (cfqd->busy_queues) {
		cfq_log(cfqd, "schedule dispatch");
256
		kblockd_schedule_work(cfqd->queue, &cfqd->unplug_work);
257
	}
A
Andrew Morton 已提交
258 259
}

260
static int cfq_queue_empty(struct request_queue *q)
A
Andrew Morton 已提交
261 262 263
{
	struct cfq_data *cfqd = q->elevator->elevator_data;

264
	return !cfqd->busy_queues;
A
Andrew Morton 已提交
265 266
}

267 268 269 270 271
/*
 * Scale schedule slice based on io priority. Use the sync time slice only
 * if a queue is marked sync and has sync io queued. A sync queue with async
 * io only, should not get full sync slice length.
 */
272 273
static inline int cfq_prio_slice(struct cfq_data *cfqd, int sync,
				 unsigned short prio)
274
{
275
	const int base_slice = cfqd->cfq_slice[sync];
276

277 278 279 280
	WARN_ON(prio >= IOPRIO_BE_NR);

	return base_slice + (base_slice/CFQ_SLICE_SCALE * (4 - prio));
}
281

282 283 284 285
static inline int
cfq_prio_to_slice(struct cfq_data *cfqd, struct cfq_queue *cfqq)
{
	return cfq_prio_slice(cfqd, cfq_cfqq_sync(cfqq), cfqq->ioprio);
286 287 288 289 290 291
}

static inline void
cfq_set_prio_slice(struct cfq_data *cfqd, struct cfq_queue *cfqq)
{
	cfqq->slice_end = cfq_prio_to_slice(cfqd, cfqq) + jiffies;
292
	cfq_log_cfqq(cfqd, cfqq, "set_slice=%lu", cfqq->slice_end - jiffies);
293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309
}

/*
 * We need to wrap this check in cfq_cfqq_slice_new(), since ->slice_end
 * isn't valid until the first request from the dispatch is activated
 * and the slice time set.
 */
static inline int cfq_slice_used(struct cfq_queue *cfqq)
{
	if (cfq_cfqq_slice_new(cfqq))
		return 0;
	if (time_before(jiffies, cfqq->slice_end))
		return 0;

	return 1;
}

L
Linus Torvalds 已提交
310
/*
J
Jens Axboe 已提交
311
 * Lifted from AS - choose which of rq1 and rq2 that is best served now.
L
Linus Torvalds 已提交
312
 * We choose the request that is closest to the head right now. Distance
313
 * behind the head is penalized and only allowed to a certain extent.
L
Linus Torvalds 已提交
314
 */
J
Jens Axboe 已提交
315 316
static struct request *
cfq_choose_req(struct cfq_data *cfqd, struct request *rq1, struct request *rq2)
L
Linus Torvalds 已提交
317 318 319
{
	sector_t last, s1, s2, d1 = 0, d2 = 0;
	unsigned long back_max;
320 321 322
#define CFQ_RQ1_WRAP	0x01 /* request 1 wraps */
#define CFQ_RQ2_WRAP	0x02 /* request 2 wraps */
	unsigned wrap = 0; /* bit mask: requests behind the disk head? */
L
Linus Torvalds 已提交
323

J
Jens Axboe 已提交
324 325 326 327
	if (rq1 == NULL || rq1 == rq2)
		return rq2;
	if (rq2 == NULL)
		return rq1;
J
Jens Axboe 已提交
328

J
Jens Axboe 已提交
329 330 331 332
	if (rq_is_sync(rq1) && !rq_is_sync(rq2))
		return rq1;
	else if (rq_is_sync(rq2) && !rq_is_sync(rq1))
		return rq2;
333 334 335 336
	if (rq_is_meta(rq1) && !rq_is_meta(rq2))
		return rq1;
	else if (rq_is_meta(rq2) && !rq_is_meta(rq1))
		return rq2;
L
Linus Torvalds 已提交
337

J
Jens Axboe 已提交
338 339
	s1 = rq1->sector;
	s2 = rq2->sector;
L
Linus Torvalds 已提交
340

J
Jens Axboe 已提交
341
	last = cfqd->last_position;
L
Linus Torvalds 已提交
342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357

	/*
	 * by definition, 1KiB is 2 sectors
	 */
	back_max = cfqd->cfq_back_max * 2;

	/*
	 * Strict one way elevator _except_ in the case where we allow
	 * short backward seeks which are biased as twice the cost of a
	 * similar forward seek.
	 */
	if (s1 >= last)
		d1 = s1 - last;
	else if (s1 + back_max >= last)
		d1 = (last - s1) * cfqd->cfq_back_penalty;
	else
358
		wrap |= CFQ_RQ1_WRAP;
L
Linus Torvalds 已提交
359 360 361 362 363 364

	if (s2 >= last)
		d2 = s2 - last;
	else if (s2 + back_max >= last)
		d2 = (last - s2) * cfqd->cfq_back_penalty;
	else
365
		wrap |= CFQ_RQ2_WRAP;
L
Linus Torvalds 已提交
366 367

	/* Found required data */
368 369 370 371 372 373

	/*
	 * By doing switch() on the bit mask "wrap" we avoid having to
	 * check two variables for all permutations: --> faster!
	 */
	switch (wrap) {
J
Jens Axboe 已提交
374
	case 0: /* common case for CFQ: rq1 and rq2 not wrapped */
375
		if (d1 < d2)
J
Jens Axboe 已提交
376
			return rq1;
377
		else if (d2 < d1)
J
Jens Axboe 已提交
378
			return rq2;
379 380
		else {
			if (s1 >= s2)
J
Jens Axboe 已提交
381
				return rq1;
382
			else
J
Jens Axboe 已提交
383
				return rq2;
384
		}
L
Linus Torvalds 已提交
385

386
	case CFQ_RQ2_WRAP:
J
Jens Axboe 已提交
387
		return rq1;
388
	case CFQ_RQ1_WRAP:
J
Jens Axboe 已提交
389 390
		return rq2;
	case (CFQ_RQ1_WRAP|CFQ_RQ2_WRAP): /* both rqs wrapped */
391 392 393 394 395 396 397 398
	default:
		/*
		 * Since both rqs are wrapped,
		 * start with the one that's further behind head
		 * (--> only *one* back seek required),
		 * since back seek takes more time than forward.
		 */
		if (s1 <= s2)
J
Jens Axboe 已提交
399
			return rq1;
L
Linus Torvalds 已提交
400
		else
J
Jens Axboe 已提交
401
			return rq2;
L
Linus Torvalds 已提交
402 403 404
	}
}

405 406 407
/*
 * The below is leftmost cache rbtree addon
 */
408
static struct cfq_queue *cfq_rb_first(struct cfq_rb_root *root)
409 410 411 412
{
	if (!root->left)
		root->left = rb_first(&root->rb);

413 414 415 416
	if (root->left)
		return rb_entry(root->left, struct cfq_queue, rb_node);

	return NULL;
417 418 419 420 421 422 423 424 425 426 427
}

static void cfq_rb_erase(struct rb_node *n, struct cfq_rb_root *root)
{
	if (root->left == n)
		root->left = NULL;

	rb_erase(n, &root->rb);
	RB_CLEAR_NODE(n);
}

L
Linus Torvalds 已提交
428 429 430
/*
 * would be nice to take fifo expire time into account as well
 */
J
Jens Axboe 已提交
431 432 433
static struct request *
cfq_find_next_rq(struct cfq_data *cfqd, struct cfq_queue *cfqq,
		  struct request *last)
L
Linus Torvalds 已提交
434
{
435 436
	struct rb_node *rbnext = rb_next(&last->rb_node);
	struct rb_node *rbprev = rb_prev(&last->rb_node);
J
Jens Axboe 已提交
437
	struct request *next = NULL, *prev = NULL;
L
Linus Torvalds 已提交
438

439
	BUG_ON(RB_EMPTY_NODE(&last->rb_node));
L
Linus Torvalds 已提交
440 441

	if (rbprev)
J
Jens Axboe 已提交
442
		prev = rb_entry_rq(rbprev);
L
Linus Torvalds 已提交
443

444
	if (rbnext)
J
Jens Axboe 已提交
445
		next = rb_entry_rq(rbnext);
446 447 448
	else {
		rbnext = rb_first(&cfqq->sort_list);
		if (rbnext && rbnext != &last->rb_node)
J
Jens Axboe 已提交
449
			next = rb_entry_rq(rbnext);
450
	}
L
Linus Torvalds 已提交
451

452
	return cfq_choose_req(cfqd, next, prev);
L
Linus Torvalds 已提交
453 454
}

455 456
static unsigned long cfq_slice_offset(struct cfq_data *cfqd,
				      struct cfq_queue *cfqq)
L
Linus Torvalds 已提交
457
{
458 459 460
	/*
	 * just an approximation, should be ok.
	 */
461 462
	return (cfqd->busy_queues - 1) * (cfq_prio_slice(cfqd, 1, 0) -
		       cfq_prio_slice(cfqd, cfq_cfqq_sync(cfqq), cfqq->ioprio));
463 464
}

465 466 467 468 469
/*
 * The cfqd->service_tree holds all pending cfq_queue's that have
 * requests waiting to be processed. It is sorted in the order that
 * we will service the queues.
 */
470
static void cfq_service_tree_add(struct cfq_data *cfqd,
471
				    struct cfq_queue *cfqq, int add_front)
472
{
473 474
	struct rb_node **p, *parent;
	struct cfq_queue *__cfqq;
475
	unsigned long rb_key;
476
	int left;
477

478 479 480 481 482 483 484 485 486
	if (cfq_class_idle(cfqq)) {
		rb_key = CFQ_IDLE_DELAY;
		parent = rb_last(&cfqd->service_tree.rb);
		if (parent && parent != &cfqq->rb_node) {
			__cfqq = rb_entry(parent, struct cfq_queue, rb_node);
			rb_key += __cfqq->rb_key;
		} else
			rb_key += jiffies;
	} else if (!add_front) {
487 488 489 490 491
		rb_key = cfq_slice_offset(cfqd, cfqq) + jiffies;
		rb_key += cfqq->slice_resid;
		cfqq->slice_resid = 0;
	} else
		rb_key = 0;
L
Linus Torvalds 已提交
492

493
	if (!RB_EMPTY_NODE(&cfqq->rb_node)) {
494
		/*
495
		 * same position, nothing more to do
496
		 */
497 498
		if (rb_key == cfqq->rb_key)
			return;
L
Linus Torvalds 已提交
499

500
		cfq_rb_erase(&cfqq->rb_node, &cfqd->service_tree);
L
Linus Torvalds 已提交
501
	}
502

503
	left = 1;
504 505
	parent = NULL;
	p = &cfqd->service_tree.rb.rb_node;
506
	while (*p) {
507
		struct rb_node **n;
508

509 510 511
		parent = *p;
		__cfqq = rb_entry(parent, struct cfq_queue, rb_node);

512 513
		/*
		 * sort RT queues first, we always want to give
514 515
		 * preference to them. IDLE queues goes to the back.
		 * after that, sort on the next service time.
516 517
		 */
		if (cfq_class_rt(cfqq) > cfq_class_rt(__cfqq))
518
			n = &(*p)->rb_left;
519
		else if (cfq_class_rt(cfqq) < cfq_class_rt(__cfqq))
520 521 522 523 524
			n = &(*p)->rb_right;
		else if (cfq_class_idle(cfqq) < cfq_class_idle(__cfqq))
			n = &(*p)->rb_left;
		else if (cfq_class_idle(cfqq) > cfq_class_idle(__cfqq))
			n = &(*p)->rb_right;
525
		else if (rb_key < __cfqq->rb_key)
526 527 528 529 530
			n = &(*p)->rb_left;
		else
			n = &(*p)->rb_right;

		if (n == &(*p)->rb_right)
531
			left = 0;
532 533

		p = n;
534 535
	}

536 537 538
	if (left)
		cfqd->service_tree.left = &cfqq->rb_node;

539 540
	cfqq->rb_key = rb_key;
	rb_link_node(&cfqq->rb_node, parent, p);
541
	rb_insert_color(&cfqq->rb_node, &cfqd->service_tree.rb);
L
Linus Torvalds 已提交
542 543
}

544 545 546
/*
 * Update cfqq's position in the service tree.
 */
547
static void cfq_resort_rr_list(struct cfq_data *cfqd, struct cfq_queue *cfqq)
J
Jens Axboe 已提交
548 549 550 551
{
	/*
	 * Resorting requires the cfqq to be on the RR list already.
	 */
552
	if (cfq_cfqq_on_rr(cfqq))
553
		cfq_service_tree_add(cfqd, cfqq, 0);
J
Jens Axboe 已提交
554 555
}

L
Linus Torvalds 已提交
556 557
/*
 * add to busy list of queues for service, trying to be fair in ordering
558
 * the pending list according to last request service
L
Linus Torvalds 已提交
559
 */
J
Jens Axboe 已提交
560
static void cfq_add_cfqq_rr(struct cfq_data *cfqd, struct cfq_queue *cfqq)
L
Linus Torvalds 已提交
561
{
562
	cfq_log_cfqq(cfqd, cfqq, "add_to_rr");
J
Jens Axboe 已提交
563 564
	BUG_ON(cfq_cfqq_on_rr(cfqq));
	cfq_mark_cfqq_on_rr(cfqq);
L
Linus Torvalds 已提交
565
	cfqd->busy_queues++;
566 567
	if (cfq_class_rt(cfqq))
		cfqd->busy_rt_queues++;
L
Linus Torvalds 已提交
568

569
	cfq_resort_rr_list(cfqd, cfqq);
L
Linus Torvalds 已提交
570 571
}

572 573 574 575
/*
 * Called when the cfqq no longer has requests pending, remove it from
 * the service tree.
 */
J
Jens Axboe 已提交
576
static void cfq_del_cfqq_rr(struct cfq_data *cfqd, struct cfq_queue *cfqq)
L
Linus Torvalds 已提交
577
{
578
	cfq_log_cfqq(cfqd, cfqq, "del_from_rr");
J
Jens Axboe 已提交
579 580
	BUG_ON(!cfq_cfqq_on_rr(cfqq));
	cfq_clear_cfqq_on_rr(cfqq);
L
Linus Torvalds 已提交
581

582 583
	if (!RB_EMPTY_NODE(&cfqq->rb_node))
		cfq_rb_erase(&cfqq->rb_node, &cfqd->service_tree);
584

L
Linus Torvalds 已提交
585 586
	BUG_ON(!cfqd->busy_queues);
	cfqd->busy_queues--;
587 588
	if (cfq_class_rt(cfqq))
		cfqd->busy_rt_queues--;
L
Linus Torvalds 已提交
589 590 591 592 593
}

/*
 * rb tree support functions
 */
J
Jens Axboe 已提交
594
static void cfq_del_rq_rb(struct request *rq)
L
Linus Torvalds 已提交
595
{
J
Jens Axboe 已提交
596
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
597
	struct cfq_data *cfqd = cfqq->cfqd;
J
Jens Axboe 已提交
598
	const int sync = rq_is_sync(rq);
L
Linus Torvalds 已提交
599

600 601
	BUG_ON(!cfqq->queued[sync]);
	cfqq->queued[sync]--;
L
Linus Torvalds 已提交
602

J
Jens Axboe 已提交
603
	elv_rb_del(&cfqq->sort_list, rq);
L
Linus Torvalds 已提交
604

605
	if (cfq_cfqq_on_rr(cfqq) && RB_EMPTY_ROOT(&cfqq->sort_list))
606
		cfq_del_cfqq_rr(cfqd, cfqq);
L
Linus Torvalds 已提交
607 608
}

J
Jens Axboe 已提交
609
static void cfq_add_rq_rb(struct request *rq)
L
Linus Torvalds 已提交
610
{
J
Jens Axboe 已提交
611
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
L
Linus Torvalds 已提交
612
	struct cfq_data *cfqd = cfqq->cfqd;
613
	struct request *__alias;
L
Linus Torvalds 已提交
614

615
	cfqq->queued[rq_is_sync(rq)]++;
L
Linus Torvalds 已提交
616 617 618 619 620

	/*
	 * looks a little odd, but the first insert might return an alias.
	 * if that happens, put the alias on the dispatch list
	 */
621
	while ((__alias = elv_rb_add(&cfqq->sort_list, rq)) != NULL)
J
Jens Axboe 已提交
622
		cfq_dispatch_insert(cfqd->queue, __alias);
623 624 625

	if (!cfq_cfqq_on_rr(cfqq))
		cfq_add_cfqq_rr(cfqd, cfqq);
626 627 628 629 630 631

	/*
	 * check if this request is a better next-serve candidate
	 */
	cfqq->next_rq = cfq_choose_req(cfqd, cfqq->next_rq, rq);
	BUG_ON(!cfqq->next_rq);
L
Linus Torvalds 已提交
632 633
}

J
Jens Axboe 已提交
634
static void cfq_reposition_rq_rb(struct cfq_queue *cfqq, struct request *rq)
L
Linus Torvalds 已提交
635
{
636 637
	elv_rb_del(&cfqq->sort_list, rq);
	cfqq->queued[rq_is_sync(rq)]--;
J
Jens Axboe 已提交
638
	cfq_add_rq_rb(rq);
L
Linus Torvalds 已提交
639 640
}

641 642
static struct request *
cfq_find_rq_fmerge(struct cfq_data *cfqd, struct bio *bio)
L
Linus Torvalds 已提交
643
{
644
	struct task_struct *tsk = current;
645
	struct cfq_io_context *cic;
646
	struct cfq_queue *cfqq;
L
Linus Torvalds 已提交
647

648
	cic = cfq_cic_lookup(cfqd, tsk->io_context);
649 650 651 652
	if (!cic)
		return NULL;

	cfqq = cic_to_cfqq(cic, cfq_bio_sync(bio));
653 654 655
	if (cfqq) {
		sector_t sector = bio->bi_sector + bio_sectors(bio);

656
		return elv_rb_find(&cfqq->sort_list, sector);
657
	}
L
Linus Torvalds 已提交
658 659 660 661

	return NULL;
}

662
static void cfq_activate_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
663
{
664
	struct cfq_data *cfqd = q->elevator->elevator_data;
J
Jens Axboe 已提交
665

666
	cfqd->rq_in_driver++;
667 668
	cfq_log_cfqq(cfqd, RQ_CFQQ(rq), "activate rq, drv=%d",
						cfqd->rq_in_driver);
669

J
Jens Axboe 已提交
670
	cfqd->last_position = rq->hard_sector + rq->hard_nr_sectors;
L
Linus Torvalds 已提交
671 672
}

673
static void cfq_deactivate_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
674
{
675 676 677 678
	struct cfq_data *cfqd = q->elevator->elevator_data;

	WARN_ON(!cfqd->rq_in_driver);
	cfqd->rq_in_driver--;
679 680
	cfq_log_cfqq(cfqd, RQ_CFQQ(rq), "deactivate rq, drv=%d",
						cfqd->rq_in_driver);
L
Linus Torvalds 已提交
681 682
}

683
static void cfq_remove_request(struct request *rq)
L
Linus Torvalds 已提交
684
{
J
Jens Axboe 已提交
685
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
686

J
Jens Axboe 已提交
687 688
	if (cfqq->next_rq == rq)
		cfqq->next_rq = cfq_find_next_rq(cfqq->cfqd, cfqq, rq);
L
Linus Torvalds 已提交
689

690
	list_del_init(&rq->queuelist);
J
Jens Axboe 已提交
691
	cfq_del_rq_rb(rq);
692

693
	cfqq->cfqd->rq_queued--;
694 695 696 697
	if (rq_is_meta(rq)) {
		WARN_ON(!cfqq->meta_pending);
		cfqq->meta_pending--;
	}
L
Linus Torvalds 已提交
698 699
}

700 701
static int cfq_merge(struct request_queue *q, struct request **req,
		     struct bio *bio)
L
Linus Torvalds 已提交
702 703 704 705
{
	struct cfq_data *cfqd = q->elevator->elevator_data;
	struct request *__rq;

706
	__rq = cfq_find_rq_fmerge(cfqd, bio);
707
	if (__rq && elv_rq_merge_ok(__rq, bio)) {
708 709
		*req = __rq;
		return ELEVATOR_FRONT_MERGE;
L
Linus Torvalds 已提交
710 711 712 713 714
	}

	return ELEVATOR_NO_MERGE;
}

715
static void cfq_merged_request(struct request_queue *q, struct request *req,
716
			       int type)
L
Linus Torvalds 已提交
717
{
718
	if (type == ELEVATOR_FRONT_MERGE) {
J
Jens Axboe 已提交
719
		struct cfq_queue *cfqq = RQ_CFQQ(req);
L
Linus Torvalds 已提交
720

J
Jens Axboe 已提交
721
		cfq_reposition_rq_rb(cfqq, req);
L
Linus Torvalds 已提交
722 723 724 725
	}
}

static void
726
cfq_merged_requests(struct request_queue *q, struct request *rq,
L
Linus Torvalds 已提交
727 728
		    struct request *next)
{
729 730 731 732 733 734 735
	/*
	 * reposition in fifo if next is older than rq
	 */
	if (!list_empty(&rq->queuelist) && !list_empty(&next->queuelist) &&
	    time_before(next->start_time, rq->start_time))
		list_move(&rq->queuelist, &next->queuelist);

736
	cfq_remove_request(next);
737 738
}

739
static int cfq_allow_merge(struct request_queue *q, struct request *rq,
740 741 742
			   struct bio *bio)
{
	struct cfq_data *cfqd = q->elevator->elevator_data;
743
	struct cfq_io_context *cic;
744 745 746
	struct cfq_queue *cfqq;

	/*
747
	 * Disallow merge of a sync bio into an async request.
748
	 */
749
	if (cfq_bio_sync(bio) && !rq_is_sync(rq))
750 751 752
		return 0;

	/*
753 754
	 * Lookup the cfqq that this bio will be queued with. Allow
	 * merge only if rq is queued there.
755
	 */
756
	cic = cfq_cic_lookup(cfqd, current->io_context);
757 758
	if (!cic)
		return 0;
759

760
	cfqq = cic_to_cfqq(cic, cfq_bio_sync(bio));
761 762
	if (cfqq == RQ_CFQQ(rq))
		return 1;
763

764
	return 0;
765 766
}

J
Jens Axboe 已提交
767 768
static void __cfq_set_active_queue(struct cfq_data *cfqd,
				   struct cfq_queue *cfqq)
769 770
{
	if (cfqq) {
771
		cfq_log_cfqq(cfqd, cfqq, "set_active");
772
		cfqq->slice_end = 0;
773 774 775
		cfqq->slice_dispatch = 0;

		cfq_clear_cfqq_wait_request(cfqq);
776
		cfq_clear_cfqq_must_dispatch(cfqq);
J
Jens Axboe 已提交
777 778
		cfq_clear_cfqq_must_alloc_slice(cfqq);
		cfq_clear_cfqq_fifo_expire(cfqq);
779
		cfq_mark_cfqq_slice_new(cfqq);
780 781

		del_timer(&cfqd->idle_slice_timer);
782 783 784 785 786
	}

	cfqd->active_queue = cfqq;
}

787 788 789 790 791
/*
 * current cfqq expired its slice (or was too idle), select new one
 */
static void
__cfq_slice_expired(struct cfq_data *cfqd, struct cfq_queue *cfqq,
792
		    int timed_out)
793
{
794 795
	cfq_log_cfqq(cfqd, cfqq, "slice expired t=%d", timed_out);

796 797 798 799 800 801
	if (cfq_cfqq_wait_request(cfqq))
		del_timer(&cfqd->idle_slice_timer);

	cfq_clear_cfqq_wait_request(cfqq);

	/*
802
	 * store what was left of this slice, if the queue idled/timed out
803
	 */
804
	if (timed_out && !cfq_cfqq_slice_new(cfqq)) {
805
		cfqq->slice_resid = cfqq->slice_end - jiffies;
806 807
		cfq_log_cfqq(cfqd, cfqq, "resid=%ld", cfqq->slice_resid);
	}
808

809
	cfq_resort_rr_list(cfqd, cfqq);
810 811 812 813 814 815 816 817 818 819

	if (cfqq == cfqd->active_queue)
		cfqd->active_queue = NULL;

	if (cfqd->active_cic) {
		put_io_context(cfqd->active_cic->ioc);
		cfqd->active_cic = NULL;
	}
}

820
static inline void cfq_slice_expired(struct cfq_data *cfqd, int timed_out)
821 822 823 824
{
	struct cfq_queue *cfqq = cfqd->active_queue;

	if (cfqq)
825
		__cfq_slice_expired(cfqd, cfqq, timed_out);
826 827
}

828 829 830 831
/*
 * Get next queue for service. Unless we have a queue preemption,
 * we'll simply select the first cfqq in the service tree.
 */
J
Jens Axboe 已提交
832
static struct cfq_queue *cfq_get_next_queue(struct cfq_data *cfqd)
833
{
834 835
	if (RB_EMPTY_ROOT(&cfqd->service_tree.rb))
		return NULL;
836

837
	return cfq_rb_first(&cfqd->service_tree);
J
Jens Axboe 已提交
838 839
}

840 841 842
/*
 * Get and set a new active queue for service.
 */
J
Jens Axboe 已提交
843 844 845 846
static struct cfq_queue *cfq_set_active_queue(struct cfq_data *cfqd)
{
	struct cfq_queue *cfqq;

847
	cfqq = cfq_get_next_queue(cfqd);
848
	__cfq_set_active_queue(cfqd, cfqq);
J
Jens Axboe 已提交
849
	return cfqq;
850 851
}

852 853 854 855 856 857 858 859 860
static inline sector_t cfq_dist_from_last(struct cfq_data *cfqd,
					  struct request *rq)
{
	if (rq->sector >= cfqd->last_position)
		return rq->sector - cfqd->last_position;
	else
		return cfqd->last_position - rq->sector;
}

J
Jens Axboe 已提交
861 862 863 864 865 866 867 868 869 870
static inline int cfq_rq_close(struct cfq_data *cfqd, struct request *rq)
{
	struct cfq_io_context *cic = cfqd->active_cic;

	if (!sample_valid(cic->seek_samples))
		return 0;

	return cfq_dist_from_last(cfqd, rq) <= cic->seek_mean;
}

871 872
static int cfq_close_cooperator(struct cfq_data *cfq_data,
				struct cfq_queue *cfqq)
J
Jens Axboe 已提交
873 874
{
	/*
875 876 877
	 * We should notice if some of the queues are cooperating, eg
	 * working closely on the same area of the disk. In that case,
	 * we can group them together and don't waste time idling.
J
Jens Axboe 已提交
878
	 */
879
	return 0;
J
Jens Axboe 已提交
880 881 882
}

#define CIC_SEEKY(cic) ((cic)->seek_mean > (8 * 1024))
883

J
Jens Axboe 已提交
884
static void cfq_arm_slice_timer(struct cfq_data *cfqd)
885
{
886
	struct cfq_queue *cfqq = cfqd->active_queue;
887
	struct cfq_io_context *cic;
888 889
	unsigned long sl;

890
	/*
J
Jens Axboe 已提交
891 892 893
	 * SSD device without seek penalty, disable idling. But only do so
	 * for devices that support queuing, otherwise we still have a problem
	 * with sync vs async workloads.
894
	 */
J
Jens Axboe 已提交
895
	if (blk_queue_nonrot(cfqd->queue) && cfqd->hw_tag)
896 897
		return;

898
	WARN_ON(!RB_EMPTY_ROOT(&cfqq->sort_list));
J
Jens Axboe 已提交
899
	WARN_ON(cfq_cfqq_slice_new(cfqq));
900 901 902 903

	/*
	 * idle is disabled, either manually or by past process history
	 */
J
Jens Axboe 已提交
904 905 906
	if (!cfqd->cfq_slice_idle || !cfq_cfqq_idle_window(cfqq))
		return;

907 908 909 910 911 912
	/*
	 * still requests with the driver, don't idle
	 */
	if (cfqd->rq_in_driver)
		return;

913 914 915
	/*
	 * task has exited, don't wait
	 */
916
	cic = cfqd->active_cic;
917
	if (!cic || !atomic_read(&cic->ioc->nr_tasks))
J
Jens Axboe 已提交
918 919 920 921 922
		return;

	/*
	 * See if this prio level has a good candidate
	 */
J
Jens Axboe 已提交
923 924
	if (cfq_close_cooperator(cfqd, cfqq) &&
	    (sample_valid(cic->ttime_samples) && cic->ttime_mean > 2))
J
Jens Axboe 已提交
925
		return;
926

J
Jens Axboe 已提交
927
	cfq_mark_cfqq_wait_request(cfqq);
928

929 930 931 932 933
	/*
	 * we don't want to idle for seeks, but we do want to allow
	 * fair distribution of slice time for a process doing back-to-back
	 * seeks. so allow a little bit of time for him to submit a new rq
	 */
J
Jens Axboe 已提交
934
	sl = cfqd->cfq_slice_idle;
935
	if (sample_valid(cic->seek_samples) && CIC_SEEKY(cic))
936
		sl = min(sl, msecs_to_jiffies(CFQ_MIN_TT));
937

938
	mod_timer(&cfqd->idle_slice_timer, jiffies + sl);
939
	cfq_log(cfqd, "arm_idle: %lu", sl);
L
Linus Torvalds 已提交
940 941
}

942 943 944
/*
 * Move request from internal lists to the request queue dispatch list.
 */
945
static void cfq_dispatch_insert(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
946
{
947
	struct cfq_data *cfqd = q->elevator->elevator_data;
J
Jens Axboe 已提交
948
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
949

950 951
	cfq_log_cfqq(cfqd, cfqq, "dispatch_insert");

952
	cfq_remove_request(rq);
J
Jens Axboe 已提交
953
	cfqq->dispatched++;
954
	elv_dispatch_sort(q, rq);
955 956 957

	if (cfq_cfqq_sync(cfqq))
		cfqd->sync_flight++;
L
Linus Torvalds 已提交
958 959 960 961 962
}

/*
 * return expired entry, or NULL to just start from scratch in rbtree
 */
J
Jens Axboe 已提交
963
static struct request *cfq_check_fifo(struct cfq_queue *cfqq)
L
Linus Torvalds 已提交
964 965
{
	struct cfq_data *cfqd = cfqq->cfqd;
966
	struct request *rq;
967
	int fifo;
L
Linus Torvalds 已提交
968

J
Jens Axboe 已提交
969
	if (cfq_cfqq_fifo_expire(cfqq))
L
Linus Torvalds 已提交
970
		return NULL;
971 972 973

	cfq_mark_cfqq_fifo_expire(cfqq);

974 975
	if (list_empty(&cfqq->fifo))
		return NULL;
L
Linus Torvalds 已提交
976

J
Jens Axboe 已提交
977
	fifo = cfq_cfqq_sync(cfqq);
978
	rq = rq_entry_fifo(cfqq->fifo.next);
L
Linus Torvalds 已提交
979

J
Jens Axboe 已提交
980
	if (time_before(jiffies, rq->start_time + cfqd->cfq_fifo_expire[fifo]))
981
		rq = NULL;
L
Linus Torvalds 已提交
982

983
	cfq_log_cfqq(cfqd, cfqq, "fifo=%p", rq);
J
Jens Axboe 已提交
984
	return rq;
L
Linus Torvalds 已提交
985 986
}

987 988 989 990
static inline int
cfq_prio_to_maxrq(struct cfq_data *cfqd, struct cfq_queue *cfqq)
{
	const int base_rq = cfqd->cfq_slice_async_rq;
L
Linus Torvalds 已提交
991

992
	WARN_ON(cfqq->ioprio >= IOPRIO_BE_NR);
L
Linus Torvalds 已提交
993

994
	return 2 * (base_rq + base_rq * (CFQ_PRIO_LISTS - 1 - cfqq->ioprio));
L
Linus Torvalds 已提交
995 996
}

997
/*
998 999
 * Select a queue for service. If we have a current active queue,
 * check whether to continue servicing it, or retrieve and set a new one.
1000
 */
1001
static struct cfq_queue *cfq_select_queue(struct cfq_data *cfqd)
L
Linus Torvalds 已提交
1002 1003 1004
{
	struct cfq_queue *cfqq;

1005 1006 1007
	cfqq = cfqd->active_queue;
	if (!cfqq)
		goto new_queue;
L
Linus Torvalds 已提交
1008

1009
	/*
J
Jens Axboe 已提交
1010
	 * The active queue has run out of time, expire it and select new.
1011
	 */
1012
	if (cfq_slice_used(cfqq) && !cfq_cfqq_must_dispatch(cfqq))
J
Jens Axboe 已提交
1013
		goto expire;
L
Linus Torvalds 已提交
1014

1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028
	/*
	 * If we have a RT cfqq waiting, then we pre-empt the current non-rt
	 * cfqq.
	 */
	if (!cfq_class_rt(cfqq) && cfqd->busy_rt_queues) {
		/*
		 * We simulate this as cfqq timed out so that it gets to bank
		 * the remaining of its time slice.
		 */
		cfq_log_cfqq(cfqd, cfqq, "preempt");
		cfq_slice_expired(cfqd, 1);
		goto new_queue;
	}

1029
	/*
J
Jens Axboe 已提交
1030 1031
	 * The active queue has requests and isn't expired, allow it to
	 * dispatch.
1032
	 */
1033
	if (!RB_EMPTY_ROOT(&cfqq->sort_list))
1034
		goto keep_queue;
J
Jens Axboe 已提交
1035 1036 1037 1038 1039 1040

	/*
	 * No requests pending. If the active queue still has requests in
	 * flight or is idling for a new request, allow either of these
	 * conditions to happen (or time out) before selecting a new queue.
	 */
1041 1042
	if (timer_pending(&cfqd->idle_slice_timer) ||
	    (cfqq->dispatched && cfq_cfqq_idle_window(cfqq))) {
1043 1044
		cfqq = NULL;
		goto keep_queue;
1045 1046
	}

J
Jens Axboe 已提交
1047
expire:
1048
	cfq_slice_expired(cfqd, 0);
J
Jens Axboe 已提交
1049 1050
new_queue:
	cfqq = cfq_set_active_queue(cfqd);
1051
keep_queue:
J
Jens Axboe 已提交
1052
	return cfqq;
1053 1054
}

J
Jens Axboe 已提交
1055
static int __cfq_forced_dispatch_cfqq(struct cfq_queue *cfqq)
1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067
{
	int dispatched = 0;

	while (cfqq->next_rq) {
		cfq_dispatch_insert(cfqq->cfqd->queue, cfqq->next_rq);
		dispatched++;
	}

	BUG_ON(!list_empty(&cfqq->fifo));
	return dispatched;
}

1068 1069 1070 1071
/*
 * Drain our current requests. Used for barriers and when switching
 * io schedulers on-the-fly.
 */
1072
static int cfq_forced_dispatch(struct cfq_data *cfqd)
1073
{
1074
	struct cfq_queue *cfqq;
1075
	int dispatched = 0;
1076

1077
	while ((cfqq = cfq_rb_first(&cfqd->service_tree)) != NULL)
1078
		dispatched += __cfq_forced_dispatch_cfqq(cfqq);
1079

1080
	cfq_slice_expired(cfqd, 0);
1081 1082 1083

	BUG_ON(cfqd->busy_queues);

1084
	cfq_log(cfqd, "forced_dispatch=%d\n", dispatched);
1085 1086 1087
	return dispatched;
}

1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121
/*
 * Dispatch a request from cfqq, moving them to the request queue
 * dispatch list.
 */
static void cfq_dispatch_request(struct cfq_data *cfqd, struct cfq_queue *cfqq)
{
	struct request *rq;

	BUG_ON(RB_EMPTY_ROOT(&cfqq->sort_list));

	/*
	 * follow expired path, else get first next available
	 */
	rq = cfq_check_fifo(cfqq);
	if (!rq)
		rq = cfqq->next_rq;

	/*
	 * insert request into driver dispatch list
	 */
	cfq_dispatch_insert(cfqd->queue, rq);

	if (!cfqd->active_cic) {
		struct cfq_io_context *cic = RQ_CIC(rq);

		atomic_inc(&cic->ioc->refcount);
		cfqd->active_cic = cic;
	}
}

/*
 * Find the cfqq that we need to service and move a request from that to the
 * dispatch list
 */
1122
static int cfq_dispatch_requests(struct request_queue *q, int force)
1123 1124
{
	struct cfq_data *cfqd = q->elevator->elevator_data;
J
Jens Axboe 已提交
1125
	struct cfq_queue *cfqq;
1126
	unsigned int max_dispatch;
1127 1128 1129 1130

	if (!cfqd->busy_queues)
		return 0;

1131 1132 1133
	if (unlikely(force))
		return cfq_forced_dispatch(cfqd);

1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146
	cfqq = cfq_select_queue(cfqd);
	if (!cfqq)
		return 0;

	/*
	 * If this is an async queue and we have sync IO in flight, let it wait
	 */
	if (cfqd->sync_flight && !cfq_cfqq_sync(cfqq))
		return 0;

	max_dispatch = cfqd->cfq_quantum;
	if (cfq_class_idle(cfqq))
		max_dispatch = 1;
1147

1148 1149 1150 1151 1152 1153 1154
	/*
	 * Does this cfqq already have too much IO in flight?
	 */
	if (cfqq->dispatched >= max_dispatch) {
		/*
		 * idle queue must always only have a single IO in flight
		 */
1155
		if (cfq_class_idle(cfqq))
1156
			return 0;
1157

1158 1159 1160 1161 1162
		/*
		 * We have other queues, don't allow more IO from this one
		 */
		if (cfqd->busy_queues > 1)
			return 0;
1163

1164 1165 1166 1167 1168 1169
		/*
		 * we are the only queue, allow up to 4 times of 'quantum'
		 */
		if (cfqq->dispatched >= 4 * max_dispatch)
			return 0;
	}
1170

1171 1172 1173 1174 1175
	/*
	 * Dispatch a request from this cfqq
	 */
	cfq_dispatch_request(cfqd, cfqq);
	cfqq->slice_dispatch++;
1176
	cfq_clear_cfqq_must_dispatch(cfqq);
1177

1178 1179 1180 1181 1182 1183 1184 1185 1186
	/*
	 * expire an async queue immediately if it has used up its slice. idle
	 * queue always expire after 1 dispatch round.
	 */
	if (cfqd->busy_queues > 1 && ((!cfq_cfqq_sync(cfqq) &&
	    cfqq->slice_dispatch >= cfq_prio_to_maxrq(cfqd, cfqq)) ||
	    cfq_class_idle(cfqq))) {
		cfqq->slice_end = jiffies + 1;
		cfq_slice_expired(cfqd, 0);
L
Linus Torvalds 已提交
1187 1188
	}

1189 1190
	cfq_log(cfqd, "dispatched a request");
	return 1;
L
Linus Torvalds 已提交
1191 1192 1193
}

/*
J
Jens Axboe 已提交
1194 1195
 * task holds one reference to the queue, dropped when task exits. each rq
 * in-flight on this queue also holds a reference, dropped when rq is freed.
L
Linus Torvalds 已提交
1196 1197 1198 1199 1200
 *
 * queue lock must be held here.
 */
static void cfq_put_queue(struct cfq_queue *cfqq)
{
1201 1202 1203
	struct cfq_data *cfqd = cfqq->cfqd;

	BUG_ON(atomic_read(&cfqq->ref) <= 0);
L
Linus Torvalds 已提交
1204 1205 1206 1207

	if (!atomic_dec_and_test(&cfqq->ref))
		return;

1208
	cfq_log_cfqq(cfqd, cfqq, "put_queue");
L
Linus Torvalds 已提交
1209
	BUG_ON(rb_first(&cfqq->sort_list));
1210
	BUG_ON(cfqq->allocated[READ] + cfqq->allocated[WRITE]);
J
Jens Axboe 已提交
1211
	BUG_ON(cfq_cfqq_on_rr(cfqq));
L
Linus Torvalds 已提交
1212

1213
	if (unlikely(cfqd->active_queue == cfqq)) {
1214
		__cfq_slice_expired(cfqd, cfqq, 0);
1215 1216
		cfq_schedule_dispatch(cfqd);
	}
1217

L
Linus Torvalds 已提交
1218 1219 1220
	kmem_cache_free(cfq_pool, cfqq);
}

1221 1222 1223
/*
 * Must always be called with the rcu_read_lock() held
 */
1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234
static void
__call_for_each_cic(struct io_context *ioc,
		    void (*func)(struct io_context *, struct cfq_io_context *))
{
	struct cfq_io_context *cic;
	struct hlist_node *n;

	hlist_for_each_entry_rcu(cic, n, &ioc->cic_list, cic_list)
		func(ioc, cic);
}

1235
/*
1236
 * Call func for each cic attached to this ioc.
1237
 */
1238
static void
1239 1240
call_for_each_cic(struct io_context *ioc,
		  void (*func)(struct io_context *, struct cfq_io_context *))
L
Linus Torvalds 已提交
1241
{
1242
	rcu_read_lock();
1243
	__call_for_each_cic(ioc, func);
1244
	rcu_read_unlock();
1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
}

static void cfq_cic_free_rcu(struct rcu_head *head)
{
	struct cfq_io_context *cic;

	cic = container_of(head, struct cfq_io_context, rcu_head);

	kmem_cache_free(cfq_ioc_pool, cic);
	elv_ioc_count_dec(ioc_count);

1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268
	if (ioc_gone) {
		/*
		 * CFQ scheduler is exiting, grab exit lock and check
		 * the pending io context count. If it hits zero,
		 * complete ioc_gone and set it back to NULL
		 */
		spin_lock(&ioc_gone_lock);
		if (ioc_gone && !elv_ioc_count_read(ioc_count)) {
			complete(ioc_gone);
			ioc_gone = NULL;
		}
		spin_unlock(&ioc_gone_lock);
	}
1269
}
1270

1271 1272 1273
static void cfq_cic_free(struct cfq_io_context *cic)
{
	call_rcu(&cic->rcu_head, cfq_cic_free_rcu);
1274 1275 1276 1277 1278 1279 1280 1281 1282 1283
}

static void cic_free_func(struct io_context *ioc, struct cfq_io_context *cic)
{
	unsigned long flags;

	BUG_ON(!cic->dead_key);

	spin_lock_irqsave(&ioc->lock, flags);
	radix_tree_delete(&ioc->radix_root, cic->dead_key);
1284
	hlist_del_rcu(&cic->cic_list);
1285 1286
	spin_unlock_irqrestore(&ioc->lock, flags);

1287
	cfq_cic_free(cic);
1288 1289
}

1290 1291 1292 1293 1294
/*
 * Must be called with rcu_read_lock() held or preemption otherwise disabled.
 * Only two callers of this - ->dtor() which is called with the rcu_read_lock(),
 * and ->trim() which is called with the task lock held
 */
1295 1296 1297
static void cfq_free_io_context(struct io_context *ioc)
{
	/*
1298 1299 1300 1301
	 * ioc->refcount is zero here, or we are called from elv_unregister(),
	 * so no more cic's are allowed to be linked into this ioc.  So it
	 * should be ok to iterate over the known list, we will see all cic's
	 * since no new ones are added.
1302
	 */
1303
	__call_for_each_cic(ioc, cic_free_func);
L
Linus Torvalds 已提交
1304 1305
}

1306
static void cfq_exit_cfqq(struct cfq_data *cfqd, struct cfq_queue *cfqq)
L
Linus Torvalds 已提交
1307
{
1308
	if (unlikely(cfqq == cfqd->active_queue)) {
1309
		__cfq_slice_expired(cfqd, cfqq, 0);
1310 1311
		cfq_schedule_dispatch(cfqd);
	}
1312

1313 1314
	cfq_put_queue(cfqq);
}
1315

1316 1317 1318
static void __cfq_exit_single_io_context(struct cfq_data *cfqd,
					 struct cfq_io_context *cic)
{
1319 1320
	struct io_context *ioc = cic->ioc;

1321
	list_del_init(&cic->queue_list);
1322 1323 1324 1325

	/*
	 * Make sure key == NULL is seen for dead queues
	 */
1326
	smp_wmb();
1327
	cic->dead_key = (unsigned long) cic->key;
1328 1329
	cic->key = NULL;

1330 1331 1332
	if (ioc->ioc_data == cic)
		rcu_assign_pointer(ioc->ioc_data, NULL);

1333 1334 1335
	if (cic->cfqq[BLK_RW_ASYNC]) {
		cfq_exit_cfqq(cfqd, cic->cfqq[BLK_RW_ASYNC]);
		cic->cfqq[BLK_RW_ASYNC] = NULL;
1336 1337
	}

1338 1339 1340
	if (cic->cfqq[BLK_RW_SYNC]) {
		cfq_exit_cfqq(cfqd, cic->cfqq[BLK_RW_SYNC]);
		cic->cfqq[BLK_RW_SYNC] = NULL;
1341
	}
1342 1343
}

1344 1345
static void cfq_exit_single_io_context(struct io_context *ioc,
				       struct cfq_io_context *cic)
1346 1347 1348 1349
{
	struct cfq_data *cfqd = cic->key;

	if (cfqd) {
1350
		struct request_queue *q = cfqd->queue;
1351
		unsigned long flags;
1352

1353
		spin_lock_irqsave(q->queue_lock, flags);
1354 1355 1356 1357 1358 1359 1360 1361 1362

		/*
		 * Ensure we get a fresh copy of the ->key to prevent
		 * race between exiting task and queue
		 */
		smp_read_barrier_depends();
		if (cic->key)
			__cfq_exit_single_io_context(cfqd, cic);

1363
		spin_unlock_irqrestore(q->queue_lock, flags);
1364
	}
L
Linus Torvalds 已提交
1365 1366
}

1367 1368 1369 1370
/*
 * The process that ioc belongs to has exited, we need to clean up
 * and put the internal structures we have that belongs to that process.
 */
1371
static void cfq_exit_io_context(struct io_context *ioc)
L
Linus Torvalds 已提交
1372
{
1373
	call_for_each_cic(ioc, cfq_exit_single_io_context);
L
Linus Torvalds 已提交
1374 1375
}

1376
static struct cfq_io_context *
A
Al Viro 已提交
1377
cfq_alloc_io_context(struct cfq_data *cfqd, gfp_t gfp_mask)
L
Linus Torvalds 已提交
1378
{
1379
	struct cfq_io_context *cic;
L
Linus Torvalds 已提交
1380

1381 1382
	cic = kmem_cache_alloc_node(cfq_ioc_pool, gfp_mask | __GFP_ZERO,
							cfqd->queue->node);
L
Linus Torvalds 已提交
1383
	if (cic) {
1384
		cic->last_end_request = jiffies;
1385
		INIT_LIST_HEAD(&cic->queue_list);
1386
		INIT_HLIST_NODE(&cic->cic_list);
1387 1388
		cic->dtor = cfq_free_io_context;
		cic->exit = cfq_exit_io_context;
1389
		elv_ioc_count_inc(ioc_count);
L
Linus Torvalds 已提交
1390 1391 1392 1393 1394
	}

	return cic;
}

1395
static void cfq_init_prio_data(struct cfq_queue *cfqq, struct io_context *ioc)
1396 1397 1398 1399
{
	struct task_struct *tsk = current;
	int ioprio_class;

J
Jens Axboe 已提交
1400
	if (!cfq_cfqq_prio_changed(cfqq))
1401 1402
		return;

1403
	ioprio_class = IOPRIO_PRIO_CLASS(ioc->ioprio);
1404
	switch (ioprio_class) {
1405 1406 1407 1408
	default:
		printk(KERN_ERR "cfq: bad prio %x\n", ioprio_class);
	case IOPRIO_CLASS_NONE:
		/*
1409
		 * no prio set, inherit CPU scheduling settings
1410 1411
		 */
		cfqq->ioprio = task_nice_ioprio(tsk);
1412
		cfqq->ioprio_class = task_nice_ioclass(tsk);
1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426
		break;
	case IOPRIO_CLASS_RT:
		cfqq->ioprio = task_ioprio(ioc);
		cfqq->ioprio_class = IOPRIO_CLASS_RT;
		break;
	case IOPRIO_CLASS_BE:
		cfqq->ioprio = task_ioprio(ioc);
		cfqq->ioprio_class = IOPRIO_CLASS_BE;
		break;
	case IOPRIO_CLASS_IDLE:
		cfqq->ioprio_class = IOPRIO_CLASS_IDLE;
		cfqq->ioprio = 7;
		cfq_clear_cfqq_idle_window(cfqq);
		break;
1427 1428 1429 1430 1431 1432 1433 1434
	}

	/*
	 * keep track of original prio settings in case we have to temporarily
	 * elevate the priority of this queue
	 */
	cfqq->org_ioprio = cfqq->ioprio;
	cfqq->org_ioprio_class = cfqq->ioprio_class;
J
Jens Axboe 已提交
1435
	cfq_clear_cfqq_prio_changed(cfqq);
1436 1437
}

J
Jens Axboe 已提交
1438
static void changed_ioprio(struct io_context *ioc, struct cfq_io_context *cic)
1439
{
1440 1441
	struct cfq_data *cfqd = cic->key;
	struct cfq_queue *cfqq;
1442
	unsigned long flags;
1443

1444 1445 1446
	if (unlikely(!cfqd))
		return;

1447
	spin_lock_irqsave(cfqd->queue->queue_lock, flags);
1448

1449
	cfqq = cic->cfqq[BLK_RW_ASYNC];
1450 1451
	if (cfqq) {
		struct cfq_queue *new_cfqq;
1452 1453
		new_cfqq = cfq_get_queue(cfqd, BLK_RW_ASYNC, cic->ioc,
						GFP_ATOMIC);
1454
		if (new_cfqq) {
1455
			cic->cfqq[BLK_RW_ASYNC] = new_cfqq;
1456 1457
			cfq_put_queue(cfqq);
		}
1458
	}
1459

1460
	cfqq = cic->cfqq[BLK_RW_SYNC];
1461 1462 1463
	if (cfqq)
		cfq_mark_cfqq_prio_changed(cfqq);

1464
	spin_unlock_irqrestore(cfqd->queue->queue_lock, flags);
1465 1466
}

1467
static void cfq_ioc_set_ioprio(struct io_context *ioc)
1468
{
1469
	call_for_each_cic(ioc, changed_ioprio);
1470
	ioc->ioprio_changed = 0;
1471 1472 1473
}

static struct cfq_queue *
1474
cfq_find_alloc_queue(struct cfq_data *cfqd, int is_sync,
1475
		     struct io_context *ioc, gfp_t gfp_mask)
1476 1477
{
	struct cfq_queue *cfqq, *new_cfqq = NULL;
1478
	struct cfq_io_context *cic;
1479 1480

retry:
1481
	cic = cfq_cic_lookup(cfqd, ioc);
1482 1483
	/* cic always exists here */
	cfqq = cic_to_cfqq(cic, is_sync);
1484 1485 1486 1487 1488 1489

	if (!cfqq) {
		if (new_cfqq) {
			cfqq = new_cfqq;
			new_cfqq = NULL;
		} else if (gfp_mask & __GFP_WAIT) {
1490 1491 1492 1493 1494 1495
			/*
			 * Inform the allocator of the fact that we will
			 * just repeat this allocation if it fails, to allow
			 * the allocator to do whatever it needs to attempt to
			 * free memory.
			 */
1496
			spin_unlock_irq(cfqd->queue->queue_lock);
1497 1498 1499
			new_cfqq = kmem_cache_alloc_node(cfq_pool,
					gfp_mask | __GFP_NOFAIL | __GFP_ZERO,
					cfqd->queue->node);
1500 1501 1502
			spin_lock_irq(cfqd->queue->queue_lock);
			goto retry;
		} else {
1503 1504 1505
			cfqq = kmem_cache_alloc_node(cfq_pool,
					gfp_mask | __GFP_ZERO,
					cfqd->queue->node);
1506 1507 1508 1509
			if (!cfqq)
				goto out;
		}

1510
		RB_CLEAR_NODE(&cfqq->rb_node);
1511 1512 1513 1514
		INIT_LIST_HEAD(&cfqq->fifo);

		atomic_set(&cfqq->ref, 0);
		cfqq->cfqd = cfqd;
1515

J
Jens Axboe 已提交
1516
		cfq_mark_cfqq_prio_changed(cfqq);
1517

1518
		cfq_init_prio_data(cfqq, ioc);
1519 1520 1521 1522 1523 1524

		if (is_sync) {
			if (!cfq_class_idle(cfqq))
				cfq_mark_cfqq_idle_window(cfqq);
			cfq_mark_cfqq_sync(cfqq);
		}
1525 1526
		cfqq->pid = current->pid;
		cfq_log_cfqq(cfqd, cfqq, "alloced");
1527 1528 1529 1530 1531 1532 1533 1534 1535 1536
	}

	if (new_cfqq)
		kmem_cache_free(cfq_pool, new_cfqq);

out:
	WARN_ON((gfp_mask & __GFP_WAIT) && !cfqq);
	return cfqq;
}

1537 1538 1539
static struct cfq_queue **
cfq_async_queue_prio(struct cfq_data *cfqd, int ioprio_class, int ioprio)
{
1540
	switch (ioprio_class) {
1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551
	case IOPRIO_CLASS_RT:
		return &cfqd->async_cfqq[0][ioprio];
	case IOPRIO_CLASS_BE:
		return &cfqd->async_cfqq[1][ioprio];
	case IOPRIO_CLASS_IDLE:
		return &cfqd->async_idle_cfqq;
	default:
		BUG();
	}
}

1552
static struct cfq_queue *
1553
cfq_get_queue(struct cfq_data *cfqd, int is_sync, struct io_context *ioc,
1554 1555
	      gfp_t gfp_mask)
{
1556 1557
	const int ioprio = task_ioprio(ioc);
	const int ioprio_class = task_ioprio_class(ioc);
1558
	struct cfq_queue **async_cfqq = NULL;
1559 1560
	struct cfq_queue *cfqq = NULL;

1561 1562 1563 1564 1565
	if (!is_sync) {
		async_cfqq = cfq_async_queue_prio(cfqd, ioprio_class, ioprio);
		cfqq = *async_cfqq;
	}

1566
	if (!cfqq) {
1567
		cfqq = cfq_find_alloc_queue(cfqd, is_sync, ioc, gfp_mask);
1568 1569 1570
		if (!cfqq)
			return NULL;
	}
1571 1572 1573 1574

	/*
	 * pin the queue now that it's allocated, scheduler exit will prune it
	 */
1575
	if (!is_sync && !(*async_cfqq)) {
1576
		atomic_inc(&cfqq->ref);
1577
		*async_cfqq = cfqq;
1578 1579 1580 1581 1582 1583
	}

	atomic_inc(&cfqq->ref);
	return cfqq;
}

1584 1585 1586
/*
 * We drop cfq io contexts lazily, so we may find a dead one.
 */
1587
static void
1588 1589
cfq_drop_dead_cic(struct cfq_data *cfqd, struct io_context *ioc,
		  struct cfq_io_context *cic)
1590
{
1591 1592
	unsigned long flags;

1593
	WARN_ON(!list_empty(&cic->queue_list));
J
Jens Axboe 已提交
1594

1595 1596
	spin_lock_irqsave(&ioc->lock, flags);

1597
	BUG_ON(ioc->ioc_data == cic);
J
Jens Axboe 已提交
1598

1599
	radix_tree_delete(&ioc->radix_root, (unsigned long) cfqd);
1600
	hlist_del_rcu(&cic->cic_list);
1601 1602 1603
	spin_unlock_irqrestore(&ioc->lock, flags);

	cfq_cic_free(cic);
1604 1605
}

1606
static struct cfq_io_context *
1607
cfq_cic_lookup(struct cfq_data *cfqd, struct io_context *ioc)
1608 1609
{
	struct cfq_io_context *cic;
1610
	unsigned long flags;
1611
	void *k;
1612

1613 1614 1615
	if (unlikely(!ioc))
		return NULL;

1616 1617
	rcu_read_lock();

J
Jens Axboe 已提交
1618 1619 1620
	/*
	 * we maintain a last-hit cache, to avoid browsing over the tree
	 */
1621
	cic = rcu_dereference(ioc->ioc_data);
1622 1623
	if (cic && cic->key == cfqd) {
		rcu_read_unlock();
J
Jens Axboe 已提交
1624
		return cic;
1625
	}
J
Jens Axboe 已提交
1626

1627 1628 1629 1630 1631
	do {
		cic = radix_tree_lookup(&ioc->radix_root, (unsigned long) cfqd);
		rcu_read_unlock();
		if (!cic)
			break;
1632 1633 1634
		/* ->key must be copied to avoid race with cfq_exit_queue() */
		k = cic->key;
		if (unlikely(!k)) {
1635
			cfq_drop_dead_cic(cfqd, ioc, cic);
1636
			rcu_read_lock();
1637
			continue;
1638
		}
1639

1640
		spin_lock_irqsave(&ioc->lock, flags);
1641
		rcu_assign_pointer(ioc->ioc_data, cic);
1642
		spin_unlock_irqrestore(&ioc->lock, flags);
1643 1644
		break;
	} while (1);
1645

1646
	return cic;
1647 1648
}

1649 1650 1651 1652 1653
/*
 * Add cic into ioc, using cfqd as the search key. This enables us to lookup
 * the process specific cfq io context when entered from the block layer.
 * Also adds the cic to a per-cfqd list, used when this queue is removed.
 */
J
Jens Axboe 已提交
1654 1655
static int cfq_cic_link(struct cfq_data *cfqd, struct io_context *ioc,
			struct cfq_io_context *cic, gfp_t gfp_mask)
1656
{
1657
	unsigned long flags;
1658
	int ret;
1659

1660 1661 1662 1663
	ret = radix_tree_preload(gfp_mask);
	if (!ret) {
		cic->ioc = ioc;
		cic->key = cfqd;
1664

1665 1666 1667
		spin_lock_irqsave(&ioc->lock, flags);
		ret = radix_tree_insert(&ioc->radix_root,
						(unsigned long) cfqd, cic);
1668 1669
		if (!ret)
			hlist_add_head_rcu(&cic->cic_list, &ioc->cic_list);
1670
		spin_unlock_irqrestore(&ioc->lock, flags);
1671

1672 1673 1674 1675 1676 1677 1678
		radix_tree_preload_end();

		if (!ret) {
			spin_lock_irqsave(cfqd->queue->queue_lock, flags);
			list_add(&cic->queue_list, &cfqd->cic_list);
			spin_unlock_irqrestore(cfqd->queue->queue_lock, flags);
		}
1679 1680
	}

1681 1682
	if (ret)
		printk(KERN_ERR "cfq: cic link failed!\n");
1683

1684
	return ret;
1685 1686
}

L
Linus Torvalds 已提交
1687 1688 1689
/*
 * Setup general io context and cfq io context. There can be several cfq
 * io contexts per general io context, if this process is doing io to more
1690
 * than one device managed by cfq.
L
Linus Torvalds 已提交
1691 1692
 */
static struct cfq_io_context *
1693
cfq_get_io_context(struct cfq_data *cfqd, gfp_t gfp_mask)
L
Linus Torvalds 已提交
1694
{
1695
	struct io_context *ioc = NULL;
L
Linus Torvalds 已提交
1696 1697
	struct cfq_io_context *cic;

1698
	might_sleep_if(gfp_mask & __GFP_WAIT);
L
Linus Torvalds 已提交
1699

1700
	ioc = get_io_context(gfp_mask, cfqd->queue->node);
L
Linus Torvalds 已提交
1701 1702 1703
	if (!ioc)
		return NULL;

1704
	cic = cfq_cic_lookup(cfqd, ioc);
1705 1706
	if (cic)
		goto out;
L
Linus Torvalds 已提交
1707

1708 1709 1710
	cic = cfq_alloc_io_context(cfqd, gfp_mask);
	if (cic == NULL)
		goto err;
L
Linus Torvalds 已提交
1711

1712 1713 1714
	if (cfq_cic_link(cfqd, ioc, cic, gfp_mask))
		goto err_free;

L
Linus Torvalds 已提交
1715
out:
1716 1717 1718 1719
	smp_read_barrier_depends();
	if (unlikely(ioc->ioprio_changed))
		cfq_ioc_set_ioprio(ioc);

L
Linus Torvalds 已提交
1720
	return cic;
1721 1722
err_free:
	cfq_cic_free(cic);
L
Linus Torvalds 已提交
1723 1724 1725 1726 1727
err:
	put_io_context(ioc);
	return NULL;
}

1728 1729
static void
cfq_update_io_thinktime(struct cfq_data *cfqd, struct cfq_io_context *cic)
L
Linus Torvalds 已提交
1730
{
1731 1732
	unsigned long elapsed = jiffies - cic->last_end_request;
	unsigned long ttime = min(elapsed, 2UL * cfqd->cfq_slice_idle);
1733

1734 1735 1736 1737
	cic->ttime_samples = (7*cic->ttime_samples + 256) / 8;
	cic->ttime_total = (7*cic->ttime_total + 256*ttime) / 8;
	cic->ttime_mean = (cic->ttime_total + 128) / cic->ttime_samples;
}
L
Linus Torvalds 已提交
1738

1739
static void
J
Jens Axboe 已提交
1740 1741
cfq_update_io_seektime(struct cfq_data *cfqd, struct cfq_io_context *cic,
		       struct request *rq)
1742 1743 1744 1745
{
	sector_t sdist;
	u64 total;

J
Jens Axboe 已提交
1746 1747
	if (cic->last_request_pos < rq->sector)
		sdist = rq->sector - cic->last_request_pos;
1748
	else
J
Jens Axboe 已提交
1749
		sdist = cic->last_request_pos - rq->sector;
1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765

	/*
	 * Don't allow the seek distance to get too large from the
	 * odd fragment, pagein, etc
	 */
	if (cic->seek_samples <= 60) /* second&third seek */
		sdist = min(sdist, (cic->seek_mean * 4) + 2*1024*1024);
	else
		sdist = min(sdist, (cic->seek_mean * 4)	+ 2*1024*64);

	cic->seek_samples = (7*cic->seek_samples + 256) / 8;
	cic->seek_total = (7*cic->seek_total + (u64)256*sdist) / 8;
	total = cic->seek_total + (cic->seek_samples/2);
	do_div(total, cic->seek_samples);
	cic->seek_mean = (sector_t)total;
}
L
Linus Torvalds 已提交
1766

1767 1768 1769 1770 1771 1772 1773 1774
/*
 * Disable idle window if the process thinks too long or seeks so much that
 * it doesn't matter
 */
static void
cfq_update_idle_window(struct cfq_data *cfqd, struct cfq_queue *cfqq,
		       struct cfq_io_context *cic)
{
1775
	int old_idle, enable_idle;
1776

1777 1778 1779 1780
	/*
	 * Don't idle for async or idle io prio class
	 */
	if (!cfq_cfqq_sync(cfqq) || cfq_class_idle(cfqq))
1781 1782
		return;

1783
	enable_idle = old_idle = cfq_cfqq_idle_window(cfqq);
L
Linus Torvalds 已提交
1784

1785
	if (!atomic_read(&cic->ioc->nr_tasks) || !cfqd->cfq_slice_idle ||
1786
	    (cfqd->hw_tag && CIC_SEEKY(cic)))
1787 1788 1789 1790 1791 1792
		enable_idle = 0;
	else if (sample_valid(cic->ttime_samples)) {
		if (cic->ttime_mean > cfqd->cfq_slice_idle)
			enable_idle = 0;
		else
			enable_idle = 1;
L
Linus Torvalds 已提交
1793 1794
	}

1795 1796 1797 1798 1799 1800 1801
	if (old_idle != enable_idle) {
		cfq_log_cfqq(cfqd, cfqq, "idle=%d", enable_idle);
		if (enable_idle)
			cfq_mark_cfqq_idle_window(cfqq);
		else
			cfq_clear_cfqq_idle_window(cfqq);
	}
1802
}
L
Linus Torvalds 已提交
1803

1804 1805 1806 1807 1808 1809
/*
 * Check if new_cfqq should preempt the currently active queue. Return 0 for
 * no or if we aren't sure, a 1 will cause a preempt.
 */
static int
cfq_should_preempt(struct cfq_data *cfqd, struct cfq_queue *new_cfqq,
J
Jens Axboe 已提交
1810
		   struct request *rq)
1811
{
J
Jens Axboe 已提交
1812
	struct cfq_queue *cfqq;
1813

J
Jens Axboe 已提交
1814 1815
	cfqq = cfqd->active_queue;
	if (!cfqq)
1816 1817
		return 0;

J
Jens Axboe 已提交
1818 1819 1820 1821
	if (cfq_slice_used(cfqq))
		return 1;

	if (cfq_class_idle(new_cfqq))
1822
		return 0;
1823 1824 1825

	if (cfq_class_idle(cfqq))
		return 1;
1826

1827 1828 1829 1830
	/*
	 * if the new request is sync, but the currently running queue is
	 * not, let the sync request have priority.
	 */
J
Jens Axboe 已提交
1831
	if (rq_is_sync(rq) && !cfq_cfqq_sync(cfqq))
1832
		return 1;
1833

1834 1835 1836 1837 1838 1839
	/*
	 * So both queues are sync. Let the new request get disk time if
	 * it's a metadata request and the current queue is doing regular IO.
	 */
	if (rq_is_meta(rq) && !cfqq->meta_pending)
		return 1;
1840

1841 1842 1843 1844 1845 1846
	/*
	 * Allow an RT request to pre-empt an ongoing non-RT cfqq timeslice.
	 */
	if (cfq_class_rt(new_cfqq) && !cfq_class_rt(cfqq))
		return 1;

1847 1848 1849 1850 1851 1852 1853
	if (!cfqd->active_cic || !cfq_cfqq_wait_request(cfqq))
		return 0;

	/*
	 * if this request is as-good as one we would expect from the
	 * current cfqq, let it preempt
	 */
J
Jens Axboe 已提交
1854
	if (cfq_rq_close(cfqd, rq))
1855 1856
		return 1;

1857 1858 1859 1860 1861 1862 1863 1864 1865
	return 0;
}

/*
 * cfqq preempts the active queue. if we allowed preempt with no slice left,
 * let it have half of its nominal slice.
 */
static void cfq_preempt_queue(struct cfq_data *cfqd, struct cfq_queue *cfqq)
{
1866
	cfq_log_cfqq(cfqd, cfqq, "preempt");
1867
	cfq_slice_expired(cfqd, 1);
1868

1869 1870 1871 1872 1873
	/*
	 * Put the new queue at the front of the of the current list,
	 * so we know that it will be selected next.
	 */
	BUG_ON(!cfq_cfqq_on_rr(cfqq));
1874 1875

	cfq_service_tree_add(cfqd, cfqq, 1);
1876

1877 1878
	cfqq->slice_end = 0;
	cfq_mark_cfqq_slice_new(cfqq);
1879 1880 1881
}

/*
J
Jens Axboe 已提交
1882
 * Called when a new fs request (rq) is added (to cfqq). Check if there's
1883 1884 1885
 * something we should do about it
 */
static void
J
Jens Axboe 已提交
1886 1887
cfq_rq_enqueued(struct cfq_data *cfqd, struct cfq_queue *cfqq,
		struct request *rq)
1888
{
J
Jens Axboe 已提交
1889
	struct cfq_io_context *cic = RQ_CIC(rq);
1890

1891
	cfqd->rq_queued++;
1892 1893 1894
	if (rq_is_meta(rq))
		cfqq->meta_pending++;

J
Jens Axboe 已提交
1895
	cfq_update_io_thinktime(cfqd, cic);
J
Jens Axboe 已提交
1896
	cfq_update_io_seektime(cfqd, cic, rq);
J
Jens Axboe 已提交
1897 1898
	cfq_update_idle_window(cfqd, cfqq, cic);

J
Jens Axboe 已提交
1899
	cic->last_request_pos = rq->sector + rq->nr_sectors;
1900 1901 1902

	if (cfqq == cfqd->active_queue) {
		/*
1903 1904 1905
		 * Remember that we saw a request from this process, but
		 * don't start queuing just yet. Otherwise we risk seeing lots
		 * of tiny requests, because we disrupt the normal plugging
1906 1907
		 * and merging. If the request is already larger than a single
		 * page, let it rip immediately. For that case we assume that
1908 1909 1910
		 * merging is already done. Ditto for a busy system that
		 * has other work pending, don't risk delaying until the
		 * idle timer unplug to continue working.
1911
		 */
1912
		if (cfq_cfqq_wait_request(cfqq)) {
1913 1914
			if (blk_rq_bytes(rq) > PAGE_CACHE_SIZE ||
			    cfqd->busy_queues > 1) {
1915 1916 1917
				del_timer(&cfqd->idle_slice_timer);
				blk_start_queueing(cfqd->queue);
			}
1918
			cfq_mark_cfqq_must_dispatch(cfqq);
1919
		}
J
Jens Axboe 已提交
1920
	} else if (cfq_should_preempt(cfqd, cfqq, rq)) {
1921 1922 1923
		/*
		 * not the active queue - expire current slice if it is
		 * idle and has expired it's mean thinktime or this new queue
1924 1925
		 * has some old slice time left and is of higher priority or
		 * this new queue is RT and the current one is BE
1926 1927
		 */
		cfq_preempt_queue(cfqd, cfqq);
1928
		blk_start_queueing(cfqd->queue);
1929
	}
L
Linus Torvalds 已提交
1930 1931
}

1932
static void cfq_insert_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
1933
{
1934
	struct cfq_data *cfqd = q->elevator->elevator_data;
J
Jens Axboe 已提交
1935
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
1936

1937
	cfq_log_cfqq(cfqd, cfqq, "insert_request");
1938
	cfq_init_prio_data(cfqq, RQ_CIC(rq)->ioc);
L
Linus Torvalds 已提交
1939

J
Jens Axboe 已提交
1940
	cfq_add_rq_rb(rq);
L
Linus Torvalds 已提交
1941

1942 1943
	list_add_tail(&rq->queuelist, &cfqq->fifo);

J
Jens Axboe 已提交
1944
	cfq_rq_enqueued(cfqd, cfqq, rq);
L
Linus Torvalds 已提交
1945 1946
}

1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971
/*
 * Update hw_tag based on peak queue depth over 50 samples under
 * sufficient load.
 */
static void cfq_update_hw_tag(struct cfq_data *cfqd)
{
	if (cfqd->rq_in_driver > cfqd->rq_in_driver_peak)
		cfqd->rq_in_driver_peak = cfqd->rq_in_driver;

	if (cfqd->rq_queued <= CFQ_HW_QUEUE_MIN &&
	    cfqd->rq_in_driver <= CFQ_HW_QUEUE_MIN)
		return;

	if (cfqd->hw_tag_samples++ < 50)
		return;

	if (cfqd->rq_in_driver_peak >= CFQ_HW_QUEUE_MIN)
		cfqd->hw_tag = 1;
	else
		cfqd->hw_tag = 0;

	cfqd->hw_tag_samples = 0;
	cfqd->rq_in_driver_peak = 0;
}

1972
static void cfq_completed_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
1973
{
J
Jens Axboe 已提交
1974
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
1975
	struct cfq_data *cfqd = cfqq->cfqd;
1976
	const int sync = rq_is_sync(rq);
1977
	unsigned long now;
L
Linus Torvalds 已提交
1978

1979
	now = jiffies;
1980
	cfq_log_cfqq(cfqd, cfqq, "complete");
L
Linus Torvalds 已提交
1981

1982 1983
	cfq_update_hw_tag(cfqd);

1984
	WARN_ON(!cfqd->rq_in_driver);
J
Jens Axboe 已提交
1985
	WARN_ON(!cfqq->dispatched);
1986
	cfqd->rq_in_driver--;
J
Jens Axboe 已提交
1987
	cfqq->dispatched--;
L
Linus Torvalds 已提交
1988

1989 1990 1991
	if (cfq_cfqq_sync(cfqq))
		cfqd->sync_flight--;

1992 1993
	if (!cfq_class_idle(cfqq))
		cfqd->last_end_request = now;
J
Jens Axboe 已提交
1994

1995
	if (sync)
J
Jens Axboe 已提交
1996
		RQ_CIC(rq)->last_end_request = now;
1997 1998 1999 2000 2001 2002

	/*
	 * If this is the active queue, check if it needs to be expired,
	 * or if we want to idle in case it has no pending requests.
	 */
	if (cfqd->active_queue == cfqq) {
2003 2004 2005 2006
		if (cfq_cfqq_slice_new(cfqq)) {
			cfq_set_prio_slice(cfqd, cfqq);
			cfq_clear_cfqq_slice_new(cfqq);
		}
2007
		if (cfq_slice_used(cfqq) || cfq_class_idle(cfqq))
2008
			cfq_slice_expired(cfqd, 1);
2009 2010
		else if (sync && !rq_noidle(rq) &&
			 RB_EMPTY_ROOT(&cfqq->sort_list)) {
J
Jens Axboe 已提交
2011
			cfq_arm_slice_timer(cfqd);
2012
		}
2013
	}
J
Jens Axboe 已提交
2014 2015 2016

	if (!cfqd->rq_in_driver)
		cfq_schedule_dispatch(cfqd);
L
Linus Torvalds 已提交
2017 2018
}

2019 2020 2021 2022 2023
/*
 * we temporarily boost lower priority queues if they are holding fs exclusive
 * resources. they are boosted to normal prio (CLASS_BE/4)
 */
static void cfq_prio_boost(struct cfq_queue *cfqq)
L
Linus Torvalds 已提交
2024
{
2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043
	if (has_fs_excl()) {
		/*
		 * boost idle prio on transactions that would lock out other
		 * users of the filesystem
		 */
		if (cfq_class_idle(cfqq))
			cfqq->ioprio_class = IOPRIO_CLASS_BE;
		if (cfqq->ioprio > IOPRIO_NORM)
			cfqq->ioprio = IOPRIO_NORM;
	} else {
		/*
		 * check if we need to unboost the queue
		 */
		if (cfqq->ioprio_class != cfqq->org_ioprio_class)
			cfqq->ioprio_class = cfqq->org_ioprio_class;
		if (cfqq->ioprio != cfqq->org_ioprio)
			cfqq->ioprio = cfqq->org_ioprio;
	}
}
L
Linus Torvalds 已提交
2044

2045
static inline int __cfq_may_queue(struct cfq_queue *cfqq)
2046
{
J
Jens Axboe 已提交
2047
	if ((cfq_cfqq_wait_request(cfqq) || cfq_cfqq_must_alloc(cfqq)) &&
A
Andrew Morton 已提交
2048
	    !cfq_cfqq_must_alloc_slice(cfqq)) {
J
Jens Axboe 已提交
2049
		cfq_mark_cfqq_must_alloc_slice(cfqq);
2050
		return ELV_MQUEUE_MUST;
J
Jens Axboe 已提交
2051
	}
L
Linus Torvalds 已提交
2052

2053 2054 2055
	return ELV_MQUEUE_MAY;
}

2056
static int cfq_may_queue(struct request_queue *q, int rw)
2057 2058 2059
{
	struct cfq_data *cfqd = q->elevator->elevator_data;
	struct task_struct *tsk = current;
2060
	struct cfq_io_context *cic;
2061 2062 2063 2064 2065 2066 2067 2068
	struct cfq_queue *cfqq;

	/*
	 * don't force setup of a queue from here, as a call to may_queue
	 * does not necessarily imply that a request actually will be queued.
	 * so just lookup a possibly existing queue, or return 'may queue'
	 * if that fails
	 */
2069
	cic = cfq_cic_lookup(cfqd, tsk->io_context);
2070 2071 2072
	if (!cic)
		return ELV_MQUEUE_MAY;

2073
	cfqq = cic_to_cfqq(cic, rw_is_sync(rw));
2074
	if (cfqq) {
2075
		cfq_init_prio_data(cfqq, cic->ioc);
2076 2077
		cfq_prio_boost(cfqq);

2078
		return __cfq_may_queue(cfqq);
2079 2080 2081
	}

	return ELV_MQUEUE_MAY;
L
Linus Torvalds 已提交
2082 2083 2084 2085 2086
}

/*
 * queue lock held here
 */
2087
static void cfq_put_request(struct request *rq)
L
Linus Torvalds 已提交
2088
{
J
Jens Axboe 已提交
2089
	struct cfq_queue *cfqq = RQ_CFQQ(rq);
L
Linus Torvalds 已提交
2090

J
Jens Axboe 已提交
2091
	if (cfqq) {
2092
		const int rw = rq_data_dir(rq);
L
Linus Torvalds 已提交
2093

2094 2095
		BUG_ON(!cfqq->allocated[rw]);
		cfqq->allocated[rw]--;
L
Linus Torvalds 已提交
2096

J
Jens Axboe 已提交
2097
		put_io_context(RQ_CIC(rq)->ioc);
L
Linus Torvalds 已提交
2098 2099

		rq->elevator_private = NULL;
J
Jens Axboe 已提交
2100
		rq->elevator_private2 = NULL;
L
Linus Torvalds 已提交
2101 2102 2103 2104 2105 2106

		cfq_put_queue(cfqq);
	}
}

/*
2107
 * Allocate cfq data structures associated with this request.
L
Linus Torvalds 已提交
2108
 */
2109
static int
2110
cfq_set_request(struct request_queue *q, struct request *rq, gfp_t gfp_mask)
L
Linus Torvalds 已提交
2111 2112 2113 2114
{
	struct cfq_data *cfqd = q->elevator->elevator_data;
	struct cfq_io_context *cic;
	const int rw = rq_data_dir(rq);
2115
	const int is_sync = rq_is_sync(rq);
2116
	struct cfq_queue *cfqq;
L
Linus Torvalds 已提交
2117 2118 2119 2120
	unsigned long flags;

	might_sleep_if(gfp_mask & __GFP_WAIT);

2121
	cic = cfq_get_io_context(cfqd, gfp_mask);
2122

L
Linus Torvalds 已提交
2123 2124
	spin_lock_irqsave(q->queue_lock, flags);

2125 2126 2127
	if (!cic)
		goto queue_fail;

2128 2129
	cfqq = cic_to_cfqq(cic, is_sync);
	if (!cfqq) {
2130
		cfqq = cfq_get_queue(cfqd, is_sync, cic->ioc, gfp_mask);
2131

2132 2133
		if (!cfqq)
			goto queue_fail;
L
Linus Torvalds 已提交
2134

2135 2136
		cic_set_cfqq(cic, cfqq, is_sync);
	}
L
Linus Torvalds 已提交
2137 2138

	cfqq->allocated[rw]++;
J
Jens Axboe 已提交
2139
	cfq_clear_cfqq_must_alloc(cfqq);
2140
	atomic_inc(&cfqq->ref);
L
Linus Torvalds 已提交
2141

J
Jens Axboe 已提交
2142
	spin_unlock_irqrestore(q->queue_lock, flags);
J
Jens Axboe 已提交
2143

J
Jens Axboe 已提交
2144 2145 2146
	rq->elevator_private = cic;
	rq->elevator_private2 = cfqq;
	return 0;
L
Linus Torvalds 已提交
2147

2148 2149 2150
queue_fail:
	if (cic)
		put_io_context(cic->ioc);
2151

J
Jens Axboe 已提交
2152
	cfq_schedule_dispatch(cfqd);
L
Linus Torvalds 已提交
2153
	spin_unlock_irqrestore(q->queue_lock, flags);
2154
	cfq_log(cfqd, "set_request fail");
L
Linus Torvalds 已提交
2155 2156 2157
	return 1;
}

2158
static void cfq_kick_queue(struct work_struct *work)
2159
{
2160 2161
	struct cfq_data *cfqd =
		container_of(work, struct cfq_data, unplug_work);
2162
	struct request_queue *q = cfqd->queue;
2163

2164
	spin_lock_irq(q->queue_lock);
2165
	blk_start_queueing(q);
2166
	spin_unlock_irq(q->queue_lock);
2167 2168 2169 2170 2171 2172 2173 2174 2175 2176
}

/*
 * Timer running if the active_queue is currently idling inside its time slice
 */
static void cfq_idle_slice_timer(unsigned long data)
{
	struct cfq_data *cfqd = (struct cfq_data *) data;
	struct cfq_queue *cfqq;
	unsigned long flags;
2177
	int timed_out = 1;
2178

2179 2180
	cfq_log(cfqd, "idle timer fired");

2181 2182
	spin_lock_irqsave(cfqd->queue->queue_lock, flags);

2183 2184
	cfqq = cfqd->active_queue;
	if (cfqq) {
2185 2186
		timed_out = 0;

2187 2188 2189 2190 2191 2192
		/*
		 * We saw a request before the queue expired, let it through
		 */
		if (cfq_cfqq_must_dispatch(cfqq))
			goto out_kick;

2193 2194 2195
		/*
		 * expired
		 */
2196
		if (cfq_slice_used(cfqq))
2197 2198 2199 2200 2201 2202
			goto expire;

		/*
		 * only expire and reinvoke request handler, if there are
		 * other queues with pending requests
		 */
2203
		if (!cfqd->busy_queues)
2204 2205 2206 2207 2208
			goto out_cont;

		/*
		 * not expired and it has a request pending, let it dispatch
		 */
2209
		if (!RB_EMPTY_ROOT(&cfqq->sort_list))
2210 2211 2212
			goto out_kick;
	}
expire:
2213
	cfq_slice_expired(cfqd, timed_out);
2214
out_kick:
J
Jens Axboe 已提交
2215
	cfq_schedule_dispatch(cfqd);
2216 2217 2218 2219
out_cont:
	spin_unlock_irqrestore(cfqd->queue->queue_lock, flags);
}

J
Jens Axboe 已提交
2220 2221 2222
static void cfq_shutdown_timer_wq(struct cfq_data *cfqd)
{
	del_timer_sync(&cfqd->idle_slice_timer);
2223
	cancel_work_sync(&cfqd->unplug_work);
J
Jens Axboe 已提交
2224
}
2225

2226 2227 2228 2229 2230 2231 2232 2233 2234 2235
static void cfq_put_async_queues(struct cfq_data *cfqd)
{
	int i;

	for (i = 0; i < IOPRIO_BE_NR; i++) {
		if (cfqd->async_cfqq[0][i])
			cfq_put_queue(cfqd->async_cfqq[0][i]);
		if (cfqd->async_cfqq[1][i])
			cfq_put_queue(cfqd->async_cfqq[1][i]);
	}
2236 2237 2238

	if (cfqd->async_idle_cfqq)
		cfq_put_queue(cfqd->async_idle_cfqq);
2239 2240
}

J
Jens Axboe 已提交
2241
static void cfq_exit_queue(struct elevator_queue *e)
L
Linus Torvalds 已提交
2242
{
2243
	struct cfq_data *cfqd = e->elevator_data;
2244
	struct request_queue *q = cfqd->queue;
2245

J
Jens Axboe 已提交
2246
	cfq_shutdown_timer_wq(cfqd);
2247

2248
	spin_lock_irq(q->queue_lock);
2249

2250
	if (cfqd->active_queue)
2251
		__cfq_slice_expired(cfqd, cfqd->active_queue, 0);
2252 2253

	while (!list_empty(&cfqd->cic_list)) {
2254 2255 2256
		struct cfq_io_context *cic = list_entry(cfqd->cic_list.next,
							struct cfq_io_context,
							queue_list);
2257 2258

		__cfq_exit_single_io_context(cfqd, cic);
2259
	}
2260

2261
	cfq_put_async_queues(cfqd);
2262

2263
	spin_unlock_irq(q->queue_lock);
2264 2265 2266 2267

	cfq_shutdown_timer_wq(cfqd);

	kfree(cfqd);
L
Linus Torvalds 已提交
2268 2269
}

2270
static void *cfq_init_queue(struct request_queue *q)
L
Linus Torvalds 已提交
2271 2272 2273
{
	struct cfq_data *cfqd;

2274
	cfqd = kmalloc_node(sizeof(*cfqd), GFP_KERNEL | __GFP_ZERO, q->node);
L
Linus Torvalds 已提交
2275
	if (!cfqd)
J
Jens Axboe 已提交
2276
		return NULL;
L
Linus Torvalds 已提交
2277

2278
	cfqd->service_tree = CFQ_RB_ROOT;
2279
	INIT_LIST_HEAD(&cfqd->cic_list);
L
Linus Torvalds 已提交
2280 2281 2282

	cfqd->queue = q;

2283 2284 2285 2286
	init_timer(&cfqd->idle_slice_timer);
	cfqd->idle_slice_timer.function = cfq_idle_slice_timer;
	cfqd->idle_slice_timer.data = (unsigned long) cfqd;

2287
	INIT_WORK(&cfqd->unplug_work, cfq_kick_queue);
2288

O
Oleg Nesterov 已提交
2289
	cfqd->last_end_request = jiffies;
L
Linus Torvalds 已提交
2290
	cfqd->cfq_quantum = cfq_quantum;
2291 2292
	cfqd->cfq_fifo_expire[0] = cfq_fifo_expire[0];
	cfqd->cfq_fifo_expire[1] = cfq_fifo_expire[1];
L
Linus Torvalds 已提交
2293 2294
	cfqd->cfq_back_max = cfq_back_max;
	cfqd->cfq_back_penalty = cfq_back_penalty;
2295 2296 2297 2298
	cfqd->cfq_slice[0] = cfq_slice_async;
	cfqd->cfq_slice[1] = cfq_slice_sync;
	cfqd->cfq_slice_async_rq = cfq_slice_async_rq;
	cfqd->cfq_slice_idle = cfq_slice_idle;
2299
	cfqd->hw_tag = 1;
J
Jens Axboe 已提交
2300

J
Jens Axboe 已提交
2301
	return cfqd;
L
Linus Torvalds 已提交
2302 2303 2304 2305
}

static void cfq_slab_kill(void)
{
2306 2307 2308 2309
	/*
	 * Caller already ensured that pending RCU callbacks are completed,
	 * so we should have no busy allocations at this point.
	 */
L
Linus Torvalds 已提交
2310 2311 2312 2313 2314 2315 2316 2317
	if (cfq_pool)
		kmem_cache_destroy(cfq_pool);
	if (cfq_ioc_pool)
		kmem_cache_destroy(cfq_ioc_pool);
}

static int __init cfq_slab_setup(void)
{
2318
	cfq_pool = KMEM_CACHE(cfq_queue, 0);
L
Linus Torvalds 已提交
2319 2320 2321
	if (!cfq_pool)
		goto fail;

2322
	cfq_ioc_pool = KMEM_CACHE(cfq_io_context, 0);
L
Linus Torvalds 已提交
2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350
	if (!cfq_ioc_pool)
		goto fail;

	return 0;
fail:
	cfq_slab_kill();
	return -ENOMEM;
}

/*
 * sysfs parts below -->
 */
static ssize_t
cfq_var_show(unsigned int var, char *page)
{
	return sprintf(page, "%d\n", var);
}

static ssize_t
cfq_var_store(unsigned int *var, const char *page, size_t count)
{
	char *p = (char *) page;

	*var = simple_strtoul(p, &p, 10);
	return count;
}

#define SHOW_FUNCTION(__FUNC, __VAR, __CONV)				\
J
Jens Axboe 已提交
2351
static ssize_t __FUNC(struct elevator_queue *e, char *page)		\
L
Linus Torvalds 已提交
2352
{									\
2353
	struct cfq_data *cfqd = e->elevator_data;			\
L
Linus Torvalds 已提交
2354 2355 2356 2357 2358 2359
	unsigned int __data = __VAR;					\
	if (__CONV)							\
		__data = jiffies_to_msecs(__data);			\
	return cfq_var_show(__data, (page));				\
}
SHOW_FUNCTION(cfq_quantum_show, cfqd->cfq_quantum, 0);
2360 2361
SHOW_FUNCTION(cfq_fifo_expire_sync_show, cfqd->cfq_fifo_expire[1], 1);
SHOW_FUNCTION(cfq_fifo_expire_async_show, cfqd->cfq_fifo_expire[0], 1);
2362 2363
SHOW_FUNCTION(cfq_back_seek_max_show, cfqd->cfq_back_max, 0);
SHOW_FUNCTION(cfq_back_seek_penalty_show, cfqd->cfq_back_penalty, 0);
2364 2365 2366 2367
SHOW_FUNCTION(cfq_slice_idle_show, cfqd->cfq_slice_idle, 1);
SHOW_FUNCTION(cfq_slice_sync_show, cfqd->cfq_slice[1], 1);
SHOW_FUNCTION(cfq_slice_async_show, cfqd->cfq_slice[0], 1);
SHOW_FUNCTION(cfq_slice_async_rq_show, cfqd->cfq_slice_async_rq, 0);
L
Linus Torvalds 已提交
2368 2369 2370
#undef SHOW_FUNCTION

#define STORE_FUNCTION(__FUNC, __PTR, MIN, MAX, __CONV)			\
J
Jens Axboe 已提交
2371
static ssize_t __FUNC(struct elevator_queue *e, const char *page, size_t count)	\
L
Linus Torvalds 已提交
2372
{									\
2373
	struct cfq_data *cfqd = e->elevator_data;			\
L
Linus Torvalds 已提交
2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386
	unsigned int __data;						\
	int ret = cfq_var_store(&__data, (page), count);		\
	if (__data < (MIN))						\
		__data = (MIN);						\
	else if (__data > (MAX))					\
		__data = (MAX);						\
	if (__CONV)							\
		*(__PTR) = msecs_to_jiffies(__data);			\
	else								\
		*(__PTR) = __data;					\
	return ret;							\
}
STORE_FUNCTION(cfq_quantum_store, &cfqd->cfq_quantum, 1, UINT_MAX, 0);
2387 2388 2389 2390
STORE_FUNCTION(cfq_fifo_expire_sync_store, &cfqd->cfq_fifo_expire[1], 1,
		UINT_MAX, 1);
STORE_FUNCTION(cfq_fifo_expire_async_store, &cfqd->cfq_fifo_expire[0], 1,
		UINT_MAX, 1);
2391
STORE_FUNCTION(cfq_back_seek_max_store, &cfqd->cfq_back_max, 0, UINT_MAX, 0);
2392 2393
STORE_FUNCTION(cfq_back_seek_penalty_store, &cfqd->cfq_back_penalty, 1,
		UINT_MAX, 0);
2394 2395 2396
STORE_FUNCTION(cfq_slice_idle_store, &cfqd->cfq_slice_idle, 0, UINT_MAX, 1);
STORE_FUNCTION(cfq_slice_sync_store, &cfqd->cfq_slice[1], 1, UINT_MAX, 1);
STORE_FUNCTION(cfq_slice_async_store, &cfqd->cfq_slice[0], 1, UINT_MAX, 1);
2397 2398
STORE_FUNCTION(cfq_slice_async_rq_store, &cfqd->cfq_slice_async_rq, 1,
		UINT_MAX, 0);
L
Linus Torvalds 已提交
2399 2400
#undef STORE_FUNCTION

2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414
#define CFQ_ATTR(name) \
	__ATTR(name, S_IRUGO|S_IWUSR, cfq_##name##_show, cfq_##name##_store)

static struct elv_fs_entry cfq_attrs[] = {
	CFQ_ATTR(quantum),
	CFQ_ATTR(fifo_expire_sync),
	CFQ_ATTR(fifo_expire_async),
	CFQ_ATTR(back_seek_max),
	CFQ_ATTR(back_seek_penalty),
	CFQ_ATTR(slice_sync),
	CFQ_ATTR(slice_async),
	CFQ_ATTR(slice_async_rq),
	CFQ_ATTR(slice_idle),
	__ATTR_NULL
L
Linus Torvalds 已提交
2415 2416 2417 2418 2419 2420 2421
};

static struct elevator_type iosched_cfq = {
	.ops = {
		.elevator_merge_fn = 		cfq_merge,
		.elevator_merged_fn =		cfq_merged_request,
		.elevator_merge_req_fn =	cfq_merged_requests,
2422
		.elevator_allow_merge_fn =	cfq_allow_merge,
2423
		.elevator_dispatch_fn =		cfq_dispatch_requests,
L
Linus Torvalds 已提交
2424
		.elevator_add_req_fn =		cfq_insert_request,
2425
		.elevator_activate_req_fn =	cfq_activate_request,
L
Linus Torvalds 已提交
2426 2427 2428
		.elevator_deactivate_req_fn =	cfq_deactivate_request,
		.elevator_queue_empty_fn =	cfq_queue_empty,
		.elevator_completed_req_fn =	cfq_completed_request,
2429 2430
		.elevator_former_req_fn =	elv_rb_former_request,
		.elevator_latter_req_fn =	elv_rb_latter_request,
L
Linus Torvalds 已提交
2431 2432 2433 2434 2435
		.elevator_set_req_fn =		cfq_set_request,
		.elevator_put_req_fn =		cfq_put_request,
		.elevator_may_queue_fn =	cfq_may_queue,
		.elevator_init_fn =		cfq_init_queue,
		.elevator_exit_fn =		cfq_exit_queue,
2436
		.trim =				cfq_free_io_context,
L
Linus Torvalds 已提交
2437
	},
2438
	.elevator_attrs =	cfq_attrs,
L
Linus Torvalds 已提交
2439 2440 2441 2442 2443 2444
	.elevator_name =	"cfq",
	.elevator_owner =	THIS_MODULE,
};

static int __init cfq_init(void)
{
2445 2446 2447 2448 2449 2450 2451 2452
	/*
	 * could be 0 on HZ < 1000 setups
	 */
	if (!cfq_slice_async)
		cfq_slice_async = 1;
	if (!cfq_slice_idle)
		cfq_slice_idle = 1;

L
Linus Torvalds 已提交
2453 2454 2455
	if (cfq_slab_setup())
		return -ENOMEM;

2456
	elv_register(&iosched_cfq);
L
Linus Torvalds 已提交
2457

2458
	return 0;
L
Linus Torvalds 已提交
2459 2460 2461 2462
}

static void __exit cfq_exit(void)
{
2463
	DECLARE_COMPLETION_ONSTACK(all_gone);
L
Linus Torvalds 已提交
2464
	elv_unregister(&iosched_cfq);
2465
	ioc_gone = &all_gone;
2466 2467
	/* ioc_gone's update must be visible before reading ioc_count */
	smp_wmb();
2468 2469 2470 2471 2472

	/*
	 * this also protects us from entering cfq_slab_kill() with
	 * pending RCU callbacks
	 */
2473
	if (elv_ioc_count_read(ioc_count))
2474
		wait_for_completion(&all_gone);
2475
	cfq_slab_kill();
L
Linus Torvalds 已提交
2476 2477 2478 2479 2480 2481 2482 2483
}

module_init(cfq_init);
module_exit(cfq_exit);

MODULE_AUTHOR("Jens Axboe");
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Completely Fair Queueing IO scheduler");