elevator.c 25.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 *  Block device elevator/IO-scheduler.
 *
 *  Copyright (C) 2000 Andrea Arcangeli <andrea@suse.de> SuSE
 *
6
 * 30042000 Jens Axboe <axboe@kernel.dk> :
L
Linus Torvalds 已提交
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33
 *
 * Split the elevator a bit so that it is possible to choose a different
 * one or even write a new "plug in". There are three pieces:
 * - elevator_fn, inserts a new request in the queue list
 * - elevator_merge_fn, decides whether a new buffer can be merged with
 *   an existing request
 * - elevator_dequeue_fn, called when a request is taken off the active list
 *
 * 20082000 Dave Jones <davej@suse.de> :
 * Removed tests for max-bomb-segments, which was breaking elvtune
 *  when run without -bN
 *
 * Jens:
 * - Rework again to work with bio instead of buffer_heads
 * - loose bi_dev comparisons, partition handling is right now
 * - completely modularize elevator setup and teardown
 *
 */
#include <linux/kernel.h>
#include <linux/fs.h>
#include <linux/blkdev.h>
#include <linux/elevator.h>
#include <linux/bio.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/compiler.h>
T
Tejun Heo 已提交
34
#include <linux/delay.h>
35
#include <linux/blktrace_api.h>
36
#include <linux/hash.h>
37
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
38

39 40
#include <trace/events/block.h>

J
Jens Axboe 已提交
41 42
#include "blk.h"

L
Linus Torvalds 已提交
43 44 45
static DEFINE_SPINLOCK(elv_list_lock);
static LIST_HEAD(elv_list);

46 47 48 49 50
/*
 * Merge hash stuff.
 */
static const int elv_hash_shift = 6;
#define ELV_HASH_BLOCK(sec)	((sec) >> 3)
51 52
#define ELV_HASH_FN(sec)	\
		(hash_long(ELV_HASH_BLOCK((sec)), elv_hash_shift))
53
#define ELV_HASH_ENTRIES	(1 << elv_hash_shift)
54
#define rq_hash_key(rq)		(blk_rq_pos(rq) + blk_rq_sectors(rq))
55

56 57 58 59 60 61
/*
 * Query io scheduler to see if the current process issuing bio may be
 * merged with rq.
 */
static int elv_iosched_allow_merge(struct request *rq, struct bio *bio)
{
62
	struct request_queue *q = rq->q;
J
Jens Axboe 已提交
63
	struct elevator_queue *e = q->elevator;
64 65 66 67 68 69 70

	if (e->ops->elevator_allow_merge_fn)
		return e->ops->elevator_allow_merge_fn(q, rq, bio);

	return 1;
}

L
Linus Torvalds 已提交
71 72 73
/*
 * can we safely merge with this request?
 */
74
int elv_rq_merge_ok(struct request *rq, struct bio *bio)
L
Linus Torvalds 已提交
75 76 77 78
{
	if (!rq_mergeable(rq))
		return 0;

79 80 81
	/*
	 * Don't merge file system requests and discard requests
	 */
82 83
	if (bio_rw_flagged(bio, BIO_RW_DISCARD) !=
	    bio_rw_flagged(rq->bio, BIO_RW_DISCARD))
84 85
		return 0;

L
Linus Torvalds 已提交
86 87 88 89 90 91 92
	/*
	 * different data direction or already started, don't merge
	 */
	if (bio_data_dir(bio) != rq_data_dir(rq))
		return 0;

	/*
93
	 * must be same device and not a special request
L
Linus Torvalds 已提交
94
	 */
95
	if (rq->rq_disk != bio->bi_bdev->bd_disk || rq->special)
96 97
		return 0;

98 99 100 101 102 103
	/*
	 * only merge integrity protected bio into ditto rq
	 */
	if (bio_integrity(bio) != blk_integrity_rq(rq))
		return 0;

104 105
	if (!elv_iosched_allow_merge(rq, bio))
		return 0;
L
Linus Torvalds 已提交
106

107
	return 1;
L
Linus Torvalds 已提交
108 109 110
}
EXPORT_SYMBOL(elv_rq_merge_ok);

111
static inline int elv_try_merge(struct request *__rq, struct bio *bio)
L
Linus Torvalds 已提交
112 113 114 115 116 117 118
{
	int ret = ELEVATOR_NO_MERGE;

	/*
	 * we can merge and sequence is ok, check if it's possible
	 */
	if (elv_rq_merge_ok(__rq, bio)) {
119
		if (blk_rq_pos(__rq) + blk_rq_sectors(__rq) == bio->bi_sector)
L
Linus Torvalds 已提交
120
			ret = ELEVATOR_BACK_MERGE;
121
		else if (blk_rq_pos(__rq) - bio_sectors(bio) == bio->bi_sector)
L
Linus Torvalds 已提交
122 123 124 125 126 127 128 129
			ret = ELEVATOR_FRONT_MERGE;
	}

	return ret;
}

static struct elevator_type *elevator_find(const char *name)
{
130
	struct elevator_type *e;
L
Linus Torvalds 已提交
131

132
	list_for_each_entry(e, &elv_list, list) {
133 134
		if (!strcmp(e->elevator_name, name))
			return e;
L
Linus Torvalds 已提交
135 136
	}

137
	return NULL;
L
Linus Torvalds 已提交
138 139 140 141 142 143 144 145 146
}

static void elevator_put(struct elevator_type *e)
{
	module_put(e->elevator_owner);
}

