“fe55ff6e6114c7382a68a2cf7230f125d4f3a248”上不存在“hw/display/vga_int.h”
raid1.c 90.8 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11
/*
 * raid1.c : Multiple Devices driver for Linux
 *
 * Copyright (C) 1999, 2000, 2001 Ingo Molnar, Red Hat
 *
 * Copyright (C) 1996, 1997, 1998 Ingo Molnar, Miguel de Icaza, Gadi Oxman
 *
 * RAID-1 management functions.
 *
 * Better read-balancing code written by Mika Kuoppala <miku@iki.fi>, 2000
 *
12
 * Fixes to reconstruction by Jakob Østergaard" <jakob@ostenfeld.dk>
L
Linus Torvalds 已提交
13 14
 * Various fixes by Neil Brown <neilb@cse.unsw.edu.au>
 *
15 16 17 18 19 20 21 22 23
 * Changes by Peter T. Breuer <ptb@it.uc3m.es> 31/1/2003 to support
 * bitmapped intelligence in resync:
 *
 *      - bitmap marked during normal i/o
 *      - bitmap used to skip nondirty blocks during sync
 *
 * Additions to bitmap code, (C) 2003-2004 Paul Clements, SteelEye Technology:
 * - persistent bitmap code
 *
L
Linus Torvalds 已提交
24 25 26 27 28 29 30 31 32 33
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * You should have received a copy of the GNU General Public License
 * (for example /usr/src/linux/COPYING); if not, write to the Free
 * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

34
#include <linux/slab.h>
35
#include <linux/delay.h>
36
#include <linux/blkdev.h>
37
#include <linux/module.h>
38
#include <linux/seq_file.h>
39
#include <linux/ratelimit.h>
40 41
#include <linux/sched/signal.h>

42
#include <trace/events/block.h>
43

44
#include "md.h"
45 46
#include "raid1.h"
#include "bitmap.h"
47

48 49
#define UNSUPPORTED_MDDEV_FLAGS		\
	((1L << MD_HAS_JOURNAL) |	\
50 51
	 (1L << MD_JOURNAL_CLEAN) |	\
	 (1L << MD_HAS_PPL))
52

L
Linus Torvalds 已提交
53 54 55 56 57
/*
 * Number of guaranteed r1bios in case of extreme VM load:
 */
#define	NR_RAID1_BIOS 256

58 59 60 61 62 63 64 65 66 67 68 69 70 71
/* when we get a read error on a read-only array, we redirect to another
 * device without failing the first device, or trying to over-write to
 * correct the read error.  To keep track of bad blocks on a per-bio
 * level, we store IO_BLOCKED in the appropriate 'bios' pointer
 */
#define IO_BLOCKED ((struct bio *)1)
/* When we successfully write to a known bad-block, we need to remove the
 * bad-block marking which must be done from process context.  So we record
 * the success by setting devs[n].bio to IO_MADE_GOOD
 */
#define IO_MADE_GOOD ((struct bio *)2)

#define BIO_SPECIAL(bio) ((unsigned long)bio <= 2)

72 73 74 75 76
/* When there are this many requests queue to be written by
 * the raid1 thread, we become 'congested' to provide back-pressure
 * for writeback.
 */
static int max_queued_requests = 1024;
L
Linus Torvalds 已提交
77

78 79
static void allow_barrier(struct r1conf *conf, sector_t sector_nr);
static void lower_barrier(struct r1conf *conf, sector_t sector_nr);
L
Linus Torvalds 已提交
80