static struct elevator_type *elevator_get(const char *name)
{
147
	struct elevator_type *e;
L
Linus Torvalds 已提交
148

149
	spin_lock(&elv_list_lock);
150 151

	e = elevator_find(name);
152 153 154 155 156
	if (!e) {
		char elv[ELV_NAME_MAX + strlen("-iosched")];

		spin_unlock(&elv_list_lock);

157
		snprintf(elv, sizeof(elv), "%s-iosched", name);
158

159
		request_module("%s", elv);
160 161 162 163
		spin_lock(&elv_list_lock);
		e = elevator_find(name);
	}

164 165 166
	if (e && !try_module_get(e->elevator_owner))
		e = NULL;

167
	spin_unlock(&elv_list_lock);
L
Linus Torvalds 已提交
168 169 170 171

	return e;
}

172 173
static void *elevator_init_queue(struct request_queue *q,
				 struct elevator_queue *eq)
L
Linus Torvalds 已提交
174
{
175
	return eq->ops->elevator_init_fn(q);
J
Jens Axboe 已提交
176
}
L
Linus Torvalds 已提交
177

178
static void elevator_attach(struct request_queue *q, struct elevator_queue *eq,
J
Jens Axboe 已提交
179 180
			   void *data)
{
L
Linus Torvalds 已提交
181
	q->elevator = eq;
J
Jens Axboe 已提交
182
	eq->elevator_data = data;
L
Linus Torvalds 已提交
183 184 185 186
}

static char chosen_elevator[16];

187
static int __init elevator_setup(char *str)
L
Linus Torvalds 已提交
188
{
189 190 191 192
	/*
	 * Be backwards-compatible with previous kernels, so users
	 * won't get the wrong elevator.
	 */
193
	strncpy(chosen_elevator, str, sizeof(chosen_elevator) - 1);
194
	return 1;
L
Linus Torvalds 已提交
195 196 197 198
}

__setup("elevator=", elevator_setup);

199 200
static struct kobj_type elv_ktype;

J
Jens Axboe 已提交
201
static struct elevator_queue *elevator_alloc(struct request_queue *q,
202
				  struct elevator_type *e)
203
{
J
Jens Axboe 已提交
204
	struct elevator_queue *eq;
205 206
	int i;

J
Jens Axboe 已提交
207
	eq = kmalloc_node(sizeof(*eq), GFP_KERNEL | __GFP_ZERO, q->node);
208 209 210 211 212
	if (unlikely(!eq))
		goto err;

	eq->ops = &e->ops;
	eq->elevator_type = e;
213
	kobject_init(&eq->kobj, &elv_ktype);
214 215
	mutex_init(&eq->sysfs_lock);

216 217
	eq->hash = kmalloc_node(sizeof(struct hlist_head) * ELV_HASH_ENTRIES,
					GFP_KERNEL, q->node);
218 219 220 221 222 223
	if (!eq->hash)
		goto err;

	for (i = 0; i < ELV_HASH_ENTRIES; i++)
		INIT_HLIST_HEAD(&eq->hash[i]);

224
	return eq;
225 226 227 228
err:
	kfree(eq);
	elevator_put(e);
	return NULL;
229 230 231 232
}

static void elevator_release(struct kobject *kobj)
{
J
Jens Axboe 已提交
233
	struct elevator_queue *e;
234

J
Jens Axboe 已提交
235
	e = container_of(kobj, struct elevator_queue, kobj);
236
	elevator_put(e->elevator_type);
237
	kfree(e->hash);
238 239 240
	kfree(e);
}

241
int elevator_init(struct request_queue *q, char *name)
L
Linus Torvalds 已提交
242 243 244
{
	struct elevator_type *e = NULL;
	struct elevator_queue *eq;
J
Jens Axboe 已提交
245
	void *data;
L
Linus Torvalds 已提交
246

247 248 249
	if (unlikely(q->elevator))
		return 0;

T
Tejun Heo 已提交
250 251 252 253 254
	INIT_LIST_HEAD(&q->queue_head);
	q->last_merge = NULL;
	q->end_sector = 0;
	q->boundary_rq = NULL;

255 256 257 258 259
	if (name) {
		e = elevator_get(name);
		if (!e)
			return -EINVAL;
	}
L
Linus Torvalds 已提交
260

261 262 263 264 265 266
	if (!e && *chosen_elevator) {
		e = elevator_get(chosen_elevator);
		if (!e)
			printk(KERN_ERR "I/O scheduler %s not found\n",
							chosen_elevator);
	}
267

268 269 270 271 272 273 274 275
	if (!e) {
		e = elevator_get(CONFIG_DEFAULT_IOSCHED);
		if (!e) {
			printk(KERN_ERR
				"Default I/O scheduler not found. " \
				"Using noop.\n");
			e = elevator_get("noop");
		}
276 277
	}

278
	eq = elevator_alloc(q, e);
279
	if (!eq)
L
Linus Torvalds 已提交
280 281
		return -ENOMEM;

J
Jens Axboe 已提交
282 283
	data = elevator_init_queue(q, eq);
	if (!data) {
284
		kobject_put(&eq->kobj);
J
Jens Axboe 已提交
285 286
		return -ENOMEM;
	}
L
Linus Torvalds 已提交
287

J
Jens Axboe 已提交
288
	elevator_attach(q, eq, data);
289
	return 0;
L
Linus Torvalds 已提交
290
}
291 292
EXPORT_SYMBOL(elevator_init);

J
Jens Axboe 已提交
293
void elevator_exit(struct elevator_queue *e)
L
Linus Torvalds 已提交
294
{
295
	mutex_lock(&e->sysfs_lock);
L
Linus Torvalds 已提交
296 297
	if (e->ops->elevator_exit_fn)
		e->ops->elevator_exit_fn(e);
298 299
	e->ops = NULL;
	mutex_unlock(&e->sysfs_lock);
L
Linus Torvalds 已提交
300

301
	kobject_put(&e->kobj);
L
Linus Torvalds 已提交
302
}
303 304
EXPORT_SYMBOL(elevator_exit);

305 306 307 308 309
static inline void __elv_rqhash_del(struct request *rq)
{
	hlist_del_init(&rq->hash);
}

310
static void elv_rqhash_del(struct request_queue *q, struct request *rq)
311 312 313 314 315
{
	if (ELV_ON_HASH(rq))
		__elv_rqhash_del(rq);
}

316
static void elv_rqhash_add(struct request_queue *q, struct request *rq)
317
{
J
Jens Axboe 已提交
318
	struct elevator_queue *e = q->elevator;
319 320 321 322 323

	BUG_ON(ELV_ON_HASH(rq));
	hlist_add_head(&rq->hash, &e->hash[ELV_HASH_FN(rq_hash_key(rq))]);
}

324
static void elv_rqhash_reposition(struct request_queue *q, struct request *rq)
325 326 327 328 329
{
	__elv_rqhash_del(rq);
	elv_rqhash_add(q, rq);
}

330
static struct request *elv_rqhash_find(struct request_queue *q, sector_t offset)
331
{
J
Jens Axboe 已提交
332
	struct elevator_queue *e = q->elevator;
333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351
	struct hlist_head *hash_list = &e->hash[ELV_HASH_FN(offset)];
	struct hlist_node *entry, *next;
	struct request *rq;

	hlist_for_each_entry_safe(rq, entry, next, hash_list, hash) {
		BUG_ON(!ELV_ON_HASH(rq));

		if (unlikely(!rq_mergeable(rq))) {
			__elv_rqhash_del(rq);
			continue;
		}

		if (rq_hash_key(rq) == offset)
			return rq;
	}

	return NULL;
}

352 353 354 355 356 357 358 359 360 361 362 363 364 365
/*
 * RB-tree support functions for inserting/lookup/removal of requests
 * in a sorted RB tree.
 */
struct request *elv_rb_add(struct rb_root *root, struct request *rq)
{
	struct rb_node **p = &root->rb_node;
	struct rb_node *parent = NULL;
	struct request *__rq;

	while (*p) {
		parent = *p;
		__rq = rb_entry(parent, struct request, rb_node);

366
		if (blk_rq_pos(rq) < blk_rq_pos(__rq))
367
			p = &(*p)->rb_left;
368
		else if (blk_rq_pos(rq) > blk_rq_pos(__rq))
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395
			p = &(*p)->rb_right;
		else
			return __rq;
	}

	rb_link_node(&rq->rb_node, parent, p);
	rb_insert_color(&rq->rb_node, root);
	return NULL;
}
EXPORT_SYMBOL(elv_rb_add);

void elv_rb_del(struct rb_root *root, struct request *rq)
{
	BUG_ON(RB_EMPTY_NODE(&rq->rb_node));
	rb_erase(&rq->rb_node, root);
	RB_CLEAR_NODE(&rq->rb_node);
}
EXPORT_SYMBOL(elv_rb_del);

struct request *elv_rb_find(struct rb_root *root, sector_t sector)
{
	struct rb_node *n = root->rb_node;
	struct request *rq;

	while (n) {
		rq = rb_entry(n, struct request, rb_node);

396
		if (sector < blk_rq_pos(rq))
397
			n = n->rb_left;
398
		else if (sector > blk_rq_pos(rq))
399 400 401 402 403 404 405 406 407
			n = n->rb_right;
		else
			return rq;
	}

	return NULL;
}
EXPORT_SYMBOL(elv_rb_find);

408 409
/*
 * Insert rq into dispatch queue of q.  Queue lock must be held on
U
Uwe Kleine-König 已提交
410
 * entry.  rq is sort instead into the dispatch queue. To be used by
411
 * specific elevators.
412
 */
413
void elv_dispatch_sort(struct request_queue *q, struct request *rq)
414 415 416
{
	sector_t boundary;
	struct list_head *entry;
417
	int stop_flags;
418

419 420
	if (q->last_merge == rq)
		q->last_merge = NULL;
421 422 423

	elv_rqhash_del(q, rq);

424
	q->nr_sorted--;
425

J
Jens Axboe 已提交
426
	boundary = q->end_sector;
427
	stop_flags = REQ_SOFTBARRIER | REQ_HARDBARRIER | REQ_STARTED;
428 429 430
	list_for_each_prev(entry, &q->queue_head) {
		struct request *pos = list_entry_rq(entry);

431 432
		if ((rq->cmd_flags & REQ_DISCARD) !=
		    (pos->cmd_flags & REQ_DISCARD))
433
			break;
434 435
		if (rq_data_dir(rq) != rq_data_dir(pos))
			break;
436
		if (pos->cmd_flags & stop_flags)
437
			break;
438 439
		if (blk_rq_pos(rq) >= boundary) {
			if (blk_rq_pos(pos) < boundary)
440 441
				continue;
		} else {
442
			if (blk_rq_pos(pos) >= boundary)
443 444
				break;
		}
445
		if (blk_rq_pos(rq) >= blk_rq_pos(pos))
446 447 448 449 450
			break;
	}

	list_add(&rq->queuelist, entry);
}
451 452
EXPORT_SYMBOL(elv_dispatch_sort);