81 82 83
#define raid1_log(md, fmt, args...)				\
	do { if ((md)->queue) blk_add_trace_msg((md)->queue, "raid1 " fmt, ##args); } while (0)

84 85
#include "raid1-10.c"

86 87 88 89 90 91 92 93 94
/*
 * for resync bio, r1bio pointer can be retrieved from the per-bio
 * 'struct resync_pages'.
 */
static inline struct r1bio *get_resync_r1bio(struct bio *bio)
{
	return get_resync_pages(bio)->raid_bio;
}

A
Al Viro 已提交
95
static void * r1bio_pool_alloc(gfp_t gfp_flags, void *data)
L
Linus Torvalds 已提交
96 97
{
	struct pool_info *pi = data;
98
	int size = offsetof(struct r1bio, bios[pi->raid_disks]);
L
Linus Torvalds 已提交
99 100

	/* allocate a r1bio with room for raid_disks entries in the bios array */
J
Jens Axboe 已提交
101
	return kzalloc(size, gfp_flags);
L
Linus Torvalds 已提交
102 103 104 105 106 107 108
}

static void r1bio_pool_free(void *r1_bio, void *data)
{
	kfree(r1_bio);
}

109
#define RESYNC_DEPTH 32
L
Linus Torvalds 已提交
110
#define RESYNC_SECTORS (RESYNC_BLOCK_SIZE >> 9)
111 112
#define RESYNC_WINDOW (RESYNC_BLOCK_SIZE * RESYNC_DEPTH)
#define RESYNC_WINDOW_SECTORS (RESYNC_WINDOW >> 9)
113 114
#define CLUSTER_RESYNC_WINDOW (16 * RESYNC_WINDOW)
#define CLUSTER_RESYNC_WINDOW_SECTORS (CLUSTER_RESYNC_WINDOW >> 9)
L
Linus Torvalds 已提交
115

A
Al Viro 已提交
116
static void * r1buf_pool_alloc(gfp_t gfp_flags, void *data)
L
Linus Torvalds 已提交
117 118
{
	struct pool_info *pi = data;
119
	struct r1bio *r1_bio;
L
Linus Torvalds 已提交
120
	struct bio *bio;
121
	int need_pages;
122 123
	int j;
	struct resync_pages *rps;
L
Linus Torvalds 已提交
124 125

	r1_bio = r1bio_pool_alloc(gfp_flags, pi);
J
Jens Axboe 已提交
126
	if (!r1_bio)
L
Linus Torvalds 已提交
127 128
		return NULL;

129 130 131 132 133
	rps = kmalloc(sizeof(struct resync_pages) * pi->raid_disks,
		      gfp_flags);
	if (!rps)
		goto out_free_r1bio;

L
Linus Torvalds 已提交
134 135 136 137
	/*
	 * Allocate bios : 1 for reading, n-1 for writing
	 */
	for (j = pi->raid_disks ; j-- ; ) {
138
		bio = bio_kmalloc(gfp_flags, RESYNC_PAGES);
L
Linus Torvalds 已提交
139 140 141 142 143 144
		if (!bio)
			goto out_free_bio;
		r1_bio->bios[j] = bio;
	}
	/*
	 * Allocate RESYNC_PAGES data pages and attach them to
145 146 147
	 * the first bio.
	 * If this is a user-requested check/repair, allocate
	 * RESYNC_PAGES for each bio.
L
Linus Torvalds 已提交
148
	 */
149
	if (test_bit(MD_RECOVERY_REQUESTED, &pi->mddev->recovery))
150
		need_pages = pi->raid_disks;
151
	else
152
		need_pages = 1;
153 154 155
	for (j = 0; j < pi->raid_disks; j++) {
		struct resync_pages *rp = &rps[j];

156 157
		bio = r1_bio->bios[j];

158 159 160 161 162 163 164 165 166 167
		if (j < need_pages) {
			if (resync_alloc_pages(rp, gfp_flags))
				goto out_free_pages;
		} else {
			memcpy(rp, &rps[0], sizeof(*rp));
			resync_get_all_pages(rp);
		}

		rp->raid_bio = r1_bio;
		bio->bi_private = rp;
L
Linus Torvalds 已提交
168 169 170 171 172 173
	}

	r1_bio->master_bio = NULL;

	return r1_bio;

174
out_free_pages:
175
	while (--j >= 0)
176
		resync_free_pages(&rps[j]);
177

L
Linus Torvalds 已提交
178
out_free_bio:
179
	while (++j < pi->raid_disks)
L
Linus Torvalds 已提交
180
		bio_put(r1_bio->bios[j]);
181 182 183
	kfree(rps);

out_free_r1bio:
L
Linus Torvalds 已提交
184 185 186 187 188 189 190
	r1bio_pool_free(r1_bio, data);
	return NULL;
}

static void r1buf_pool_free(void *__r1_bio, void *data)
{
	struct pool_info *pi = data;
191
	int i;
192
	struct r1bio *r1bio = __r1_bio;
193
	struct resync_pages *rp = NULL;
L
Linus Torvalds 已提交
194

195 196 197
	for (i = pi->raid_disks; i--; ) {
		rp = get_resync_pages(r1bio->bios[i]);
		resync_free_pages(rp);
L
Linus Torvalds 已提交
198
		bio_put(r1bio->bios[i]);
199 200 201 202
	}

	/* resync pages array stored in the 1st bio's .bi_private */
	kfree(rp);
L
Linus Torvalds 已提交
203 204 205 206

	r1bio_pool_free(r1bio, data);
}

207
static void put_all_bios(struct r1conf *conf, struct r1bio *r1_bio)
L
Linus Torvalds 已提交
208 209 210
{
	int i;

211
	for (i = 0; i < conf->raid_disks * 2; i++) {
L
Linus Torvalds 已提交
212
		struct bio **bio = r1_bio->bios + i;
213
		if (!BIO_SPECIAL(*bio))
L
Linus Torvalds 已提交
214 215 216 217 218
			bio_put(*bio);
		*bio = NULL;
	}
}

219
static void free_r1bio(struct r1bio *r1_bio)
L
Linus Torvalds 已提交
220
{
221
	struct r1conf *conf = r1_bio->mddev->private;
L
Linus Torvalds 已提交
222 223 224 225 226

	put_all_bios(conf, r1_bio);
	mempool_free(r1_bio, conf->r1bio_pool);
}

227
static void put_buf(struct r1bio *r1_bio)
L
Linus Torvalds 已提交
228
{
229
	struct r1conf *conf = r1_bio->mddev->private;
S
Shaohua Li 已提交
230
	sector_t sect = r1_bio->sector;
231 232
	int i;

233
	for (i = 0; i < conf->raid_disks * 2; i++) {
234 235 236 237
		struct bio *bio = r1_bio->bios[i];
		if (bio->bi_end_io)
			rdev_dec_pending(conf->mirrors[i].rdev, r1_bio->mddev);
	}
L
Linus Torvalds 已提交
238 239 240

	mempool_free(r1_bio, conf->r1buf_pool);

S
Shaohua Li 已提交
241
	lower_barrier(conf, sect);
L
Linus Torvalds 已提交
242 243
}

244
static void reschedule_retry(struct r1bio *r1_bio)
L
Linus Torvalds 已提交
245 246
{
	unsigned long flags;
247
	struct mddev *mddev = r1_bio->mddev;
248
	struct r1conf *conf = mddev->private;
249
	int idx;
L
Linus Torvalds 已提交
250

251
	idx = sector_to_idx(r1_bio->sector);
L
Linus Torvalds 已提交
252 253
	spin_lock_irqsave(&conf->device_lock, flags);
	list_add(&r1_bio->retry_list, &conf->retry_list);
254
	atomic_inc(&conf->nr_queued[idx]);
L
Linus Torvalds 已提交
255 256
	spin_unlock_irqrestore(&conf->device_lock, flags);

257
	wake_up(&conf->wait_barrier);
L
Linus Torvalds 已提交
258 259 260 261 262 263 264 265
	md_wakeup_thread(mddev->thread);
}

/*
 * raid_end_bio_io() is called when we have finished servicing a mirrored
 * operation and are ready to return a success/failure code to the buffer
 * cache layer.
 */
266
static void call_bio_endio(struct r1bio *r1_bio)
267 268
{
	struct bio *bio = r1_bio->master_bio;
269
	struct r1conf *conf = r1_bio->mddev->private;
270 271

	if (!test_bit(R1BIO_Uptodate, &r1_bio->state))
272
		bio->bi_status = BLK_STS_IOERR;
273

N
NeilBrown 已提交
274 275 276 277 278 279
	bio_endio(bio);
	/*
	 * Wake up any possible resync thread that waits for the device
	 * to go idle.
	 */
	allow_barrier(conf, r1_bio->sector);
280 281
}

282
static void raid_end_bio_io(struct r1bio *r1_bio)
L
Linus Torvalds 已提交
283 284 285
{
	struct bio *bio = r1_bio->master_bio;

286 287
	/* if nobody has done the final endio yet, do it now */
	if (!test_and_set_bit(R1BIO_Returned, &r1_bio->state)) {
288 289
		pr_debug("raid1: sync end %s on sectors %llu-%llu\n",
			 (bio_data_dir(bio) == WRITE) ? "write" : "read",
290 291
			 (unsigned long long) bio->bi_iter.bi_sector,
			 (unsigned long long) bio_end_sector(bio) - 1);
292

293
		call_bio_endio(r1_bio);
294
	}
L
Linus Torvalds 已提交
295 296 297 298 299 300
	free_r1bio(r1_bio);
}

/*
 * Update disk head position estimator based on IRQ completion info.
 */
301
static inline void update_head_pos(int disk, struct r1bio *r1_bio)
L
Linus Torvalds 已提交
302
{
303
	struct r1conf *conf = r1_bio->mddev->private;
L
Linus Torvalds 已提交
304 305 306 307 308

	conf->mirrors[disk].head_position =
		r1_bio->sector + (r1_bio->sectors);
}

309 310 311
/*
 * Find the disk number which triggered given bio
 */
312
static int find_bio_disk(struct r1bio *r1_bio, struct bio *bio)
313 314
{
	int mirror;
315 316
	struct r1conf *conf = r1_bio->mddev->private;
	int raid_disks = conf->raid_disks;
317

318
	for (mirror = 0; mirror < raid_disks * 2; mirror++)
319 320 321
		if (r1_bio->bios[mirror] == bio)
			break;

322
	BUG_ON(mirror == raid_disks * 2);
323 324 325 326 327
	update_head_pos(mirror, r1_bio);

	return mirror;
}

328
static void raid1_end_read_request(struct bio *bio)
L
Linus Torvalds 已提交
329
{
330
	int uptodate = !bio->bi_status;
331
	struct r1bio *r1_bio = bio->bi_private;
332
	struct r1conf *conf = r1_bio->mddev->private;
333
	struct md_rdev *rdev = conf->mirrors[r1_bio->read_disk].rdev;
L
Linus Torvalds 已提交
334 335 336 337

	/*
	 * this branch is our 'one mirror IO has finished' event handler:
	 */
338
	update_head_pos(r1_bio->read_disk, r1_bio);
339

340 341
	if (uptodate)
		set_bit(R1BIO_Uptodate, &r1_bio->state);
342 343 344 345 346
	else if (test_bit(FailFast, &rdev->flags) &&
		 test_bit(R1BIO_FailFast, &r1_bio->state))
		/* This was a fail-fast read so we definitely
		 * want to retry */
		;
347 348 349 350
	else {
		/* If all other devices have failed, we want to return
		 * the error upwards rather than fail the last device.
		 * Here we redefine "uptodate" to mean "Don't want to retry"
L
Linus Torvalds 已提交
351
		 */
352 353 354 355
		unsigned long flags;
		spin_lock_irqsave(&conf->device_lock, flags);
		if (r1_bio->mddev->degraded == conf->raid_disks ||
		    (r1_bio->mddev->degraded == conf->raid_disks-1 &&
356
		     test_bit(In_sync, &rdev->flags)))
357 358 359
			uptodate = 1;
		spin_unlock_irqrestore(&conf->device_lock, flags);
	}
L
Linus Torvalds 已提交
360

361
	if (uptodate) {
L
Linus Torvalds 已提交
362
		raid_end_bio_io(r1_bio);
363
		rdev_dec_pending(rdev, conf->mddev);
364
	} else {
L
Linus Torvalds 已提交
365 366 367 368
		/*
		 * oops, read error:
		 */
		char b[BDEVNAME_SIZE];
N
NeilBrown 已提交
369 370 371 372
		pr_err_ratelimited("md/raid1:%s: %s: rescheduling sector %llu\n",
				   mdname(conf->mddev),
				   bdevname(rdev->bdev, b),
				   (unsigned long long)r1_bio->sector);
373
		set_bit(R1BIO_ReadError, &r1_bio->state);
L
Linus Torvalds 已提交
374
		reschedule_retry(r1_bio);
375
		/* don't drop the reference on read_disk yet */
L
Linus Torvalds 已提交
376 377 378
	}
}

379
static void close_write(struct r1bio *r1_bio)
380 381 382
{
	/* it really is the end of this request */
	if (test_bit(R1BIO_BehindIO, &r1_bio->state)) {
M
Ming Lei 已提交
383 384 385
		bio_free_pages(r1_bio->behind_master_bio);
		bio_put(r1_bio->behind_master_bio);
		r1_bio->behind_master_bio = NULL;
386 387 388 389 390 391 392 393 394
	}
	/* clear the bitmap if all writes complete successfully */
	bitmap_endwrite(r1_bio->mddev->bitmap, r1_bio->sector,
			r1_bio->sectors,
			!test_bit(R1BIO_Degraded, &r1_bio->state),
			test_bit(R1BIO_BehindIO, &r1_bio->state));
	md_write_end(r1_bio->mddev);
}

395
static void r1_bio_write_done(struct r1bio *r1_bio)
396
{
397 398 399 400 401 402 403
	if (!atomic_dec_and_test(&r1_bio->remaining))
		return;

	if (test_bit(R1BIO_WriteError, &r1_bio->state))
		reschedule_retry(r1_bio);
	else {
		close_write(r1_bio);
404 405 406 407
		if (test_bit(R1BIO_MadeGood, &r1_bio->state))
			reschedule_retry(r1_bio);
		else
			raid_end_bio_io(r1_bio);
408 409 410
	}
}

411
static void raid1_end_write_request(struct bio *bio)
L
Linus Torvalds 已提交
412
{
413
	struct r1bio *r1_bio = bio->bi_private;
414
	int behind = test_bit(R1BIO_BehindIO, &r1_bio->state);
415
	struct r1conf *conf = r1_bio->mddev->private;
416
	struct bio *to_put = NULL;
417 418
	int mirror = find_bio_disk(r1_bio, bio);
	struct md_rdev *rdev = conf->mirrors[mirror].rdev;
S
Shaohua Li 已提交
419 420
	bool discard_error;

421
	discard_error = bio->bi_status && bio_op(bio) == REQ_OP_DISCARD;
L
Linus Torvalds 已提交
422

T
Tejun Heo 已提交
423 424 425
	/*
	 * 'one mirror IO has finished' event handler:
	 */
426
	if (bio->bi_status && !discard_error) {
427 428
		set_bit(WriteErrorSeen,	&rdev->flags);
		if (!test_and_set_bit(WantReplacement, &rdev->flags))
429 430 431
			set_bit(MD_RECOVERY_NEEDED, &
				conf->mddev->recovery);

432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
		if (test_bit(FailFast, &rdev->flags) &&
		    (bio->bi_opf & MD_FAILFAST) &&
		    /* We never try FailFast to WriteMostly devices */
		    !test_bit(WriteMostly, &rdev->flags)) {
			md_error(r1_bio->mddev, rdev);
			if (!test_bit(Faulty, &rdev->flags))
				/* This is the only remaining device,
				 * We need to retry the write without
				 * FailFast
				 */
				set_bit(R1BIO_WriteError, &r1_bio->state);
			else {
				/* Finished with this branch */
				r1_bio->bios[mirror] = NULL;
				to_put = bio;
			}
		} else
			set_bit(R1BIO_WriteError, &r1_bio->state);
450
	} else {
L
Linus Torvalds 已提交
451
		/*
T
Tejun Heo 已提交
452 453 454 455 456 457 458 459
		 * Set R1BIO_Uptodate in our master bio, so that we
		 * will return a good error code for to the higher
		 * levels even if IO on some other mirrored buffer
		 * fails.
		 *
		 * The 'master' represents the composite IO operation
		 * to user-side. So if something waits for IO, then it
		 * will wait for the 'master' bio.
L
Linus Torvalds 已提交
460
		 */
461 462 463
		sector_t first_bad;
		int bad_sectors;

464 465
		r1_bio->bios[mirror] = NULL;
		to_put = bio;
466 467 468 469 470 471 472 473
		/*
		 * Do not set R1BIO_Uptodate if the current device is
		 * rebuilding or Faulty. This is because we cannot use
		 * such device for properly reading the data back (we could
		 * potentially use it, if the current write would have felt
		 * before rdev->recovery_offset, but for simplicity we don't
		 * check this here.
		 */
474 475
		if (test_bit(In_sync, &rdev->flags) &&
		    !test_bit(Faulty, &rdev->flags))
476
			set_bit(R1BIO_Uptodate, &r1_bio->state);
T
Tejun Heo 已提交
477

478
		/* Maybe we can clear some bad blocks. */
479
		if (is_badblock(rdev, r1_bio->sector, r1_bio->sectors,
S
Shaohua Li 已提交
480
				&first_bad, &bad_sectors) && !discard_error) {
481 482 483 484 485
			r1_bio->bios[mirror] = IO_MADE_GOOD;
			set_bit(R1BIO_MadeGood, &r1_bio->state);
		}
	}

T
Tejun Heo 已提交
486
	if (behind) {
487
		if (test_bit(WriteMostly, &rdev->flags))
T
Tejun Heo 已提交
488 489 490 491 492 493 494 495 496 497 498 499 500 501
			atomic_dec(&r1_bio->behind_remaining);

		/*
		 * In behind mode, we ACK the master bio once the I/O
		 * has safely reached all non-writemostly
		 * disks. Setting the Returned bit ensures that this
		 * gets done only once -- we don't ever want to return
		 * -EIO here, instead we'll wait
		 */
		if (atomic_read(&r1_bio->behind_remaining) >= (atomic_read(&r1_bio->remaining)-1) &&
		    test_bit(R1BIO_Uptodate, &r1_bio->state)) {
			/* Maybe we can return now */
			if (!test_and_set_bit(R1BIO_Returned, &r1_bio->state)) {
				struct bio *mbio = r1_bio->master_bio;
502 503
				pr_debug("raid1: behind end write sectors"
					 " %llu-%llu\n",
504 505
					 (unsigned long long) mbio->bi_iter.bi_sector,
					 (unsigned long long) bio_end_sector(mbio) - 1);
506
				call_bio_endio(r1_bio);
507 508 509
			}
		}
	}
510
	if (r1_bio->bios[mirror] == NULL)
511
		rdev_dec_pending(rdev, conf->mddev);
T
Tejun Heo 已提交
512

L
Linus Torvalds 已提交
513 514 515 516
	/*
	 * Let's see if all mirrored write operations have finished
	 * already.
	 */
517
	r1_bio_write_done(r1_bio);
518

519 520
	if (to_put)
		bio_put(to_put);
L
Linus Torvalds 已提交
521 522
}

523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541
static sector_t align_to_barrier_unit_end(sector_t start_sector,
					  sector_t sectors)
{
	sector_t len;

	WARN_ON(sectors == 0);
	/*
	 * len is the number of sectors from start_sector to end of the
	 * barrier unit which start_sector belongs to.
	 */
	len = round_up(start_sector + 1, BARRIER_UNIT_SECTOR_SIZE) -
	      start_sector;

	if (len > sectors)
		len = sectors;

	return len;
}

L
Linus Torvalds 已提交
542 543 544 545 546 547 548 549 550 551 552 553 554 555
/*
 * This routine returns the disk from which the requested read should
 * be done. There is a per-array 'next expected sequential IO' sector
 * number - if this matches on the next IO then we use the last disk.
 * There is also a per-disk 'last know head position' sector that is
 * maintained from IRQ contexts, both the normal and the resync IO
 * completion handlers update this position correctly. If there is no
 * perfect sequential match then we pick the disk whose head is closest.
 *
 * If there are 2 mirrors in the same 2 devices, performance degrades
 * because position is mirror, not device based.
 *
 * The rdev for the device selected will have nr_pending incremented.
 */
556
static int read_balance(struct r1conf *conf, struct r1bio *r1_bio, int *max_sectors)
L
Linus Torvalds 已提交
557
{
558
	const sector_t this_sector = r1_bio->sector;
559 560
	int sectors;
	int best_good_sectors;
561 562
	int best_disk, best_dist_disk, best_pending_disk;
	int has_nonrot_disk;
563
	int disk;
N
NeilBrown 已提交
564
	sector_t best_dist;
565
	unsigned int min_pending;
566
	struct md_rdev *rdev;
567
	int choose_first;
568
	int choose_next_idle;
L
Linus Torvalds 已提交
569 570 571

	rcu_read_lock();
	/*
572
	 * Check if we can balance. We can balance on the whole
L
Linus Torvalds 已提交
573 574 575 576
	 * device if no resync is going on, or below the resync window.
	 * We take the first readable disk when above the resync window.
	 */
 retry:
577
	sectors = r1_bio->sectors;
N
NeilBrown 已提交
578
	best_disk = -1;
579
	best_dist_disk = -1;
N
NeilBrown 已提交
580
	best_dist = MaxSector;
581 582
	best_pending_disk = -1;
	min_pending = UINT_MAX;
583
	best_good_sectors = 0;
584
	has_nonrot_disk = 0;
585
	choose_next_idle = 0;
586
	clear_bit(R1BIO_FailFast, &r1_bio->state);
587

588 589
	if ((conf->mddev->recovery_cp < this_sector + sectors) ||
	    (mddev_is_clustered(conf->mddev) &&
590
	    md_cluster_ops->area_resyncing(conf->mddev, READ, this_sector,
591 592 593 594
		    this_sector + sectors)))
		choose_first = 1;
	else
		choose_first = 0;
L
Linus Torvalds 已提交
595

596
	for (disk = 0 ; disk < conf->raid_disks * 2 ; disk++) {
N
NeilBrown 已提交
597
		sector_t dist;
598 599
		sector_t first_bad;
		int bad_sectors;
600
		unsigned int pending;
601
		bool nonrot;
602

603 604 605
		rdev = rcu_dereference(conf->mirrors[disk].rdev);
		if (r1_bio->bios[disk] == IO_BLOCKED
		    || rdev == NULL
N
NeilBrown 已提交
606
		    || test_bit(Faulty, &rdev->flags))
607
			continue;
N
NeilBrown 已提交
608 609
		if (!test_bit(In_sync, &rdev->flags) &&
		    rdev->recovery_offset < this_sector + sectors)
L
Linus Torvalds 已提交
610
			continue;
N
NeilBrown 已提交
611 612 613
		if (test_bit(WriteMostly, &rdev->flags)) {
			/* Don't balance among write-mostly, just
			 * use the first as a last resort */
614
			if (best_dist_disk < 0) {
615 616
				if (is_badblock(rdev, this_sector, sectors,
						&first_bad, &bad_sectors)) {
617
					if (first_bad <= this_sector)
618 619 620 621 622
						/* Cannot use this */
						continue;
					best_good_sectors = first_bad - this_sector;
				} else
					best_good_sectors = sectors;
623 624
				best_dist_disk = disk;
				best_pending_disk = disk;
625
			}
N
NeilBrown 已提交
626 627 628 629 630
			continue;
		}
		/* This is a reasonable device to use.  It might
		 * even be best.
		 */
631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656
		if (is_badblock(rdev, this_sector, sectors,
				&first_bad, &bad_sectors)) {
			if (best_dist < MaxSector)
				/* already have a better device */
				continue;
			if (first_bad <= this_sector) {
				/* cannot read here. If this is the 'primary'
				 * device, then we must not read beyond
				 * bad_sectors from another device..
				 */
				bad_sectors -= (this_sector - first_bad);
				if (choose_first && sectors > bad_sectors)
					sectors = bad_sectors;
				if (best_good_sectors > sectors)
					best_good_sectors = sectors;

			} else {
				sector_t good_sectors = first_bad - this_sector;
				if (good_sectors > best_good_sectors) {
					best_good_sectors = good_sectors;
					best_disk = disk;
				}
				if (choose_first)
					break;
			}
			continue;
657 658 659
		} else {
			if ((sectors > best_good_sectors) && (best_disk >= 0))
				best_disk = -1;
660
			best_good_sectors = sectors;
661
		}
662

663 664 665 666
		if (best_disk >= 0)
			/* At least two disks to choose from so failfast is OK */
			set_bit(R1BIO_FailFast, &r1_bio->state);

667 668
		nonrot = blk_queue_nonrot(bdev_get_queue(rdev->bdev));
		has_nonrot_disk |= nonrot;
669
		pending = atomic_read(&rdev->nr_pending);
N
NeilBrown 已提交
670
		dist = abs(this_sector - conf->mirrors[disk].head_position);
671
		if (choose_first) {
N
NeilBrown 已提交
672
			best_disk = disk;
L
Linus Torvalds 已提交
673 674
			break;
		}
675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707
		/* Don't change to another disk for sequential reads */
		if (conf->mirrors[disk].next_seq_sect == this_sector
		    || dist == 0) {
			int opt_iosize = bdev_io_opt(rdev->bdev) >> 9;
			struct raid1_info *mirror = &conf->mirrors[disk];

			best_disk = disk;
			/*
			 * If buffered sequential IO size exceeds optimal
			 * iosize, check if there is idle disk. If yes, choose
			 * the idle disk. read_balance could already choose an
			 * idle disk before noticing it's a sequential IO in
			 * this disk. This doesn't matter because this disk
			 * will idle, next time it will be utilized after the
			 * first disk has IO size exceeds optimal iosize. In
			 * this way, iosize of the first disk will be optimal
			 * iosize at least. iosize of the second disk might be
			 * small, but not a big deal since when the second disk
			 * starts IO, the first disk is likely still busy.
			 */
			if (nonrot && opt_iosize > 0 &&
			    mirror->seq_start != MaxSector &&
			    mirror->next_seq_sect > opt_iosize &&
			    mirror->next_seq_sect - opt_iosize >=
			    mirror->seq_start) {
				choose_next_idle = 1;
				continue;
			}
			break;
		}

		if (choose_next_idle)
			continue;
708 709 710 711 712 713

		if (min_pending > pending) {
			min_pending = pending;
			best_pending_disk = disk;
		}

N
NeilBrown 已提交
714 715
		if (dist < best_dist) {
			best_dist = dist;
716
			best_dist_disk = disk;
L
Linus Torvalds 已提交
717
		}
718
	}
L
Linus Torvalds 已提交
719

720 721 722 723 724 725 726
	/*
	 * If all disks are rotational, choose the closest disk. If any disk is
	 * non-rotational, choose the disk with less pending request even the
	 * disk is rotational, which might/might not be optimal for raids with
	 * mixed ratation/non-rotational disks depending on workload.
	 */
	if (best_disk == -1) {
727
		if (has_nonrot_disk || min_pending == 0)
728 729 730 731 732
			best_disk = best_pending_disk;
		else
			best_disk = best_dist_disk;
	}

N
NeilBrown 已提交
733 734
	if (best_disk >= 0) {
		rdev = rcu_dereference(conf->mirrors[best_disk].rdev);
735 736 737
		if (!rdev)
			goto retry;
		atomic_inc(&rdev->nr_pending);
738
		sectors = best_good_sectors;
739 740 741 742

		if (conf->mirrors[best_disk].next_seq_sect != this_sector)
			conf->mirrors[best_disk].seq_start = this_sector;

743
		conf->mirrors[best_disk].next_seq_sect = this_sector + sectors;
L
Linus Torvalds 已提交
744 745
	}
	rcu_read_unlock();
746
	*max_sectors = sectors;
L
Linus Torvalds 已提交
747

N
NeilBrown 已提交
748
	return best_disk;
L
Linus Torvalds 已提交
749 750
}

751
static int raid1_congested(struct mddev *mddev, int bits)
752
{
753
	struct r1conf *conf = mddev->private;
754 755
	int i, ret = 0;

756
	if ((bits & (1 << WB_async_congested)) &&
757 758 759
	    conf->pending_count >= max_queued_requests)
		return 1;

760
	rcu_read_lock();
761
	for (i = 0; i < conf->raid_disks * 2; i++) {
762
		struct md_rdev *rdev = rcu_dereference(conf->mirrors[i].rdev);
763
		if (rdev && !test_bit(Faulty, &rdev->flags)) {
764
			struct request_queue *q = bdev_get_queue(rdev->bdev);
765

766 767
			BUG_ON(!q);

768 769 770
			/* Note the '|| 1' - when read_balance prefers
			 * non-congested targets, it can be removed
			 */
771
			if ((bits & (1 << WB_async_congested)) || 1)
772
				ret |= bdi_congested(q->backing_dev_info, bits);
773
			else
774
				ret &= bdi_congested(q->backing_dev_info, bits);
775 776 777 778 779 780
		}
	}
	rcu_read_unlock();
	return ret;
}

781 782 783 784 785 786 787 788 789 790 791 792
static void flush_bio_list(struct r1conf *conf, struct bio *bio)
{
	/* flush any pending bitmap writes to disk before proceeding w/ I/O */
	bitmap_unplug(conf->mddev->bitmap);
	wake_up(&conf->wait_barrier);

	while (bio) { /* submit pending writes */
		struct bio *next = bio->bi_next;
		struct md_rdev *rdev = (void*)bio->bi_bdev;
		bio->bi_next = NULL;
		bio->bi_bdev = rdev->bdev;
		if (test_bit(Faulty, &rdev->flags)) {
793
			bio_io_error(bio);
794 795 796 797 798 799 800 801 802 803
		} else if (unlikely((bio_op(bio) == REQ_OP_DISCARD) &&
				    !blk_queue_discard(bdev_get_queue(bio->bi_bdev))))
			/* Just ignore it */
			bio_endio(bio);
		else
			generic_make_request(bio);
		bio = next;
	}
}

804
static void flush_pending_writes(struct r1conf *conf)
805 806 807 808 809 810 811 812 813
{
	/* Any writes that have been queued but are awaiting
	 * bitmap updates get flushed here.
	 */
	spin_lock_irq(&conf->device_lock);

	if (conf->pending_bio_list.head) {
		struct bio *bio;
		bio = bio_list_get(&conf->pending_bio_list);
814
		conf->pending_count = 0;
815
		spin_unlock_irq(&conf->device_lock);
816
		flush_bio_list(conf, bio);
817 818
	} else
		spin_unlock_irq(&conf->device_lock);
J
Jens Axboe 已提交
819 820
}

821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
/* Barriers....
 * Sometimes we need to suspend IO while we do something else,
 * either some resync/recovery, or reconfigure the array.
 * To do this we raise a 'barrier'.
 * The 'barrier' is a counter that can be raised multiple times
 * to count how many activities are happening which preclude
 * normal IO.
 * We can only raise the barrier if there is no pending IO.
 * i.e. if nr_pending == 0.
 * We choose only to raise the barrier if no-one is waiting for the
 * barrier to go down.  This means that as soon as an IO request
 * is ready, no other operations which require a barrier will start
 * until the IO request has had a chance.
 *
 * So: regular IO calls 'wait_barrier'.  When that returns there
 *    is no backgroup IO happening,  It must arrange to call
 *    allow_barrier when it has finished its IO.
 * backgroup IO calls must call raise_barrier.  Once that returns
 *    there is no normal IO happeing.  It must arrange to call
 *    lower_barrier when the particular background IO completes.
L
Linus Torvalds 已提交
841
 */
842
static void raise_barrier(struct r1conf *conf, sector_t sector_nr)
L
Linus Torvalds 已提交
843
{
844 845
	int idx = sector_to_idx(sector_nr);

L
Linus Torvalds 已提交
846
	spin_lock_irq(&conf->resync_lock);
847 848

	/* Wait until no block IO is waiting */
849 850
	wait_event_lock_irq(conf->wait_barrier,
			    !atomic_read(&conf->nr_waiting[idx]),
851
			    conf->resync_lock);
852 853

	/* block any new IO from starting */
854 855 856 857 858 859 860 861 862 863
	atomic_inc(&conf->barrier[idx]);
	/*
	 * In raise_barrier() we firstly increase conf->barrier[idx] then
	 * check conf->nr_pending[idx]. In _wait_barrier() we firstly
	 * increase conf->nr_pending[idx] then check conf->barrier[idx].
	 * A memory barrier here to make sure conf->nr_pending[idx] won't
	 * be fetched before conf->barrier[idx] is increased. Otherwise
	 * there will be a race between raise_barrier() and _wait_barrier().
	 */
	smp_mb__after_atomic();
864

865 866
	/* For these conditions we must wait:
	 * A: while the array is in frozen state
867 868 869 870
	 * B: while conf->nr_pending[idx] is not 0, meaning regular I/O
	 *    existing in corresponding I/O barrier bucket.
	 * C: while conf->barrier[idx] >= RESYNC_DEPTH, meaning reaches
	 *    max resync count which allowed on current I/O barrier bucket.
871
	 */
872
	wait_event_lock_irq(conf->wait_barrier,
873
			    !conf->array_frozen &&
874 875
			     !atomic_read(&conf->nr_pending[idx]) &&
			     atomic_read(&conf->barrier[idx]) < RESYNC_DEPTH,
876
			    conf->resync_lock);
877

878
	atomic_inc(&conf->nr_sync_pending);
879 880 881
	spin_unlock_irq(&conf->resync_lock);
}

882
static void lower_barrier(struct r1conf *conf, sector_t sector_nr)
883
{
884 885
	int idx = sector_to_idx(sector_nr);

886
	BUG_ON(atomic_read(&conf->barrier[idx]) <= 0);
887

888
	atomic_dec(&conf->barrier[idx]);
889
	atomic_dec(&conf->nr_sync_pending);
890 891 892
	wake_up(&conf->wait_barrier);
}

893
static void _wait_barrier(struct r1conf *conf, int idx)
894
{
895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912
	/*
	 * We need to increase conf->nr_pending[idx] very early here,
	 * then raise_barrier() can be blocked when it waits for
	 * conf->nr_pending[idx] to be 0. Then we can avoid holding
	 * conf->resync_lock when there is no barrier raised in same
	 * barrier unit bucket. Also if the array is frozen, I/O
	 * should be blocked until array is unfrozen.
	 */
	atomic_inc(&conf->nr_pending[idx]);
	/*
	 * In _wait_barrier() we firstly increase conf->nr_pending[idx], then
	 * check conf->barrier[idx]. In raise_barrier() we firstly increase
	 * conf->barrier[idx], then check conf->nr_pending[idx]. A memory
	 * barrier is necessary here to make sure conf->barrier[idx] won't be
	 * fetched before conf->nr_pending[idx] is increased. Otherwise there
	 * will be a race between _wait_barrier() and raise_barrier().
	 */
	smp_mb__after_atomic();
913

914 915 916 917 918 919 920 921 922 923 924 925
	/*
	 * Don't worry about checking two atomic_t variables at same time
	 * here. If during we check conf->barrier[idx], the array is
	 * frozen (conf->array_frozen is 1), and chonf->barrier[idx] is
	 * 0, it is safe to return and make the I/O continue. Because the
	 * array is frozen, all I/O returned here will eventually complete
	 * or be queued, no race will happen. See code comment in
	 * frozen_array().
	 */
	if (!READ_ONCE(conf->array_frozen) &&
	    !atomic_read(&conf->barrier[idx]))
		return;
926

927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948
	/*
	 * After holding conf->resync_lock, conf->nr_pending[idx]
	 * should be decreased before waiting for barrier to drop.
	 * Otherwise, we may encounter a race condition because
	 * raise_barrer() might be waiting for conf->nr_pending[idx]
	 * to be 0 at same time.
	 */
	spin_lock_irq(&conf->resync_lock);
	atomic_inc(&conf->nr_waiting[idx]);
	atomic_dec(&conf->nr_pending[idx]);
	/*
	 * In case freeze_array() is waiting for
	 * get_unqueued_pending() == extra
	 */
	wake_up(&conf->wait_barrier);
	/* Wait for the barrier in same barrier unit bucket to drop. */
	wait_event_lock_irq(conf->wait_barrier,
			    !conf->array_frozen &&
			     !atomic_read(&conf->barrier[idx]),
			    conf->resync_lock);
	atomic_inc(&conf->nr_pending[idx]);
	atomic_dec(&conf->nr_waiting[idx]);
949
	spin_unlock_irq(&conf->resync_lock);
950 951
}

952
static void wait_read_barrier(struct r1conf *conf, sector_t sector_nr)
953
{
954
	int idx = sector_to_idx(sector_nr);
955

956 957 958 959 960 961 962 963
	/*
	 * Very similar to _wait_barrier(). The difference is, for read
	 * I/O we don't need wait for sync I/O, but if the whole array
	 * is frozen, the read I/O still has to wait until the array is
	 * unfrozen. Since there is no ordering requirement with
	 * conf->barrier[idx] here, memory barrier is unnecessary as well.
	 */
	atomic_inc(&conf->nr_pending[idx]);
964

965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981
	if (!READ_ONCE(conf->array_frozen))
		return;

	spin_lock_irq(&conf->resync_lock);
	atomic_inc(&conf->nr_waiting[idx]);
	atomic_dec(&conf->nr_pending[idx]);
	/*
	 * In case freeze_array() is waiting for
	 * get_unqueued_pending() == extra
	 */
	wake_up(&conf->wait_barrier);
	/* Wait for array to be unfrozen */
	wait_event_lock_irq(conf->wait_barrier,
			    !conf->array_frozen,
			    conf->resync_lock);
	atomic_inc(&conf->nr_pending[idx]);
	atomic_dec(&conf->nr_waiting[idx]);
L
Linus Torvalds 已提交
982 983 984
	spin_unlock_irq(&conf->resync_lock);
}

985
static void wait_barrier(struct r1conf *conf, sector_t sector_nr)
986
{
987
	int idx = sector_to_idx(sector_nr);
988

989 990 991 992 993 994 995 996 997 998 999 1000
	_wait_barrier(conf, idx);
}

static void wait_all_barriers(struct r1conf *conf)
{
	int idx;

	for (idx = 0; idx < BARRIER_BUCKETS_NR; idx++)
		_wait_barrier(conf, idx);
}

static void _allow_barrier(struct r1conf *conf, int idx)
1001
{
1002
	atomic_dec(&conf->nr_pending[idx]);
1003 1004 1005
	wake_up(&conf->wait_barrier);
}

1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
static void allow_barrier(struct r1conf *conf, sector_t sector_nr)
{
	int idx = sector_to_idx(sector_nr);

	_allow_barrier(conf, idx);
}

static void allow_all_barriers(struct r1conf *conf)
{
	int idx;

	for (idx = 0; idx < BARRIER_BUCKETS_NR; idx++)
		_allow_barrier(conf, idx);
}

/* conf->resync_lock should be held */
static int get_unqueued_pending(struct r1conf *conf)
{
	int idx, ret;

1026 1027
	ret = atomic_read(&conf->nr_sync_pending);
	for (idx = 0; idx < BARRIER_BUCKETS_NR; idx++)
1028 1029
		ret += atomic_read(&conf->nr_pending[idx]) -
			atomic_read(&conf->nr_queued[idx]);
1030 1031 1032 1033

	return ret;
}

1034
static void freeze_array(struct r1conf *conf, int extra)
1035
{
1036
	/* Stop sync I/O and normal I/O and wait for everything to
1037
	 * go quiet.
1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057
	 * This is called in two situations:
	 * 1) management command handlers (reshape, remove disk, quiesce).
	 * 2) one normal I/O request failed.

	 * After array_frozen is set to 1, new sync IO will be blocked at
	 * raise_barrier(), and new normal I/O will blocked at _wait_barrier()
	 * or wait_read_barrier(). The flying I/Os will either complete or be
	 * queued. When everything goes quite, there are only queued I/Os left.

	 * Every flying I/O contributes to a conf->nr_pending[idx], idx is the
	 * barrier bucket index which this I/O request hits. When all sync and
	 * normal I/O are queued, sum of all conf->nr_pending[] will match sum
	 * of all conf->nr_queued[]. But normal I/O failure is an exception,
	 * in handle_read_error(), we may call freeze_array() before trying to
	 * fix the read error. In this case, the error read I/O is not queued,
	 * so get_unqueued_pending() == 1.
	 *
	 * Therefore before this function returns, we need to wait until
	 * get_unqueued_pendings(conf) gets equal to extra. For
	 * normal I/O context, extra is 1, in rested situations extra is 0.
1058 1059
	 */
	spin_lock_irq(&conf->resync_lock);
1060
	conf->array_frozen = 1;
1061
	raid1_log(conf->mddev, "wait freeze");
1062 1063 1064 1065 1066
	wait_event_lock_irq_cmd(
		conf->wait_barrier,
		get_unqueued_pending(conf) == extra,
		conf->resync_lock,
		flush_pending_writes(conf));
1067 1068
	spin_unlock_irq(&conf->resync_lock);
}
1069
static void unfreeze_array(struct r1conf *conf)
1070 1071 1072
{
	/* reverse the effect of the freeze */
	spin_lock_irq(&conf->resync_lock);
1073
	conf->array_frozen = 0;
1074
	spin_unlock_irq(&conf->resync_lock);
1075
	wake_up(&conf->wait_barrier);
1076 1077
}

S
Shaohua Li 已提交
1078
static void alloc_behind_master_bio(struct r1bio *r1_bio,
1079
					   struct bio *bio)
1080
{
1081
	int size = bio->bi_iter.bi_size;
M
Ming Lei 已提交
1082 1083 1084 1085 1086 1087
	unsigned vcnt = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;
	int i = 0;
	struct bio *behind_bio = NULL;

	behind_bio = bio_alloc_mddev(GFP_NOIO, vcnt, r1_bio->mddev);
	if (!behind_bio)
S
Shaohua Li 已提交
1088
		return;
1089

1090
	/* discard op, we don't support writezero/writesame yet */
S
Shaohua Li 已提交
1091 1092
	if (!bio_has_data(bio)) {
		behind_bio->bi_iter.bi_size = size;
1093
		goto skip_copy;
S
Shaohua Li 已提交
1094
	}
1095

M
Ming Lei 已提交
1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107
	while (i < vcnt && size) {
		struct page *page;
		int len = min_t(int, PAGE_SIZE, size);

		page = alloc_page(GFP_NOIO);
		if (unlikely(!page))
			goto free_pages;

		bio_add_page(behind_bio, page, len, 0);

		size -= len;
		i++;
1108
	}
M
Ming Lei 已提交
1109

1110
	bio_copy_data(behind_bio, bio);
1111
skip_copy:
M
Ming Lei 已提交
1112
	r1_bio->behind_master_bio = behind_bio;;
1113
	set_bit(R1BIO_BehindIO, &r1_bio->state);
1114

S
Shaohua Li 已提交
1115
	return;
M
Ming Lei 已提交
1116 1117

free_pages:
1118 1119
	pr_debug("%dB behind alloc failed, doing sync I/O\n",
		 bio->bi_iter.bi_size);
M
Ming Lei 已提交
1120
	bio_free_pages(behind_bio);
S
Shaohua Li 已提交
1121
	bio_put(behind_bio);
1122 1123
}

1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137
struct raid1_plug_cb {
	struct blk_plug_cb	cb;
	struct bio_list		pending;
	int			pending_cnt;
};

static void raid1_unplug(struct blk_plug_cb *cb, bool from_schedule)
{
	struct raid1_plug_cb *plug = container_of(cb, struct raid1_plug_cb,
						  cb);
	struct mddev *mddev = plug->cb.data;
	struct r1conf *conf = mddev->private;
	struct bio *bio;

1138
	if (from_schedule || current->bio_list) {
1139 1140 1141 1142
		spin_lock_irq(&conf->device_lock);
		bio_list_merge(&conf->pending_bio_list, &plug->pending);
		conf->pending_count += plug->pending_cnt;
		spin_unlock_irq(&conf->device_lock);
1143
		wake_up(&conf->wait_barrier);
1144 1145 1146 1147 1148 1149 1150
		md_wakeup_thread(mddev->thread);
		kfree(plug);
		return;
	}

	/* we aren't scheduling, so we can do the write-out directly. */
	bio = bio_list_get(&plug->pending);
1151
	flush_bio_list(conf, bio);
1152 1153 1154
	kfree(plug);
}

1155 1156 1157 1158 1159 1160 1161 1162 1163
static void init_r1bio(struct r1bio *r1_bio, struct mddev *mddev, struct bio *bio)
{
	r1_bio->master_bio = bio;
	r1_bio->sectors = bio_sectors(bio);
	r1_bio->state = 0;
	r1_bio->mddev = mddev;
	r1_bio->sector = bio->bi_iter.bi_sector;
}

1164
static inline struct r1bio *
1165
alloc_r1bio(struct mddev *mddev, struct bio *bio)
1166 1167 1168 1169 1170
{
	struct r1conf *conf = mddev->private;
	struct r1bio *r1_bio;

	r1_bio = mempool_alloc(conf->r1bio_pool, GFP_NOIO);
1171 1172 1173
	/* Ensure no bio records IO_BLOCKED */
	memset(r1_bio->bios, 0, conf->raid_disks * sizeof(r1_bio->bios[0]));
	init_r1bio(r1_bio, mddev, bio);
1174 1175 1176
	return r1_bio;
}

1177
static void raid1_read_request(struct mddev *mddev, struct bio *bio,
1178
			       int max_read_sectors, struct r1bio *r1_bio)
L
Linus Torvalds 已提交
1179
{
1180
	struct r1conf *conf = mddev->private;
1181
	struct raid1_info *mirror;
L
Linus Torvalds 已提交
1182
	struct bio *read_bio;
1183 1184 1185 1186 1187
	struct bitmap *bitmap = mddev->bitmap;
	const int op = bio_op(bio);
	const unsigned long do_sync = (bio->bi_opf & REQ_SYNC);
	int max_sectors;
	int rdisk;
1188 1189
	bool print_msg = !!r1_bio;
	char b[BDEVNAME_SIZE];
1190

1191
	/*
1192 1193 1194
	 * If r1_bio is set, we are blocking the raid1d thread
	 * so there is a tiny risk of deadlock.  So ask for
	 * emergency memory if needed.
1195
	 */
1196
	gfp_t gfp = r1_bio ? (GFP_NOIO | __GFP_HIGH) : GFP_NOIO;
1197

1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208
	if (print_msg) {
		/* Need to get the block device name carefully */
		struct md_rdev *rdev;
		rcu_read_lock();
		rdev = rcu_dereference(conf->mirrors[r1_bio->read_disk].rdev);
		if (rdev)
			bdevname(rdev->bdev, b);
		else
			strcpy(b, "???");
		rcu_read_unlock();
	}
1209

1210 1211 1212 1213 1214 1215
	/*
	 * Still need barrier for READ in case that whole
	 * array is frozen.
	 */
	wait_read_barrier(conf, bio->bi_iter.bi_sector);

1216 1217 1218 1219
	if (!r1_bio)
		r1_bio = alloc_r1bio(mddev, bio);
	else
		init_r1bio(r1_bio, mddev, bio);
1220
	r1_bio->sectors = max_read_sectors;
1221 1222 1223 1224 1225

	/*
	 * make_request() can abort the operation when read-ahead is being
	 * used and no empty request is available.
	 */
1226 1227 1228 1229
	rdisk = read_balance(conf, r1_bio, &max_sectors);

	if (rdisk < 0) {
		/* couldn't find anywhere to read from */
1230 1231 1232 1233 1234 1235
		if (print_msg) {
			pr_crit_ratelimited("md/raid1:%s: %s: unrecoverable I/O read error for block %llu\n",
					    mdname(mddev),
					    b,
					    (unsigned long long)r1_bio->sector);
		}
1236 1237 1238 1239 1240
		raid_end_bio_io(r1_bio);
		return;
	}
	mirror = conf->mirrors + rdisk;

1241 1242 1243 1244 1245 1246
	if (print_msg)
		pr_info_ratelimited("md/raid1:%s: redirecting sector %llu to other mirror: %s\n",
				    mdname(mddev),
				    (unsigned long long)r1_bio->sector,
				    bdevname(mirror->rdev->bdev, b));

1247 1248 1249 1250 1251 1252 1253 1254 1255 1256
	if (test_bit(WriteMostly, &mirror->rdev->flags) &&
	    bitmap) {
		/*
		 * Reading from a write-mostly device must take care not to
		 * over-take any writes that are 'behind'
		 */
		raid1_log(mddev, "wait behind writes");
		wait_event(bitmap->behind_wait,
			   atomic_read(&bitmap->behind_writes) == 0);
	}
1257 1258 1259

	if (max_sectors < bio_sectors(bio)) {
		struct bio *split = bio_split(bio, max_sectors,
1260
					      gfp, conf->bio_split);
1261 1262 1263 1264 1265 1266 1267
		bio_chain(split, bio);
		generic_make_request(bio);
		bio = split;
		r1_bio->master_bio = bio;
		r1_bio->sectors = max_sectors;
	}

1268 1269
	r1_bio->read_disk = rdisk;

1270
	read_bio = bio_clone_fast(bio, gfp, mddev->bio_set);
1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288

	r1_bio->bios[rdisk] = read_bio;

	read_bio->bi_iter.bi_sector = r1_bio->sector +
		mirror->rdev->data_offset;
	read_bio->bi_bdev = mirror->rdev->bdev;
	read_bio->bi_end_io = raid1_end_read_request;
	bio_set_op_attrs(read_bio, op, do_sync);
	if (test_bit(FailFast, &mirror->rdev->flags) &&
	    test_bit(R1BIO_FailFast, &r1_bio->state))
	        read_bio->bi_opf |= MD_FAILFAST;
	read_bio->bi_private = r1_bio;

	if (mddev->gendisk)
	        trace_block_bio_remap(bdev_get_queue(read_bio->bi_bdev),
	                              read_bio, disk_devt(mddev->gendisk),
	                              r1_bio->sector);

1289
	generic_make_request(read_bio);
1290 1291
}

1292 1293
static void raid1_write_request(struct mddev *mddev, struct bio *bio,
				int max_write_sectors)
1294 1295
{
	struct r1conf *conf = mddev->private;
1296
	struct r1bio *r1_bio;
1297
	int i, disks;
1298
	struct bitmap *bitmap = mddev->bitmap;
1299
	unsigned long flags;
1300
	struct md_rdev *blocked_rdev;
1301 1302
	struct blk_plug_cb *cb;
	struct raid1_plug_cb *plug = NULL;
1303 1304
	int first_clone;
	int max_sectors;
1305

L
Linus Torvalds 已提交
1306 1307 1308 1309 1310
	/*
	 * Register the new request and wait if the reconstruction
	 * thread has put up a bar for new requests.
	 * Continue immediately if no resync is active currently.
	 */
1311

1312

1313
	if ((bio_end_sector(bio) > mddev->suspend_lo &&
1314 1315
	    bio->bi_iter.bi_sector < mddev->suspend_hi) ||
	    (mddev_is_clustered(mddev) &&
1316
	     md_cluster_ops->area_resyncing(mddev, WRITE,
1317 1318 1319 1320 1321
		     bio->bi_iter.bi_sector, bio_end_sector(bio)))) {

		/*
		 * As the suspend_* range is controlled by userspace, we want
		 * an interruptible wait.
1322 1323 1324
		 */
		DEFINE_WAIT(w);
		for (;;) {
1325
			sigset_t full, old;
1326 1327
			prepare_to_wait(&conf->wait_barrier,
					&w, TASK_INTERRUPTIBLE);
K
Kent Overstreet 已提交
1328
			if (bio_end_sector(bio) <= mddev->suspend_lo ||
1329 1330
			    bio->bi_iter.bi_sector >= mddev->suspend_hi ||
			    (mddev_is_clustered(mddev) &&
1331
			     !md_cluster_ops->area_resyncing(mddev, WRITE,
1332 1333
				     bio->bi_iter.bi_sector,
				     bio_end_sector(bio))))
1334
				break;
1335 1336
			sigfillset(&full);
			sigprocmask(SIG_BLOCK, &full, &old);
1337
			schedule();
1338
			sigprocmask(SIG_SETMASK, &old, NULL);
1339 1340 1341
		}
		finish_wait(&conf->wait_barrier, &w);
	}
1342 1343
	wait_barrier(conf, bio->bi_iter.bi_sector);

1344
	r1_bio = alloc_r1bio(mddev, bio);
1345
	r1_bio->sectors = max_write_sectors;
L
Linus Torvalds 已提交
1346

1347 1348
	if (conf->pending_count >= max_queued_requests) {
		md_wakeup_thread(mddev->thread);
1349
		raid1_log(mddev, "wait queued");
1350 1351 1352
		wait_event(conf->wait_barrier,
			   conf->pending_count < max_queued_requests);
	}
1353
	/* first select target devices under rcu_lock and
L
Linus Torvalds 已提交
1354 1355
	 * inc refcount on their rdev.  Record them by setting
	 * bios[x] to bio
1356 1357 1358 1359 1360 1361
	 * If there are known/acknowledged bad blocks on any device on
	 * which we have seen a write error, we want to avoid writing those
	 * blocks.
	 * This potentially requires several writes to write around
	 * the bad blocks.  Each set of writes gets it's own r1bio
	 * with a set of bios attached.
L
Linus Torvalds 已提交
1362
	 */
N
NeilBrown 已提交
1363

1364
	disks = conf->raid_disks * 2;
1365 1366
 retry_write:
	blocked_rdev = NULL;
L
Linus Torvalds 已提交
1367
	rcu_read_lock();
1368
	max_sectors = r1_bio->sectors;
L
Linus Torvalds 已提交
1369
	for (i = 0;  i < disks; i++) {
1370
		struct md_rdev *rdev = rcu_dereference(conf->mirrors[i].rdev);
1371 1372 1373 1374 1375
		if (rdev && unlikely(test_bit(Blocked, &rdev->flags))) {
			atomic_inc(&rdev->nr_pending);
			blocked_rdev = rdev;
			break;
		}
1376
		r1_bio->bios[i] = NULL;
1377
		if (!rdev || test_bit(Faulty, &rdev->flags)) {
1378 1379
			if (i < conf->raid_disks)
				set_bit(R1BIO_Degraded, &r1_bio->state);
1380 1381 1382 1383 1384 1385 1386 1387 1388
			continue;
		}

		atomic_inc(&rdev->nr_pending);
		if (test_bit(WriteErrorSeen, &rdev->flags)) {
			sector_t first_bad;
			int bad_sectors;
			int is_bad;

1389
			is_bad = is_badblock(rdev, r1_bio->sector, max_sectors,
1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405
					     &first_bad, &bad_sectors);
			if (is_bad < 0) {
				/* mustn't write here until the bad block is
				 * acknowledged*/
				set_bit(BlockedBadBlocks, &rdev->flags);
				blocked_rdev = rdev;
				break;
			}
			if (is_bad && first_bad <= r1_bio->sector) {
				/* Cannot write here at all */
				bad_sectors -= (r1_bio->sector - first_bad);
				if (bad_sectors < max_sectors)
					/* mustn't write more than bad_sectors
					 * to other devices yet
					 */
					max_sectors = bad_sectors;
1406
				rdev_dec_pending(rdev, mddev);
1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417
				/* We don't set R1BIO_Degraded as that
				 * only applies if the disk is
				 * missing, so it might be re-added,
				 * and we want to know to recover this
				 * chunk.
				 * In this case the device is here,
				 * and the fact that this chunk is not
				 * in-sync is recorded in the bad
				 * block log
				 */
				continue;
1418
			}
1419 1420 1421 1422 1423 1424 1425
			if (is_bad) {
				int good_sectors = first_bad - r1_bio->sector;
				if (good_sectors < max_sectors)
					max_sectors = good_sectors;
			}
		}
		r1_bio->bios[i] = bio;
L
Linus Torvalds 已提交
1426 1427 1428
	}
	rcu_read_unlock();

1429 1430 1431 1432 1433 1434 1435
	if (unlikely(blocked_rdev)) {
		/* Wait for this device to become unblocked */
		int j;

		for (j = 0; j < i; j++)
			if (r1_bio->bios[j])
				rdev_dec_pending(conf->mirrors[j].rdev, mddev);
1436
		r1_bio->state = 0;
1437
		allow_barrier(conf, bio->bi_iter.bi_sector);
1438
		raid1_log(mddev, "wait rdev %d blocked", blocked_rdev->raid_disk);
1439
		md_wait_for_blocked_rdev(blocked_rdev, mddev);
1440
		wait_barrier(conf, bio->bi_iter.bi_sector);
1441 1442 1443
		goto retry_write;
	}

1444 1445 1446 1447 1448 1449 1450
	if (max_sectors < bio_sectors(bio)) {
		struct bio *split = bio_split(bio, max_sectors,
					      GFP_NOIO, conf->bio_split);
		bio_chain(split, bio);
		generic_make_request(bio);
		bio = split;
		r1_bio->master_bio = bio;
1451
		r1_bio->sectors = max_sectors;
1452
	}
1453

1454
	atomic_set(&r1_bio->remaining, 1);
1455
	atomic_set(&r1_bio->behind_remaining, 0);
1456

1457
	first_clone = 1;
M
Ming Lei 已提交
1458

L
Linus Torvalds 已提交
1459
	for (i = 0; i < disks; i++) {
1460
		struct bio *mbio = NULL;
L
Linus Torvalds 已提交
1461 1462 1463
		if (!r1_bio->bios[i])
			continue;

1464 1465 1466 1467 1468 1469 1470 1471 1472

		if (first_clone) {
			/* do behind I/O ?
			 * Not if there are too many, or cannot
			 * allocate memory, or a reader on WriteMostly
			 * is waiting for behind writes to flush */
			if (bitmap &&
			    (atomic_read(&bitmap->behind_writes)
			     < mddev->bitmap_info.max_write_behind) &&
1473
			    !waitqueue_active(&bitmap->behind_wait)) {
S
Shaohua Li 已提交
1474
				alloc_behind_master_bio(r1_bio, bio);
1475
			}
1476 1477 1478 1479 1480 1481 1482

			bitmap_startwrite(bitmap, r1_bio->sector,
					  r1_bio->sectors,
					  test_bit(R1BIO_BehindIO,
						   &r1_bio->state));
			first_clone = 0;
		}
1483

S
Shaohua Li 已提交
1484 1485 1486 1487 1488
		if (r1_bio->behind_master_bio)
			mbio = bio_clone_fast(r1_bio->behind_master_bio,
					      GFP_NOIO, mddev->bio_set);
		else
			mbio = bio_clone_fast(bio, GFP_NOIO, mddev->bio_set);
1489

M
Ming Lei 已提交
1490
		if (r1_bio->behind_master_bio) {
1491 1492 1493 1494
			if (test_bit(WriteMostly, &conf->mirrors[i].rdev->flags))
				atomic_inc(&r1_bio->behind_remaining);
		}

1495 1496
		r1_bio->bios[i] = mbio;

1497
		mbio->bi_iter.bi_sector	= (r1_bio->sector +
1498
				   conf->mirrors[i].rdev->data_offset);
1499
		mbio->bi_bdev = conf->mirrors[i].rdev->bdev;
1500
		mbio->bi_end_io	= raid1_end_write_request;
1501
		mbio->bi_opf = bio_op(bio) | (bio->bi_opf & (REQ_SYNC | REQ_FUA));
1502 1503 1504 1505
		if (test_bit(FailFast, &conf->mirrors[i].rdev->flags) &&
		    !test_bit(WriteMostly, &conf->mirrors[i].rdev->flags) &&
		    conf->raid_disks - mddev->degraded > 1)
			mbio->bi_opf |= MD_FAILFAST;
1506 1507
		mbio->bi_private = r1_bio;

L
Linus Torvalds 已提交
1508
		atomic_inc(&r1_bio->remaining);
1509

1510 1511 1512 1513 1514 1515 1516
		if (mddev->gendisk)
			trace_block_bio_remap(bdev_get_queue(mbio->bi_bdev),
					      mbio, disk_devt(mddev->gendisk),
					      r1_bio->sector);
		/* flush_pending_writes() needs access to the rdev so...*/
		mbio->bi_bdev = (void*)conf->mirrors[i].rdev;

1517 1518 1519 1520 1521 1522 1523 1524 1525
		cb = blk_check_plugged(raid1_unplug, mddev, sizeof(*plug));
		if (cb)
			plug = container_of(cb, struct raid1_plug_cb, cb);
		else
			plug = NULL;
		if (plug) {
			bio_list_add(&plug->pending, mbio);
			plug->pending_cnt++;
		} else {
1526
			spin_lock_irqsave(&conf->device_lock, flags);
1527 1528
			bio_list_add(&conf->pending_bio_list, mbio);
			conf->pending_count++;
1529
			spin_unlock_irqrestore(&conf->device_lock, flags);
N
NeilBrown 已提交
1530
			md_wakeup_thread(mddev->thread);
1531
		}
L
Linus Torvalds 已提交
1532
	}
1533

1534 1535 1536 1537
	r1_bio_write_done(r1_bio);

	/* In case raid1d snuck in to freeze_array */
	wake_up(&conf->wait_barrier);
L
Linus Torvalds 已提交
1538 1539
}

1540
static bool raid1_make_request(struct mddev *mddev, struct bio *bio)
1541
{
1542
	sector_t sectors;
1543

1544 1545
	if (unlikely(bio->bi_opf & REQ_PREFLUSH)) {
		md_flush_request(mddev, bio);
1546
		return true;
1547
	}
1548

1549 1550 1551 1552 1553 1554 1555 1556 1557
	/*
	 * There is a limit to the maximum size, but
	 * the read/write handler might find a lower limit
	 * due to bad blocks.  To avoid multiple splits,
	 * we pass the maximum number of sectors down
	 * and let the lower level perform the split.
	 */
	sectors = align_to_barrier_unit_end(
		bio->bi_iter.bi_sector, bio_sectors(bio));
S
Shaohua Li 已提交
1558

1559
	if (bio_data_dir(bio) == READ)
1560
		raid1_read_request(mddev, bio, sectors, NULL);
1561 1562 1563
	else {
		if (!md_write_start(mddev,bio))
			return false;
1564
		raid1_write_request(mddev, bio, sectors);
1565 1566
	}
	return true;
1567 1568
}

S
Shaohua Li 已提交
1569
static void raid1_status(struct seq_file *seq, struct mddev *mddev)
L
Linus Torvalds 已提交
1570
{
1571
	struct r1conf *conf = mddev->private;
L
Linus Torvalds 已提交
1572 1573 1574
	int i;

	seq_printf(seq, " [%d/%d] [", conf->raid_disks,
1575
		   conf->raid_disks - mddev->degraded);
1576 1577
	rcu_read_lock();
	for (i = 0; i < conf->raid_disks; i++) {
1578
		struct md_rdev *rdev = rcu_dereference(conf->mirrors[i].rdev);
L
Linus Torvalds 已提交
1579
		seq_printf(seq, "%s",
1580 1581 1582
			   rdev && test_bit(In_sync, &rdev->flags) ? "U" : "_");
	}
	rcu_read_unlock();
L
Linus Torvalds 已提交
1583 1584 1585
	seq_printf(seq, "]");
}

S
Shaohua Li 已提交
1586
static void raid1_error(struct mddev *mddev, struct md_rdev *rdev)
L
Linus Torvalds 已提交
1587 1588
{
	char b[BDEVNAME_SIZE];
1589
	struct r1conf *conf = mddev->private;
1590
	unsigned long flags;
L
Linus Torvalds 已提交
1591 1592 1593 1594 1595 1596 1597

	/*
	 * If it is not operational, then we have already marked it as dead
	 * else if it is the last working disks, ignore the error, let the
	 * next level up know.
	 * else mark the drive as failed
	 */
1598
	spin_lock_irqsave(&conf->device_lock, flags);
1599
	if (test_bit(In_sync, &rdev->flags)
1600
	    && (conf->raid_disks - mddev->degraded) == 1) {
L
Linus Torvalds 已提交
1601 1602
		/*
		 * Don't fail the drive, act as though we were just a
1603 1604 1605
		 * normal single drive.
		 * However don't try a recovery from this drive as
		 * it is very likely to fail.
L
Linus Torvalds 已提交
1606
		 */
1607
		conf->recovery_disabled = mddev->recovery_disabled;
1608
		spin_unlock_irqrestore(&conf->device_lock, flags);
L
Linus Torvalds 已提交
1609
		return;
1610
	}
1611
	set_bit(Blocked, &rdev->flags);
1612
	if (test_and_clear_bit(In_sync, &rdev->flags)) {
L
Linus Torvalds 已提交
1613
		mddev->degraded++;
1614 1615 1616
		set_bit(Faulty, &rdev->flags);
	} else
		set_bit(Faulty, &rdev->flags);
1617
	spin_unlock_irqrestore(&conf->device_lock, flags);
1618 1619 1620 1621
	/*
	 * if recovery is running, make sure it aborts.
	 */
	set_bit(MD_RECOVERY_INTR, &mddev->recovery);
1622 1623
	set_mask_bits(&mddev->sb_flags, 0,
		      BIT(MD_SB_CHANGE_DEVS) | BIT(MD_SB_CHANGE_PENDING));
N
NeilBrown 已提交
1624 1625 1626 1627
	pr_crit("md/raid1:%s: Disk failure on %s, disabling device.\n"
		"md/raid1:%s: Operation continuing on %d devices.\n",
		mdname(mddev), bdevname(rdev->bdev, b),
		mdname(mddev), conf->raid_disks - mddev->degraded);
L
Linus Torvalds 已提交
1628 1629
}

1630
static void print_conf(struct r1conf *conf)
L
Linus Torvalds 已提交
1631 1632 1633
{
	int i;

N
NeilBrown 已提交
1634
	pr_debug("RAID1 conf printout:\n");
L
Linus Torvalds 已提交
1635
	if (!conf) {
N
NeilBrown 已提交
1636
		pr_debug("(!conf)\n");
L
Linus Torvalds 已提交
1637 1638
		return;
	}
N
NeilBrown 已提交
1639 1640
	pr_debug(" --- wd:%d rd:%d\n", conf->raid_disks - conf->mddev->degraded,
		 conf->raid_disks);
L
Linus Torvalds 已提交
1641

1642
	rcu_read_lock();
L
Linus Torvalds 已提交
1643 1644
	for (i = 0; i < conf->raid_disks; i++) {
		char b[BDEVNAME_SIZE];
1645
		struct md_rdev *rdev = rcu_dereference(conf->mirrors[i].rdev);
1646
		if (rdev)
N
NeilBrown 已提交
1647 1648 1649 1650
			pr_debug(" disk %d, wo:%d, o:%d, dev:%s\n",
				 i, !test_bit(In_sync, &rdev->flags),
				 !test_bit(Faulty, &rdev->flags),
				 bdevname(rdev->bdev,b));
L
Linus Torvalds 已提交
1651
	}
1652
	rcu_read_unlock();
L
Linus Torvalds 已提交
1653 1654
}

1655
static void close_sync(struct r1conf *conf)
L
Linus Torvalds 已提交
1656
{
1657 1658
	wait_all_barriers(conf);
	allow_all_barriers(conf);
L
Linus Torvalds 已提交
1659 1660 1661 1662 1663

	mempool_destroy(conf->r1buf_pool);
	conf->r1buf_pool = NULL;
}

1664
static int raid1_spare_active(struct mddev *mddev)
L
Linus Torvalds 已提交
1665 1666
{
	int i;
1667
	struct r1conf *conf = mddev->private;
1668 1669
	int count = 0;
	unsigned long flags;
L
Linus Torvalds 已提交
1670 1671

	/*
1672
	 * Find all failed disks within the RAID1 configuration
1673 1674
	 * and mark them readable.
	 * Called under mddev lock, so rcu protection not needed.
1675 1676
	 * device_lock used to avoid races with raid1_end_read_request
	 * which expects 'In_sync' flags and ->degraded to be consistent.
L
Linus Torvalds 已提交
1677
	 */
1678
	spin_lock_irqsave(&conf->device_lock, flags);
L
Linus Torvalds 已提交
1679
	for (i = 0; i < conf->raid_disks; i++) {
1680
		struct md_rdev *rdev = conf->mirrors[i].rdev;
1681 1682
		struct md_rdev *repl = conf->mirrors[conf->raid_disks + i].rdev;
		if (repl
1683
		    && !test_bit(Candidate, &repl->flags)
1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700
		    && repl->recovery_offset == MaxSector
		    && !test_bit(Faulty, &repl->flags)
		    && !test_and_set_bit(In_sync, &repl->flags)) {
			/* replacement has just become active */
			if (!rdev ||
			    !test_and_clear_bit(In_sync, &rdev->flags))
				count++;
			if (rdev) {
				/* Replaced device not technically
				 * faulty, but we need to be sure
				 * it gets removed and never re-added
				 */
				set_bit(Faulty, &rdev->flags);
				sysfs_notify_dirent_safe(
					rdev->sysfs_state);
			}
		}
1701
		if (rdev
1702
		    && rdev->recovery_offset == MaxSector
1703
		    && !test_bit(Faulty, &rdev->flags)
1704
		    && !test_and_set_bit(In_sync, &rdev->flags)) {
1705
			count++;
1706
			sysfs_notify_dirent_safe(rdev->sysfs_state);
L
Linus Torvalds 已提交
1707 1708
		}
	}
1709 1710
	mddev->degraded -= count;
	spin_unlock_irqrestore(&conf->device_lock, flags);
L
Linus Torvalds 已提交
1711 1712

	print_conf(conf);
1713
	return count;
L
Linus Torvalds 已提交
1714 1715
}

1716
static int raid1_add_disk(struct mddev *mddev, struct md_rdev *rdev)
L
Linus Torvalds 已提交
1717
{
1718
	struct r1conf *conf = mddev->private;
1719
	int err = -EEXIST;
1720
	int mirror = 0;
1721
	struct raid1_info *p;
1722
	int first = 0;
1723
	int last = conf->raid_disks - 1;
L
Linus Torvalds 已提交
1724

1725 1726 1727
	if (mddev->recovery_disabled == conf->recovery_disabled)
		return -EBUSY;

1728 1729 1730
	if (md_integrity_add_rdev(rdev, mddev))
		return -ENXIO;

1731 1732 1733
	if (rdev->raid_disk >= 0)
		first = last = rdev->raid_disk;

1734 1735 1736 1737 1738 1739 1740 1741 1742
	/*
	 * find the disk ... but prefer rdev->saved_raid_disk
	 * if possible.
	 */
	if (rdev->saved_raid_disk >= 0 &&
	    rdev->saved_raid_disk >= first &&
	    conf->mirrors[rdev->saved_raid_disk].rdev == NULL)
		first = last = rdev->saved_raid_disk;

1743 1744 1745
	for (mirror = first; mirror <= last; mirror++) {
		p = conf->mirrors+mirror;
		if (!p->rdev) {
L
Linus Torvalds 已提交
1746

1747 1748 1749
			if (mddev->gendisk)
				disk_stack_limits(mddev->gendisk, rdev->bdev,
						  rdev->data_offset << 9);
L
Linus Torvalds 已提交
1750 1751 1752

			p->head_position = 0;
			rdev->raid_disk = mirror;
1753
			err = 0;
1754 1755 1756 1757
			/* As all devices are equivalent, we don't need a full recovery
			 * if this was recently any drive of the array
			 */
			if (rdev->saved_raid_disk < 0)
1758
				conf->fullsync = 1;
1759
			rcu_assign_pointer(p->rdev, rdev);
L
Linus Torvalds 已提交
1760 1761
			break;
		}
1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773
		if (test_bit(WantReplacement, &p->rdev->flags) &&
		    p[conf->raid_disks].rdev == NULL) {
			/* Add this device as a replacement */
			clear_bit(In_sync, &rdev->flags);
			set_bit(Replacement, &rdev->flags);
			rdev->raid_disk = mirror;
			err = 0;
			conf->fullsync = 1;
			rcu_assign_pointer(p[conf->raid_disks].rdev, rdev);
			break;
		}
	}
1774
	if (mddev->queue && blk_queue_discard(bdev_get_queue(rdev->bdev)))
S
Shaohua Li 已提交
1775
		queue_flag_set_unlocked(QUEUE_FLAG_DISCARD, mddev->queue);
L
Linus Torvalds 已提交
1776
	print_conf(conf);
1777
	return err;
L
Linus Torvalds 已提交
1778 1779
}

1780
static int raid1_remove_disk(struct mddev *mddev, struct md_rdev *rdev)
L
Linus Torvalds 已提交
1781
{
1782
	struct r1conf *conf = mddev->private;
L
Linus Torvalds 已提交
1783
	int err = 0;
1784
	int number = rdev->raid_disk;
1785
	struct raid1_info *p = conf->mirrors + number;
L
Linus Torvalds 已提交
1786

1787 1788 1789
	if (rdev != p->rdev)
		p = conf->mirrors + conf->raid_disks + number;

L
Linus Torvalds 已提交
1790
	print_conf(conf);
1791
	if (rdev == p->rdev) {
1792
		if (test_bit(In_sync, &rdev->flags) ||
L
Linus Torvalds 已提交
1793 1794 1795 1796
		    atomic_read(&rdev->nr_pending)) {
			err = -EBUSY;
			goto abort;
		}
N
NeilBrown 已提交
1797
		/* Only remove non-faulty devices if recovery
1798 1799 1800
		 * is not possible.
		 */
		if (!test_bit(Faulty, &rdev->flags) &&
1801
		    mddev->recovery_disabled != conf->recovery_disabled &&
1802 1803 1804 1805
		    mddev->degraded < conf->raid_disks) {
			err = -EBUSY;
			goto abort;
		}
L
Linus Torvalds 已提交
1806
		p->rdev = NULL;
1807 1808 1809 1810 1811 1812 1813 1814 1815 1816
		if (!test_bit(RemoveSynchronized, &rdev->flags)) {
			synchronize_rcu();
			if (atomic_read(&rdev->nr_pending)) {
				/* lost the race, try later */
				err = -EBUSY;
				p->rdev = rdev;
				goto abort;
			}
		}
		if (conf->mirrors[conf->raid_disks + number].rdev) {
1817 1818 1819 1820 1821 1822
			/* We just removed a device that is being replaced.
			 * Move down the replacement.  We drain all IO before
			 * doing this to avoid confusion.
			 */
			struct md_rdev *repl =
				conf->mirrors[conf->raid_disks + number].rdev;
1823
			freeze_array(conf, 0);
1824 1825 1826
			clear_bit(Replacement, &repl->flags);
			p->rdev = repl;
			conf->mirrors[conf->raid_disks + number].rdev = NULL;
1827
			unfreeze_array(conf);
1828 1829 1830
		}

		clear_bit(WantReplacement, &rdev->flags);
1831
		err = md_integrity_register(mddev);
L
Linus Torvalds 已提交
1832 1833 1834 1835 1836 1837 1838
	}
abort:

	print_conf(conf);
	return err;
}

1839
static void end_sync_read(struct bio *bio)
L
Linus Torvalds 已提交
1840
{
1841
	struct r1bio *r1_bio = get_resync_r1bio(bio);
L
Linus Torvalds 已提交
1842

1843
	update_head_pos(r1_bio->read_disk, r1_bio);
1844

L
Linus Torvalds 已提交
1845 1846 1847 1848 1849
	/*
	 * we have read a block, now it needs to be re-written,
	 * or re-read if the read failed.
	 * We don't do much here, just schedule handling by raid1d
	 */
1850
	if (!bio->bi_status)
L
Linus Torvalds 已提交
1851
		set_bit(R1BIO_Uptodate, &r1_bio->state);
1852 1853 1854

	if (atomic_dec_and_test(&r1_bio->remaining))
		reschedule_retry(r1_bio);
L
Linus Torvalds 已提交
1855 1856
}

1857
static void end_sync_write(struct bio *bio)
L
Linus Torvalds 已提交
1858
{
1859
	int uptodate = !bio->bi_status;
1860
	struct r1bio *r1_bio = get_resync_r1bio(bio);
1861
	struct mddev *mddev = r1_bio->mddev;
1862
	struct r1conf *conf = mddev->private;
1863 1864
	sector_t first_bad;
	int bad_sectors;
1865
	struct md_rdev *rdev = conf->mirrors[find_bio_disk(r1_bio, bio)].rdev;
1866

1867
	if (!uptodate) {
N
NeilBrown 已提交
1868
		sector_t sync_blocks = 0;
1869 1870 1871 1872
		sector_t s = r1_bio->sector;
		long sectors_to_go = r1_bio->sectors;
		/* make sure these bits doesn't get cleared. */
		do {
1873
			bitmap_end_sync(mddev->bitmap, s,
1874 1875 1876 1877
					&sync_blocks, 1);
			s += sync_blocks;
			sectors_to_go -= sync_blocks;
		} while (sectors_to_go > 0);
1878 1879
		set_bit(WriteErrorSeen, &rdev->flags);
		if (!test_and_set_bit(WantReplacement, &rdev->flags))
1880 1881
			set_bit(MD_RECOVERY_NEEDED, &
				mddev->recovery);
1882
		set_bit(R1BIO_WriteError, &r1_bio->state);
1883
	} else if (is_badblock(rdev, r1_bio->sector, r1_bio->sectors,
1884 1885 1886 1887 1888 1889
			       &first_bad, &bad_sectors) &&
		   !is_badblock(conf->mirrors[r1_bio->read_disk].rdev,
				r1_bio->sector,
				r1_bio->sectors,
				&first_bad, &bad_sectors)
		)
1890
		set_bit(R1BIO_MadeGood, &r1_bio->state);
1891

L
Linus Torvalds 已提交
1892
	if (atomic_dec_and_test(&r1_bio->remaining)) {
1893
		int s = r1_bio->sectors;
1894 1895
		if (test_bit(R1BIO_MadeGood, &r1_bio->state) ||
		    test_bit(R1BIO_WriteError, &r1_bio->state))
1896 1897 1898 1899 1900
			reschedule_retry(r1_bio);
		else {
			put_buf(r1_bio);
			md_done_sync(mddev, s, uptodate);
		}
L
Linus Torvalds 已提交
1901 1902 1903
	}
}

1904
static int r1_sync_page_io(struct md_rdev *rdev, sector_t sector,
1905 1906
			    int sectors, struct page *page, int rw)
{
M
Mike Christie 已提交
1907
	if (sync_page_io(rdev, sector, sectors << 9, page, rw, 0, false))
1908 1909
		/* success */
		return 1;
1910
	if (rw == WRITE) {
1911
		set_bit(WriteErrorSeen, &rdev->flags);
1912 1913 1914 1915 1916
		if (!test_and_set_bit(WantReplacement,
				      &rdev->flags))
			set_bit(MD_RECOVERY_NEEDED, &
				rdev->mddev->recovery);
	}
1917 1918 1919 1920 1921 1922
	/* need to record an error - either for the block or the device */
	if (!rdev_set_badblocks(rdev, sector, sectors, 0))
		md_error(rdev->mddev, rdev);
	return 0;
}

1923
static int fix_sync_read_error(struct r1bio *r1_bio)
L
Linus Torvalds 已提交
1924
{
1925 1926 1927 1928 1929 1930 1931
	/* Try some synchronous reads of other devices to get
	 * good data, much like with normal read errors.  Only
	 * read into the pages we already have so we don't
	 * need to re-issue the read request.
	 * We don't need to freeze the array, because being in an
	 * active sync request, there is no normal IO, and
	 * no overlapping syncs.
1932 1933 1934
	 * We don't need to check is_badblock() again as we
	 * made sure that anything with a bad block in range
	 * will have bi_end_io clear.
1935
	 */
1936
	struct mddev *mddev = r1_bio->mddev;
1937
	struct r1conf *conf = mddev->private;
1938
	struct bio *bio = r1_bio->bios[r1_bio->read_disk];
1939
	struct page **pages = get_resync_pages(bio)->pages;
1940 1941 1942
	sector_t sect = r1_bio->sector;
	int sectors = r1_bio->sectors;
	int idx = 0;
1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955
	struct md_rdev *rdev;

	rdev = conf->mirrors[r1_bio->read_disk].rdev;
	if (test_bit(FailFast, &rdev->flags)) {
		/* Don't try recovering from here - just fail it
		 * ... unless it is the last working device of course */
		md_error(mddev, rdev);
		if (test_bit(Faulty, &rdev->flags))
			/* Don't try to read from here, but make sure
			 * put_buf does it's thing
			 */
			bio->bi_end_io = end_sync_write;
	}
1956 1957 1958 1959 1960

	while(sectors) {
		int s = sectors;
		int d = r1_bio->read_disk;
		int success = 0;
1961
		int start;
1962 1963 1964 1965 1966 1967 1968 1969 1970 1971

		if (s > (PAGE_SIZE>>9))
			s = PAGE_SIZE >> 9;
		do {
			if (r1_bio->bios[d]->bi_end_io == end_sync_read) {
				/* No rcu protection needed here devices
				 * can only be removed when no resync is
				 * active, and resync is currently active
				 */
				rdev = conf->mirrors[d].rdev;
1972
				if (sync_page_io(rdev, sect, s<<9,
1973
						 pages[idx],
M
Mike Christie 已提交
1974
						 REQ_OP_READ, 0, false)) {
1975 1976 1977 1978 1979
					success = 1;
					break;
				}
			}
			d++;
1980
			if (d == conf->raid_disks * 2)
1981 1982 1983
				d = 0;
		} while (!success && d != r1_bio->read_disk);

1984
		if (!success) {
1985
			char b[BDEVNAME_SIZE];
1986 1987 1988 1989 1990 1991
			int abort = 0;
			/* Cannot read from anywhere, this block is lost.
			 * Record a bad block on each device.  If that doesn't
			 * work just disable and interrupt the recovery.
			 * Don't fail devices as that won't really help.
			 */
N
NeilBrown 已提交
1992 1993 1994 1995
			pr_crit_ratelimited("md/raid1:%s: %s: unrecoverable I/O read error for block %llu\n",
					    mdname(mddev),
					    bdevname(bio->bi_bdev, b),
					    (unsigned long long)r1_bio->sector);
1996
			for (d = 0; d < conf->raid_disks * 2; d++) {
1997 1998 1999 2000 2001 2002 2003
				rdev = conf->mirrors[d].rdev;
				if (!rdev || test_bit(Faulty, &rdev->flags))
					continue;
				if (!rdev_set_badblocks(rdev, sect, s, 0))
					abort = 1;
			}
			if (abort) {
2004 2005
				conf->recovery_disabled =
					mddev->recovery_disabled;
2006 2007 2008 2009 2010 2011 2012 2013 2014 2015
				set_bit(MD_RECOVERY_INTR, &mddev->recovery);
				md_done_sync(mddev, r1_bio->sectors, 0);
				put_buf(r1_bio);
				return 0;
			}
			/* Try next page */
			sectors -= s;
			sect += s;
			idx++;
			continue;
2016
		}
2017 2018 2019 2020 2021

		start = d;
		/* write it back and re-read */
		while (d != r1_bio->read_disk) {
			if (d == 0)
2022
				d = conf->raid_disks * 2;
2023 2024 2025 2026
			d--;
			if (r1_bio->bios[d]->bi_end_io != end_sync_read)
				continue;
			rdev = conf->mirrors[d].rdev;
2027
			if (r1_sync_page_io(rdev, sect, s,
2028
					    pages[idx],
2029
					    WRITE) == 0) {
2030 2031
				r1_bio->bios[d]->bi_end_io = NULL;
				rdev_dec_pending(rdev, mddev);
2032
			}
2033 2034 2035 2036
		}
		d = start;
		while (d != r1_bio->read_disk) {
			if (d == 0)
2037
				d = conf->raid_disks * 2;
2038 2039 2040 2041
			d--;
			if (r1_bio->bios[d]->bi_end_io != end_sync_read)
				continue;
			rdev = conf->mirrors[d].rdev;
2042
			if (r1_sync_page_io(rdev, sect, s,
2043
					    pages[idx],
2044
					    READ) != 0)
2045
				atomic_add(s, &rdev->corrected_errors);
2046
		}
2047 2048 2049 2050
		sectors -= s;
		sect += s;
		idx ++;
	}
2051
	set_bit(R1BIO_Uptodate, &r1_bio->state);
2052
	bio->bi_status = 0;
2053 2054 2055
	return 1;
}

2056
static void process_checks(struct r1bio *r1_bio)
2057 2058 2059 2060 2061 2062 2063 2064
{
	/* We have read all readable devices.  If we haven't
	 * got the block, then there is no hope left.
	 * If we have, then we want to do a comparison
	 * and skip the write if everything is the same.
	 * If any blocks failed to read, then we need to
	 * attempt an over-write
	 */
2065
	struct mddev *mddev = r1_bio->mddev;
2066
	struct r1conf *conf = mddev->private;
2067 2068
	int primary;
	int i;
2069
	int vcnt;
2070

2071 2072 2073
	/* Fix variable parts of all bios */
	vcnt = (r1_bio->sectors + PAGE_SIZE / 512 - 1) >> (PAGE_SHIFT - 9);
	for (i = 0; i < conf->raid_disks * 2; i++) {
2074
		blk_status_t status;
2075
		struct bio *b = r1_bio->bios[i];
2076
		struct resync_pages *rp = get_resync_pages(b);
2077 2078
		if (b->bi_end_io != end_sync_read)
			continue;
2079
		/* fixup the bio for reuse, but preserve errno */
2080
		status = b->bi_status;
2081
		bio_reset(b);
2082
		b->bi_status = status;
2083
		b->bi_iter.bi_sector = r1_bio->sector +
2084 2085 2086
			conf->mirrors[i].rdev->data_offset;
		b->bi_bdev = conf->mirrors[i].rdev->bdev;
		b->bi_end_io = end_sync_read;
2087 2088
		rp->raid_bio = r1_bio;
		b->bi_private = rp;
2089

2090 2091
		/* initialize bvec table again */
		md_bio_reset_resync_pages(b, rp, r1_bio->sectors << 9);
2092
	}
2093
	for (primary = 0; primary < conf->raid_disks * 2; primary++)
2094
		if (r1_bio->bios[primary]->bi_end_io == end_sync_read &&
2095
		    !r1_bio->bios[primary]->bi_status) {
2096 2097 2098 2099 2100
			r1_bio->bios[primary]->bi_end_io = NULL;
			rdev_dec_pending(conf->mirrors[primary].rdev, mddev);
			break;
		}
	r1_bio->read_disk = primary;
2101
	for (i = 0; i < conf->raid_disks * 2; i++) {
2102 2103 2104
		int j;
		struct bio *pbio = r1_bio->bios[primary];
		struct bio *sbio = r1_bio->bios[i];
2105
		blk_status_t status = sbio->bi_status;
2106 2107
		struct page **ppages = get_resync_pages(pbio)->pages;
		struct page **spages = get_resync_pages(sbio)->pages;
2108
		struct bio_vec *bi;
2109
		int page_len[RESYNC_PAGES] = { 0 };
2110

K
Kent Overstreet 已提交
2111
		if (sbio->bi_end_io != end_sync_read)
2112
			continue;
2113
		/* Now we can 'fixup' the error value */
2114
		sbio->bi_status = 0;
2115

2116 2117 2118
		bio_for_each_segment_all(bi, sbio, j)
			page_len[j] = bi->bv_len;

2119
		if (!status) {
2120
			for (j = vcnt; j-- ; ) {
2121 2122
				if (memcmp(page_address(ppages[j]),
					   page_address(spages[j]),
2123
					   page_len[j]))
2124
					break;
2125
			}
2126 2127 2128
		} else
			j = 0;
		if (j >= 0)
2129
			atomic64_add(r1_bio->sectors, &mddev->resync_mismatches);
2130
		if (j < 0 || (test_bit(MD_RECOVERY_CHECK, &mddev->recovery)
2131
			      && !status)) {
2132 2133 2134 2135 2136
			/* No need to write to this device. */
			sbio->bi_end_io = NULL;
			rdev_dec_pending(conf->mirrors[i].rdev, mddev);
			continue;
		}
K
Kent Overstreet 已提交
2137 2138

		bio_copy_data(sbio, pbio);
2139
	}
2140 2141
}

2142
static void sync_request_write(struct mddev *mddev, struct r1bio *r1_bio)
2143
{
2144
	struct r1conf *conf = mddev->private;
2145
	int i;
2146
	int disks = conf->raid_disks * 2;
2147
	struct bio *wbio;
2148 2149 2150 2151 2152

	if (!test_bit(R1BIO_Uptodate, &r1_bio->state))
		/* ouch - failed to read all of that. */
		if (!fix_sync_read_error(r1_bio))
			return;
2153 2154

	if (test_bit(MD_RECOVERY_REQUESTED, &mddev->recovery))
2155 2156
		process_checks(r1_bio);

2157 2158 2159
	/*
	 * schedule writes
	 */
L
Linus Torvalds 已提交
2160 2161 2162
	atomic_set(&r1_bio->remaining, 1);
	for (i = 0; i < disks ; i++) {
		wbio = r1_bio->bios[i];
2163 2164 2165 2166
		if (wbio->bi_end_io == NULL ||
		    (wbio->bi_end_io == end_sync_read &&
		     (i == r1_bio->read_disk ||
		      !test_bit(MD_RECOVERY_SYNC, &mddev->recovery))))
L
Linus Torvalds 已提交
2167
			continue;
2168 2169
		if (test_bit(Faulty, &conf->mirrors[i].rdev->flags))
			continue;
L
Linus Torvalds 已提交
2170

M
Mike Christie 已提交
2171
		bio_set_op_attrs(wbio, REQ_OP_WRITE, 0);
2172 2173 2174
		if (test_bit(FailFast, &conf->mirrors[i].rdev->flags))
			wbio->bi_opf |= MD_FAILFAST;

2175
		wbio->bi_end_io = end_sync_write;
L
Linus Torvalds 已提交
2176
		atomic_inc(&r1_bio->remaining);
2177
		md_sync_acct(conf->mirrors[i].rdev->bdev, bio_sectors(wbio));
2178

L
Linus Torvalds 已提交
2179 2180 2181 2182
		generic_make_request(wbio);
	}

	if (atomic_dec_and_test(&r1_bio->remaining)) {
2183
		/* if we're here, all write(s) have completed, so clean up */
2184 2185 2186 2187 2188 2189 2190 2191
		int s = r1_bio->sectors;
		if (test_bit(R1BIO_MadeGood, &r1_bio->state) ||
		    test_bit(R1BIO_WriteError, &r1_bio->state))
			reschedule_retry(r1_bio);
		else {
			put_buf(r1_bio);
			md_done_sync(mddev, s, 1);
		}
L
Linus Torvalds 已提交
2192 2193 2194 2195 2196 2197 2198 2199
	}
}

/*
 * This is a kernel thread which:
 *
 *	1.	Retries failed read operations on working mirrors.
 *	2.	Updates the raid superblock when problems encounter.
2200
 *	3.	Performs writes following reads for array synchronising.
L
Linus Torvalds 已提交
2201 2202
 */

2203
static void fix_read_error(struct r1conf *conf, int read_disk,
2204 2205
			   sector_t sect, int sectors)
{
2206
	struct mddev *mddev = conf->mddev;
2207 2208 2209 2210 2211
	while(sectors) {
		int s = sectors;
		int d = read_disk;
		int success = 0;
		int start;
2212
		struct md_rdev *rdev;
2213 2214 2215 2216 2217

		if (s > (PAGE_SIZE>>9))
			s = PAGE_SIZE >> 9;

		do {
2218 2219 2220
			sector_t first_bad;
			int bad_sectors;

2221 2222
			rcu_read_lock();
			rdev = rcu_dereference(conf->mirrors[d].rdev);
2223
			if (rdev &&
2224 2225 2226
			    (test_bit(In_sync, &rdev->flags) ||
			     (!test_bit(Faulty, &rdev->flags) &&
			      rdev->recovery_offset >= sect + s)) &&
2227
			    is_badblock(rdev, sect, s,
2228 2229 2230 2231
					&first_bad, &bad_sectors) == 0) {
				atomic_inc(&rdev->nr_pending);
				rcu_read_unlock();
				if (sync_page_io(rdev, sect, s<<9,
M
Mike Christie 已提交
2232
					 conf->tmppage, REQ_OP_READ, 0, false))
2233 2234 2235 2236 2237 2238 2239 2240 2241
					success = 1;
				rdev_dec_pending(rdev, mddev);
				if (success)
					break;
			} else
				rcu_read_unlock();
			d++;
			if (d == conf->raid_disks * 2)
				d = 0;
2242 2243 2244
		} while (!success && d != read_disk);

		if (!success) {
2245
			/* Cannot read from anywhere - mark it bad */
2246
			struct md_rdev *rdev = conf->mirrors[read_disk].rdev;
2247 2248
			if (!rdev_set_badblocks(rdev, sect, s, 0))
				md_error(mddev, rdev);
2249 2250 2251 2252 2253 2254
			break;
		}
		/* write it back and re-read */
		start = d;
		while (d != read_disk) {
			if (d==0)
2255
				d = conf->raid_disks * 2;
2256
			d--;
2257 2258
			rcu_read_lock();
			rdev = rcu_dereference(conf->mirrors[d].rdev);
2259
			if (rdev &&
2260 2261 2262
			    !test_bit(Faulty, &rdev->flags)) {
				atomic_inc(&rdev->nr_pending);
				rcu_read_unlock();
2263 2264
				r1_sync_page_io(rdev, sect, s,
						conf->tmppage, WRITE);
2265 2266 2267
				rdev_dec_pending(rdev, mddev);
			} else
				rcu_read_unlock();
2268 2269 2270 2271 2272
		}
		d = start;
		while (d != read_disk) {
			char b[BDEVNAME_SIZE];
			if (d==0)
2273
				d = conf->raid_disks * 2;
2274
			d--;
2275 2276
			rcu_read_lock();
			rdev = rcu_dereference(conf->mirrors[d].rdev);
2277
			if (rdev &&
2278
			    !test_bit(Faulty, &rdev->flags)) {
2279 2280
				atomic_inc(&rdev->nr_pending);
				rcu_read_unlock();
2281 2282
				if (r1_sync_page_io(rdev, sect, s,
						    conf->tmppage, READ)) {
2283
					atomic_add(s, &rdev->corrected_errors);
N
NeilBrown 已提交
2284 2285 2286 2287 2288
					pr_info("md/raid1:%s: read error corrected (%d sectors at %llu on %s)\n",
						mdname(mddev), s,
						(unsigned long long)(sect +
								     rdev->data_offset),
						bdevname(rdev->bdev, b));
2289
				}
2290 2291 2292
				rdev_dec_pending(rdev, mddev);
			} else
				rcu_read_unlock();
2293 2294 2295 2296 2297 2298
		}
		sectors -= s;
		sect += s;
	}
}

2299
static int narrow_write_error(struct r1bio *r1_bio, int i)
2300
{
2301
	struct mddev *mddev = r1_bio->mddev;
2302
	struct r1conf *conf = mddev->private;
2303
	struct md_rdev *rdev = conf->mirrors[i].rdev;
2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324

	/* bio has the data to be written to device 'i' where
	 * we just recently had a write error.
	 * We repeatedly clone the bio and trim down to one block,
	 * then try the write.  Where the write fails we record
	 * a bad block.
	 * It is conceivable that the bio doesn't exactly align with
	 * blocks.  We must handle this somehow.
	 *
	 * We currently own a reference on the rdev.
	 */

	int block_sectors;
	sector_t sector;
	int sectors;
	int sect_to_write = r1_bio->sectors;
	int ok = 1;

	if (rdev->badblocks.shift < 0)
		return 0;

2325 2326
	block_sectors = roundup(1 << rdev->badblocks.shift,
				bdev_logical_block_size(rdev->bdev) >> 9);
2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337
	sector = r1_bio->sector;
	sectors = ((sector + block_sectors)
		   & ~(sector_t)(block_sectors - 1))
		- sector;

	while (sect_to_write) {
		struct bio *wbio;
		if (sectors > sect_to_write)
			sectors = sect_to_write;
		/* Write at 'sector' for 'sectors'*/

2338
		if (test_bit(R1BIO_BehindIO, &r1_bio->state)) {
M
Ming Lei 已提交
2339 2340 2341
			wbio = bio_clone_fast(r1_bio->behind_master_bio,
					      GFP_NOIO,
					      mddev->bio_set);
2342
		} else {
2343 2344
			wbio = bio_clone_fast(r1_bio->master_bio, GFP_NOIO,
					      mddev->bio_set);
2345 2346
		}

M
Mike Christie 已提交
2347
		bio_set_op_attrs(wbio, REQ_OP_WRITE, 0);
2348 2349
		wbio->bi_iter.bi_sector = r1_bio->sector;
		wbio->bi_iter.bi_size = r1_bio->sectors << 9;
2350

2351
		bio_trim(wbio, sector - r1_bio->sector, sectors);
2352
		wbio->bi_iter.bi_sector += rdev->data_offset;
2353
		wbio->bi_bdev = rdev->bdev;
2354 2355

		if (submit_bio_wait(wbio) < 0)
2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368
			/* failure! */
			ok = rdev_set_badblocks(rdev, sector,
						sectors, 0)
				&& ok;

		bio_put(wbio);
		sect_to_write -= sectors;
		sector += sectors;
		sectors = block_sectors;
	}
	return ok;
}

2369
static void handle_sync_write_finished(struct r1conf *conf, struct r1bio *r1_bio)
2370 2371 2372
{
	int m;
	int s = r1_bio->sectors;
2373
	for (m = 0; m < conf->raid_disks * 2 ; m++) {
2374
		struct md_rdev *rdev = conf->mirrors[m].rdev;
2375 2376 2377
		struct bio *bio = r1_bio->bios[m];
		if (bio->bi_end_io == NULL)
			continue;
2378
		if (!bio->bi_status &&
2379
		    test_bit(R1BIO_MadeGood, &r1_bio->state)) {
2380
			rdev_clear_badblocks(rdev, r1_bio->sector, s, 0);
2381
		}
2382
		if (bio->bi_status &&
2383 2384 2385 2386 2387 2388 2389 2390 2391
		    test_bit(R1BIO_WriteError, &r1_bio->state)) {
			if (!rdev_set_badblocks(rdev, r1_bio->sector, s, 0))
				md_error(conf->mddev, rdev);
		}
	}
	put_buf(r1_bio);
	md_done_sync(conf->mddev, s, 1);
}

2392
static void handle_write_finished(struct r1conf *conf, struct r1bio *r1_bio)
2393
{
2394
	int m, idx;
2395
	bool fail = false;
2396

2397
	for (m = 0; m < conf->raid_disks * 2 ; m++)
2398
		if (r1_bio->bios[m] == IO_MADE_GOOD) {
2399
			struct md_rdev *rdev = conf->mirrors[m].rdev;
2400 2401
			rdev_clear_badblocks(rdev,
					     r1_bio->sector,
2402
					     r1_bio->sectors, 0);
2403 2404 2405 2406 2407 2408
			rdev_dec_pending(rdev, conf->mddev);
		} else if (r1_bio->bios[m] != NULL) {
			/* This drive got a write error.  We need to
			 * narrow down and record precise write
			 * errors.
			 */
2409
			fail = true;
2410 2411 2412 2413 2414 2415 2416 2417 2418
			if (!narrow_write_error(r1_bio, m)) {
				md_error(conf->mddev,
					 conf->mirrors[m].rdev);
				/* an I/O failed, we can't clear the bitmap */
				set_bit(R1BIO_Degraded, &r1_bio->state);
			}
			rdev_dec_pending(conf->mirrors[m].rdev,
					 conf->mddev);
		}
2419 2420 2421
	if (fail) {
		spin_lock_irq(&conf->device_lock);
		list_add(&r1_bio->retry_list, &conf->bio_end_io_list);
2422
		idx = sector_to_idx(r1_bio->sector);
2423
		atomic_inc(&conf->nr_queued[idx]);
2424
		spin_unlock_irq(&conf->device_lock);
2425 2426 2427 2428 2429
		/*
		 * In case freeze_array() is waiting for condition
		 * get_unqueued_pending() == extra to be true.
		 */
		wake_up(&conf->wait_barrier);
2430
		md_wakeup_thread(conf->mddev->thread);
2431 2432 2433
	} else {
		if (test_bit(R1BIO_WriteError, &r1_bio->state))
			close_write(r1_bio);
2434
		raid_end_bio_io(r1_bio);
2435
	}
2436 2437
}

2438
static void handle_read_error(struct r1conf *conf, struct r1bio *r1_bio)
2439
{
2440
	struct mddev *mddev = conf->mddev;
2441
	struct bio *bio;
2442
	struct md_rdev *rdev;
2443 2444
	dev_t bio_dev;
	sector_t bio_sector;
2445 2446 2447 2448 2449 2450 2451 2452 2453 2454

	clear_bit(R1BIO_ReadError, &r1_bio->state);
	/* we got a read error. Maybe the drive is bad.  Maybe just
	 * the block and we can fix it.
	 * We freeze all other IO, and try reading the block from
	 * other devices.  When we find one, we re-write
	 * and check it that fixes the read error.
	 * This is all done synchronously while the array is
	 * frozen
	 */
2455 2456

	bio = r1_bio->bios[r1_bio->read_disk];
2457 2458
	bio_dev = bio->bi_bdev->bd_dev;
	bio_sector = conf->mirrors[r1_bio->read_disk].rdev->data_offset + r1_bio->sector;
2459 2460 2461
	bio_put(bio);
	r1_bio->bios[r1_bio->read_disk] = NULL;

2462 2463 2464
	rdev = conf->mirrors[r1_bio->read_disk].rdev;
	if (mddev->ro == 0
	    && !test_bit(FailFast, &rdev->flags)) {
2465
		freeze_array(conf, 1);
2466 2467 2468
		fix_read_error(conf, r1_bio->read_disk,
			       r1_bio->sector, r1_bio->sectors);
		unfreeze_array(conf);
2469 2470 2471 2472
	} else {
		r1_bio->bios[r1_bio->read_disk] = IO_BLOCKED;
	}

2473
	rdev_dec_pending(rdev, conf->mddev);
2474 2475
	allow_barrier(conf, r1_bio->sector);
	bio = r1_bio->master_bio;
2476

2477 2478 2479
	/* Reuse the old r1_bio so that the IO_BLOCKED settings are preserved */
	r1_bio->state = 0;
	raid1_read_request(mddev, bio, r1_bio->sectors, r1_bio);
2480 2481
}

S
Shaohua Li 已提交
2482
static void raid1d(struct md_thread *thread)
L
Linus Torvalds 已提交
2483
{
S
Shaohua Li 已提交
2484
	struct mddev *mddev = thread->mddev;
2485
	struct r1bio *r1_bio;
L
Linus Torvalds 已提交
2486
	unsigned long flags;
2487
	struct r1conf *conf = mddev->private;
L
Linus Torvalds 已提交
2488
	struct list_head *head = &conf->retry_list;
2489
	struct blk_plug plug;
2490
	int idx;
L
Linus Torvalds 已提交
2491 2492

	md_check_recovery(mddev);
2493

2494
	if (!list_empty_careful(&conf->bio_end_io_list) &&
2495
	    !test_bit(MD_SB_CHANGE_PENDING, &mddev->sb_flags)) {
2496 2497
		LIST_HEAD(tmp);
		spin_lock_irqsave(&conf->device_lock, flags);
2498 2499
		if (!test_bit(MD_SB_CHANGE_PENDING, &mddev->sb_flags))
			list_splice_init(&conf->bio_end_io_list, &tmp);
2500 2501
		spin_unlock_irqrestore(&conf->device_lock, flags);
		while (!list_empty(&tmp)) {
2502 2503
			r1_bio = list_first_entry(&tmp, struct r1bio,
						  retry_list);
2504
			list_del(&r1_bio->retry_list);
2505
			idx = sector_to_idx(r1_bio->sector);
2506
			atomic_dec(&conf->nr_queued[idx]);
2507 2508 2509 2510
			if (mddev->degraded)
				set_bit(R1BIO_Degraded, &r1_bio->state);
			if (test_bit(R1BIO_WriteError, &r1_bio->state))
				close_write(r1_bio);
2511 2512 2513 2514
			raid_end_bio_io(r1_bio);
		}
	}

2515
	blk_start_plug(&plug);
L
Linus Torvalds 已提交
2516
	for (;;) {
2517

2518
		flush_pending_writes(conf);
2519

2520 2521 2522
		spin_lock_irqsave(&conf->device_lock, flags);
		if (list_empty(head)) {
			spin_unlock_irqrestore(&conf->device_lock, flags);
L
Linus Torvalds 已提交
2523
			break;
2524
		}
2525
		r1_bio = list_entry(head->prev, struct r1bio, retry_list);
L
Linus Torvalds 已提交
2526
		list_del(head->prev);
2527
		idx = sector_to_idx(r1_bio->sector);
2528
		atomic_dec(&conf->nr_queued[idx]);
L
Linus Torvalds 已提交
2529 2530 2531
		spin_unlock_irqrestore(&conf->device_lock, flags);

		mddev = r1_bio->mddev;
2532
		conf = mddev->private;
2533
		if (test_bit(R1BIO_IsSync, &r1_bio->state)) {
2534
			if (test_bit(R1BIO_MadeGood, &r1_bio->state) ||
2535 2536 2537
			    test_bit(R1BIO_WriteError, &r1_bio->state))
				handle_sync_write_finished(conf, r1_bio);
			else
2538
				sync_request_write(mddev, r1_bio);
2539
		} else if (test_bit(R1BIO_MadeGood, &r1_bio->state) ||
2540 2541 2542 2543 2544
			   test_bit(R1BIO_WriteError, &r1_bio->state))
			handle_write_finished(conf, r1_bio);
		else if (test_bit(R1BIO_ReadError, &r1_bio->state))
			handle_read_error(conf, r1_bio);
		else
2545
			WARN_ON_ONCE(1);
2546

N
NeilBrown 已提交
2547
		cond_resched();
2548
		if (mddev->sb_flags & ~(1<<MD_SB_CHANGE_PENDING))
2549
			md_check_recovery(mddev);
L
Linus Torvalds 已提交
2550
	}
2551
	blk_finish_plug(&plug);
L
Linus Torvalds 已提交
2552 2553
}

2554
static int init_resync(struct r1conf *conf)
L
Linus Torvalds 已提交
2555 2556 2557 2558
{
	int buffs;

	buffs = RESYNC_WINDOW / RESYNC_BLOCK_SIZE;
2559
	BUG_ON(conf->r1buf_pool);
L
Linus Torvalds 已提交
2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576
	conf->r1buf_pool = mempool_create(buffs, r1buf_pool_alloc, r1buf_pool_free,
					  conf->poolinfo);
	if (!conf->r1buf_pool)
		return -ENOMEM;
	return 0;
}

/*
 * perform a "sync" on one "block"
 *
 * We need to make sure that no normal I/O request - particularly write
 * requests - conflict with active sync requests.
 *
 * This is achieved by tracking pending requests and a 'barrier' concept
 * that can be installed to exclude normal IO requests.
 */

S
Shaohua Li 已提交
2577 2578
static sector_t raid1_sync_request(struct mddev *mddev, sector_t sector_nr,
				   int *skipped)
L
Linus Torvalds 已提交
2579
{
2580
	struct r1conf *conf = mddev->private;
2581
	struct r1bio *r1_bio;
L
Linus Torvalds 已提交
2582 2583
	struct bio *bio;
	sector_t max_sector, nr_sectors;
2584
	int disk = -1;
L
Linus Torvalds 已提交
2585
	int i;
2586 2587
	int wonly = -1;
	int write_targets = 0, read_targets = 0;
N
NeilBrown 已提交
2588
	sector_t sync_blocks;
2589
	int still_degraded = 0;
2590 2591
	int good_sectors = RESYNC_SECTORS;
	int min_bad = 0; /* number of sectors that are bad in all devices */
2592
	int idx = sector_to_idx(sector_nr);
2593
	int page_idx = 0;
L
Linus Torvalds 已提交
2594 2595 2596

	if (!conf->r1buf_pool)
		if (init_resync(conf))
2597
			return 0;
L
Linus Torvalds 已提交
2598

A
Andre Noll 已提交
2599
	max_sector = mddev->dev_sectors;
L
Linus Torvalds 已提交
2600
	if (sector_nr >= max_sector) {
2601 2602 2603 2604 2605
		/* If we aborted, we need to abort the
		 * sync on the 'current' bitmap chunk (there will
		 * only be one in raid1 resync.
		 * We can find the current addess in mddev->curr_resync
		 */
2606 2607
		if (mddev->curr_resync < max_sector) /* aborted */
			bitmap_end_sync(mddev->bitmap, mddev->curr_resync,
2608
						&sync_blocks, 1);
2609
		else /* completed sync */
2610
			conf->fullsync = 0;
2611 2612

		bitmap_close_sync(mddev->bitmap);
L
Linus Torvalds 已提交
2613
		close_sync(conf);
2614 2615 2616 2617 2618

		if (mddev_is_clustered(mddev)) {
			conf->cluster_sync_low = 0;
			conf->cluster_sync_high = 0;
		}
L
Linus Torvalds 已提交
2619 2620 2621
		return 0;
	}

2622 2623
	if (mddev->bitmap == NULL &&
	    mddev->recovery_cp == MaxSector &&
2624
	    !test_bit(MD_RECOVERY_REQUESTED, &mddev->recovery) &&
2625 2626 2627 2628
	    conf->fullsync == 0) {
		*skipped = 1;
		return max_sector - sector_nr;
	}
2629 2630 2631
	/* before building a request, check if we can skip these blocks..
	 * This call the bitmap_start_sync doesn't actually record anything
	 */
2632
	if (!bitmap_start_sync(mddev->bitmap, sector_nr, &sync_blocks, 1) &&
2633
	    !conf->fullsync && !test_bit(MD_RECOVERY_REQUESTED, &mddev->recovery)) {
2634 2635 2636 2637
		/* We can skip this block, and probably several more */
		*skipped = 1;
		return sync_blocks;
	}
2638

2639 2640 2641 2642
	/*
	 * If there is non-resync activity waiting for a turn, then let it
	 * though before starting on this new sync request.
	 */
2643
	if (atomic_read(&conf->nr_waiting[idx]))
2644 2645
		schedule_timeout_uninterruptible(1);

2646 2647 2648 2649 2650 2651
	/* we are incrementing sector_nr below. To be safe, we check against
	 * sector_nr + two times RESYNC_SECTORS
	 */

	bitmap_cond_end_sync(mddev->bitmap, sector_nr,
		mddev_is_clustered(mddev) && (sector_nr + 2 * RESYNC_SECTORS > conf->cluster_sync_high));
2652
	r1_bio = mempool_alloc(conf->r1buf_pool, GFP_NOIO);
2653

2654
	raise_barrier(conf, sector_nr);
L
Linus Torvalds 已提交
2655

2656
	rcu_read_lock();
L
Linus Torvalds 已提交
2657
	/*
2658 2659 2660 2661 2662 2663
	 * If we get a correctably read error during resync or recovery,
	 * we might want to read from a different device.  So we
	 * flag all drives that could conceivably be read from for READ,
	 * and any others (which will be non-In_sync devices) for WRITE.
	 * If a read fails, we try reading from something else for which READ
	 * is OK.
L
Linus Torvalds 已提交
2664 2665 2666 2667
	 */

	r1_bio->mddev = mddev;
	r1_bio->sector = sector_nr;
2668
	r1_bio->state = 0;
L
Linus Torvalds 已提交
2669
	set_bit(R1BIO_IsSync, &r1_bio->state);
2670 2671
	/* make sure good_sectors won't go across barrier unit boundary */
	good_sectors = align_to_barrier_unit_end(sector_nr, good_sectors);
L
Linus Torvalds 已提交
2672

2673
	for (i = 0; i < conf->raid_disks * 2; i++) {
2674
		struct md_rdev *rdev;
L
Linus Torvalds 已提交
2675 2676
		bio = r1_bio->bios[i];

2677 2678
		rdev = rcu_dereference(conf->mirrors[i].rdev);
		if (rdev == NULL ||
2679
		    test_bit(Faulty, &rdev->flags)) {
2680 2681
			if (i < conf->raid_disks)
				still_degraded = 1;
2682
		} else if (!test_bit(In_sync, &rdev->flags)) {
M
Mike Christie 已提交
2683
			bio_set_op_attrs(bio, REQ_OP_WRITE, 0);
L
Linus Torvalds 已提交
2684 2685
			bio->bi_end_io = end_sync_write;
			write_targets ++;
2686 2687
		} else {
			/* may need to read from here */
2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709
			sector_t first_bad = MaxSector;
			int bad_sectors;

			if (is_badblock(rdev, sector_nr, good_sectors,
					&first_bad, &bad_sectors)) {
				if (first_bad > sector_nr)
					good_sectors = first_bad - sector_nr;
				else {
					bad_sectors -= (sector_nr - first_bad);
					if (min_bad == 0 ||
					    min_bad > bad_sectors)
						min_bad = bad_sectors;
				}
			}
			if (sector_nr < first_bad) {
				if (test_bit(WriteMostly, &rdev->flags)) {
					if (wonly < 0)
						wonly = i;
				} else {
					if (disk < 0)
						disk = i;
				}
M
Mike Christie 已提交
2710
				bio_set_op_attrs(bio, REQ_OP_READ, 0);
2711 2712
				bio->bi_end_io = end_sync_read;
				read_targets++;
2713 2714 2715 2716 2717 2718 2719 2720 2721
			} else if (!test_bit(WriteErrorSeen, &rdev->flags) &&
				test_bit(MD_RECOVERY_SYNC, &mddev->recovery) &&
				!test_bit(MD_RECOVERY_CHECK, &mddev->recovery)) {
				/*
				 * The device is suitable for reading (InSync),
				 * but has bad block(s) here. Let's try to correct them,
				 * if we are doing resync or repair. Otherwise, leave
				 * this device alone for this sync request.
				 */
M
Mike Christie 已提交
2722
				bio_set_op_attrs(bio, REQ_OP_WRITE, 0);
2723 2724
				bio->bi_end_io = end_sync_write;
				write_targets++;
2725 2726
			}
		}
2727 2728
		if (bio->bi_end_io) {
			atomic_inc(&rdev->nr_pending);
2729
			bio->bi_iter.bi_sector = sector_nr + rdev->data_offset;
2730
			bio->bi_bdev = rdev->bdev;
2731 2732
			if (test_bit(FailFast, &rdev->flags))
				bio->bi_opf |= MD_FAILFAST;
2733
		}
L
Linus Torvalds 已提交
2734
	}
2735 2736 2737 2738
	rcu_read_unlock();
	if (disk < 0)
		disk = wonly;
	r1_bio->read_disk = disk;
2739

2740 2741 2742 2743 2744
	if (read_targets == 0 && min_bad > 0) {
		/* These sectors are bad on all InSync devices, so we
		 * need to mark them bad on all write targets
		 */
		int ok = 1;
2745
		for (i = 0 ; i < conf->raid_disks * 2 ; i++)
2746
			if (r1_bio->bios[i]->bi_end_io == end_sync_write) {
2747
				struct md_rdev *rdev = conf->mirrors[i].rdev;
2748 2749 2750 2751
				ok = rdev_set_badblocks(rdev, sector_nr,
							min_bad, 0
					) && ok;
			}
2752
		set_bit(MD_SB_CHANGE_DEVS, &mddev->sb_flags);
2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774
		*skipped = 1;
		put_buf(r1_bio);

		if (!ok) {
			/* Cannot record the badblocks, so need to
			 * abort the resync.
			 * If there are multiple read targets, could just
			 * fail the really bad ones ???
			 */
			conf->recovery_disabled = mddev->recovery_disabled;
			set_bit(MD_RECOVERY_INTR, &mddev->recovery);
			return 0;
		} else
			return min_bad;

	}
	if (min_bad > 0 && min_bad < good_sectors) {
		/* only resync enough to reach the next bad->good
		 * transition */
		good_sectors = min_bad;
	}

2775 2776 2777 2778 2779
	if (test_bit(MD_RECOVERY_SYNC, &mddev->recovery) && read_targets > 0)
		/* extra read targets are also write targets */
		write_targets += read_targets-1;

	if (write_targets == 0 || read_targets == 0) {
L
Linus Torvalds 已提交
2780 2781 2782
		/* There is nowhere to write, so all non-sync
		 * drives must be failed - so we are finished
		 */
2783 2784 2785 2786
		sector_t rv;
		if (min_bad > 0)
			max_sector = sector_nr + min_bad;
		rv = max_sector - sector_nr;
2787
		*skipped = 1;
L
Linus Torvalds 已提交
2788 2789 2790 2791
		put_buf(r1_bio);
		return rv;
	}

2792 2793
	if (max_sector > mddev->resync_max)
		max_sector = mddev->resync_max; /* Don't do IO beyond here */
2794 2795
	if (max_sector > sector_nr + good_sectors)
		max_sector = sector_nr + good_sectors;
L
Linus Torvalds 已提交
2796
	nr_sectors = 0;
2797
	sync_blocks = 0;
L
Linus Torvalds 已提交
2798 2799 2800 2801 2802 2803 2804
	do {
		struct page *page;
		int len = PAGE_SIZE;
		if (sector_nr + (len>>9) > max_sector)
			len = (max_sector - sector_nr) << 9;
		if (len == 0)
			break;
2805 2806
		if (sync_blocks == 0) {
			if (!bitmap_start_sync(mddev->bitmap, sector_nr,
2807 2808 2809
					       &sync_blocks, still_degraded) &&
			    !conf->fullsync &&
			    !test_bit(MD_RECOVERY_REQUESTED, &mddev->recovery))
2810
				break;
2811
			if ((len >> 9) > sync_blocks)
2812
				len = sync_blocks<<9;
2813
		}
2814

2815
		for (i = 0 ; i < conf->raid_disks * 2; i++) {
2816 2817
			struct resync_pages *rp;

L
Linus Torvalds 已提交
2818
			bio = r1_bio->bios[i];
2819
			rp = get_resync_pages(bio);
L
Linus Torvalds 已提交
2820
			if (bio->bi_end_io) {
2821
				page = resync_fetch_page(rp, page_idx);
2822 2823 2824 2825 2826 2827

				/*
				 * won't fail because the vec table is big
				 * enough to hold all these pages
				 */
				bio_add_page(bio, page, len, 0);
L
Linus Torvalds 已提交
2828 2829 2830 2831
			}
		}
		nr_sectors += len>>9;
		sector_nr += len>>9;
2832
		sync_blocks -= (len>>9);
2833
	} while (++page_idx < RESYNC_PAGES);
2834

L
Linus Torvalds 已提交
2835 2836
	r1_bio->sectors = nr_sectors;

2837 2838 2839 2840 2841 2842 2843 2844 2845 2846
	if (mddev_is_clustered(mddev) &&
			conf->cluster_sync_high < sector_nr + nr_sectors) {
		conf->cluster_sync_low = mddev->curr_resync_completed;
		conf->cluster_sync_high = conf->cluster_sync_low + CLUSTER_RESYNC_WINDOW_SECTORS;
		/* Send resync message */
		md_cluster_ops->resync_info_update(mddev,
				conf->cluster_sync_low,
				conf->cluster_sync_high);
	}

2847 2848 2849 2850 2851
	/* For a user-requested sync, we read all readable devices and do a
	 * compare
	 */
	if (test_bit(MD_RECOVERY_REQUESTED, &mddev->recovery)) {
		atomic_set(&r1_bio->remaining, read_targets);
2852
		for (i = 0; i < conf->raid_disks * 2 && read_targets; i++) {
2853 2854
			bio = r1_bio->bios[i];
			if (bio->bi_end_io == end_sync_read) {
2855
				read_targets--;
2856
				md_sync_acct(bio->bi_bdev, nr_sectors);
2857 2858
				if (read_targets == 1)
					bio->bi_opf &= ~MD_FAILFAST;
2859 2860 2861 2862 2863 2864
				generic_make_request(bio);
			}
		}
	} else {
		atomic_set(&r1_bio->remaining, 1);
		bio = r1_bio->bios[r1_bio->read_disk];
2865
		md_sync_acct(bio->bi_bdev, nr_sectors);
2866 2867
		if (read_targets == 1)
			bio->bi_opf &= ~MD_FAILFAST;
2868
		generic_make_request(bio);
L
Linus Torvalds 已提交
2869

2870
	}
L
Linus Torvalds 已提交
2871 2872 2873
	return nr_sectors;
}

2874
static sector_t raid1_size(struct mddev *mddev, sector_t sectors, int raid_disks)
2875 2876 2877 2878 2879 2880 2881
{
	if (sectors)
		return sectors;

	return mddev->dev_sectors;
}

2882
static struct r1conf *setup_conf(struct mddev *mddev)
L
Linus Torvalds 已提交
2883
{
2884
	struct r1conf *conf;
2885
	int i;
2886
	struct raid1_info *disk;
2887
	struct md_rdev *rdev;
2888
	int err = -ENOMEM;
L
Linus Torvalds 已提交
2889

2890
	conf = kzalloc(sizeof(struct r1conf), GFP_KERNEL);
L
Linus Torvalds 已提交
2891
	if (!conf)
2892
		goto abort;
L
Linus Torvalds 已提交
2893

2894
	conf->nr_pending = kcalloc(BARRIER_BUCKETS_NR,
2895
				   sizeof(atomic_t), GFP_KERNEL);
2896 2897 2898 2899
	if (!conf->nr_pending)
		goto abort;

	conf->nr_waiting = kcalloc(BARRIER_BUCKETS_NR,
2900
				   sizeof(atomic_t), GFP_KERNEL);
2901 2902 2903 2904
	if (!conf->nr_waiting)
		goto abort;

	conf->nr_queued = kcalloc(BARRIER_BUCKETS_NR,
2905
				  sizeof(atomic_t), GFP_KERNEL);
2906 2907 2908 2909
	if (!conf->nr_queued)
		goto abort;

	conf->barrier = kcalloc(BARRIER_BUCKETS_NR,
2910
				sizeof(atomic_t), GFP_KERNEL);
2911 2912 2913
	if (!conf->barrier)
		goto abort;

2914
	conf->mirrors = kzalloc(sizeof(struct raid1_info)
2915
				* mddev->raid_disks * 2,
L
Linus Torvalds 已提交
2916 2917
				 GFP_KERNEL);
	if (!conf->mirrors)
2918
		goto abort;
L
Linus Torvalds 已提交
2919

2920 2921
	conf->tmppage = alloc_page(GFP_KERNEL);
	if (!conf->tmppage)
2922
		goto abort;
2923

2924
	conf->poolinfo = kzalloc(sizeof(*conf->poolinfo), GFP_KERNEL);
L
Linus Torvalds 已提交
2925
	if (!conf->poolinfo)
2926
		goto abort;
2927
	conf->poolinfo->raid_disks = mddev->raid_disks * 2;
L
Linus Torvalds 已提交
2928 2929 2930 2931
	conf->r1bio_pool = mempool_create(NR_RAID1_BIOS, r1bio_pool_alloc,
					  r1bio_pool_free,
					  conf->poolinfo);
	if (!conf->r1bio_pool)
2932 2933
		goto abort;

2934
	conf->bio_split = bioset_create(BIO_POOL_SIZE, 0, 0);
2935 2936 2937
	if (!conf->bio_split)
		goto abort;

2938
	conf->poolinfo->mddev = mddev;
L
Linus Torvalds 已提交
2939

2940
	err = -EINVAL;
2941
	spin_lock_init(&conf->device_lock);
N
NeilBrown 已提交
2942
	rdev_for_each(rdev, mddev) {
2943
		int disk_idx = rdev->raid_disk;
L
Linus Torvalds 已提交
2944 2945 2946
		if (disk_idx >= mddev->raid_disks
		    || disk_idx < 0)
			continue;
2947
		if (test_bit(Replacement, &rdev->flags))
2948
			disk = conf->mirrors + mddev->raid_disks + disk_idx;
2949 2950
		else
			disk = conf->mirrors + disk_idx;
L
Linus Torvalds 已提交
2951

2952 2953
		if (disk->rdev)
			goto abort;
L
Linus Torvalds 已提交
2954 2955
		disk->rdev = rdev;
		disk->head_position = 0;
2956
		disk->seq_start = MaxSector;
L
Linus Torvalds 已提交
2957 2958 2959 2960
	}
	conf->raid_disks = mddev->raid_disks;
	conf->mddev = mddev;
	INIT_LIST_HEAD(&conf->retry_list);
2961
	INIT_LIST_HEAD(&conf->bio_end_io_list);
L
Linus Torvalds 已提交
2962 2963

	spin_lock_init(&conf->resync_lock);
2964
	init_waitqueue_head(&conf->wait_barrier);
L
Linus Torvalds 已提交
2965

2966
	bio_list_init(&conf->pending_bio_list);
2967
	conf->pending_count = 0;
2968
	conf->recovery_disabled = mddev->recovery_disabled - 1;
2969

2970
	err = -EIO;
2971
	for (i = 0; i < conf->raid_disks * 2; i++) {
L
Linus Torvalds 已提交
2972 2973 2974

		disk = conf->mirrors + i;

2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989
		if (i < conf->raid_disks &&
		    disk[conf->raid_disks].rdev) {
			/* This slot has a replacement. */
			if (!disk->rdev) {
				/* No original, just make the replacement
				 * a recovering spare
				 */
				disk->rdev =
					disk[conf->raid_disks].rdev;
				disk[conf->raid_disks].rdev = NULL;
			} else if (!test_bit(In_sync, &disk->rdev->flags))
				/* Original is not in_sync - bad */
				goto abort;
		}

2990 2991
		if (!disk->rdev ||
		    !test_bit(In_sync, &disk->rdev->flags)) {
L
Linus Torvalds 已提交
2992
			disk->head_position = 0;
2993 2994
			if (disk->rdev &&
			    (disk->rdev->saved_raid_disk < 0))
2995
				conf->fullsync = 1;
2996
		}
L
Linus Torvalds 已提交
2997
	}
2998 2999

	err = -ENOMEM;
3000
	conf->thread = md_register_thread(raid1d, mddev, "raid1");
N
NeilBrown 已提交
3001
	if (!conf->thread)
3002
		goto abort;
L
Linus Torvalds 已提交
3003

3004 3005 3006 3007
	return conf;

 abort:
	if (conf) {
3008
		mempool_destroy(conf->r1bio_pool);
3009 3010 3011
		kfree(conf->mirrors);
		safe_put_page(conf->tmppage);
		kfree(conf->poolinfo);
3012 3013 3014 3015
		kfree(conf->nr_pending);
		kfree(conf->nr_waiting);
		kfree(conf->nr_queued);
		kfree(conf->barrier);
3016 3017
		if (conf->bio_split)
			bioset_free(conf->bio_split);
3018 3019 3020 3021 3022
		kfree(conf);
	}
	return ERR_PTR(err);
}

N
NeilBrown 已提交
3023
static void raid1_free(struct mddev *mddev, void *priv);
S
Shaohua Li 已提交
3024
static int raid1_run(struct mddev *mddev)
3025
{
3026
	struct r1conf *conf;
3027
	int i;
3028
	struct md_rdev *rdev;
3029
	int ret;
S
Shaohua Li 已提交
3030
	bool discard_supported = false;
3031 3032

	if (mddev->level != 1) {
N
NeilBrown 已提交
3033 3034
		pr_warn("md/raid1:%s: raid level not set to mirroring (%d)\n",
			mdname(mddev), mddev->level);
3035 3036 3037
		return -EIO;
	}
	if (mddev->reshape_position != MaxSector) {
N
NeilBrown 已提交
3038 3039
		pr_warn("md/raid1:%s: reshape_position set but not supported\n",
			mdname(mddev));
3040 3041
		return -EIO;
	}
3042 3043
	if (mddev_init_writes_pending(mddev) < 0)
		return -ENOMEM;
L
Linus Torvalds 已提交
3044
	/*
3045 3046
	 * copy the already verified devices into our private RAID1
	 * bookkeeping area. [whatever we allocate in run(),
N
NeilBrown 已提交
3047
	 * should be freed in raid1_free()]
L
Linus Torvalds 已提交
3048
	 */
3049 3050 3051 3052
	if (mddev->private == NULL)
		conf = setup_conf(mddev);
	else
		conf = mddev->private;
L
Linus Torvalds 已提交
3053

3054 3055
	if (IS_ERR(conf))
		return PTR_ERR(conf);
L
Linus Torvalds 已提交
3056

3057
	if (mddev->queue) {
3058
		blk_queue_max_write_same_sectors(mddev->queue, 0);
3059 3060
		blk_queue_max_write_zeroes_sectors(mddev->queue, 0);
	}
3061

N
NeilBrown 已提交
3062
	rdev_for_each(rdev, mddev) {
3063 3064
		if (!mddev->gendisk)
			continue;
3065 3066
		disk_stack_limits(mddev->gendisk, rdev->bdev,
				  rdev->data_offset << 9);
S
Shaohua Li 已提交
3067 3068
		if (blk_queue_discard(bdev_get_queue(rdev->bdev)))
			discard_supported = true;
L
Linus Torvalds 已提交
3069
	}
3070

3071 3072 3073 3074 3075 3076 3077 3078 3079 3080
	mddev->degraded = 0;
	for (i=0; i < conf->raid_disks; i++)
		if (conf->mirrors[i].rdev == NULL ||
		    !test_bit(In_sync, &conf->mirrors[i].rdev->flags) ||
		    test_bit(Faulty, &conf->mirrors[i].rdev->flags))
			mddev->degraded++;

	if (conf->raid_disks - mddev->degraded == 1)
		mddev->recovery_cp = MaxSector;

3081
	if (mddev->recovery_cp != MaxSector)
N
NeilBrown 已提交
3082 3083 3084
		pr_info("md/raid1:%s: not clean -- starting background reconstruction\n",
			mdname(mddev));
	pr_info("md/raid1:%s: active with %d out of %d mirrors\n",
3085
		mdname(mddev), mddev->raid_disks - mddev->degraded,
L
Linus Torvalds 已提交
3086
		mddev->raid_disks);
3087

L
Linus Torvalds 已提交
3088 3089 3090
	/*
	 * Ok, everything is just fine now
	 */
3091 3092 3093
	mddev->thread = conf->thread;
	conf->thread = NULL;
	mddev->private = conf;
3094
	set_bit(MD_FAILFAST_SUPPORTED, &mddev->flags);
3095

3096
	md_set_array_sectors(mddev, raid1_size(mddev, 0, 0));
L
Linus Torvalds 已提交
3097

3098
	if (mddev->queue) {
S
Shaohua Li 已提交
3099 3100 3101 3102 3103 3104
		if (discard_supported)
			queue_flag_set_unlocked(QUEUE_FLAG_DISCARD,
						mddev->queue);
		else
			queue_flag_clear_unlocked(QUEUE_FLAG_DISCARD,
						  mddev->queue);
3105
	}
3106 3107

	ret =  md_integrity_register(mddev);
3108 3109
	if (ret) {
		md_unregister_thread(&mddev->thread);
N
NeilBrown 已提交
3110
		raid1_free(mddev, conf);
3111
	}
3112
	return ret;
L
Linus Torvalds 已提交
3113 3114
}

N
NeilBrown 已提交
3115
static void raid1_free(struct mddev *mddev, void *priv)
L
Linus Torvalds 已提交
3116
{
N
NeilBrown 已提交
3117
	struct r1conf *conf = priv;
3118

3119
	mempool_destroy(conf->r1bio_pool);
3120
	kfree(conf->mirrors);
3121
	safe_put_page(conf->tmppage);
3122
	kfree(conf->poolinfo);
3123 3124 3125 3126
	kfree(conf->nr_pending);
	kfree(conf->nr_waiting);
	kfree(conf->nr_queued);
	kfree(conf->barrier);
3127 3128
	if (conf->bio_split)
		bioset_free(conf->bio_split);
L
Linus Torvalds 已提交
3129 3130 3131
	kfree(conf);
}

3132
static int raid1_resize(struct mddev *mddev, sector_t sectors)
L
Linus Torvalds 已提交
3133 3134 3135 3136 3137 3138 3139 3140
{
	/* no resync is happening, and there is enough space
	 * on all devices, so we can resize.
	 * We need to make sure resync covers any new space.
	 * If the array is shrinking we should possibly wait until
	 * any io in the removed space completes, but it hardly seems
	 * worth it.
	 */
3141 3142 3143
	sector_t newsize = raid1_size(mddev, sectors, 0);
	if (mddev->external_size &&
	    mddev->array_sectors > newsize)
D
Dan Williams 已提交
3144
		return -EINVAL;
3145 3146 3147 3148 3149 3150
	if (mddev->bitmap) {
		int ret = bitmap_resize(mddev->bitmap, newsize, 0, 0);
		if (ret)
			return ret;
	}
	md_set_array_sectors(mddev, newsize);
D
Dan Williams 已提交
3151
	if (sectors > mddev->dev_sectors &&
3152
	    mddev->recovery_cp > mddev->dev_sectors) {
A
Andre Noll 已提交
3153
		mddev->recovery_cp = mddev->dev_sectors;
L
Linus Torvalds 已提交
3154 3155
		set_bit(MD_RECOVERY_NEEDED, &mddev->recovery);
	}
D
Dan Williams 已提交
3156
	mddev->dev_sectors = sectors;
3157
	mddev->resync_max_sectors = sectors;
L
Linus Torvalds 已提交
3158 3159 3160
	return 0;
}

3161
static int raid1_reshape(struct mddev *mddev)
L
Linus Torvalds 已提交
3162 3163 3164 3165 3166 3167 3168 3169
{
	/* We need to:
	 * 1/ resize the r1bio_pool
	 * 2/ resize conf->mirrors
	 *
	 * We allocate a new r1bio_pool if we can.
	 * Then raise a device barrier and wait until all IO stops.
	 * Then resize conf->mirrors and swap in the new r1bio pool.
3170 3171 3172
	 *
	 * At the same time, we "pack" the devices so that all the missing
	 * devices have the higher raid_disk numbers.
L
Linus Torvalds 已提交
3173 3174 3175
	 */
	mempool_t *newpool, *oldpool;
	struct pool_info *newpoolinfo;
3176
	struct raid1_info *newmirrors;
3177
	struct r1conf *conf = mddev->private;
3178
	int cnt, raid_disks;
3179
	unsigned long flags;
3180
	int d, d2;
L
Linus Torvalds 已提交
3181

3182
	/* Cannot change chunk_size, layout, or level */
3183
	if (mddev->chunk_sectors != mddev->new_chunk_sectors ||
3184 3185
	    mddev->layout != mddev->new_layout ||
	    mddev->level != mddev->new_level) {
3186
		mddev->new_chunk_sectors = mddev->chunk_sectors;
3187 3188 3189 3190 3191
		mddev->new_layout = mddev->layout;
		mddev->new_level = mddev->level;
		return -EINVAL;
	}

3192 3193
	if (!mddev_is_clustered(mddev))
		md_allow_write(mddev);
3194

3195 3196
	raid_disks = mddev->raid_disks + mddev->delta_disks;

3197 3198 3199 3200 3201 3202
	if (raid_disks < conf->raid_disks) {
		cnt=0;
		for (d= 0; d < conf->raid_disks; d++)
			if (conf->mirrors[d].rdev)
				cnt++;
		if (cnt > raid_disks)
L
Linus Torvalds 已提交
3203
			return -EBUSY;
3204
	}
L
Linus Torvalds 已提交
3205 3206 3207 3208 3209

	newpoolinfo = kmalloc(sizeof(*newpoolinfo), GFP_KERNEL);
	if (!newpoolinfo)
		return -ENOMEM;
	newpoolinfo->mddev = mddev;
3210
	newpoolinfo->raid_disks = raid_disks * 2;
L
Linus Torvalds 已提交
3211 3212 3213 3214 3215 3216 3217

	newpool = mempool_create(NR_RAID1_BIOS, r1bio_pool_alloc,
				 r1bio_pool_free, newpoolinfo);
	if (!newpool) {
		kfree(newpoolinfo);
		return -ENOMEM;
	}
3218
	newmirrors = kzalloc(sizeof(struct raid1_info) * raid_disks * 2,
3219
			     GFP_KERNEL);
L
Linus Torvalds 已提交
3220 3221 3222 3223 3224 3225
	if (!newmirrors) {
		kfree(newpoolinfo);
		mempool_destroy(newpool);
		return -ENOMEM;
	}

3226
	freeze_array(conf, 0);
L
Linus Torvalds 已提交
3227 3228 3229 3230

	/* ok, everything is stopped */
	oldpool = conf->r1bio_pool;
	conf->r1bio_pool = newpool;
3231

3232
	for (d = d2 = 0; d < conf->raid_disks; d++) {
3233
		struct md_rdev *rdev = conf->mirrors[d].rdev;
3234
		if (rdev && rdev->raid_disk != d2) {
3235
			sysfs_unlink_rdev(mddev, rdev);
3236
			rdev->raid_disk = d2;
3237 3238
			sysfs_unlink_rdev(mddev, rdev);
			if (sysfs_link_rdev(mddev, rdev))
N
NeilBrown 已提交
3239 3240
				pr_warn("md/raid1:%s: cannot register rd%d\n",
					mdname(mddev), rdev->raid_disk);
3241
		}
3242 3243 3244
		if (rdev)
			newmirrors[d2++].rdev = rdev;
	}
L
Linus Torvalds 已提交
3245 3246 3247 3248 3249
	kfree(conf->mirrors);
	conf->mirrors = newmirrors;
	kfree(conf->poolinfo);
	conf->poolinfo = newpoolinfo;

3250
	spin_lock_irqsave(&conf->device_lock, flags);
L
Linus Torvalds 已提交
3251
	mddev->degraded += (raid_disks - conf->raid_disks);
3252
	spin_unlock_irqrestore(&conf->device_lock, flags);
L
Linus Torvalds 已提交
3253
	conf->raid_disks = mddev->raid_disks = raid_disks;
3254
	mddev->delta_disks = 0;
L
Linus Torvalds 已提交
3255

3256
	unfreeze_array(conf);
L
Linus Torvalds 已提交
3257

3258
	set_bit(MD_RECOVERY_RECOVER, &mddev->recovery);
L
Linus Torvalds 已提交
3259 3260 3261 3262 3263 3264 3265
	set_bit(MD_RECOVERY_NEEDED, &mddev->recovery);
	md_wakeup_thread(mddev->thread);

	mempool_destroy(oldpool);
	return 0;
}

3266
static void raid1_quiesce(struct mddev *mddev, int state)
3267
{
3268
	struct r1conf *conf = mddev->private;
3269 3270

	switch(state) {
3271 3272 3273
	case 2: /* wake for suspend */
		wake_up(&conf->wait_barrier);
		break;
3274
	case 1:
3275
		freeze_array(conf, 0);
3276
		break;
3277
	case 0:
3278
		unfreeze_array(conf);
3279 3280 3281 3282
		break;
	}
}

3283
static void *raid1_takeover(struct mddev *mddev)
3284 3285 3286 3287 3288
{
	/* raid1 can take over:
	 *  raid5 with 2 devices, any layout or chunk size
	 */
	if (mddev->level == 5 && mddev->raid_disks == 2) {
3289
		struct r1conf *conf;
3290 3291 3292 3293
		mddev->new_level = 1;
		mddev->new_layout = 0;
		mddev->new_chunk_sectors = 0;
		conf = setup_conf(mddev);
3294
		if (!IS_ERR(conf)) {
3295 3296
			/* Array must appear to be quiesced */
			conf->array_frozen = 1;
3297 3298
			mddev_clear_unsupported_flags(mddev,
				UNSUPPORTED_MDDEV_FLAGS);
3299
		}
3300 3301 3302 3303
		return conf;
	}
	return ERR_PTR(-EINVAL);
}
L
Linus Torvalds 已提交
3304

3305
static struct md_personality raid1_personality =
L
Linus Torvalds 已提交
3306 3307
{
	.name		= "raid1",
3308
	.level		= 1,
L
Linus Torvalds 已提交
3309
	.owner		= THIS_MODULE,
S
Shaohua Li 已提交
3310 3311
	.make_request	= raid1_make_request,
	.run		= raid1_run,
N
NeilBrown 已提交
3312
	.free		= raid1_free,
S
Shaohua Li 已提交
3313 3314
	.status		= raid1_status,
	.error_handler	= raid1_error,
L
Linus Torvalds 已提交
3315 3316 3317
	.hot_add_disk	= raid1_add_disk,
	.hot_remove_disk= raid1_remove_disk,
	.spare_active	= raid1_spare_active,
S
Shaohua Li 已提交
3318
	.sync_request	= raid1_sync_request,
L
Linus Torvalds 已提交
3319
	.resize		= raid1_resize,
3320
	.size		= raid1_size,
3321
	.check_reshape	= raid1_reshape,
3322
	.quiesce	= raid1_quiesce,
3323
	.takeover	= raid1_takeover,
3324
	.congested	= raid1_congested,
L
Linus Torvalds 已提交
3325 3326 3327 3328
};

static int __init raid_init(void)
{
3329
	return register_md_personality(&raid1_personality);
L
Linus Torvalds 已提交
3330 3331 3332 3333
}

static void raid_exit(void)
{
3334
	unregister_md_personality(&raid1_personality);
L
Linus Torvalds 已提交
3335 3336 3337 3338 3339
}

module_init(raid_init);
module_exit(raid_exit);
MODULE_LICENSE("GPL");
3340
MODULE_DESCRIPTION("RAID1 (mirroring) personality for MD");
L
Linus Torvalds 已提交
3341
MODULE_ALIAS("md-personality-3"); /* RAID1 */
3342
MODULE_ALIAS("md-raid1");
3343
MODULE_ALIAS("md-level-1");
3344 3345

module_param(max_queued_requests, int, S_IRUGO|S_IWUSR);