453
/*
454 455 456
 * Insert rq into dispatch queue of q.  Queue lock must be held on
 * entry.  rq is added to the back of the dispatch queue. To be used by
 * specific elevators.
457 458 459 460 461 462 463 464 465 466 467 468 469 470
 */
void elv_dispatch_add_tail(struct request_queue *q, struct request *rq)
{
	if (q->last_merge == rq)
		q->last_merge = NULL;

	elv_rqhash_del(q, rq);

	q->nr_sorted--;

	q->end_sector = rq_end_sector(rq);
	q->boundary_rq = rq;
	list_add_tail(&rq->queuelist, &q->queue_head);
}
471 472
EXPORT_SYMBOL(elv_dispatch_add_tail);

473
int elv_merge(struct request_queue *q, struct request **req, struct bio *bio)
L
Linus Torvalds 已提交
474
{
J
Jens Axboe 已提交
475
	struct elevator_queue *e = q->elevator;
476
	struct request *__rq;
477 478
	int ret;

479 480 481 482 483 484 485 486 487
	/*
	 * Levels of merges:
	 * 	nomerges:  No merges at all attempted
	 * 	noxmerges: Only simple one-hit cache try
	 * 	merges:	   All merge tries attempted
	 */
	if (blk_queue_nomerges(q))
		return ELEVATOR_NO_MERGE;

488 489 490
	/*
	 * First try one-hit cache.
	 */
491 492 493 494 495 496 497
	if (q->last_merge) {
		ret = elv_try_merge(q->last_merge, bio);
		if (ret != ELEVATOR_NO_MERGE) {
			*req = q->last_merge;
			return ret;
		}
	}
L
Linus Torvalds 已提交
498

499
	if (blk_queue_noxmerges(q))
500 501
		return ELEVATOR_NO_MERGE;

502 503 504 505 506 507 508 509 510
	/*
	 * See if our hash lookup can find a potential backmerge.
	 */
	__rq = elv_rqhash_find(q, bio->bi_sector);
	if (__rq && elv_rq_merge_ok(__rq, bio)) {
		*req = __rq;
		return ELEVATOR_BACK_MERGE;
	}

L
Linus Torvalds 已提交
511 512 513 514 515 516
	if (e->ops->elevator_merge_fn)
		return e->ops->elevator_merge_fn(q, req, bio);

	return ELEVATOR_NO_MERGE;
}

517
void elv_merged_request(struct request_queue *q, struct request *rq, int type)
L
Linus Torvalds 已提交
518
{
J
Jens Axboe 已提交
519
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
520 521

	if (e->ops->elevator_merged_fn)
522
		e->ops->elevator_merged_fn(q, rq, type);
523

524 525
	if (type == ELEVATOR_BACK_MERGE)
		elv_rqhash_reposition(q, rq);
526

527
	q->last_merge = rq;
L
Linus Torvalds 已提交
528 529
}

530
void elv_merge_requests(struct request_queue *q, struct request *rq,
L
Linus Torvalds 已提交
531 532
			     struct request *next)
{
J
Jens Axboe 已提交
533
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
534 535 536

	if (e->ops->elevator_merge_req_fn)
		e->ops->elevator_merge_req_fn(q, rq, next);
537

538 539 540 541
	elv_rqhash_reposition(q, rq);
	elv_rqhash_del(q, next);

	q->nr_sorted--;
542
	q->last_merge = rq;
L
Linus Torvalds 已提交
543 544
}

D
Divyesh Shah 已提交
545 546 547 548 549 550 551 552 553
void elv_bio_merged(struct request_queue *q, struct request *rq,
			struct bio *bio)
{
	struct elevator_queue *e = q->elevator;

	if (e->ops->elevator_bio_merged_fn)
		e->ops->elevator_bio_merged_fn(q, rq, bio);
}

554
void elv_requeue_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
555 556 557 558 559
{
	/*
	 * it already went through dequeue, we need to decrement the
	 * in_flight count again
	 */
560
	if (blk_account_rq(rq)) {
561
		q->in_flight[rq_is_sync(rq)]--;
562
		if (rq->cmd_flags & REQ_SORTED)
563
			elv_deactivate_rq(q, rq);
564
	}
L
Linus Torvalds 已提交
565

566
	rq->cmd_flags &= ~REQ_STARTED;
L
Linus Torvalds 已提交
567

568
	elv_insert(q, rq, ELEVATOR_INSERT_REQUEUE);
L
Linus Torvalds 已提交
569 570
}

571
void elv_drain_elevator(struct request_queue *q)
572 573 574 575 576 577 578 579 580 581 582 583 584
{
	static int printed;
	while (q->elevator->ops->elevator_dispatch_fn(q, 1))
		;
	if (q->nr_sorted == 0)
		return;
	if (printed++ < 10) {
		printk(KERN_ERR "%s: forced dispatching is broken "
		       "(nr_sorted=%u), please report this\n",
		       q->elevator->elevator_type->elevator_name, q->nr_sorted);
	}
}

J
Jens Axboe 已提交
585 586 587
/*
 * Call with queue lock held, interrupts disabled
 */
J
Jens Axboe 已提交
588
void elv_quiesce_start(struct request_queue *q)
J
Jens Axboe 已提交
589
{
590 591 592
	if (!q->elevator)
		return;

J
Jens Axboe 已提交
593 594 595 596 597 598 599
	queue_flag_set(QUEUE_FLAG_ELVSWITCH, q);

	/*
	 * make sure we don't have any requests in flight
	 */
	elv_drain_elevator(q);
	while (q->rq.elvpriv) {
T
Tejun Heo 已提交
600
		__blk_run_queue(q);
J
Jens Axboe 已提交
601 602 603 604 605 606 607
		spin_unlock_irq(q->queue_lock);
		msleep(10);
		spin_lock_irq(q->queue_lock);
		elv_drain_elevator(q);
	}
}

J
Jens Axboe 已提交
608
void elv_quiesce_end(struct request_queue *q)
J
Jens Axboe 已提交
609 610 611 612
{
	queue_flag_clear(QUEUE_FLAG_ELVSWITCH, q);
}

613
void elv_insert(struct request_queue *q, struct request *rq, int where)
L
Linus Torvalds 已提交
614
{
615 616
	struct list_head *pos;
	unsigned ordseq;
J
Jens Axboe 已提交
617
	int unplug_it = 1;
618

619
	trace_block_rq_insert(q, rq);
620

L
Linus Torvalds 已提交
621 622
	rq->q = q;

623 624
	switch (where) {
	case ELEVATOR_INSERT_FRONT:
625
		rq->cmd_flags |= REQ_SOFTBARRIER;
626 627 628 629 630

		list_add(&rq->queuelist, &q->queue_head);
		break;

	case ELEVATOR_INSERT_BACK:
631
		rq->cmd_flags |= REQ_SOFTBARRIER;
632
		elv_drain_elevator(q);
633 634 635 636 637 638 639 640 641 642 643
		list_add_tail(&rq->queuelist, &q->queue_head);
		/*
		 * We kick the queue here for the following reasons.
		 * - The elevator might have returned NULL previously
		 *   to delay requests and returned them now.  As the
		 *   queue wasn't empty before this request, ll_rw_blk
		 *   won't run the queue on return, resulting in hang.
		 * - Usually, back inserted requests won't be merged
		 *   with anything.  There's no point in delaying queue
		 *   processing.
		 */
T
Tejun Heo 已提交
644
		__blk_run_queue(q);
645 646 647
		break;

	case ELEVATOR_INSERT_SORT:
648 649
		BUG_ON(rq->cmd_type != REQ_TYPE_FS &&
		       !(rq->cmd_flags & REQ_DISCARD));
650
		rq->cmd_flags |= REQ_SORTED;
651
		q->nr_sorted++;
652 653 654 655 656 657
		if (rq_mergeable(rq)) {
			elv_rqhash_add(q, rq);
			if (!q->last_merge)
				q->last_merge = rq;
		}

658 659 660 661 662 663
		/*
		 * Some ioscheds (cfq) run q->request_fn directly, so
		 * rq cannot be accessed after calling
		 * elevator_add_req_fn.
		 */
		q->elevator->ops->elevator_add_req_fn(q, rq);
664 665
		break;

666 667 668 669 670 671
	case ELEVATOR_INSERT_REQUEUE:
		/*
		 * If ordered flush isn't in progress, we do front
		 * insertion; otherwise, requests should be requeued
		 * in ordseq order.
		 */
672
		rq->cmd_flags |= REQ_SOFTBARRIER;
673

674 675 676 677 678 679
		/*
		 * Most requeues happen because of a busy condition,
		 * don't force unplug of the queue for that case.
		 */
		unplug_it = 0;

680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695
		if (q->ordseq == 0) {
			list_add(&rq->queuelist, &q->queue_head);
			break;
		}

		ordseq = blk_ordered_req_seq(rq);

		list_for_each(pos, &q->queue_head) {
			struct request *pos_rq = list_entry_rq(pos);
			if (ordseq <= blk_ordered_req_seq(pos_rq))
				break;
		}

		list_add_tail(&rq->queuelist, pos);
		break;

696 697
	default:
		printk(KERN_ERR "%s: bad insertion point %d\n",
698
		       __func__, where);
699 700 701
		BUG();
	}

J
Jens Axboe 已提交
702
	if (unplug_it && blk_queue_plugged(q)) {
703
		int nrq = q->rq.count[BLK_RW_SYNC] + q->rq.count[BLK_RW_ASYNC]
704
				- queue_in_flight(q);
705 706 707 708

		if (nrq >= q->unplug_thresh)
			__generic_unplug_device(q);
	}
L
Linus Torvalds 已提交
709 710
}

711
void __elv_add_request(struct request_queue *q, struct request *rq, int where,
712 713 714
		       int plug)
{
	if (q->ordcolor)
715
		rq->cmd_flags |= REQ_ORDERED_COLOR;
716

717
	if (rq->cmd_flags & (REQ_SOFTBARRIER | REQ_HARDBARRIER)) {
718 719 720
		/*
		 * toggle ordered color
		 */
721
		if (rq->cmd_flags & REQ_HARDBARRIER)
722 723 724 725 726 727 728 729 730 731 732 733
			q->ordcolor ^= 1;

		/*
		 * barriers implicitly indicate back insertion
		 */
		if (where == ELEVATOR_INSERT_SORT)
			where = ELEVATOR_INSERT_BACK;

		/*
		 * this request is scheduling boundary, update
		 * end_sector
		 */
734 735
		if (rq->cmd_type == REQ_TYPE_FS ||
		    (rq->cmd_flags & REQ_DISCARD)) {
736 737 738
			q->end_sector = rq_end_sector(rq);
			q->boundary_rq = rq;
		}
739 740
	} else if (!(rq->cmd_flags & REQ_ELVPRIV) &&
		    where == ELEVATOR_INSERT_SORT)
741 742 743 744 745 746 747
		where = ELEVATOR_INSERT_BACK;

	if (plug)
		blk_plug_device(q);

	elv_insert(q, rq, where);
}
748 749
EXPORT_SYMBOL(__elv_add_request);

750
void elv_add_request(struct request_queue *q, struct request *rq, int where,
L
Linus Torvalds 已提交
751 752 753 754 755 756 757 758
		     int plug)
{
	unsigned long flags;

	spin_lock_irqsave(q->queue_lock, flags);
	__elv_add_request(q, rq, where, plug);
	spin_unlock_irqrestore(q->queue_lock, flags);
}
759 760
EXPORT_SYMBOL(elv_add_request);

761
int elv_queue_empty(struct request_queue *q)
L
Linus Torvalds 已提交
762
{
J
Jens Axboe 已提交
763
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
764

765 766 767
	if (!list_empty(&q->queue_head))
		return 0;

L
Linus Torvalds 已提交
768 769 770
	if (e->ops->elevator_queue_empty_fn)
		return e->ops->elevator_queue_empty_fn(q);

771
	return 1;
L
Linus Torvalds 已提交
772
}
773 774
EXPORT_SYMBOL(elv_queue_empty);

775
struct request *elv_latter_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
776
{
J
Jens Axboe 已提交
777
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
778 779 780 781 782 783

	if (e->ops->elevator_latter_req_fn)
		return e->ops->elevator_latter_req_fn(q, rq);
	return NULL;
}

784
struct request *elv_former_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
785
{
J
Jens Axboe 已提交
786
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
787 788 789 790 791 792

	if (e->ops->elevator_former_req_fn)
		return e->ops->elevator_former_req_fn(q, rq);
	return NULL;
}

793
int elv_set_request(struct request_queue *q, struct request *rq, gfp_t gfp_mask)
L
Linus Torvalds 已提交
794
{
J
Jens Axboe 已提交
795
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
796 797

	if (e->ops->elevator_set_req_fn)
798
		return e->ops->elevator_set_req_fn(q, rq, gfp_mask);
L
Linus Torvalds 已提交
799 800 801 802 803

	rq->elevator_private = NULL;
	return 0;
}

804
void elv_put_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
805
{
J
Jens Axboe 已提交
806
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
807 808

	if (e->ops->elevator_put_req_fn)
809
		e->ops->elevator_put_req_fn(rq);
L
Linus Torvalds 已提交
810 811
}

812
int elv_may_queue(struct request_queue *q, int rw)
L
Linus Torvalds 已提交
813
{
J
Jens Axboe 已提交
814
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
815 816

	if (e->ops->elevator_may_queue_fn)
817
		return e->ops->elevator_may_queue_fn(q, rw);
L
Linus Torvalds 已提交
818 819 820 821

	return ELV_MQUEUE_MAY;
}

822 823 824 825 826 827 828
void elv_abort_queue(struct request_queue *q)
{
	struct request *rq;

	while (!list_empty(&q->queue_head)) {
		rq = list_entry_rq(q->queue_head.next);
		rq->cmd_flags |= REQ_QUIET;
829
		trace_block_rq_abort(q, rq);
830 831 832 833 834
		/*
		 * Mark this request as started so we don't trigger
		 * any debug logic in the end I/O path.
		 */
		blk_start_request(rq);
835
		__blk_end_request_all(rq, -EIO);
836 837 838 839
	}
}
EXPORT_SYMBOL(elv_abort_queue);

840
void elv_completed_request(struct request_queue *q, struct request *rq)
L
Linus Torvalds 已提交
841
{
J
Jens Axboe 已提交
842
	struct elevator_queue *e = q->elevator;
L
Linus Torvalds 已提交
843 844 845 846

	/*
	 * request is released from the driver, io must be done
	 */
847
	if (blk_account_rq(rq)) {
848
		q->in_flight[rq_is_sync(rq)]--;
849 850
		if ((rq->cmd_flags & REQ_SORTED) &&
		    e->ops->elevator_completed_req_fn)
851 852
			e->ops->elevator_completed_req_fn(q, rq);
	}
853

854 855 856 857 858
	/*
	 * Check if the queue is waiting for fs requests to be
	 * drained for flush sequence.
	 */
	if (unlikely(q->ordseq)) {
859 860 861 862 863
		struct request *next = NULL;

		if (!list_empty(&q->queue_head))
			next = list_entry_rq(q->queue_head.next);

864
		if (!queue_in_flight(q) &&
865
		    blk_ordered_cur_seq(q) == QUEUE_ORDSEQ_DRAIN &&
866
		    (!next || blk_ordered_req_seq(next) > QUEUE_ORDSEQ_DRAIN)) {
867
			blk_ordered_complete_seq(q, QUEUE_ORDSEQ_DRAIN, 0);
T
Tejun Heo 已提交
868
			__blk_run_queue(q);
869
		}
870
	}
L
Linus Torvalds 已提交
871 872
}

873 874 875 876
#define to_elv(atr) container_of((atr), struct elv_fs_entry, attr)

static ssize_t
elv_attr_show(struct kobject *kobj, struct attribute *attr, char *page)
L
Linus Torvalds 已提交
877
{
878
	struct elv_fs_entry *entry = to_elv(attr);
J
Jens Axboe 已提交
879
	struct elevator_queue *e;
880 881 882 883 884
	ssize_t error;

	if (!entry->show)
		return -EIO;

J
Jens Axboe 已提交
885
	e = container_of(kobj, struct elevator_queue, kobj);
886 887 888 889 890
	mutex_lock(&e->sysfs_lock);
	error = e->ops ? entry->show(e, page) : -ENOENT;
	mutex_unlock(&e->sysfs_lock);
	return error;
}
L
Linus Torvalds 已提交
891

892 893 894 895 896
static ssize_t
elv_attr_store(struct kobject *kobj, struct attribute *attr,
	       const char *page, size_t length)
{
	struct elv_fs_entry *entry = to_elv(attr);
J
Jens Axboe 已提交
897
	struct elevator_queue *e;
898
	ssize_t error;
L
Linus Torvalds 已提交
899

900 901
	if (!entry->store)
		return -EIO;
L
Linus Torvalds 已提交
902

J
Jens Axboe 已提交
903
	e = container_of(kobj, struct elevator_queue, kobj);
904 905 906 907 908 909
	mutex_lock(&e->sysfs_lock);
	error = e->ops ? entry->store(e, page, length) : -ENOENT;
	mutex_unlock(&e->sysfs_lock);
	return error;
}

910
static const struct sysfs_ops elv_sysfs_ops = {
911 912 913 914 915 916 917 918 919 920 921
	.show	= elv_attr_show,
	.store	= elv_attr_store,
};

static struct kobj_type elv_ktype = {
	.sysfs_ops	= &elv_sysfs_ops,
	.release	= elevator_release,
};

int elv_register_queue(struct request_queue *q)
{
J
Jens Axboe 已提交
922
	struct elevator_queue *e = q->elevator;
923 924
	int error;

925
	error = kobject_add(&e->kobj, &q->kobj, "%s", "iosched");
926
	if (!error) {
927
		struct elv_fs_entry *attr = e->elevator_type->elevator_attrs;
928
		if (attr) {
929 930
			while (attr->attr.name) {
				if (sysfs_create_file(&e->kobj, &attr->attr))
931
					break;
932
				attr++;
933 934 935 936 937
			}
		}
		kobject_uevent(&e->kobj, KOBJ_ADD);
	}
	return error;
L
Linus Torvalds 已提交
938
}
939
EXPORT_SYMBOL(elv_register_queue);
L
Linus Torvalds 已提交
940

J
Jens Axboe 已提交
941
static void __elv_unregister_queue(struct elevator_queue *e)
J
Jens Axboe 已提交
942 943 944 945 946
{
	kobject_uevent(&e->kobj, KOBJ_REMOVE);
	kobject_del(&e->kobj);
}

L
Linus Torvalds 已提交
947 948
void elv_unregister_queue(struct request_queue *q)
{
J
Jens Axboe 已提交
949 950
	if (q)
		__elv_unregister_queue(q->elevator);
L
Linus Torvalds 已提交
951
}
952
EXPORT_SYMBOL(elv_unregister_queue);
L
Linus Torvalds 已提交
953

954
void elv_register(struct elevator_type *e)
L
Linus Torvalds 已提交
955
{
956
	char *def = "";
957 958

	spin_lock(&elv_list_lock);
959
	BUG_ON(elevator_find(e->elevator_name));
L
Linus Torvalds 已提交
960
	list_add_tail(&e->list, &elv_list);
961
	spin_unlock(&elv_list_lock);
L
Linus Torvalds 已提交
962

963 964 965
	if (!strcmp(e->elevator_name, chosen_elevator) ||
			(!*chosen_elevator &&
			 !strcmp(e->elevator_name, CONFIG_DEFAULT_IOSCHED)))
966 967
				def = " (default)";

968 969
	printk(KERN_INFO "io scheduler %s registered%s\n", e->elevator_name,
								def);
L
Linus Torvalds 已提交
970 971 972 973 974
}
EXPORT_SYMBOL_GPL(elv_register);

void elv_unregister(struct elevator_type *e)
{
975 976 977 978 979
	struct task_struct *g, *p;

	/*
	 * Iterate every thread in the process to remove the io contexts.
	 */
980 981 982 983
	if (e->ops.trim) {
		read_lock(&tasklist_lock);
		do_each_thread(g, p) {
			task_lock(p);
984 985
			if (p->io_context)
				e->ops.trim(p->io_context);
986 987 988 989
			task_unlock(p);
		} while_each_thread(g, p);
		read_unlock(&tasklist_lock);
	}
990

991
	spin_lock(&elv_list_lock);
L
Linus Torvalds 已提交
992
	list_del_init(&e->list);
993
	spin_unlock(&elv_list_lock);
L
Linus Torvalds 已提交
994 995 996 997 998 999 1000
}
EXPORT_SYMBOL_GPL(elv_unregister);

/*
 * switch to new_e io scheduler. be careful not to introduce deadlocks -
 * we don't free the old io scheduler, before we have allocated what we
 * need for the new one. this way we have a chance of going back to the old
T
Tejun Heo 已提交
1001
 * one, if the new one fails init for some reason.
L
Linus Torvalds 已提交
1002
 */
1003
static int elevator_switch(struct request_queue *q, struct elevator_type *new_e)
L
Linus Torvalds 已提交
1004
{
J
Jens Axboe 已提交
1005
	struct elevator_queue *old_elevator, *e;
J
Jens Axboe 已提交
1006
	void *data;
L
Linus Torvalds 已提交
1007

T
Tejun Heo 已提交
1008 1009 1010
	/*
	 * Allocate new elevator
	 */
1011
	e = elevator_alloc(q, new_e);
L
Linus Torvalds 已提交
1012
	if (!e)
1013
		return 0;
L
Linus Torvalds 已提交
1014

J
Jens Axboe 已提交
1015 1016 1017 1018 1019 1020
	data = elevator_init_queue(q, e);
	if (!data) {
		kobject_put(&e->kobj);
		return 0;
	}

L
Linus Torvalds 已提交
1021
	/*
T
Tejun Heo 已提交
1022
	 * Turn on BYPASS and drain all requests w/ elevator private data
L
Linus Torvalds 已提交
1023
	 */
T
Tejun Heo 已提交
1024
	spin_lock_irq(q->queue_lock);
J
Jens Axboe 已提交
1025
	elv_quiesce_start(q);
T
Tejun Heo 已提交
1026

L
Linus Torvalds 已提交
1027
	/*
J
Jens Axboe 已提交
1028
	 * Remember old elevator.
L
Linus Torvalds 已提交
1029 1030 1031 1032 1033 1034
	 */
	old_elevator = q->elevator;

	/*
	 * attach and start new elevator
	 */
J
Jens Axboe 已提交
1035 1036 1037 1038 1039
	elevator_attach(q, e, data);

	spin_unlock_irq(q->queue_lock);

	__elv_unregister_queue(old_elevator);
L
Linus Torvalds 已提交
1040 1041 1042 1043 1044

	if (elv_register_queue(q))
		goto fail_register;

	/*
T
Tejun Heo 已提交
1045
	 * finally exit old elevator and turn off BYPASS.
L
Linus Torvalds 已提交
1046 1047
	 */
	elevator_exit(old_elevator);
N
Nick Piggin 已提交
1048
	spin_lock_irq(q->queue_lock);
J
Jens Axboe 已提交
1049
	elv_quiesce_end(q);
N
Nick Piggin 已提交
1050 1051
	spin_unlock_irq(q->queue_lock);

1052 1053
	blk_add_trace_msg(q, "elv switch: %s", e->elevator_type->elevator_name);

1054
	return 1;
L
Linus Torvalds 已提交
1055 1056 1057 1058 1059 1060 1061 1062 1063

fail_register:
	/*
	 * switch failed, exit the new io scheduler and reattach the old
	 * one again (along with re-adding the sysfs dir)
	 */
	elevator_exit(e);
	q->elevator = old_elevator;
	elv_register_queue(q);
N
Nick Piggin 已提交
1064 1065 1066 1067 1068

	spin_lock_irq(q->queue_lock);
	queue_flag_clear(QUEUE_FLAG_ELVSWITCH, q);
	spin_unlock_irq(q->queue_lock);

1069
	return 0;
L
Linus Torvalds 已提交
1070 1071
}

1072 1073
ssize_t elv_iosched_store(struct request_queue *q, const char *name,
			  size_t count)
L
Linus Torvalds 已提交
1074 1075 1076 1077
{
	char elevator_name[ELV_NAME_MAX];
	struct elevator_type *e;

1078 1079 1080
	if (!q->elevator)
		return count;

1081
	strlcpy(elevator_name, name, sizeof(elevator_name));
1082
	e = elevator_get(strstrip(elevator_name));
L
Linus Torvalds 已提交
1083 1084 1085 1086 1087
	if (!e) {
		printk(KERN_ERR "elevator: type %s not found\n", elevator_name);
		return -EINVAL;
	}

1088 1089
	if (!strcmp(elevator_name, q->elevator->elevator_type->elevator_name)) {
		elevator_put(e);
L
Linus Torvalds 已提交
1090
		return count;
1091
	}
L
Linus Torvalds 已提交
1092

1093
	if (!elevator_switch(q, e))
1094 1095
		printk(KERN_ERR "elevator: switch to %s failed\n",
							elevator_name);
L
Linus Torvalds 已提交
1096 1097 1098
	return count;
}

1099
ssize_t elv_iosched_show(struct request_queue *q, char *name)
L
Linus Torvalds 已提交
1100
{
J
Jens Axboe 已提交
1101
	struct elevator_queue *e = q->elevator;
1102
	struct elevator_type *elv;
1103
	struct elevator_type *__e;
L
Linus Torvalds 已提交
1104 1105
	int len = 0;

1106
	if (!q->elevator || !blk_queue_stackable(q))
1107 1108 1109 1110
		return sprintf(name, "none\n");

	elv = e->elevator_type;

1111
	spin_lock(&elv_list_lock);
1112
	list_for_each_entry(__e, &elv_list, list) {
L
Linus Torvalds 已提交
1113 1114 1115 1116 1117
		if (!strcmp(elv->elevator_name, __e->elevator_name))
			len += sprintf(name+len, "[%s] ", elv->elevator_name);
		else
			len += sprintf(name+len, "%s ", __e->elevator_name);
	}
1118
	spin_unlock(&elv_list_lock);
L
Linus Torvalds 已提交
1119 1120 1121 1122 1123

	len += sprintf(len+name, "\n");
	return len;
}

1124 1125
struct request *elv_rb_former_request(struct request_queue *q,
				      struct request *rq)
1126 1127 1128 1129 1130 1131 1132 1133 1134 1135
{
	struct rb_node *rbprev = rb_prev(&rq->rb_node);

	if (rbprev)
		return rb_entry_rq(rbprev);

	return NULL;
}
EXPORT_SYMBOL(elv_rb_former_request);

1136 1137
struct request *elv_rb_latter_request(struct request_queue *q,
				      struct request *rq)
1138 1139 1140 1141 1142 1143 1144 1145 1146
{
	struct rb_node *rbnext = rb_next(&rq->rb_node);

	if (rbnext)
		return rb_entry_rq(rbnext);

	return NULL;
}
EXPORT_SYMBOL(elv_rb_latter_request);