Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (C) 2012 Fusion-io All rights reserved.
4 * Copyright (C) 2012 Intel Corp. All rights reserved.
5 */
6
7#include <linux/sched.h>
8#include <linux/bio.h>
9#include <linux/slab.h>
10#include <linux/blkdev.h>
11#include <linux/raid/pq.h>
12#include <linux/hash.h>
13#include <linux/list_sort.h>
14#include <linux/raid/xor.h>
15#include <linux/mm.h>
16#include "ctree.h"
17#include "disk-io.h"
18#include "volumes.h"
19#include "raid56.h"
20#include "async-thread.h"
21
22/* set when additional merges to this rbio are not allowed */
23#define RBIO_RMW_LOCKED_BIT 1
24
25/*
26 * set when this rbio is sitting in the hash, but it is just a cache
27 * of past RMW
28 */
29#define RBIO_CACHE_BIT 2
30
31/*
32 * set when it is safe to trust the stripe_pages for caching
33 */
34#define RBIO_CACHE_READY_BIT 3
35
36#define RBIO_CACHE_SIZE 1024
37
38#define BTRFS_STRIPE_HASH_TABLE_BITS 11
39
40/* Used by the raid56 code to lock stripes for read/modify/write */
41struct btrfs_stripe_hash {
42 struct list_head hash_list;
43 spinlock_t lock;
44};
45
46/* Used by the raid56 code to lock stripes for read/modify/write */
47struct btrfs_stripe_hash_table {
48 struct list_head stripe_cache;
49 spinlock_t cache_lock;
50 int cache_size;
51 struct btrfs_stripe_hash table[];
52};
53
54enum btrfs_rbio_ops {
55 BTRFS_RBIO_WRITE,
56 BTRFS_RBIO_READ_REBUILD,
57 BTRFS_RBIO_PARITY_SCRUB,
58 BTRFS_RBIO_REBUILD_MISSING,
59};
60
61struct btrfs_raid_bio {
62 struct btrfs_fs_info *fs_info;
63 struct btrfs_bio *bbio;
64
65 /* while we're doing rmw on a stripe
66 * we put it into a hash table so we can
67 * lock the stripe and merge more rbios
68 * into it.
69 */
70 struct list_head hash_list;
71
72 /*
73 * LRU list for the stripe cache
74 */
75 struct list_head stripe_cache;
76
77 /*
78 * for scheduling work in the helper threads
79 */
80 struct btrfs_work work;
81
82 /*
83 * bio list and bio_list_lock are used
84 * to add more bios into the stripe
85 * in hopes of avoiding the full rmw
86 */
87 struct bio_list bio_list;
88 spinlock_t bio_list_lock;
89
90 /* also protected by the bio_list_lock, the
91 * plug list is used by the plugging code
92 * to collect partial bios while plugged. The
93 * stripe locking code also uses it to hand off
94 * the stripe lock to the next pending IO
95 */
96 struct list_head plug_list;
97
98 /*
99 * flags that tell us if it is safe to
100 * merge with this bio
101 */
102 unsigned long flags;
103
104 /* size of each individual stripe on disk */
105 int stripe_len;
106
107 /* number of data stripes (no p/q) */
108 int nr_data;
109
110 int real_stripes;
111
112 int stripe_npages;
113 /*
114 * set if we're doing a parity rebuild
115 * for a read from higher up, which is handled
116 * differently from a parity rebuild as part of
117 * rmw
118 */
119 enum btrfs_rbio_ops operation;
120
121 /* first bad stripe */
122 int faila;
123
124 /* second bad stripe (for raid6 use) */
125 int failb;
126
127 int scrubp;
128 /*
129 * number of pages needed to represent the full
130 * stripe
131 */
132 int nr_pages;
133
134 /*
135 * size of all the bios in the bio_list. This
136 * helps us decide if the rbio maps to a full
137 * stripe or not
138 */
139 int bio_list_bytes;
140
141 int generic_bio_cnt;
142
143 refcount_t refs;
144
145 atomic_t stripes_pending;
146
147 atomic_t error;
148 /*
149 * these are two arrays of pointers. We allocate the
150 * rbio big enough to hold them both and setup their
151 * locations when the rbio is allocated
152 */
153
154 /* pointers to pages that we allocated for
155 * reading/writing stripes directly from the disk (including P/Q)
156 */
157 struct page **stripe_pages;
158
159 /*
160 * pointers to the pages in the bio_list. Stored
161 * here for faster lookup
162 */
163 struct page **bio_pages;
164
165 /*
166 * bitmap to record which horizontal stripe has data
167 */
168 unsigned long *dbitmap;
169
170 /* allocated with real_stripes-many pointers for finish_*() calls */
171 void **finish_pointers;
172
173 /* allocated with stripe_npages-many bits for finish_*() calls */
174 unsigned long *finish_pbitmap;
175};
176
177static int __raid56_parity_recover(struct btrfs_raid_bio *rbio);
178static noinline void finish_rmw(struct btrfs_raid_bio *rbio);
179static void rmw_work(struct btrfs_work *work);
180static void read_rebuild_work(struct btrfs_work *work);
181static int fail_bio_stripe(struct btrfs_raid_bio *rbio, struct bio *bio);
182static int fail_rbio_index(struct btrfs_raid_bio *rbio, int failed);
183static void __free_raid_bio(struct btrfs_raid_bio *rbio);
184static void index_rbio_pages(struct btrfs_raid_bio *rbio);
185static int alloc_rbio_pages(struct btrfs_raid_bio *rbio);
186
187static noinline void finish_parity_scrub(struct btrfs_raid_bio *rbio,
188 int need_check);
189static void scrub_parity_work(struct btrfs_work *work);
190
191static void start_async_work(struct btrfs_raid_bio *rbio, btrfs_func_t work_func)
192{
193 btrfs_init_work(&rbio->work, btrfs_rmw_helper, work_func, NULL, NULL);
194 btrfs_queue_work(rbio->fs_info->rmw_workers, &rbio->work);
195}
196
197/*
198 * the stripe hash table is used for locking, and to collect
199 * bios in hopes of making a full stripe
200 */
201int btrfs_alloc_stripe_hash_table(struct btrfs_fs_info *info)
202{
203 struct btrfs_stripe_hash_table *table;
204 struct btrfs_stripe_hash_table *x;
205 struct btrfs_stripe_hash *cur;
206 struct btrfs_stripe_hash *h;
207 int num_entries = 1 << BTRFS_STRIPE_HASH_TABLE_BITS;
208 int i;
209 int table_size;
210
211 if (info->stripe_hash_table)
212 return 0;
213
214 /*
215 * The table is large, starting with order 4 and can go as high as
216 * order 7 in case lock debugging is turned on.
217 *
218 * Try harder to allocate and fallback to vmalloc to lower the chance
219 * of a failing mount.
220 */
221 table_size = sizeof(*table) + sizeof(*h) * num_entries;
222 table = kvzalloc(table_size, GFP_KERNEL);
223 if (!table)
224 return -ENOMEM;
225
226 spin_lock_init(&table->cache_lock);
227 INIT_LIST_HEAD(&table->stripe_cache);
228
229 h = table->table;
230
231 for (i = 0; i < num_entries; i++) {
232 cur = h + i;
233 INIT_LIST_HEAD(&cur->hash_list);
234 spin_lock_init(&cur->lock);
235 }
236
237 x = cmpxchg(&info->stripe_hash_table, NULL, table);
238 if (x)
239 kvfree(x);
240 return 0;
241}
242
243/*
244 * caching an rbio means to copy anything from the
245 * bio_pages array into the stripe_pages array. We
246 * use the page uptodate bit in the stripe cache array
247 * to indicate if it has valid data
248 *
249 * once the caching is done, we set the cache ready
250 * bit.
251 */
252static void cache_rbio_pages(struct btrfs_raid_bio *rbio)
253{
254 int i;
255 char *s;
256 char *d;
257 int ret;
258
259 ret = alloc_rbio_pages(rbio);
260 if (ret)
261 return;
262
263 for (i = 0; i < rbio->nr_pages; i++) {
264 if (!rbio->bio_pages[i])
265 continue;
266
267 s = kmap(rbio->bio_pages[i]);
268 d = kmap(rbio->stripe_pages[i]);
269
270 copy_page(d, s);
271
272 kunmap(rbio->bio_pages[i]);
273 kunmap(rbio->stripe_pages[i]);
274 SetPageUptodate(rbio->stripe_pages[i]);
275 }
276 set_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
277}
278
279/*
280 * we hash on the first logical address of the stripe
281 */
282static int rbio_bucket(struct btrfs_raid_bio *rbio)
283{
284 u64 num = rbio->bbio->raid_map[0];
285
286 /*
287 * we shift down quite a bit. We're using byte
288 * addressing, and most of the lower bits are zeros.
289 * This tends to upset hash_64, and it consistently
290 * returns just one or two different values.
291 *
292 * shifting off the lower bits fixes things.
293 */
294 return hash_64(num >> 16, BTRFS_STRIPE_HASH_TABLE_BITS);
295}
296
297/*
298 * stealing an rbio means taking all the uptodate pages from the stripe
299 * array in the source rbio and putting them into the destination rbio
300 */
301static void steal_rbio(struct btrfs_raid_bio *src, struct btrfs_raid_bio *dest)
302{
303 int i;
304 struct page *s;
305 struct page *d;
306
307 if (!test_bit(RBIO_CACHE_READY_BIT, &src->flags))
308 return;
309
310 for (i = 0; i < dest->nr_pages; i++) {
311 s = src->stripe_pages[i];
312 if (!s || !PageUptodate(s)) {
313 continue;
314 }
315
316 d = dest->stripe_pages[i];
317 if (d)
318 __free_page(d);
319
320 dest->stripe_pages[i] = s;
321 src->stripe_pages[i] = NULL;
322 }
323}
324
325/*
326 * merging means we take the bio_list from the victim and
327 * splice it into the destination. The victim should
328 * be discarded afterwards.
329 *
330 * must be called with dest->rbio_list_lock held
331 */
332static void merge_rbio(struct btrfs_raid_bio *dest,
333 struct btrfs_raid_bio *victim)
334{
335 bio_list_merge(&dest->bio_list, &victim->bio_list);
336 dest->bio_list_bytes += victim->bio_list_bytes;
337 dest->generic_bio_cnt += victim->generic_bio_cnt;
338 bio_list_init(&victim->bio_list);
339}
340
341/*
342 * used to prune items that are in the cache. The caller
343 * must hold the hash table lock.
344 */
345static void __remove_rbio_from_cache(struct btrfs_raid_bio *rbio)
346{
347 int bucket = rbio_bucket(rbio);
348 struct btrfs_stripe_hash_table *table;
349 struct btrfs_stripe_hash *h;
350 int freeit = 0;
351
352 /*
353 * check the bit again under the hash table lock.
354 */
355 if (!test_bit(RBIO_CACHE_BIT, &rbio->flags))
356 return;
357
358 table = rbio->fs_info->stripe_hash_table;
359 h = table->table + bucket;
360
361 /* hold the lock for the bucket because we may be
362 * removing it from the hash table
363 */
364 spin_lock(&h->lock);
365
366 /*
367 * hold the lock for the bio list because we need
368 * to make sure the bio list is empty
369 */
370 spin_lock(&rbio->bio_list_lock);
371
372 if (test_and_clear_bit(RBIO_CACHE_BIT, &rbio->flags)) {
373 list_del_init(&rbio->stripe_cache);
374 table->cache_size -= 1;
375 freeit = 1;
376
377 /* if the bio list isn't empty, this rbio is
378 * still involved in an IO. We take it out
379 * of the cache list, and drop the ref that
380 * was held for the list.
381 *
382 * If the bio_list was empty, we also remove
383 * the rbio from the hash_table, and drop
384 * the corresponding ref
385 */
386 if (bio_list_empty(&rbio->bio_list)) {
387 if (!list_empty(&rbio->hash_list)) {
388 list_del_init(&rbio->hash_list);
389 refcount_dec(&rbio->refs);
390 BUG_ON(!list_empty(&rbio->plug_list));
391 }
392 }
393 }
394
395 spin_unlock(&rbio->bio_list_lock);
396 spin_unlock(&h->lock);
397
398 if (freeit)
399 __free_raid_bio(rbio);
400}
401
402/*
403 * prune a given rbio from the cache
404 */
405static void remove_rbio_from_cache(struct btrfs_raid_bio *rbio)
406{
407 struct btrfs_stripe_hash_table *table;
408 unsigned long flags;
409
410 if (!test_bit(RBIO_CACHE_BIT, &rbio->flags))
411 return;
412
413 table = rbio->fs_info->stripe_hash_table;
414
415 spin_lock_irqsave(&table->cache_lock, flags);
416 __remove_rbio_from_cache(rbio);
417 spin_unlock_irqrestore(&table->cache_lock, flags);
418}
419
420/*
421 * remove everything in the cache
422 */
423static void btrfs_clear_rbio_cache(struct btrfs_fs_info *info)
424{
425 struct btrfs_stripe_hash_table *table;
426 unsigned long flags;
427 struct btrfs_raid_bio *rbio;
428
429 table = info->stripe_hash_table;
430
431 spin_lock_irqsave(&table->cache_lock, flags);
432 while (!list_empty(&table->stripe_cache)) {
433 rbio = list_entry(table->stripe_cache.next,
434 struct btrfs_raid_bio,
435 stripe_cache);
436 __remove_rbio_from_cache(rbio);
437 }
438 spin_unlock_irqrestore(&table->cache_lock, flags);
439}
440
441/*
442 * remove all cached entries and free the hash table
443 * used by unmount
444 */
445void btrfs_free_stripe_hash_table(struct btrfs_fs_info *info)
446{
447 if (!info->stripe_hash_table)
448 return;
449 btrfs_clear_rbio_cache(info);
450 kvfree(info->stripe_hash_table);
451 info->stripe_hash_table = NULL;
452}
453
454/*
455 * insert an rbio into the stripe cache. It
456 * must have already been prepared by calling
457 * cache_rbio_pages
458 *
459 * If this rbio was already cached, it gets
460 * moved to the front of the lru.
461 *
462 * If the size of the rbio cache is too big, we
463 * prune an item.
464 */
465static void cache_rbio(struct btrfs_raid_bio *rbio)
466{
467 struct btrfs_stripe_hash_table *table;
468 unsigned long flags;
469
470 if (!test_bit(RBIO_CACHE_READY_BIT, &rbio->flags))
471 return;
472
473 table = rbio->fs_info->stripe_hash_table;
474
475 spin_lock_irqsave(&table->cache_lock, flags);
476 spin_lock(&rbio->bio_list_lock);
477
478 /* bump our ref if we were not in the list before */
479 if (!test_and_set_bit(RBIO_CACHE_BIT, &rbio->flags))
480 refcount_inc(&rbio->refs);
481
482 if (!list_empty(&rbio->stripe_cache)){
483 list_move(&rbio->stripe_cache, &table->stripe_cache);
484 } else {
485 list_add(&rbio->stripe_cache, &table->stripe_cache);
486 table->cache_size += 1;
487 }
488
489 spin_unlock(&rbio->bio_list_lock);
490
491 if (table->cache_size > RBIO_CACHE_SIZE) {
492 struct btrfs_raid_bio *found;
493
494 found = list_entry(table->stripe_cache.prev,
495 struct btrfs_raid_bio,
496 stripe_cache);
497
498 if (found != rbio)
499 __remove_rbio_from_cache(found);
500 }
501
502 spin_unlock_irqrestore(&table->cache_lock, flags);
503}
504
505/*
506 * helper function to run the xor_blocks api. It is only
507 * able to do MAX_XOR_BLOCKS at a time, so we need to
508 * loop through.
509 */
510static void run_xor(void **pages, int src_cnt, ssize_t len)
511{
512 int src_off = 0;
513 int xor_src_cnt = 0;
514 void *dest = pages[src_cnt];
515
516 while(src_cnt > 0) {
517 xor_src_cnt = min(src_cnt, MAX_XOR_BLOCKS);
518 xor_blocks(xor_src_cnt, len, dest, pages + src_off);
519
520 src_cnt -= xor_src_cnt;
521 src_off += xor_src_cnt;
522 }
523}
524
525/*
526 * Returns true if the bio list inside this rbio covers an entire stripe (no
527 * rmw required).
528 */
529static int rbio_is_full(struct btrfs_raid_bio *rbio)
530{
531 unsigned long flags;
532 unsigned long size = rbio->bio_list_bytes;
533 int ret = 1;
534
535 spin_lock_irqsave(&rbio->bio_list_lock, flags);
536 if (size != rbio->nr_data * rbio->stripe_len)
537 ret = 0;
538 BUG_ON(size > rbio->nr_data * rbio->stripe_len);
539 spin_unlock_irqrestore(&rbio->bio_list_lock, flags);
540
541 return ret;
542}
543
544/*
545 * returns 1 if it is safe to merge two rbios together.
546 * The merging is safe if the two rbios correspond to
547 * the same stripe and if they are both going in the same
548 * direction (read vs write), and if neither one is
549 * locked for final IO
550 *
551 * The caller is responsible for locking such that
552 * rmw_locked is safe to test
553 */
554static int rbio_can_merge(struct btrfs_raid_bio *last,
555 struct btrfs_raid_bio *cur)
556{
557 if (test_bit(RBIO_RMW_LOCKED_BIT, &last->flags) ||
558 test_bit(RBIO_RMW_LOCKED_BIT, &cur->flags))
559 return 0;
560
561 /*
562 * we can't merge with cached rbios, since the
563 * idea is that when we merge the destination
564 * rbio is going to run our IO for us. We can
565 * steal from cached rbios though, other functions
566 * handle that.
567 */
568 if (test_bit(RBIO_CACHE_BIT, &last->flags) ||
569 test_bit(RBIO_CACHE_BIT, &cur->flags))
570 return 0;
571
572 if (last->bbio->raid_map[0] !=
573 cur->bbio->raid_map[0])
574 return 0;
575
576 /* we can't merge with different operations */
577 if (last->operation != cur->operation)
578 return 0;
579 /*
580 * We've need read the full stripe from the drive.
581 * check and repair the parity and write the new results.
582 *
583 * We're not allowed to add any new bios to the
584 * bio list here, anyone else that wants to
585 * change this stripe needs to do their own rmw.
586 */
587 if (last->operation == BTRFS_RBIO_PARITY_SCRUB)
588 return 0;
589
590 if (last->operation == BTRFS_RBIO_REBUILD_MISSING)
591 return 0;
592
593 if (last->operation == BTRFS_RBIO_READ_REBUILD) {
594 int fa = last->faila;
595 int fb = last->failb;
596 int cur_fa = cur->faila;
597 int cur_fb = cur->failb;
598
599 if (last->faila >= last->failb) {
600 fa = last->failb;
601 fb = last->faila;
602 }
603
604 if (cur->faila >= cur->failb) {
605 cur_fa = cur->failb;
606 cur_fb = cur->faila;
607 }
608
609 if (fa != cur_fa || fb != cur_fb)
610 return 0;
611 }
612 return 1;
613}
614
615static int rbio_stripe_page_index(struct btrfs_raid_bio *rbio, int stripe,
616 int index)
617{
618 return stripe * rbio->stripe_npages + index;
619}
620
621/*
622 * these are just the pages from the rbio array, not from anything
623 * the FS sent down to us
624 */
625static struct page *rbio_stripe_page(struct btrfs_raid_bio *rbio, int stripe,
626 int index)
627{
628 return rbio->stripe_pages[rbio_stripe_page_index(rbio, stripe, index)];
629}
630
631/*
632 * helper to index into the pstripe
633 */
634static struct page *rbio_pstripe_page(struct btrfs_raid_bio *rbio, int index)
635{
636 return rbio_stripe_page(rbio, rbio->nr_data, index);
637}
638
639/*
640 * helper to index into the qstripe, returns null
641 * if there is no qstripe
642 */
643static struct page *rbio_qstripe_page(struct btrfs_raid_bio *rbio, int index)
644{
645 if (rbio->nr_data + 1 == rbio->real_stripes)
646 return NULL;
647 return rbio_stripe_page(rbio, rbio->nr_data + 1, index);
648}
649
650/*
651 * The first stripe in the table for a logical address
652 * has the lock. rbios are added in one of three ways:
653 *
654 * 1) Nobody has the stripe locked yet. The rbio is given
655 * the lock and 0 is returned. The caller must start the IO
656 * themselves.
657 *
658 * 2) Someone has the stripe locked, but we're able to merge
659 * with the lock owner. The rbio is freed and the IO will
660 * start automatically along with the existing rbio. 1 is returned.
661 *
662 * 3) Someone has the stripe locked, but we're not able to merge.
663 * The rbio is added to the lock owner's plug list, or merged into
664 * an rbio already on the plug list. When the lock owner unlocks,
665 * the next rbio on the list is run and the IO is started automatically.
666 * 1 is returned
667 *
668 * If we return 0, the caller still owns the rbio and must continue with
669 * IO submission. If we return 1, the caller must assume the rbio has
670 * already been freed.
671 */
672static noinline int lock_stripe_add(struct btrfs_raid_bio *rbio)
673{
674 int bucket = rbio_bucket(rbio);
675 struct btrfs_stripe_hash *h = rbio->fs_info->stripe_hash_table->table + bucket;
676 struct btrfs_raid_bio *cur;
677 struct btrfs_raid_bio *pending;
678 unsigned long flags;
679 struct btrfs_raid_bio *freeit = NULL;
680 struct btrfs_raid_bio *cache_drop = NULL;
681 int ret = 0;
682
683 spin_lock_irqsave(&h->lock, flags);
684 list_for_each_entry(cur, &h->hash_list, hash_list) {
685 if (cur->bbio->raid_map[0] == rbio->bbio->raid_map[0]) {
686 spin_lock(&cur->bio_list_lock);
687
688 /* can we steal this cached rbio's pages? */
689 if (bio_list_empty(&cur->bio_list) &&
690 list_empty(&cur->plug_list) &&
691 test_bit(RBIO_CACHE_BIT, &cur->flags) &&
692 !test_bit(RBIO_RMW_LOCKED_BIT, &cur->flags)) {
693 list_del_init(&cur->hash_list);
694 refcount_dec(&cur->refs);
695
696 steal_rbio(cur, rbio);
697 cache_drop = cur;
698 spin_unlock(&cur->bio_list_lock);
699
700 goto lockit;
701 }
702
703 /* can we merge into the lock owner? */
704 if (rbio_can_merge(cur, rbio)) {
705 merge_rbio(cur, rbio);
706 spin_unlock(&cur->bio_list_lock);
707 freeit = rbio;
708 ret = 1;
709 goto out;
710 }
711
712
713 /*
714 * we couldn't merge with the running
715 * rbio, see if we can merge with the
716 * pending ones. We don't have to
717 * check for rmw_locked because there
718 * is no way they are inside finish_rmw
719 * right now
720 */
721 list_for_each_entry(pending, &cur->plug_list,
722 plug_list) {
723 if (rbio_can_merge(pending, rbio)) {
724 merge_rbio(pending, rbio);
725 spin_unlock(&cur->bio_list_lock);
726 freeit = rbio;
727 ret = 1;
728 goto out;
729 }
730 }
731
732 /* no merging, put us on the tail of the plug list,
733 * our rbio will be started with the currently
734 * running rbio unlocks
735 */
736 list_add_tail(&rbio->plug_list, &cur->plug_list);
737 spin_unlock(&cur->bio_list_lock);
738 ret = 1;
739 goto out;
740 }
741 }
742lockit:
743 refcount_inc(&rbio->refs);
744 list_add(&rbio->hash_list, &h->hash_list);
745out:
746 spin_unlock_irqrestore(&h->lock, flags);
747 if (cache_drop)
748 remove_rbio_from_cache(cache_drop);
749 if (freeit)
750 __free_raid_bio(freeit);
751 return ret;
752}
753
754/*
755 * called as rmw or parity rebuild is completed. If the plug list has more
756 * rbios waiting for this stripe, the next one on the list will be started
757 */
758static noinline void unlock_stripe(struct btrfs_raid_bio *rbio)
759{
760 int bucket;
761 struct btrfs_stripe_hash *h;
762 unsigned long flags;
763 int keep_cache = 0;
764
765 bucket = rbio_bucket(rbio);
766 h = rbio->fs_info->stripe_hash_table->table + bucket;
767
768 if (list_empty(&rbio->plug_list))
769 cache_rbio(rbio);
770
771 spin_lock_irqsave(&h->lock, flags);
772 spin_lock(&rbio->bio_list_lock);
773
774 if (!list_empty(&rbio->hash_list)) {
775 /*
776 * if we're still cached and there is no other IO
777 * to perform, just leave this rbio here for others
778 * to steal from later
779 */
780 if (list_empty(&rbio->plug_list) &&
781 test_bit(RBIO_CACHE_BIT, &rbio->flags)) {
782 keep_cache = 1;
783 clear_bit(RBIO_RMW_LOCKED_BIT, &rbio->flags);
784 BUG_ON(!bio_list_empty(&rbio->bio_list));
785 goto done;
786 }
787
788 list_del_init(&rbio->hash_list);
789 refcount_dec(&rbio->refs);
790
791 /*
792 * we use the plug list to hold all the rbios
793 * waiting for the chance to lock this stripe.
794 * hand the lock over to one of them.
795 */
796 if (!list_empty(&rbio->plug_list)) {
797 struct btrfs_raid_bio *next;
798 struct list_head *head = rbio->plug_list.next;
799
800 next = list_entry(head, struct btrfs_raid_bio,
801 plug_list);
802
803 list_del_init(&rbio->plug_list);
804
805 list_add(&next->hash_list, &h->hash_list);
806 refcount_inc(&next->refs);
807 spin_unlock(&rbio->bio_list_lock);
808 spin_unlock_irqrestore(&h->lock, flags);
809
810 if (next->operation == BTRFS_RBIO_READ_REBUILD)
811 start_async_work(next, read_rebuild_work);
812 else if (next->operation == BTRFS_RBIO_REBUILD_MISSING) {
813 steal_rbio(rbio, next);
814 start_async_work(next, read_rebuild_work);
815 } else if (next->operation == BTRFS_RBIO_WRITE) {
816 steal_rbio(rbio, next);
817 start_async_work(next, rmw_work);
818 } else if (next->operation == BTRFS_RBIO_PARITY_SCRUB) {
819 steal_rbio(rbio, next);
820 start_async_work(next, scrub_parity_work);
821 }
822
823 goto done_nolock;
824 }
825 }
826done:
827 spin_unlock(&rbio->bio_list_lock);
828 spin_unlock_irqrestore(&h->lock, flags);
829
830done_nolock:
831 if (!keep_cache)
832 remove_rbio_from_cache(rbio);
833}
834
835static void __free_raid_bio(struct btrfs_raid_bio *rbio)
836{
837 int i;
838
839 if (!refcount_dec_and_test(&rbio->refs))
840 return;
841
842 WARN_ON(!list_empty(&rbio->stripe_cache));
843 WARN_ON(!list_empty(&rbio->hash_list));
844 WARN_ON(!bio_list_empty(&rbio->bio_list));
845
846 for (i = 0; i < rbio->nr_pages; i++) {
847 if (rbio->stripe_pages[i]) {
848 __free_page(rbio->stripe_pages[i]);
849 rbio->stripe_pages[i] = NULL;
850 }
851 }
852
853 btrfs_put_bbio(rbio->bbio);
854 kfree(rbio);
855}
856
857static void rbio_endio_bio_list(struct bio *cur, blk_status_t err)
858{
859 struct bio *next;
860
861 while (cur) {
862 next = cur->bi_next;
863 cur->bi_next = NULL;
864 cur->bi_status = err;
865 bio_endio(cur);
866 cur = next;
867 }
868}
869
870/*
871 * this frees the rbio and runs through all the bios in the
872 * bio_list and calls end_io on them
873 */
874static void rbio_orig_end_io(struct btrfs_raid_bio *rbio, blk_status_t err)
875{
876 struct bio *cur = bio_list_get(&rbio->bio_list);
877 struct bio *extra;
878
879 if (rbio->generic_bio_cnt)
880 btrfs_bio_counter_sub(rbio->fs_info, rbio->generic_bio_cnt);
881
882 /*
883 * At this moment, rbio->bio_list is empty, however since rbio does not
884 * always have RBIO_RMW_LOCKED_BIT set and rbio is still linked on the
885 * hash list, rbio may be merged with others so that rbio->bio_list
886 * becomes non-empty.
887 * Once unlock_stripe() is done, rbio->bio_list will not be updated any
888 * more and we can call bio_endio() on all queued bios.
889 */
890 unlock_stripe(rbio);
891 extra = bio_list_get(&rbio->bio_list);
892 __free_raid_bio(rbio);
893
894 rbio_endio_bio_list(cur, err);
895 if (extra)
896 rbio_endio_bio_list(extra, err);
897}
898
899/*
900 * end io function used by finish_rmw. When we finally
901 * get here, we've written a full stripe
902 */
903static void raid_write_end_io(struct bio *bio)
904{
905 struct btrfs_raid_bio *rbio = bio->bi_private;
906 blk_status_t err = bio->bi_status;
907 int max_errors;
908
909 if (err)
910 fail_bio_stripe(rbio, bio);
911
912 bio_put(bio);
913
914 if (!atomic_dec_and_test(&rbio->stripes_pending))
915 return;
916
917 err = BLK_STS_OK;
918
919 /* OK, we have read all the stripes we need to. */
920 max_errors = (rbio->operation == BTRFS_RBIO_PARITY_SCRUB) ?
921 0 : rbio->bbio->max_errors;
922 if (atomic_read(&rbio->error) > max_errors)
923 err = BLK_STS_IOERR;
924
925 rbio_orig_end_io(rbio, err);
926}
927
928/*
929 * the read/modify/write code wants to use the original bio for
930 * any pages it included, and then use the rbio for everything
931 * else. This function decides if a given index (stripe number)
932 * and page number in that stripe fall inside the original bio
933 * or the rbio.
934 *
935 * if you set bio_list_only, you'll get a NULL back for any ranges
936 * that are outside the bio_list
937 *
938 * This doesn't take any refs on anything, you get a bare page pointer
939 * and the caller must bump refs as required.
940 *
941 * You must call index_rbio_pages once before you can trust
942 * the answers from this function.
943 */
944static struct page *page_in_rbio(struct btrfs_raid_bio *rbio,
945 int index, int pagenr, int bio_list_only)
946{
947 int chunk_page;
948 struct page *p = NULL;
949
950 chunk_page = index * (rbio->stripe_len >> PAGE_SHIFT) + pagenr;
951
952 spin_lock_irq(&rbio->bio_list_lock);
953 p = rbio->bio_pages[chunk_page];
954 spin_unlock_irq(&rbio->bio_list_lock);
955
956 if (p || bio_list_only)
957 return p;
958
959 return rbio->stripe_pages[chunk_page];
960}
961
962/*
963 * number of pages we need for the entire stripe across all the
964 * drives
965 */
966static unsigned long rbio_nr_pages(unsigned long stripe_len, int nr_stripes)
967{
968 return DIV_ROUND_UP(stripe_len, PAGE_SIZE) * nr_stripes;
969}
970
971/*
972 * allocation and initial setup for the btrfs_raid_bio. Not
973 * this does not allocate any pages for rbio->pages.
974 */
975static struct btrfs_raid_bio *alloc_rbio(struct btrfs_fs_info *fs_info,
976 struct btrfs_bio *bbio,
977 u64 stripe_len)
978{
979 struct btrfs_raid_bio *rbio;
980 int nr_data = 0;
981 int real_stripes = bbio->num_stripes - bbio->num_tgtdevs;
982 int num_pages = rbio_nr_pages(stripe_len, real_stripes);
983 int stripe_npages = DIV_ROUND_UP(stripe_len, PAGE_SIZE);
984 void *p;
985
986 rbio = kzalloc(sizeof(*rbio) +
987 sizeof(*rbio->stripe_pages) * num_pages +
988 sizeof(*rbio->bio_pages) * num_pages +
989 sizeof(*rbio->finish_pointers) * real_stripes +
990 sizeof(*rbio->dbitmap) * BITS_TO_LONGS(stripe_npages) +
991 sizeof(*rbio->finish_pbitmap) *
992 BITS_TO_LONGS(stripe_npages),
993 GFP_NOFS);
994 if (!rbio)
995 return ERR_PTR(-ENOMEM);
996
997 bio_list_init(&rbio->bio_list);
998 INIT_LIST_HEAD(&rbio->plug_list);
999 spin_lock_init(&rbio->bio_list_lock);
1000 INIT_LIST_HEAD(&rbio->stripe_cache);
1001 INIT_LIST_HEAD(&rbio->hash_list);
1002 rbio->bbio = bbio;
1003 rbio->fs_info = fs_info;
1004 rbio->stripe_len = stripe_len;
1005 rbio->nr_pages = num_pages;
1006 rbio->real_stripes = real_stripes;
1007 rbio->stripe_npages = stripe_npages;
1008 rbio->faila = -1;
1009 rbio->failb = -1;
1010 refcount_set(&rbio->refs, 1);
1011 atomic_set(&rbio->error, 0);
1012 atomic_set(&rbio->stripes_pending, 0);
1013
1014 /*
1015 * the stripe_pages, bio_pages, etc arrays point to the extra
1016 * memory we allocated past the end of the rbio
1017 */
1018 p = rbio + 1;
1019#define CONSUME_ALLOC(ptr, count) do { \
1020 ptr = p; \
1021 p = (unsigned char *)p + sizeof(*(ptr)) * (count); \
1022 } while (0)
1023 CONSUME_ALLOC(rbio->stripe_pages, num_pages);
1024 CONSUME_ALLOC(rbio->bio_pages, num_pages);
1025 CONSUME_ALLOC(rbio->finish_pointers, real_stripes);
1026 CONSUME_ALLOC(rbio->dbitmap, BITS_TO_LONGS(stripe_npages));
1027 CONSUME_ALLOC(rbio->finish_pbitmap, BITS_TO_LONGS(stripe_npages));
1028#undef CONSUME_ALLOC
1029
1030 if (bbio->map_type & BTRFS_BLOCK_GROUP_RAID5)
1031 nr_data = real_stripes - 1;
1032 else if (bbio->map_type & BTRFS_BLOCK_GROUP_RAID6)
1033 nr_data = real_stripes - 2;
1034 else
1035 BUG();
1036
1037 rbio->nr_data = nr_data;
1038 return rbio;
1039}
1040
1041/* allocate pages for all the stripes in the bio, including parity */
1042static int alloc_rbio_pages(struct btrfs_raid_bio *rbio)
1043{
1044 int i;
1045 struct page *page;
1046
1047 for (i = 0; i < rbio->nr_pages; i++) {
1048 if (rbio->stripe_pages[i])
1049 continue;
1050 page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
1051 if (!page)
1052 return -ENOMEM;
1053 rbio->stripe_pages[i] = page;
1054 }
1055 return 0;
1056}
1057
1058/* only allocate pages for p/q stripes */
1059static int alloc_rbio_parity_pages(struct btrfs_raid_bio *rbio)
1060{
1061 int i;
1062 struct page *page;
1063
1064 i = rbio_stripe_page_index(rbio, rbio->nr_data, 0);
1065
1066 for (; i < rbio->nr_pages; i++) {
1067 if (rbio->stripe_pages[i])
1068 continue;
1069 page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
1070 if (!page)
1071 return -ENOMEM;
1072 rbio->stripe_pages[i] = page;
1073 }
1074 return 0;
1075}
1076
1077/*
1078 * add a single page from a specific stripe into our list of bios for IO
1079 * this will try to merge into existing bios if possible, and returns
1080 * zero if all went well.
1081 */
1082static int rbio_add_io_page(struct btrfs_raid_bio *rbio,
1083 struct bio_list *bio_list,
1084 struct page *page,
1085 int stripe_nr,
1086 unsigned long page_index,
1087 unsigned long bio_max_len)
1088{
1089 struct bio *last = bio_list->tail;
1090 u64 last_end = 0;
1091 int ret;
1092 struct bio *bio;
1093 struct btrfs_bio_stripe *stripe;
1094 u64 disk_start;
1095
1096 stripe = &rbio->bbio->stripes[stripe_nr];
1097 disk_start = stripe->physical + (page_index << PAGE_SHIFT);
1098
1099 /* if the device is missing, just fail this stripe */
1100 if (!stripe->dev->bdev)
1101 return fail_rbio_index(rbio, stripe_nr);
1102
1103 /* see if we can add this page onto our existing bio */
1104 if (last) {
1105 last_end = (u64)last->bi_iter.bi_sector << 9;
1106 last_end += last->bi_iter.bi_size;
1107
1108 /*
1109 * we can't merge these if they are from different
1110 * devices or if they are not contiguous
1111 */
1112 if (last_end == disk_start && stripe->dev->bdev &&
1113 !last->bi_status &&
1114 last->bi_disk == stripe->dev->bdev->bd_disk &&
1115 last->bi_partno == stripe->dev->bdev->bd_partno) {
1116 ret = bio_add_page(last, page, PAGE_SIZE, 0);
1117 if (ret == PAGE_SIZE)
1118 return 0;
1119 }
1120 }
1121
1122 /* put a new bio on the list */
1123 bio = btrfs_io_bio_alloc(bio_max_len >> PAGE_SHIFT ?: 1);
1124 bio->bi_iter.bi_size = 0;
1125 bio_set_dev(bio, stripe->dev->bdev);
1126 bio->bi_iter.bi_sector = disk_start >> 9;
1127
1128 bio_add_page(bio, page, PAGE_SIZE, 0);
1129 bio_list_add(bio_list, bio);
1130 return 0;
1131}
1132
1133/*
1134 * while we're doing the read/modify/write cycle, we could
1135 * have errors in reading pages off the disk. This checks
1136 * for errors and if we're not able to read the page it'll
1137 * trigger parity reconstruction. The rmw will be finished
1138 * after we've reconstructed the failed stripes
1139 */
1140static void validate_rbio_for_rmw(struct btrfs_raid_bio *rbio)
1141{
1142 if (rbio->faila >= 0 || rbio->failb >= 0) {
1143 BUG_ON(rbio->faila == rbio->real_stripes - 1);
1144 __raid56_parity_recover(rbio);
1145 } else {
1146 finish_rmw(rbio);
1147 }
1148}
1149
1150/*
1151 * helper function to walk our bio list and populate the bio_pages array with
1152 * the result. This seems expensive, but it is faster than constantly
1153 * searching through the bio list as we setup the IO in finish_rmw or stripe
1154 * reconstruction.
1155 *
1156 * This must be called before you trust the answers from page_in_rbio
1157 */
1158static void index_rbio_pages(struct btrfs_raid_bio *rbio)
1159{
1160 struct bio *bio;
1161 u64 start;
1162 unsigned long stripe_offset;
1163 unsigned long page_index;
1164
1165 spin_lock_irq(&rbio->bio_list_lock);
1166 bio_list_for_each(bio, &rbio->bio_list) {
1167 struct bio_vec bvec;
1168 struct bvec_iter iter;
1169 int i = 0;
1170
1171 start = (u64)bio->bi_iter.bi_sector << 9;
1172 stripe_offset = start - rbio->bbio->raid_map[0];
1173 page_index = stripe_offset >> PAGE_SHIFT;
1174
1175 if (bio_flagged(bio, BIO_CLONED))
1176 bio->bi_iter = btrfs_io_bio(bio)->iter;
1177
1178 bio_for_each_segment(bvec, bio, iter) {
1179 rbio->bio_pages[page_index + i] = bvec.bv_page;
1180 i++;
1181 }
1182 }
1183 spin_unlock_irq(&rbio->bio_list_lock);
1184}
1185
1186/*
1187 * this is called from one of two situations. We either
1188 * have a full stripe from the higher layers, or we've read all
1189 * the missing bits off disk.
1190 *
1191 * This will calculate the parity and then send down any
1192 * changed blocks.
1193 */
1194static noinline void finish_rmw(struct btrfs_raid_bio *rbio)
1195{
1196 struct btrfs_bio *bbio = rbio->bbio;
1197 void **pointers = rbio->finish_pointers;
1198 int nr_data = rbio->nr_data;
1199 int stripe;
1200 int pagenr;
1201 int p_stripe = -1;
1202 int q_stripe = -1;
1203 struct bio_list bio_list;
1204 struct bio *bio;
1205 int ret;
1206
1207 bio_list_init(&bio_list);
1208
1209 if (rbio->real_stripes - rbio->nr_data == 1) {
1210 p_stripe = rbio->real_stripes - 1;
1211 } else if (rbio->real_stripes - rbio->nr_data == 2) {
1212 p_stripe = rbio->real_stripes - 2;
1213 q_stripe = rbio->real_stripes - 1;
1214 } else {
1215 BUG();
1216 }
1217
1218 /* at this point we either have a full stripe,
1219 * or we've read the full stripe from the drive.
1220 * recalculate the parity and write the new results.
1221 *
1222 * We're not allowed to add any new bios to the
1223 * bio list here, anyone else that wants to
1224 * change this stripe needs to do their own rmw.
1225 */
1226 spin_lock_irq(&rbio->bio_list_lock);
1227 set_bit(RBIO_RMW_LOCKED_BIT, &rbio->flags);
1228 spin_unlock_irq(&rbio->bio_list_lock);
1229
1230 atomic_set(&rbio->error, 0);
1231
1232 /*
1233 * now that we've set rmw_locked, run through the
1234 * bio list one last time and map the page pointers
1235 *
1236 * We don't cache full rbios because we're assuming
1237 * the higher layers are unlikely to use this area of
1238 * the disk again soon. If they do use it again,
1239 * hopefully they will send another full bio.
1240 */
1241 index_rbio_pages(rbio);
1242 if (!rbio_is_full(rbio))
1243 cache_rbio_pages(rbio);
1244 else
1245 clear_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
1246
1247 for (pagenr = 0; pagenr < rbio->stripe_npages; pagenr++) {
1248 struct page *p;
1249 /* first collect one page from each data stripe */
1250 for (stripe = 0; stripe < nr_data; stripe++) {
1251 p = page_in_rbio(rbio, stripe, pagenr, 0);
1252 pointers[stripe] = kmap(p);
1253 }
1254
1255 /* then add the parity stripe */
1256 p = rbio_pstripe_page(rbio, pagenr);
1257 SetPageUptodate(p);
1258 pointers[stripe++] = kmap(p);
1259
1260 if (q_stripe != -1) {
1261
1262 /*
1263 * raid6, add the qstripe and call the
1264 * library function to fill in our p/q
1265 */
1266 p = rbio_qstripe_page(rbio, pagenr);
1267 SetPageUptodate(p);
1268 pointers[stripe++] = kmap(p);
1269
1270 raid6_call.gen_syndrome(rbio->real_stripes, PAGE_SIZE,
1271 pointers);
1272 } else {
1273 /* raid5 */
1274 copy_page(pointers[nr_data], pointers[0]);
1275 run_xor(pointers + 1, nr_data - 1, PAGE_SIZE);
1276 }
1277
1278
1279 for (stripe = 0; stripe < rbio->real_stripes; stripe++)
1280 kunmap(page_in_rbio(rbio, stripe, pagenr, 0));
1281 }
1282
1283 /*
1284 * time to start writing. Make bios for everything from the
1285 * higher layers (the bio_list in our rbio) and our p/q. Ignore
1286 * everything else.
1287 */
1288 for (stripe = 0; stripe < rbio->real_stripes; stripe++) {
1289 for (pagenr = 0; pagenr < rbio->stripe_npages; pagenr++) {
1290 struct page *page;
1291 if (stripe < rbio->nr_data) {
1292 page = page_in_rbio(rbio, stripe, pagenr, 1);
1293 if (!page)
1294 continue;
1295 } else {
1296 page = rbio_stripe_page(rbio, stripe, pagenr);
1297 }
1298
1299 ret = rbio_add_io_page(rbio, &bio_list,
1300 page, stripe, pagenr, rbio->stripe_len);
1301 if (ret)
1302 goto cleanup;
1303 }
1304 }
1305
1306 if (likely(!bbio->num_tgtdevs))
1307 goto write_data;
1308
1309 for (stripe = 0; stripe < rbio->real_stripes; stripe++) {
1310 if (!bbio->tgtdev_map[stripe])
1311 continue;
1312
1313 for (pagenr = 0; pagenr < rbio->stripe_npages; pagenr++) {
1314 struct page *page;
1315 if (stripe < rbio->nr_data) {
1316 page = page_in_rbio(rbio, stripe, pagenr, 1);
1317 if (!page)
1318 continue;
1319 } else {
1320 page = rbio_stripe_page(rbio, stripe, pagenr);
1321 }
1322
1323 ret = rbio_add_io_page(rbio, &bio_list, page,
1324 rbio->bbio->tgtdev_map[stripe],
1325 pagenr, rbio->stripe_len);
1326 if (ret)
1327 goto cleanup;
1328 }
1329 }
1330
1331write_data:
1332 atomic_set(&rbio->stripes_pending, bio_list_size(&bio_list));
1333 BUG_ON(atomic_read(&rbio->stripes_pending) == 0);
1334
1335 while (1) {
1336 bio = bio_list_pop(&bio_list);
1337 if (!bio)
1338 break;
1339
1340 bio->bi_private = rbio;
1341 bio->bi_end_io = raid_write_end_io;
1342 bio->bi_opf = REQ_OP_WRITE;
1343
1344 submit_bio(bio);
1345 }
1346 return;
1347
1348cleanup:
1349 rbio_orig_end_io(rbio, BLK_STS_IOERR);
1350
1351 while ((bio = bio_list_pop(&bio_list)))
1352 bio_put(bio);
1353}
1354
1355/*
1356 * helper to find the stripe number for a given bio. Used to figure out which
1357 * stripe has failed. This expects the bio to correspond to a physical disk,
1358 * so it looks up based on physical sector numbers.
1359 */
1360static int find_bio_stripe(struct btrfs_raid_bio *rbio,
1361 struct bio *bio)
1362{
1363 u64 physical = bio->bi_iter.bi_sector;
1364 u64 stripe_start;
1365 int i;
1366 struct btrfs_bio_stripe *stripe;
1367
1368 physical <<= 9;
1369
1370 for (i = 0; i < rbio->bbio->num_stripes; i++) {
1371 stripe = &rbio->bbio->stripes[i];
1372 stripe_start = stripe->physical;
1373 if (physical >= stripe_start &&
1374 physical < stripe_start + rbio->stripe_len &&
1375 stripe->dev->bdev &&
1376 bio->bi_disk == stripe->dev->bdev->bd_disk &&
1377 bio->bi_partno == stripe->dev->bdev->bd_partno) {
1378 return i;
1379 }
1380 }
1381 return -1;
1382}
1383
1384/*
1385 * helper to find the stripe number for a given
1386 * bio (before mapping). Used to figure out which stripe has
1387 * failed. This looks up based on logical block numbers.
1388 */
1389static int find_logical_bio_stripe(struct btrfs_raid_bio *rbio,
1390 struct bio *bio)
1391{
1392 u64 logical = bio->bi_iter.bi_sector;
1393 u64 stripe_start;
1394 int i;
1395
1396 logical <<= 9;
1397
1398 for (i = 0; i < rbio->nr_data; i++) {
1399 stripe_start = rbio->bbio->raid_map[i];
1400 if (logical >= stripe_start &&
1401 logical < stripe_start + rbio->stripe_len) {
1402 return i;
1403 }
1404 }
1405 return -1;
1406}
1407
1408/*
1409 * returns -EIO if we had too many failures
1410 */
1411static int fail_rbio_index(struct btrfs_raid_bio *rbio, int failed)
1412{
1413 unsigned long flags;
1414 int ret = 0;
1415
1416 spin_lock_irqsave(&rbio->bio_list_lock, flags);
1417
1418 /* we already know this stripe is bad, move on */
1419 if (rbio->faila == failed || rbio->failb == failed)
1420 goto out;
1421
1422 if (rbio->faila == -1) {
1423 /* first failure on this rbio */
1424 rbio->faila = failed;
1425 atomic_inc(&rbio->error);
1426 } else if (rbio->failb == -1) {
1427 /* second failure on this rbio */
1428 rbio->failb = failed;
1429 atomic_inc(&rbio->error);
1430 } else {
1431 ret = -EIO;
1432 }
1433out:
1434 spin_unlock_irqrestore(&rbio->bio_list_lock, flags);
1435
1436 return ret;
1437}
1438
1439/*
1440 * helper to fail a stripe based on a physical disk
1441 * bio.
1442 */
1443static int fail_bio_stripe(struct btrfs_raid_bio *rbio,
1444 struct bio *bio)
1445{
1446 int failed = find_bio_stripe(rbio, bio);
1447
1448 if (failed < 0)
1449 return -EIO;
1450
1451 return fail_rbio_index(rbio, failed);
1452}
1453
1454/*
1455 * this sets each page in the bio uptodate. It should only be used on private
1456 * rbio pages, nothing that comes in from the higher layers
1457 */
1458static void set_bio_pages_uptodate(struct bio *bio)
1459{
1460 struct bio_vec *bvec;
1461 struct bvec_iter_all iter_all;
1462
1463 ASSERT(!bio_flagged(bio, BIO_CLONED));
1464
1465 bio_for_each_segment_all(bvec, bio, iter_all)
1466 SetPageUptodate(bvec->bv_page);
1467}
1468
1469/*
1470 * end io for the read phase of the rmw cycle. All the bios here are physical
1471 * stripe bios we've read from the disk so we can recalculate the parity of the
1472 * stripe.
1473 *
1474 * This will usually kick off finish_rmw once all the bios are read in, but it
1475 * may trigger parity reconstruction if we had any errors along the way
1476 */
1477static void raid_rmw_end_io(struct bio *bio)
1478{
1479 struct btrfs_raid_bio *rbio = bio->bi_private;
1480
1481 if (bio->bi_status)
1482 fail_bio_stripe(rbio, bio);
1483 else
1484 set_bio_pages_uptodate(bio);
1485
1486 bio_put(bio);
1487
1488 if (!atomic_dec_and_test(&rbio->stripes_pending))
1489 return;
1490
1491 if (atomic_read(&rbio->error) > rbio->bbio->max_errors)
1492 goto cleanup;
1493
1494 /*
1495 * this will normally call finish_rmw to start our write
1496 * but if there are any failed stripes we'll reconstruct
1497 * from parity first
1498 */
1499 validate_rbio_for_rmw(rbio);
1500 return;
1501
1502cleanup:
1503
1504 rbio_orig_end_io(rbio, BLK_STS_IOERR);
1505}
1506
1507/*
1508 * the stripe must be locked by the caller. It will
1509 * unlock after all the writes are done
1510 */
1511static int raid56_rmw_stripe(struct btrfs_raid_bio *rbio)
1512{
1513 int bios_to_read = 0;
1514 struct bio_list bio_list;
1515 int ret;
1516 int pagenr;
1517 int stripe;
1518 struct bio *bio;
1519
1520 bio_list_init(&bio_list);
1521
1522 ret = alloc_rbio_pages(rbio);
1523 if (ret)
1524 goto cleanup;
1525
1526 index_rbio_pages(rbio);
1527
1528 atomic_set(&rbio->error, 0);
1529 /*
1530 * build a list of bios to read all the missing parts of this
1531 * stripe
1532 */
1533 for (stripe = 0; stripe < rbio->nr_data; stripe++) {
1534 for (pagenr = 0; pagenr < rbio->stripe_npages; pagenr++) {
1535 struct page *page;
1536 /*
1537 * we want to find all the pages missing from
1538 * the rbio and read them from the disk. If
1539 * page_in_rbio finds a page in the bio list
1540 * we don't need to read it off the stripe.
1541 */
1542 page = page_in_rbio(rbio, stripe, pagenr, 1);
1543 if (page)
1544 continue;
1545
1546 page = rbio_stripe_page(rbio, stripe, pagenr);
1547 /*
1548 * the bio cache may have handed us an uptodate
1549 * page. If so, be happy and use it
1550 */
1551 if (PageUptodate(page))
1552 continue;
1553
1554 ret = rbio_add_io_page(rbio, &bio_list, page,
1555 stripe, pagenr, rbio->stripe_len);
1556 if (ret)
1557 goto cleanup;
1558 }
1559 }
1560
1561 bios_to_read = bio_list_size(&bio_list);
1562 if (!bios_to_read) {
1563 /*
1564 * this can happen if others have merged with
1565 * us, it means there is nothing left to read.
1566 * But if there are missing devices it may not be
1567 * safe to do the full stripe write yet.
1568 */
1569 goto finish;
1570 }
1571
1572 /*
1573 * the bbio may be freed once we submit the last bio. Make sure
1574 * not to touch it after that
1575 */
1576 atomic_set(&rbio->stripes_pending, bios_to_read);
1577 while (1) {
1578 bio = bio_list_pop(&bio_list);
1579 if (!bio)
1580 break;
1581
1582 bio->bi_private = rbio;
1583 bio->bi_end_io = raid_rmw_end_io;
1584 bio->bi_opf = REQ_OP_READ;
1585
1586 btrfs_bio_wq_end_io(rbio->fs_info, bio, BTRFS_WQ_ENDIO_RAID56);
1587
1588 submit_bio(bio);
1589 }
1590 /* the actual write will happen once the reads are done */
1591 return 0;
1592
1593cleanup:
1594 rbio_orig_end_io(rbio, BLK_STS_IOERR);
1595
1596 while ((bio = bio_list_pop(&bio_list)))
1597 bio_put(bio);
1598
1599 return -EIO;
1600
1601finish:
1602 validate_rbio_for_rmw(rbio);
1603 return 0;
1604}
1605
1606/*
1607 * if the upper layers pass in a full stripe, we thank them by only allocating
1608 * enough pages to hold the parity, and sending it all down quickly.
1609 */
1610static int full_stripe_write(struct btrfs_raid_bio *rbio)
1611{
1612 int ret;
1613
1614 ret = alloc_rbio_parity_pages(rbio);
1615 if (ret) {
1616 __free_raid_bio(rbio);
1617 return ret;
1618 }
1619
1620 ret = lock_stripe_add(rbio);
1621 if (ret == 0)
1622 finish_rmw(rbio);
1623 return 0;
1624}
1625
1626/*
1627 * partial stripe writes get handed over to async helpers.
1628 * We're really hoping to merge a few more writes into this
1629 * rbio before calculating new parity
1630 */
1631static int partial_stripe_write(struct btrfs_raid_bio *rbio)
1632{
1633 int ret;
1634
1635 ret = lock_stripe_add(rbio);
1636 if (ret == 0)
1637 start_async_work(rbio, rmw_work);
1638 return 0;
1639}
1640
1641/*
1642 * sometimes while we were reading from the drive to
1643 * recalculate parity, enough new bios come into create
1644 * a full stripe. So we do a check here to see if we can
1645 * go directly to finish_rmw
1646 */
1647static int __raid56_parity_write(struct btrfs_raid_bio *rbio)
1648{
1649 /* head off into rmw land if we don't have a full stripe */
1650 if (!rbio_is_full(rbio))
1651 return partial_stripe_write(rbio);
1652 return full_stripe_write(rbio);
1653}
1654
1655/*
1656 * We use plugging call backs to collect full stripes.
1657 * Any time we get a partial stripe write while plugged
1658 * we collect it into a list. When the unplug comes down,
1659 * we sort the list by logical block number and merge
1660 * everything we can into the same rbios
1661 */
1662struct btrfs_plug_cb {
1663 struct blk_plug_cb cb;
1664 struct btrfs_fs_info *info;
1665 struct list_head rbio_list;
1666 struct btrfs_work work;
1667};
1668
1669/*
1670 * rbios on the plug list are sorted for easier merging.
1671 */
1672static int plug_cmp(void *priv, struct list_head *a, struct list_head *b)
1673{
1674 struct btrfs_raid_bio *ra = container_of(a, struct btrfs_raid_bio,
1675 plug_list);
1676 struct btrfs_raid_bio *rb = container_of(b, struct btrfs_raid_bio,
1677 plug_list);
1678 u64 a_sector = ra->bio_list.head->bi_iter.bi_sector;
1679 u64 b_sector = rb->bio_list.head->bi_iter.bi_sector;
1680
1681 if (a_sector < b_sector)
1682 return -1;
1683 if (a_sector > b_sector)
1684 return 1;
1685 return 0;
1686}
1687
1688static void run_plug(struct btrfs_plug_cb *plug)
1689{
1690 struct btrfs_raid_bio *cur;
1691 struct btrfs_raid_bio *last = NULL;
1692
1693 /*
1694 * sort our plug list then try to merge
1695 * everything we can in hopes of creating full
1696 * stripes.
1697 */
1698 list_sort(NULL, &plug->rbio_list, plug_cmp);
1699 while (!list_empty(&plug->rbio_list)) {
1700 cur = list_entry(plug->rbio_list.next,
1701 struct btrfs_raid_bio, plug_list);
1702 list_del_init(&cur->plug_list);
1703
1704 if (rbio_is_full(cur)) {
1705 int ret;
1706
1707 /* we have a full stripe, send it down */
1708 ret = full_stripe_write(cur);
1709 BUG_ON(ret);
1710 continue;
1711 }
1712 if (last) {
1713 if (rbio_can_merge(last, cur)) {
1714 merge_rbio(last, cur);
1715 __free_raid_bio(cur);
1716 continue;
1717
1718 }
1719 __raid56_parity_write(last);
1720 }
1721 last = cur;
1722 }
1723 if (last) {
1724 __raid56_parity_write(last);
1725 }
1726 kfree(plug);
1727}
1728
1729/*
1730 * if the unplug comes from schedule, we have to push the
1731 * work off to a helper thread
1732 */
1733static void unplug_work(struct btrfs_work *work)
1734{
1735 struct btrfs_plug_cb *plug;
1736 plug = container_of(work, struct btrfs_plug_cb, work);
1737 run_plug(plug);
1738}
1739
1740static void btrfs_raid_unplug(struct blk_plug_cb *cb, bool from_schedule)
1741{
1742 struct btrfs_plug_cb *plug;
1743 plug = container_of(cb, struct btrfs_plug_cb, cb);
1744
1745 if (from_schedule) {
1746 btrfs_init_work(&plug->work, btrfs_rmw_helper,
1747 unplug_work, NULL, NULL);
1748 btrfs_queue_work(plug->info->rmw_workers,
1749 &plug->work);
1750 return;
1751 }
1752 run_plug(plug);
1753}
1754
1755/*
1756 * our main entry point for writes from the rest of the FS.
1757 */
1758int raid56_parity_write(struct btrfs_fs_info *fs_info, struct bio *bio,
1759 struct btrfs_bio *bbio, u64 stripe_len)
1760{
1761 struct btrfs_raid_bio *rbio;
1762 struct btrfs_plug_cb *plug = NULL;
1763 struct blk_plug_cb *cb;
1764 int ret;
1765
1766 rbio = alloc_rbio(fs_info, bbio, stripe_len);
1767 if (IS_ERR(rbio)) {
1768 btrfs_put_bbio(bbio);
1769 return PTR_ERR(rbio);
1770 }
1771 bio_list_add(&rbio->bio_list, bio);
1772 rbio->bio_list_bytes = bio->bi_iter.bi_size;
1773 rbio->operation = BTRFS_RBIO_WRITE;
1774
1775 btrfs_bio_counter_inc_noblocked(fs_info);
1776 rbio->generic_bio_cnt = 1;
1777
1778 /*
1779 * don't plug on full rbios, just get them out the door
1780 * as quickly as we can
1781 */
1782 if (rbio_is_full(rbio)) {
1783 ret = full_stripe_write(rbio);
1784 if (ret)
1785 btrfs_bio_counter_dec(fs_info);
1786 return ret;
1787 }
1788
1789 cb = blk_check_plugged(btrfs_raid_unplug, fs_info, sizeof(*plug));
1790 if (cb) {
1791 plug = container_of(cb, struct btrfs_plug_cb, cb);
1792 if (!plug->info) {
1793 plug->info = fs_info;
1794 INIT_LIST_HEAD(&plug->rbio_list);
1795 }
1796 list_add_tail(&rbio->plug_list, &plug->rbio_list);
1797 ret = 0;
1798 } else {
1799 ret = __raid56_parity_write(rbio);
1800 if (ret)
1801 btrfs_bio_counter_dec(fs_info);
1802 }
1803 return ret;
1804}
1805
1806/*
1807 * all parity reconstruction happens here. We've read in everything
1808 * we can find from the drives and this does the heavy lifting of
1809 * sorting the good from the bad.
1810 */
1811static void __raid_recover_end_io(struct btrfs_raid_bio *rbio)
1812{
1813 int pagenr, stripe;
1814 void **pointers;
1815 int faila = -1, failb = -1;
1816 struct page *page;
1817 blk_status_t err;
1818 int i;
1819
1820 pointers = kcalloc(rbio->real_stripes, sizeof(void *), GFP_NOFS);
1821 if (!pointers) {
1822 err = BLK_STS_RESOURCE;
1823 goto cleanup_io;
1824 }
1825
1826 faila = rbio->faila;
1827 failb = rbio->failb;
1828
1829 if (rbio->operation == BTRFS_RBIO_READ_REBUILD ||
1830 rbio->operation == BTRFS_RBIO_REBUILD_MISSING) {
1831 spin_lock_irq(&rbio->bio_list_lock);
1832 set_bit(RBIO_RMW_LOCKED_BIT, &rbio->flags);
1833 spin_unlock_irq(&rbio->bio_list_lock);
1834 }
1835
1836 index_rbio_pages(rbio);
1837
1838 for (pagenr = 0; pagenr < rbio->stripe_npages; pagenr++) {
1839 /*
1840 * Now we just use bitmap to mark the horizontal stripes in
1841 * which we have data when doing parity scrub.
1842 */
1843 if (rbio->operation == BTRFS_RBIO_PARITY_SCRUB &&
1844 !test_bit(pagenr, rbio->dbitmap))
1845 continue;
1846
1847 /* setup our array of pointers with pages
1848 * from each stripe
1849 */
1850 for (stripe = 0; stripe < rbio->real_stripes; stripe++) {
1851 /*
1852 * if we're rebuilding a read, we have to use
1853 * pages from the bio list
1854 */
1855 if ((rbio->operation == BTRFS_RBIO_READ_REBUILD ||
1856 rbio->operation == BTRFS_RBIO_REBUILD_MISSING) &&
1857 (stripe == faila || stripe == failb)) {
1858 page = page_in_rbio(rbio, stripe, pagenr, 0);
1859 } else {
1860 page = rbio_stripe_page(rbio, stripe, pagenr);
1861 }
1862 pointers[stripe] = kmap(page);
1863 }
1864
1865 /* all raid6 handling here */
1866 if (rbio->bbio->map_type & BTRFS_BLOCK_GROUP_RAID6) {
1867 /*
1868 * single failure, rebuild from parity raid5
1869 * style
1870 */
1871 if (failb < 0) {
1872 if (faila == rbio->nr_data) {
1873 /*
1874 * Just the P stripe has failed, without
1875 * a bad data or Q stripe.
1876 * TODO, we should redo the xor here.
1877 */
1878 err = BLK_STS_IOERR;
1879 goto cleanup;
1880 }
1881 /*
1882 * a single failure in raid6 is rebuilt
1883 * in the pstripe code below
1884 */
1885 goto pstripe;
1886 }
1887
1888 /* make sure our ps and qs are in order */
1889 if (faila > failb) {
1890 int tmp = failb;
1891 failb = faila;
1892 faila = tmp;
1893 }
1894
1895 /* if the q stripe is failed, do a pstripe reconstruction
1896 * from the xors.
1897 * If both the q stripe and the P stripe are failed, we're
1898 * here due to a crc mismatch and we can't give them the
1899 * data they want
1900 */
1901 if (rbio->bbio->raid_map[failb] == RAID6_Q_STRIPE) {
1902 if (rbio->bbio->raid_map[faila] ==
1903 RAID5_P_STRIPE) {
1904 err = BLK_STS_IOERR;
1905 goto cleanup;
1906 }
1907 /*
1908 * otherwise we have one bad data stripe and
1909 * a good P stripe. raid5!
1910 */
1911 goto pstripe;
1912 }
1913
1914 if (rbio->bbio->raid_map[failb] == RAID5_P_STRIPE) {
1915 raid6_datap_recov(rbio->real_stripes,
1916 PAGE_SIZE, faila, pointers);
1917 } else {
1918 raid6_2data_recov(rbio->real_stripes,
1919 PAGE_SIZE, faila, failb,
1920 pointers);
1921 }
1922 } else {
1923 void *p;
1924
1925 /* rebuild from P stripe here (raid5 or raid6) */
1926 BUG_ON(failb != -1);
1927pstripe:
1928 /* Copy parity block into failed block to start with */
1929 copy_page(pointers[faila], pointers[rbio->nr_data]);
1930
1931 /* rearrange the pointer array */
1932 p = pointers[faila];
1933 for (stripe = faila; stripe < rbio->nr_data - 1; stripe++)
1934 pointers[stripe] = pointers[stripe + 1];
1935 pointers[rbio->nr_data - 1] = p;
1936
1937 /* xor in the rest */
1938 run_xor(pointers, rbio->nr_data - 1, PAGE_SIZE);
1939 }
1940 /* if we're doing this rebuild as part of an rmw, go through
1941 * and set all of our private rbio pages in the
1942 * failed stripes as uptodate. This way finish_rmw will
1943 * know they can be trusted. If this was a read reconstruction,
1944 * other endio functions will fiddle the uptodate bits
1945 */
1946 if (rbio->operation == BTRFS_RBIO_WRITE) {
1947 for (i = 0; i < rbio->stripe_npages; i++) {
1948 if (faila != -1) {
1949 page = rbio_stripe_page(rbio, faila, i);
1950 SetPageUptodate(page);
1951 }
1952 if (failb != -1) {
1953 page = rbio_stripe_page(rbio, failb, i);
1954 SetPageUptodate(page);
1955 }
1956 }
1957 }
1958 for (stripe = 0; stripe < rbio->real_stripes; stripe++) {
1959 /*
1960 * if we're rebuilding a read, we have to use
1961 * pages from the bio list
1962 */
1963 if ((rbio->operation == BTRFS_RBIO_READ_REBUILD ||
1964 rbio->operation == BTRFS_RBIO_REBUILD_MISSING) &&
1965 (stripe == faila || stripe == failb)) {
1966 page = page_in_rbio(rbio, stripe, pagenr, 0);
1967 } else {
1968 page = rbio_stripe_page(rbio, stripe, pagenr);
1969 }
1970 kunmap(page);
1971 }
1972 }
1973
1974 err = BLK_STS_OK;
1975cleanup:
1976 kfree(pointers);
1977
1978cleanup_io:
1979 /*
1980 * Similar to READ_REBUILD, REBUILD_MISSING at this point also has a
1981 * valid rbio which is consistent with ondisk content, thus such a
1982 * valid rbio can be cached to avoid further disk reads.
1983 */
1984 if (rbio->operation == BTRFS_RBIO_READ_REBUILD ||
1985 rbio->operation == BTRFS_RBIO_REBUILD_MISSING) {
1986 /*
1987 * - In case of two failures, where rbio->failb != -1:
1988 *
1989 * Do not cache this rbio since the above read reconstruction
1990 * (raid6_datap_recov() or raid6_2data_recov()) may have
1991 * changed some content of stripes which are not identical to
1992 * on-disk content any more, otherwise, a later write/recover
1993 * may steal stripe_pages from this rbio and end up with
1994 * corruptions or rebuild failures.
1995 *
1996 * - In case of single failure, where rbio->failb == -1:
1997 *
1998 * Cache this rbio iff the above read reconstruction is
1999 * executed without problems.
2000 */
2001 if (err == BLK_STS_OK && rbio->failb < 0)
2002 cache_rbio_pages(rbio);
2003 else
2004 clear_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
2005
2006 rbio_orig_end_io(rbio, err);
2007 } else if (err == BLK_STS_OK) {
2008 rbio->faila = -1;
2009 rbio->failb = -1;
2010
2011 if (rbio->operation == BTRFS_RBIO_WRITE)
2012 finish_rmw(rbio);
2013 else if (rbio->operation == BTRFS_RBIO_PARITY_SCRUB)
2014 finish_parity_scrub(rbio, 0);
2015 else
2016 BUG();
2017 } else {
2018 rbio_orig_end_io(rbio, err);
2019 }
2020}
2021
2022/*
2023 * This is called only for stripes we've read from disk to
2024 * reconstruct the parity.
2025 */
2026static void raid_recover_end_io(struct bio *bio)
2027{
2028 struct btrfs_raid_bio *rbio = bio->bi_private;
2029
2030 /*
2031 * we only read stripe pages off the disk, set them
2032 * up to date if there were no errors
2033 */
2034 if (bio->bi_status)
2035 fail_bio_stripe(rbio, bio);
2036 else
2037 set_bio_pages_uptodate(bio);
2038 bio_put(bio);
2039
2040 if (!atomic_dec_and_test(&rbio->stripes_pending))
2041 return;
2042
2043 if (atomic_read(&rbio->error) > rbio->bbio->max_errors)
2044 rbio_orig_end_io(rbio, BLK_STS_IOERR);
2045 else
2046 __raid_recover_end_io(rbio);
2047}
2048
2049/*
2050 * reads everything we need off the disk to reconstruct
2051 * the parity. endio handlers trigger final reconstruction
2052 * when the IO is done.
2053 *
2054 * This is used both for reads from the higher layers and for
2055 * parity construction required to finish a rmw cycle.
2056 */
2057static int __raid56_parity_recover(struct btrfs_raid_bio *rbio)
2058{
2059 int bios_to_read = 0;
2060 struct bio_list bio_list;
2061 int ret;
2062 int pagenr;
2063 int stripe;
2064 struct bio *bio;
2065
2066 bio_list_init(&bio_list);
2067
2068 ret = alloc_rbio_pages(rbio);
2069 if (ret)
2070 goto cleanup;
2071
2072 atomic_set(&rbio->error, 0);
2073
2074 /*
2075 * read everything that hasn't failed. Thanks to the
2076 * stripe cache, it is possible that some or all of these
2077 * pages are going to be uptodate.
2078 */
2079 for (stripe = 0; stripe < rbio->real_stripes; stripe++) {
2080 if (rbio->faila == stripe || rbio->failb == stripe) {
2081 atomic_inc(&rbio->error);
2082 continue;
2083 }
2084
2085 for (pagenr = 0; pagenr < rbio->stripe_npages; pagenr++) {
2086 struct page *p;
2087
2088 /*
2089 * the rmw code may have already read this
2090 * page in
2091 */
2092 p = rbio_stripe_page(rbio, stripe, pagenr);
2093 if (PageUptodate(p))
2094 continue;
2095
2096 ret = rbio_add_io_page(rbio, &bio_list,
2097 rbio_stripe_page(rbio, stripe, pagenr),
2098 stripe, pagenr, rbio->stripe_len);
2099 if (ret < 0)
2100 goto cleanup;
2101 }
2102 }
2103
2104 bios_to_read = bio_list_size(&bio_list);
2105 if (!bios_to_read) {
2106 /*
2107 * we might have no bios to read just because the pages
2108 * were up to date, or we might have no bios to read because
2109 * the devices were gone.
2110 */
2111 if (atomic_read(&rbio->error) <= rbio->bbio->max_errors) {
2112 __raid_recover_end_io(rbio);
2113 goto out;
2114 } else {
2115 goto cleanup;
2116 }
2117 }
2118
2119 /*
2120 * the bbio may be freed once we submit the last bio. Make sure
2121 * not to touch it after that
2122 */
2123 atomic_set(&rbio->stripes_pending, bios_to_read);
2124 while (1) {
2125 bio = bio_list_pop(&bio_list);
2126 if (!bio)
2127 break;
2128
2129 bio->bi_private = rbio;
2130 bio->bi_end_io = raid_recover_end_io;
2131 bio->bi_opf = REQ_OP_READ;
2132
2133 btrfs_bio_wq_end_io(rbio->fs_info, bio, BTRFS_WQ_ENDIO_RAID56);
2134
2135 submit_bio(bio);
2136 }
2137out:
2138 return 0;
2139
2140cleanup:
2141 if (rbio->operation == BTRFS_RBIO_READ_REBUILD ||
2142 rbio->operation == BTRFS_RBIO_REBUILD_MISSING)
2143 rbio_orig_end_io(rbio, BLK_STS_IOERR);
2144
2145 while ((bio = bio_list_pop(&bio_list)))
2146 bio_put(bio);
2147
2148 return -EIO;
2149}
2150
2151/*
2152 * the main entry point for reads from the higher layers. This
2153 * is really only called when the normal read path had a failure,
2154 * so we assume the bio they send down corresponds to a failed part
2155 * of the drive.
2156 */
2157int raid56_parity_recover(struct btrfs_fs_info *fs_info, struct bio *bio,
2158 struct btrfs_bio *bbio, u64 stripe_len,
2159 int mirror_num, int generic_io)
2160{
2161 struct btrfs_raid_bio *rbio;
2162 int ret;
2163
2164 if (generic_io) {
2165 ASSERT(bbio->mirror_num == mirror_num);
2166 btrfs_io_bio(bio)->mirror_num = mirror_num;
2167 }
2168
2169 rbio = alloc_rbio(fs_info, bbio, stripe_len);
2170 if (IS_ERR(rbio)) {
2171 if (generic_io)
2172 btrfs_put_bbio(bbio);
2173 return PTR_ERR(rbio);
2174 }
2175
2176 rbio->operation = BTRFS_RBIO_READ_REBUILD;
2177 bio_list_add(&rbio->bio_list, bio);
2178 rbio->bio_list_bytes = bio->bi_iter.bi_size;
2179
2180 rbio->faila = find_logical_bio_stripe(rbio, bio);
2181 if (rbio->faila == -1) {
2182 btrfs_warn(fs_info,
2183 "%s could not find the bad stripe in raid56 so that we cannot recover any more (bio has logical %llu len %llu, bbio has map_type %llu)",
2184 __func__, (u64)bio->bi_iter.bi_sector << 9,
2185 (u64)bio->bi_iter.bi_size, bbio->map_type);
2186 if (generic_io)
2187 btrfs_put_bbio(bbio);
2188 kfree(rbio);
2189 return -EIO;
2190 }
2191
2192 if (generic_io) {
2193 btrfs_bio_counter_inc_noblocked(fs_info);
2194 rbio->generic_bio_cnt = 1;
2195 } else {
2196 btrfs_get_bbio(bbio);
2197 }
2198
2199 /*
2200 * Loop retry:
2201 * for 'mirror == 2', reconstruct from all other stripes.
2202 * for 'mirror_num > 2', select a stripe to fail on every retry.
2203 */
2204 if (mirror_num > 2) {
2205 /*
2206 * 'mirror == 3' is to fail the p stripe and
2207 * reconstruct from the q stripe. 'mirror > 3' is to
2208 * fail a data stripe and reconstruct from p+q stripe.
2209 */
2210 rbio->failb = rbio->real_stripes - (mirror_num - 1);
2211 ASSERT(rbio->failb > 0);
2212 if (rbio->failb <= rbio->faila)
2213 rbio->failb--;
2214 }
2215
2216 ret = lock_stripe_add(rbio);
2217
2218 /*
2219 * __raid56_parity_recover will end the bio with
2220 * any errors it hits. We don't want to return
2221 * its error value up the stack because our caller
2222 * will end up calling bio_endio with any nonzero
2223 * return
2224 */
2225 if (ret == 0)
2226 __raid56_parity_recover(rbio);
2227 /*
2228 * our rbio has been added to the list of
2229 * rbios that will be handled after the
2230 * currently lock owner is done
2231 */
2232 return 0;
2233
2234}
2235
2236static void rmw_work(struct btrfs_work *work)
2237{
2238 struct btrfs_raid_bio *rbio;
2239
2240 rbio = container_of(work, struct btrfs_raid_bio, work);
2241 raid56_rmw_stripe(rbio);
2242}
2243
2244static void read_rebuild_work(struct btrfs_work *work)
2245{
2246 struct btrfs_raid_bio *rbio;
2247
2248 rbio = container_of(work, struct btrfs_raid_bio, work);
2249 __raid56_parity_recover(rbio);
2250}
2251
2252/*
2253 * The following code is used to scrub/replace the parity stripe
2254 *
2255 * Caller must have already increased bio_counter for getting @bbio.
2256 *
2257 * Note: We need make sure all the pages that add into the scrub/replace
2258 * raid bio are correct and not be changed during the scrub/replace. That
2259 * is those pages just hold metadata or file data with checksum.
2260 */
2261
2262struct btrfs_raid_bio *
2263raid56_parity_alloc_scrub_rbio(struct btrfs_fs_info *fs_info, struct bio *bio,
2264 struct btrfs_bio *bbio, u64 stripe_len,
2265 struct btrfs_device *scrub_dev,
2266 unsigned long *dbitmap, int stripe_nsectors)
2267{
2268 struct btrfs_raid_bio *rbio;
2269 int i;
2270
2271 rbio = alloc_rbio(fs_info, bbio, stripe_len);
2272 if (IS_ERR(rbio))
2273 return NULL;
2274 bio_list_add(&rbio->bio_list, bio);
2275 /*
2276 * This is a special bio which is used to hold the completion handler
2277 * and make the scrub rbio is similar to the other types
2278 */
2279 ASSERT(!bio->bi_iter.bi_size);
2280 rbio->operation = BTRFS_RBIO_PARITY_SCRUB;
2281
2282 /*
2283 * After mapping bbio with BTRFS_MAP_WRITE, parities have been sorted
2284 * to the end position, so this search can start from the first parity
2285 * stripe.
2286 */
2287 for (i = rbio->nr_data; i < rbio->real_stripes; i++) {
2288 if (bbio->stripes[i].dev == scrub_dev) {
2289 rbio->scrubp = i;
2290 break;
2291 }
2292 }
2293 ASSERT(i < rbio->real_stripes);
2294
2295 /* Now we just support the sectorsize equals to page size */
2296 ASSERT(fs_info->sectorsize == PAGE_SIZE);
2297 ASSERT(rbio->stripe_npages == stripe_nsectors);
2298 bitmap_copy(rbio->dbitmap, dbitmap, stripe_nsectors);
2299
2300 /*
2301 * We have already increased bio_counter when getting bbio, record it
2302 * so we can free it at rbio_orig_end_io().
2303 */
2304 rbio->generic_bio_cnt = 1;
2305
2306 return rbio;
2307}
2308
2309/* Used for both parity scrub and missing. */
2310void raid56_add_scrub_pages(struct btrfs_raid_bio *rbio, struct page *page,
2311 u64 logical)
2312{
2313 int stripe_offset;
2314 int index;
2315
2316 ASSERT(logical >= rbio->bbio->raid_map[0]);
2317 ASSERT(logical + PAGE_SIZE <= rbio->bbio->raid_map[0] +
2318 rbio->stripe_len * rbio->nr_data);
2319 stripe_offset = (int)(logical - rbio->bbio->raid_map[0]);
2320 index = stripe_offset >> PAGE_SHIFT;
2321 rbio->bio_pages[index] = page;
2322}
2323
2324/*
2325 * We just scrub the parity that we have correct data on the same horizontal,
2326 * so we needn't allocate all pages for all the stripes.
2327 */
2328static int alloc_rbio_essential_pages(struct btrfs_raid_bio *rbio)
2329{
2330 int i;
2331 int bit;
2332 int index;
2333 struct page *page;
2334
2335 for_each_set_bit(bit, rbio->dbitmap, rbio->stripe_npages) {
2336 for (i = 0; i < rbio->real_stripes; i++) {
2337 index = i * rbio->stripe_npages + bit;
2338 if (rbio->stripe_pages[index])
2339 continue;
2340
2341 page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
2342 if (!page)
2343 return -ENOMEM;
2344 rbio->stripe_pages[index] = page;
2345 }
2346 }
2347 return 0;
2348}
2349
2350static noinline void finish_parity_scrub(struct btrfs_raid_bio *rbio,
2351 int need_check)
2352{
2353 struct btrfs_bio *bbio = rbio->bbio;
2354 void **pointers = rbio->finish_pointers;
2355 unsigned long *pbitmap = rbio->finish_pbitmap;
2356 int nr_data = rbio->nr_data;
2357 int stripe;
2358 int pagenr;
2359 int p_stripe = -1;
2360 int q_stripe = -1;
2361 struct page *p_page = NULL;
2362 struct page *q_page = NULL;
2363 struct bio_list bio_list;
2364 struct bio *bio;
2365 int is_replace = 0;
2366 int ret;
2367
2368 bio_list_init(&bio_list);
2369
2370 if (rbio->real_stripes - rbio->nr_data == 1) {
2371 p_stripe = rbio->real_stripes - 1;
2372 } else if (rbio->real_stripes - rbio->nr_data == 2) {
2373 p_stripe = rbio->real_stripes - 2;
2374 q_stripe = rbio->real_stripes - 1;
2375 } else {
2376 BUG();
2377 }
2378
2379 if (bbio->num_tgtdevs && bbio->tgtdev_map[rbio->scrubp]) {
2380 is_replace = 1;
2381 bitmap_copy(pbitmap, rbio->dbitmap, rbio->stripe_npages);
2382 }
2383
2384 /*
2385 * Because the higher layers(scrubber) are unlikely to
2386 * use this area of the disk again soon, so don't cache
2387 * it.
2388 */
2389 clear_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
2390
2391 if (!need_check)
2392 goto writeback;
2393
2394 p_page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
2395 if (!p_page)
2396 goto cleanup;
2397 SetPageUptodate(p_page);
2398
2399 if (q_stripe != -1) {
2400 q_page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
2401 if (!q_page) {
2402 __free_page(p_page);
2403 goto cleanup;
2404 }
2405 SetPageUptodate(q_page);
2406 }
2407
2408 atomic_set(&rbio->error, 0);
2409
2410 for_each_set_bit(pagenr, rbio->dbitmap, rbio->stripe_npages) {
2411 struct page *p;
2412 void *parity;
2413 /* first collect one page from each data stripe */
2414 for (stripe = 0; stripe < nr_data; stripe++) {
2415 p = page_in_rbio(rbio, stripe, pagenr, 0);
2416 pointers[stripe] = kmap(p);
2417 }
2418
2419 /* then add the parity stripe */
2420 pointers[stripe++] = kmap(p_page);
2421
2422 if (q_stripe != -1) {
2423
2424 /*
2425 * raid6, add the qstripe and call the
2426 * library function to fill in our p/q
2427 */
2428 pointers[stripe++] = kmap(q_page);
2429
2430 raid6_call.gen_syndrome(rbio->real_stripes, PAGE_SIZE,
2431 pointers);
2432 } else {
2433 /* raid5 */
2434 copy_page(pointers[nr_data], pointers[0]);
2435 run_xor(pointers + 1, nr_data - 1, PAGE_SIZE);
2436 }
2437
2438 /* Check scrubbing parity and repair it */
2439 p = rbio_stripe_page(rbio, rbio->scrubp, pagenr);
2440 parity = kmap(p);
2441 if (memcmp(parity, pointers[rbio->scrubp], PAGE_SIZE))
2442 copy_page(parity, pointers[rbio->scrubp]);
2443 else
2444 /* Parity is right, needn't writeback */
2445 bitmap_clear(rbio->dbitmap, pagenr, 1);
2446 kunmap(p);
2447
2448 for (stripe = 0; stripe < nr_data; stripe++)
2449 kunmap(page_in_rbio(rbio, stripe, pagenr, 0));
2450 kunmap(p_page);
2451 }
2452
2453 __free_page(p_page);
2454 if (q_page)
2455 __free_page(q_page);
2456
2457writeback:
2458 /*
2459 * time to start writing. Make bios for everything from the
2460 * higher layers (the bio_list in our rbio) and our p/q. Ignore
2461 * everything else.
2462 */
2463 for_each_set_bit(pagenr, rbio->dbitmap, rbio->stripe_npages) {
2464 struct page *page;
2465
2466 page = rbio_stripe_page(rbio, rbio->scrubp, pagenr);
2467 ret = rbio_add_io_page(rbio, &bio_list,
2468 page, rbio->scrubp, pagenr, rbio->stripe_len);
2469 if (ret)
2470 goto cleanup;
2471 }
2472
2473 if (!is_replace)
2474 goto submit_write;
2475
2476 for_each_set_bit(pagenr, pbitmap, rbio->stripe_npages) {
2477 struct page *page;
2478
2479 page = rbio_stripe_page(rbio, rbio->scrubp, pagenr);
2480 ret = rbio_add_io_page(rbio, &bio_list, page,
2481 bbio->tgtdev_map[rbio->scrubp],
2482 pagenr, rbio->stripe_len);
2483 if (ret)
2484 goto cleanup;
2485 }
2486
2487submit_write:
2488 nr_data = bio_list_size(&bio_list);
2489 if (!nr_data) {
2490 /* Every parity is right */
2491 rbio_orig_end_io(rbio, BLK_STS_OK);
2492 return;
2493 }
2494
2495 atomic_set(&rbio->stripes_pending, nr_data);
2496
2497 while (1) {
2498 bio = bio_list_pop(&bio_list);
2499 if (!bio)
2500 break;
2501
2502 bio->bi_private = rbio;
2503 bio->bi_end_io = raid_write_end_io;
2504 bio->bi_opf = REQ_OP_WRITE;
2505
2506 submit_bio(bio);
2507 }
2508 return;
2509
2510cleanup:
2511 rbio_orig_end_io(rbio, BLK_STS_IOERR);
2512
2513 while ((bio = bio_list_pop(&bio_list)))
2514 bio_put(bio);
2515}
2516
2517static inline int is_data_stripe(struct btrfs_raid_bio *rbio, int stripe)
2518{
2519 if (stripe >= 0 && stripe < rbio->nr_data)
2520 return 1;
2521 return 0;
2522}
2523
2524/*
2525 * While we're doing the parity check and repair, we could have errors
2526 * in reading pages off the disk. This checks for errors and if we're
2527 * not able to read the page it'll trigger parity reconstruction. The
2528 * parity scrub will be finished after we've reconstructed the failed
2529 * stripes
2530 */
2531static void validate_rbio_for_parity_scrub(struct btrfs_raid_bio *rbio)
2532{
2533 if (atomic_read(&rbio->error) > rbio->bbio->max_errors)
2534 goto cleanup;
2535
2536 if (rbio->faila >= 0 || rbio->failb >= 0) {
2537 int dfail = 0, failp = -1;
2538
2539 if (is_data_stripe(rbio, rbio->faila))
2540 dfail++;
2541 else if (is_parity_stripe(rbio->faila))
2542 failp = rbio->faila;
2543
2544 if (is_data_stripe(rbio, rbio->failb))
2545 dfail++;
2546 else if (is_parity_stripe(rbio->failb))
2547 failp = rbio->failb;
2548
2549 /*
2550 * Because we can not use a scrubbing parity to repair
2551 * the data, so the capability of the repair is declined.
2552 * (In the case of RAID5, we can not repair anything)
2553 */
2554 if (dfail > rbio->bbio->max_errors - 1)
2555 goto cleanup;
2556
2557 /*
2558 * If all data is good, only parity is correctly, just
2559 * repair the parity.
2560 */
2561 if (dfail == 0) {
2562 finish_parity_scrub(rbio, 0);
2563 return;
2564 }
2565
2566 /*
2567 * Here means we got one corrupted data stripe and one
2568 * corrupted parity on RAID6, if the corrupted parity
2569 * is scrubbing parity, luckily, use the other one to repair
2570 * the data, or we can not repair the data stripe.
2571 */
2572 if (failp != rbio->scrubp)
2573 goto cleanup;
2574
2575 __raid_recover_end_io(rbio);
2576 } else {
2577 finish_parity_scrub(rbio, 1);
2578 }
2579 return;
2580
2581cleanup:
2582 rbio_orig_end_io(rbio, BLK_STS_IOERR);
2583}
2584
2585/*
2586 * end io for the read phase of the rmw cycle. All the bios here are physical
2587 * stripe bios we've read from the disk so we can recalculate the parity of the
2588 * stripe.
2589 *
2590 * This will usually kick off finish_rmw once all the bios are read in, but it
2591 * may trigger parity reconstruction if we had any errors along the way
2592 */
2593static void raid56_parity_scrub_end_io(struct bio *bio)
2594{
2595 struct btrfs_raid_bio *rbio = bio->bi_private;
2596
2597 if (bio->bi_status)
2598 fail_bio_stripe(rbio, bio);
2599 else
2600 set_bio_pages_uptodate(bio);
2601
2602 bio_put(bio);
2603
2604 if (!atomic_dec_and_test(&rbio->stripes_pending))
2605 return;
2606
2607 /*
2608 * this will normally call finish_rmw to start our write
2609 * but if there are any failed stripes we'll reconstruct
2610 * from parity first
2611 */
2612 validate_rbio_for_parity_scrub(rbio);
2613}
2614
2615static void raid56_parity_scrub_stripe(struct btrfs_raid_bio *rbio)
2616{
2617 int bios_to_read = 0;
2618 struct bio_list bio_list;
2619 int ret;
2620 int pagenr;
2621 int stripe;
2622 struct bio *bio;
2623
2624 bio_list_init(&bio_list);
2625
2626 ret = alloc_rbio_essential_pages(rbio);
2627 if (ret)
2628 goto cleanup;
2629
2630 atomic_set(&rbio->error, 0);
2631 /*
2632 * build a list of bios to read all the missing parts of this
2633 * stripe
2634 */
2635 for (stripe = 0; stripe < rbio->real_stripes; stripe++) {
2636 for_each_set_bit(pagenr, rbio->dbitmap, rbio->stripe_npages) {
2637 struct page *page;
2638 /*
2639 * we want to find all the pages missing from
2640 * the rbio and read them from the disk. If
2641 * page_in_rbio finds a page in the bio list
2642 * we don't need to read it off the stripe.
2643 */
2644 page = page_in_rbio(rbio, stripe, pagenr, 1);
2645 if (page)
2646 continue;
2647
2648 page = rbio_stripe_page(rbio, stripe, pagenr);
2649 /*
2650 * the bio cache may have handed us an uptodate
2651 * page. If so, be happy and use it
2652 */
2653 if (PageUptodate(page))
2654 continue;
2655
2656 ret = rbio_add_io_page(rbio, &bio_list, page,
2657 stripe, pagenr, rbio->stripe_len);
2658 if (ret)
2659 goto cleanup;
2660 }
2661 }
2662
2663 bios_to_read = bio_list_size(&bio_list);
2664 if (!bios_to_read) {
2665 /*
2666 * this can happen if others have merged with
2667 * us, it means there is nothing left to read.
2668 * But if there are missing devices it may not be
2669 * safe to do the full stripe write yet.
2670 */
2671 goto finish;
2672 }
2673
2674 /*
2675 * the bbio may be freed once we submit the last bio. Make sure
2676 * not to touch it after that
2677 */
2678 atomic_set(&rbio->stripes_pending, bios_to_read);
2679 while (1) {
2680 bio = bio_list_pop(&bio_list);
2681 if (!bio)
2682 break;
2683
2684 bio->bi_private = rbio;
2685 bio->bi_end_io = raid56_parity_scrub_end_io;
2686 bio->bi_opf = REQ_OP_READ;
2687
2688 btrfs_bio_wq_end_io(rbio->fs_info, bio, BTRFS_WQ_ENDIO_RAID56);
2689
2690 submit_bio(bio);
2691 }
2692 /* the actual write will happen once the reads are done */
2693 return;
2694
2695cleanup:
2696 rbio_orig_end_io(rbio, BLK_STS_IOERR);
2697
2698 while ((bio = bio_list_pop(&bio_list)))
2699 bio_put(bio);
2700
2701 return;
2702
2703finish:
2704 validate_rbio_for_parity_scrub(rbio);
2705}
2706
2707static void scrub_parity_work(struct btrfs_work *work)
2708{
2709 struct btrfs_raid_bio *rbio;
2710
2711 rbio = container_of(work, struct btrfs_raid_bio, work);
2712 raid56_parity_scrub_stripe(rbio);
2713}
2714
2715void raid56_parity_submit_scrub_rbio(struct btrfs_raid_bio *rbio)
2716{
2717 if (!lock_stripe_add(rbio))
2718 start_async_work(rbio, scrub_parity_work);
2719}
2720
2721/* The following code is used for dev replace of a missing RAID 5/6 device. */
2722
2723struct btrfs_raid_bio *
2724raid56_alloc_missing_rbio(struct btrfs_fs_info *fs_info, struct bio *bio,
2725 struct btrfs_bio *bbio, u64 length)
2726{
2727 struct btrfs_raid_bio *rbio;
2728
2729 rbio = alloc_rbio(fs_info, bbio, length);
2730 if (IS_ERR(rbio))
2731 return NULL;
2732
2733 rbio->operation = BTRFS_RBIO_REBUILD_MISSING;
2734 bio_list_add(&rbio->bio_list, bio);
2735 /*
2736 * This is a special bio which is used to hold the completion handler
2737 * and make the scrub rbio is similar to the other types
2738 */
2739 ASSERT(!bio->bi_iter.bi_size);
2740
2741 rbio->faila = find_logical_bio_stripe(rbio, bio);
2742 if (rbio->faila == -1) {
2743 BUG();
2744 kfree(rbio);
2745 return NULL;
2746 }
2747
2748 /*
2749 * When we get bbio, we have already increased bio_counter, record it
2750 * so we can free it at rbio_orig_end_io()
2751 */
2752 rbio->generic_bio_cnt = 1;
2753
2754 return rbio;
2755}
2756
2757void raid56_submit_missing_rbio(struct btrfs_raid_bio *rbio)
2758{
2759 if (!lock_stripe_add(rbio))
2760 start_async_work(rbio, read_rebuild_work);
2761}
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (C) 2012 Fusion-io All rights reserved.
4 * Copyright (C) 2012 Intel Corp. All rights reserved.
5 */
6
7#include <linux/sched.h>
8#include <linux/bio.h>
9#include <linux/slab.h>
10#include <linux/blkdev.h>
11#include <linux/raid/pq.h>
12#include <linux/hash.h>
13#include <linux/list_sort.h>
14#include <linux/raid/xor.h>
15#include <linux/mm.h>
16#include "messages.h"
17#include "ctree.h"
18#include "disk-io.h"
19#include "volumes.h"
20#include "raid56.h"
21#include "async-thread.h"
22#include "file-item.h"
23#include "btrfs_inode.h"
24
25/* set when additional merges to this rbio are not allowed */
26#define RBIO_RMW_LOCKED_BIT 1
27
28/*
29 * set when this rbio is sitting in the hash, but it is just a cache
30 * of past RMW
31 */
32#define RBIO_CACHE_BIT 2
33
34/*
35 * set when it is safe to trust the stripe_pages for caching
36 */
37#define RBIO_CACHE_READY_BIT 3
38
39#define RBIO_CACHE_SIZE 1024
40
41#define BTRFS_STRIPE_HASH_TABLE_BITS 11
42
43static void dump_bioc(const struct btrfs_fs_info *fs_info, const struct btrfs_io_context *bioc)
44{
45 if (unlikely(!bioc)) {
46 btrfs_crit(fs_info, "bioc=NULL");
47 return;
48 }
49 btrfs_crit(fs_info,
50"bioc logical=%llu full_stripe=%llu size=%llu map_type=0x%llx mirror=%u replace_nr_stripes=%u replace_stripe_src=%d num_stripes=%u",
51 bioc->logical, bioc->full_stripe_logical, bioc->size,
52 bioc->map_type, bioc->mirror_num, bioc->replace_nr_stripes,
53 bioc->replace_stripe_src, bioc->num_stripes);
54 for (int i = 0; i < bioc->num_stripes; i++) {
55 btrfs_crit(fs_info, " nr=%d devid=%llu physical=%llu",
56 i, bioc->stripes[i].dev->devid,
57 bioc->stripes[i].physical);
58 }
59}
60
61static void btrfs_dump_rbio(const struct btrfs_fs_info *fs_info,
62 const struct btrfs_raid_bio *rbio)
63{
64 if (!IS_ENABLED(CONFIG_BTRFS_ASSERT))
65 return;
66
67 dump_bioc(fs_info, rbio->bioc);
68 btrfs_crit(fs_info,
69"rbio flags=0x%lx nr_sectors=%u nr_data=%u real_stripes=%u stripe_nsectors=%u scrubp=%u dbitmap=0x%lx",
70 rbio->flags, rbio->nr_sectors, rbio->nr_data,
71 rbio->real_stripes, rbio->stripe_nsectors,
72 rbio->scrubp, rbio->dbitmap);
73}
74
75#define ASSERT_RBIO(expr, rbio) \
76({ \
77 if (IS_ENABLED(CONFIG_BTRFS_ASSERT) && unlikely(!(expr))) { \
78 const struct btrfs_fs_info *__fs_info = (rbio)->bioc ? \
79 (rbio)->bioc->fs_info : NULL; \
80 \
81 btrfs_dump_rbio(__fs_info, (rbio)); \
82 } \
83 ASSERT((expr)); \
84})
85
86#define ASSERT_RBIO_STRIPE(expr, rbio, stripe_nr) \
87({ \
88 if (IS_ENABLED(CONFIG_BTRFS_ASSERT) && unlikely(!(expr))) { \
89 const struct btrfs_fs_info *__fs_info = (rbio)->bioc ? \
90 (rbio)->bioc->fs_info : NULL; \
91 \
92 btrfs_dump_rbio(__fs_info, (rbio)); \
93 btrfs_crit(__fs_info, "stripe_nr=%d", (stripe_nr)); \
94 } \
95 ASSERT((expr)); \
96})
97
98#define ASSERT_RBIO_SECTOR(expr, rbio, sector_nr) \
99({ \
100 if (IS_ENABLED(CONFIG_BTRFS_ASSERT) && unlikely(!(expr))) { \
101 const struct btrfs_fs_info *__fs_info = (rbio)->bioc ? \
102 (rbio)->bioc->fs_info : NULL; \
103 \
104 btrfs_dump_rbio(__fs_info, (rbio)); \
105 btrfs_crit(__fs_info, "sector_nr=%d", (sector_nr)); \
106 } \
107 ASSERT((expr)); \
108})
109
110#define ASSERT_RBIO_LOGICAL(expr, rbio, logical) \
111({ \
112 if (IS_ENABLED(CONFIG_BTRFS_ASSERT) && unlikely(!(expr))) { \
113 const struct btrfs_fs_info *__fs_info = (rbio)->bioc ? \
114 (rbio)->bioc->fs_info : NULL; \
115 \
116 btrfs_dump_rbio(__fs_info, (rbio)); \
117 btrfs_crit(__fs_info, "logical=%llu", (logical)); \
118 } \
119 ASSERT((expr)); \
120})
121
122/* Used by the raid56 code to lock stripes for read/modify/write */
123struct btrfs_stripe_hash {
124 struct list_head hash_list;
125 spinlock_t lock;
126};
127
128/* Used by the raid56 code to lock stripes for read/modify/write */
129struct btrfs_stripe_hash_table {
130 struct list_head stripe_cache;
131 spinlock_t cache_lock;
132 int cache_size;
133 struct btrfs_stripe_hash table[];
134};
135
136/*
137 * A bvec like structure to present a sector inside a page.
138 *
139 * Unlike bvec we don't need bvlen, as it's fixed to sectorsize.
140 */
141struct sector_ptr {
142 struct page *page;
143 unsigned int pgoff:24;
144 unsigned int uptodate:8;
145};
146
147static void rmw_rbio_work(struct work_struct *work);
148static void rmw_rbio_work_locked(struct work_struct *work);
149static void index_rbio_pages(struct btrfs_raid_bio *rbio);
150static int alloc_rbio_pages(struct btrfs_raid_bio *rbio);
151
152static int finish_parity_scrub(struct btrfs_raid_bio *rbio);
153static void scrub_rbio_work_locked(struct work_struct *work);
154
155static void free_raid_bio_pointers(struct btrfs_raid_bio *rbio)
156{
157 bitmap_free(rbio->error_bitmap);
158 kfree(rbio->stripe_pages);
159 kfree(rbio->bio_sectors);
160 kfree(rbio->stripe_sectors);
161 kfree(rbio->finish_pointers);
162}
163
164static void free_raid_bio(struct btrfs_raid_bio *rbio)
165{
166 int i;
167
168 if (!refcount_dec_and_test(&rbio->refs))
169 return;
170
171 WARN_ON(!list_empty(&rbio->stripe_cache));
172 WARN_ON(!list_empty(&rbio->hash_list));
173 WARN_ON(!bio_list_empty(&rbio->bio_list));
174
175 for (i = 0; i < rbio->nr_pages; i++) {
176 if (rbio->stripe_pages[i]) {
177 __free_page(rbio->stripe_pages[i]);
178 rbio->stripe_pages[i] = NULL;
179 }
180 }
181
182 btrfs_put_bioc(rbio->bioc);
183 free_raid_bio_pointers(rbio);
184 kfree(rbio);
185}
186
187static void start_async_work(struct btrfs_raid_bio *rbio, work_func_t work_func)
188{
189 INIT_WORK(&rbio->work, work_func);
190 queue_work(rbio->bioc->fs_info->rmw_workers, &rbio->work);
191}
192
193/*
194 * the stripe hash table is used for locking, and to collect
195 * bios in hopes of making a full stripe
196 */
197int btrfs_alloc_stripe_hash_table(struct btrfs_fs_info *info)
198{
199 struct btrfs_stripe_hash_table *table;
200 struct btrfs_stripe_hash_table *x;
201 struct btrfs_stripe_hash *cur;
202 struct btrfs_stripe_hash *h;
203 int num_entries = 1 << BTRFS_STRIPE_HASH_TABLE_BITS;
204 int i;
205
206 if (info->stripe_hash_table)
207 return 0;
208
209 /*
210 * The table is large, starting with order 4 and can go as high as
211 * order 7 in case lock debugging is turned on.
212 *
213 * Try harder to allocate and fallback to vmalloc to lower the chance
214 * of a failing mount.
215 */
216 table = kvzalloc(struct_size(table, table, num_entries), GFP_KERNEL);
217 if (!table)
218 return -ENOMEM;
219
220 spin_lock_init(&table->cache_lock);
221 INIT_LIST_HEAD(&table->stripe_cache);
222
223 h = table->table;
224
225 for (i = 0; i < num_entries; i++) {
226 cur = h + i;
227 INIT_LIST_HEAD(&cur->hash_list);
228 spin_lock_init(&cur->lock);
229 }
230
231 x = cmpxchg(&info->stripe_hash_table, NULL, table);
232 kvfree(x);
233 return 0;
234}
235
236/*
237 * caching an rbio means to copy anything from the
238 * bio_sectors array into the stripe_pages array. We
239 * use the page uptodate bit in the stripe cache array
240 * to indicate if it has valid data
241 *
242 * once the caching is done, we set the cache ready
243 * bit.
244 */
245static void cache_rbio_pages(struct btrfs_raid_bio *rbio)
246{
247 int i;
248 int ret;
249
250 ret = alloc_rbio_pages(rbio);
251 if (ret)
252 return;
253
254 for (i = 0; i < rbio->nr_sectors; i++) {
255 /* Some range not covered by bio (partial write), skip it */
256 if (!rbio->bio_sectors[i].page) {
257 /*
258 * Even if the sector is not covered by bio, if it is
259 * a data sector it should still be uptodate as it is
260 * read from disk.
261 */
262 if (i < rbio->nr_data * rbio->stripe_nsectors)
263 ASSERT(rbio->stripe_sectors[i].uptodate);
264 continue;
265 }
266
267 ASSERT(rbio->stripe_sectors[i].page);
268 memcpy_page(rbio->stripe_sectors[i].page,
269 rbio->stripe_sectors[i].pgoff,
270 rbio->bio_sectors[i].page,
271 rbio->bio_sectors[i].pgoff,
272 rbio->bioc->fs_info->sectorsize);
273 rbio->stripe_sectors[i].uptodate = 1;
274 }
275 set_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
276}
277
278/*
279 * we hash on the first logical address of the stripe
280 */
281static int rbio_bucket(struct btrfs_raid_bio *rbio)
282{
283 u64 num = rbio->bioc->full_stripe_logical;
284
285 /*
286 * we shift down quite a bit. We're using byte
287 * addressing, and most of the lower bits are zeros.
288 * This tends to upset hash_64, and it consistently
289 * returns just one or two different values.
290 *
291 * shifting off the lower bits fixes things.
292 */
293 return hash_64(num >> 16, BTRFS_STRIPE_HASH_TABLE_BITS);
294}
295
296static bool full_page_sectors_uptodate(struct btrfs_raid_bio *rbio,
297 unsigned int page_nr)
298{
299 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
300 const u32 sectors_per_page = PAGE_SIZE / sectorsize;
301 int i;
302
303 ASSERT(page_nr < rbio->nr_pages);
304
305 for (i = sectors_per_page * page_nr;
306 i < sectors_per_page * page_nr + sectors_per_page;
307 i++) {
308 if (!rbio->stripe_sectors[i].uptodate)
309 return false;
310 }
311 return true;
312}
313
314/*
315 * Update the stripe_sectors[] array to use correct page and pgoff
316 *
317 * Should be called every time any page pointer in stripes_pages[] got modified.
318 */
319static void index_stripe_sectors(struct btrfs_raid_bio *rbio)
320{
321 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
322 u32 offset;
323 int i;
324
325 for (i = 0, offset = 0; i < rbio->nr_sectors; i++, offset += sectorsize) {
326 int page_index = offset >> PAGE_SHIFT;
327
328 ASSERT(page_index < rbio->nr_pages);
329 rbio->stripe_sectors[i].page = rbio->stripe_pages[page_index];
330 rbio->stripe_sectors[i].pgoff = offset_in_page(offset);
331 }
332}
333
334static void steal_rbio_page(struct btrfs_raid_bio *src,
335 struct btrfs_raid_bio *dest, int page_nr)
336{
337 const u32 sectorsize = src->bioc->fs_info->sectorsize;
338 const u32 sectors_per_page = PAGE_SIZE / sectorsize;
339 int i;
340
341 if (dest->stripe_pages[page_nr])
342 __free_page(dest->stripe_pages[page_nr]);
343 dest->stripe_pages[page_nr] = src->stripe_pages[page_nr];
344 src->stripe_pages[page_nr] = NULL;
345
346 /* Also update the sector->uptodate bits. */
347 for (i = sectors_per_page * page_nr;
348 i < sectors_per_page * page_nr + sectors_per_page; i++)
349 dest->stripe_sectors[i].uptodate = true;
350}
351
352static bool is_data_stripe_page(struct btrfs_raid_bio *rbio, int page_nr)
353{
354 const int sector_nr = (page_nr << PAGE_SHIFT) >>
355 rbio->bioc->fs_info->sectorsize_bits;
356
357 /*
358 * We have ensured PAGE_SIZE is aligned with sectorsize, thus
359 * we won't have a page which is half data half parity.
360 *
361 * Thus if the first sector of the page belongs to data stripes, then
362 * the full page belongs to data stripes.
363 */
364 return (sector_nr < rbio->nr_data * rbio->stripe_nsectors);
365}
366
367/*
368 * Stealing an rbio means taking all the uptodate pages from the stripe array
369 * in the source rbio and putting them into the destination rbio.
370 *
371 * This will also update the involved stripe_sectors[] which are referring to
372 * the old pages.
373 */
374static void steal_rbio(struct btrfs_raid_bio *src, struct btrfs_raid_bio *dest)
375{
376 int i;
377
378 if (!test_bit(RBIO_CACHE_READY_BIT, &src->flags))
379 return;
380
381 for (i = 0; i < dest->nr_pages; i++) {
382 struct page *p = src->stripe_pages[i];
383
384 /*
385 * We don't need to steal P/Q pages as they will always be
386 * regenerated for RMW or full write anyway.
387 */
388 if (!is_data_stripe_page(src, i))
389 continue;
390
391 /*
392 * If @src already has RBIO_CACHE_READY_BIT, it should have
393 * all data stripe pages present and uptodate.
394 */
395 ASSERT(p);
396 ASSERT(full_page_sectors_uptodate(src, i));
397 steal_rbio_page(src, dest, i);
398 }
399 index_stripe_sectors(dest);
400 index_stripe_sectors(src);
401}
402
403/*
404 * merging means we take the bio_list from the victim and
405 * splice it into the destination. The victim should
406 * be discarded afterwards.
407 *
408 * must be called with dest->rbio_list_lock held
409 */
410static void merge_rbio(struct btrfs_raid_bio *dest,
411 struct btrfs_raid_bio *victim)
412{
413 bio_list_merge_init(&dest->bio_list, &victim->bio_list);
414 dest->bio_list_bytes += victim->bio_list_bytes;
415 /* Also inherit the bitmaps from @victim. */
416 bitmap_or(&dest->dbitmap, &victim->dbitmap, &dest->dbitmap,
417 dest->stripe_nsectors);
418}
419
420/*
421 * used to prune items that are in the cache. The caller
422 * must hold the hash table lock.
423 */
424static void __remove_rbio_from_cache(struct btrfs_raid_bio *rbio)
425{
426 int bucket = rbio_bucket(rbio);
427 struct btrfs_stripe_hash_table *table;
428 struct btrfs_stripe_hash *h;
429 int freeit = 0;
430
431 /*
432 * check the bit again under the hash table lock.
433 */
434 if (!test_bit(RBIO_CACHE_BIT, &rbio->flags))
435 return;
436
437 table = rbio->bioc->fs_info->stripe_hash_table;
438 h = table->table + bucket;
439
440 /* hold the lock for the bucket because we may be
441 * removing it from the hash table
442 */
443 spin_lock(&h->lock);
444
445 /*
446 * hold the lock for the bio list because we need
447 * to make sure the bio list is empty
448 */
449 spin_lock(&rbio->bio_list_lock);
450
451 if (test_and_clear_bit(RBIO_CACHE_BIT, &rbio->flags)) {
452 list_del_init(&rbio->stripe_cache);
453 table->cache_size -= 1;
454 freeit = 1;
455
456 /* if the bio list isn't empty, this rbio is
457 * still involved in an IO. We take it out
458 * of the cache list, and drop the ref that
459 * was held for the list.
460 *
461 * If the bio_list was empty, we also remove
462 * the rbio from the hash_table, and drop
463 * the corresponding ref
464 */
465 if (bio_list_empty(&rbio->bio_list)) {
466 if (!list_empty(&rbio->hash_list)) {
467 list_del_init(&rbio->hash_list);
468 refcount_dec(&rbio->refs);
469 BUG_ON(!list_empty(&rbio->plug_list));
470 }
471 }
472 }
473
474 spin_unlock(&rbio->bio_list_lock);
475 spin_unlock(&h->lock);
476
477 if (freeit)
478 free_raid_bio(rbio);
479}
480
481/*
482 * prune a given rbio from the cache
483 */
484static void remove_rbio_from_cache(struct btrfs_raid_bio *rbio)
485{
486 struct btrfs_stripe_hash_table *table;
487
488 if (!test_bit(RBIO_CACHE_BIT, &rbio->flags))
489 return;
490
491 table = rbio->bioc->fs_info->stripe_hash_table;
492
493 spin_lock(&table->cache_lock);
494 __remove_rbio_from_cache(rbio);
495 spin_unlock(&table->cache_lock);
496}
497
498/*
499 * remove everything in the cache
500 */
501static void btrfs_clear_rbio_cache(struct btrfs_fs_info *info)
502{
503 struct btrfs_stripe_hash_table *table;
504 struct btrfs_raid_bio *rbio;
505
506 table = info->stripe_hash_table;
507
508 spin_lock(&table->cache_lock);
509 while (!list_empty(&table->stripe_cache)) {
510 rbio = list_entry(table->stripe_cache.next,
511 struct btrfs_raid_bio,
512 stripe_cache);
513 __remove_rbio_from_cache(rbio);
514 }
515 spin_unlock(&table->cache_lock);
516}
517
518/*
519 * remove all cached entries and free the hash table
520 * used by unmount
521 */
522void btrfs_free_stripe_hash_table(struct btrfs_fs_info *info)
523{
524 if (!info->stripe_hash_table)
525 return;
526 btrfs_clear_rbio_cache(info);
527 kvfree(info->stripe_hash_table);
528 info->stripe_hash_table = NULL;
529}
530
531/*
532 * insert an rbio into the stripe cache. It
533 * must have already been prepared by calling
534 * cache_rbio_pages
535 *
536 * If this rbio was already cached, it gets
537 * moved to the front of the lru.
538 *
539 * If the size of the rbio cache is too big, we
540 * prune an item.
541 */
542static void cache_rbio(struct btrfs_raid_bio *rbio)
543{
544 struct btrfs_stripe_hash_table *table;
545
546 if (!test_bit(RBIO_CACHE_READY_BIT, &rbio->flags))
547 return;
548
549 table = rbio->bioc->fs_info->stripe_hash_table;
550
551 spin_lock(&table->cache_lock);
552 spin_lock(&rbio->bio_list_lock);
553
554 /* bump our ref if we were not in the list before */
555 if (!test_and_set_bit(RBIO_CACHE_BIT, &rbio->flags))
556 refcount_inc(&rbio->refs);
557
558 if (!list_empty(&rbio->stripe_cache)){
559 list_move(&rbio->stripe_cache, &table->stripe_cache);
560 } else {
561 list_add(&rbio->stripe_cache, &table->stripe_cache);
562 table->cache_size += 1;
563 }
564
565 spin_unlock(&rbio->bio_list_lock);
566
567 if (table->cache_size > RBIO_CACHE_SIZE) {
568 struct btrfs_raid_bio *found;
569
570 found = list_entry(table->stripe_cache.prev,
571 struct btrfs_raid_bio,
572 stripe_cache);
573
574 if (found != rbio)
575 __remove_rbio_from_cache(found);
576 }
577
578 spin_unlock(&table->cache_lock);
579}
580
581/*
582 * helper function to run the xor_blocks api. It is only
583 * able to do MAX_XOR_BLOCKS at a time, so we need to
584 * loop through.
585 */
586static void run_xor(void **pages, int src_cnt, ssize_t len)
587{
588 int src_off = 0;
589 int xor_src_cnt = 0;
590 void *dest = pages[src_cnt];
591
592 while(src_cnt > 0) {
593 xor_src_cnt = min(src_cnt, MAX_XOR_BLOCKS);
594 xor_blocks(xor_src_cnt, len, dest, pages + src_off);
595
596 src_cnt -= xor_src_cnt;
597 src_off += xor_src_cnt;
598 }
599}
600
601/*
602 * Returns true if the bio list inside this rbio covers an entire stripe (no
603 * rmw required).
604 */
605static int rbio_is_full(struct btrfs_raid_bio *rbio)
606{
607 unsigned long size = rbio->bio_list_bytes;
608 int ret = 1;
609
610 spin_lock(&rbio->bio_list_lock);
611 if (size != rbio->nr_data * BTRFS_STRIPE_LEN)
612 ret = 0;
613 BUG_ON(size > rbio->nr_data * BTRFS_STRIPE_LEN);
614 spin_unlock(&rbio->bio_list_lock);
615
616 return ret;
617}
618
619/*
620 * returns 1 if it is safe to merge two rbios together.
621 * The merging is safe if the two rbios correspond to
622 * the same stripe and if they are both going in the same
623 * direction (read vs write), and if neither one is
624 * locked for final IO
625 *
626 * The caller is responsible for locking such that
627 * rmw_locked is safe to test
628 */
629static int rbio_can_merge(struct btrfs_raid_bio *last,
630 struct btrfs_raid_bio *cur)
631{
632 if (test_bit(RBIO_RMW_LOCKED_BIT, &last->flags) ||
633 test_bit(RBIO_RMW_LOCKED_BIT, &cur->flags))
634 return 0;
635
636 /*
637 * we can't merge with cached rbios, since the
638 * idea is that when we merge the destination
639 * rbio is going to run our IO for us. We can
640 * steal from cached rbios though, other functions
641 * handle that.
642 */
643 if (test_bit(RBIO_CACHE_BIT, &last->flags) ||
644 test_bit(RBIO_CACHE_BIT, &cur->flags))
645 return 0;
646
647 if (last->bioc->full_stripe_logical != cur->bioc->full_stripe_logical)
648 return 0;
649
650 /* we can't merge with different operations */
651 if (last->operation != cur->operation)
652 return 0;
653 /*
654 * We've need read the full stripe from the drive.
655 * check and repair the parity and write the new results.
656 *
657 * We're not allowed to add any new bios to the
658 * bio list here, anyone else that wants to
659 * change this stripe needs to do their own rmw.
660 */
661 if (last->operation == BTRFS_RBIO_PARITY_SCRUB)
662 return 0;
663
664 if (last->operation == BTRFS_RBIO_READ_REBUILD)
665 return 0;
666
667 return 1;
668}
669
670static unsigned int rbio_stripe_sector_index(const struct btrfs_raid_bio *rbio,
671 unsigned int stripe_nr,
672 unsigned int sector_nr)
673{
674 ASSERT_RBIO_STRIPE(stripe_nr < rbio->real_stripes, rbio, stripe_nr);
675 ASSERT_RBIO_SECTOR(sector_nr < rbio->stripe_nsectors, rbio, sector_nr);
676
677 return stripe_nr * rbio->stripe_nsectors + sector_nr;
678}
679
680/* Return a sector from rbio->stripe_sectors, not from the bio list */
681static struct sector_ptr *rbio_stripe_sector(const struct btrfs_raid_bio *rbio,
682 unsigned int stripe_nr,
683 unsigned int sector_nr)
684{
685 return &rbio->stripe_sectors[rbio_stripe_sector_index(rbio, stripe_nr,
686 sector_nr)];
687}
688
689/* Grab a sector inside P stripe */
690static struct sector_ptr *rbio_pstripe_sector(const struct btrfs_raid_bio *rbio,
691 unsigned int sector_nr)
692{
693 return rbio_stripe_sector(rbio, rbio->nr_data, sector_nr);
694}
695
696/* Grab a sector inside Q stripe, return NULL if not RAID6 */
697static struct sector_ptr *rbio_qstripe_sector(const struct btrfs_raid_bio *rbio,
698 unsigned int sector_nr)
699{
700 if (rbio->nr_data + 1 == rbio->real_stripes)
701 return NULL;
702 return rbio_stripe_sector(rbio, rbio->nr_data + 1, sector_nr);
703}
704
705/*
706 * The first stripe in the table for a logical address
707 * has the lock. rbios are added in one of three ways:
708 *
709 * 1) Nobody has the stripe locked yet. The rbio is given
710 * the lock and 0 is returned. The caller must start the IO
711 * themselves.
712 *
713 * 2) Someone has the stripe locked, but we're able to merge
714 * with the lock owner. The rbio is freed and the IO will
715 * start automatically along with the existing rbio. 1 is returned.
716 *
717 * 3) Someone has the stripe locked, but we're not able to merge.
718 * The rbio is added to the lock owner's plug list, or merged into
719 * an rbio already on the plug list. When the lock owner unlocks,
720 * the next rbio on the list is run and the IO is started automatically.
721 * 1 is returned
722 *
723 * If we return 0, the caller still owns the rbio and must continue with
724 * IO submission. If we return 1, the caller must assume the rbio has
725 * already been freed.
726 */
727static noinline int lock_stripe_add(struct btrfs_raid_bio *rbio)
728{
729 struct btrfs_stripe_hash *h;
730 struct btrfs_raid_bio *cur;
731 struct btrfs_raid_bio *pending;
732 struct btrfs_raid_bio *freeit = NULL;
733 struct btrfs_raid_bio *cache_drop = NULL;
734 int ret = 0;
735
736 h = rbio->bioc->fs_info->stripe_hash_table->table + rbio_bucket(rbio);
737
738 spin_lock(&h->lock);
739 list_for_each_entry(cur, &h->hash_list, hash_list) {
740 if (cur->bioc->full_stripe_logical != rbio->bioc->full_stripe_logical)
741 continue;
742
743 spin_lock(&cur->bio_list_lock);
744
745 /* Can we steal this cached rbio's pages? */
746 if (bio_list_empty(&cur->bio_list) &&
747 list_empty(&cur->plug_list) &&
748 test_bit(RBIO_CACHE_BIT, &cur->flags) &&
749 !test_bit(RBIO_RMW_LOCKED_BIT, &cur->flags)) {
750 list_del_init(&cur->hash_list);
751 refcount_dec(&cur->refs);
752
753 steal_rbio(cur, rbio);
754 cache_drop = cur;
755 spin_unlock(&cur->bio_list_lock);
756
757 goto lockit;
758 }
759
760 /* Can we merge into the lock owner? */
761 if (rbio_can_merge(cur, rbio)) {
762 merge_rbio(cur, rbio);
763 spin_unlock(&cur->bio_list_lock);
764 freeit = rbio;
765 ret = 1;
766 goto out;
767 }
768
769
770 /*
771 * We couldn't merge with the running rbio, see if we can merge
772 * with the pending ones. We don't have to check for rmw_locked
773 * because there is no way they are inside finish_rmw right now
774 */
775 list_for_each_entry(pending, &cur->plug_list, plug_list) {
776 if (rbio_can_merge(pending, rbio)) {
777 merge_rbio(pending, rbio);
778 spin_unlock(&cur->bio_list_lock);
779 freeit = rbio;
780 ret = 1;
781 goto out;
782 }
783 }
784
785 /*
786 * No merging, put us on the tail of the plug list, our rbio
787 * will be started with the currently running rbio unlocks
788 */
789 list_add_tail(&rbio->plug_list, &cur->plug_list);
790 spin_unlock(&cur->bio_list_lock);
791 ret = 1;
792 goto out;
793 }
794lockit:
795 refcount_inc(&rbio->refs);
796 list_add(&rbio->hash_list, &h->hash_list);
797out:
798 spin_unlock(&h->lock);
799 if (cache_drop)
800 remove_rbio_from_cache(cache_drop);
801 if (freeit)
802 free_raid_bio(freeit);
803 return ret;
804}
805
806static void recover_rbio_work_locked(struct work_struct *work);
807
808/*
809 * called as rmw or parity rebuild is completed. If the plug list has more
810 * rbios waiting for this stripe, the next one on the list will be started
811 */
812static noinline void unlock_stripe(struct btrfs_raid_bio *rbio)
813{
814 int bucket;
815 struct btrfs_stripe_hash *h;
816 int keep_cache = 0;
817
818 bucket = rbio_bucket(rbio);
819 h = rbio->bioc->fs_info->stripe_hash_table->table + bucket;
820
821 if (list_empty(&rbio->plug_list))
822 cache_rbio(rbio);
823
824 spin_lock(&h->lock);
825 spin_lock(&rbio->bio_list_lock);
826
827 if (!list_empty(&rbio->hash_list)) {
828 /*
829 * if we're still cached and there is no other IO
830 * to perform, just leave this rbio here for others
831 * to steal from later
832 */
833 if (list_empty(&rbio->plug_list) &&
834 test_bit(RBIO_CACHE_BIT, &rbio->flags)) {
835 keep_cache = 1;
836 clear_bit(RBIO_RMW_LOCKED_BIT, &rbio->flags);
837 BUG_ON(!bio_list_empty(&rbio->bio_list));
838 goto done;
839 }
840
841 list_del_init(&rbio->hash_list);
842 refcount_dec(&rbio->refs);
843
844 /*
845 * we use the plug list to hold all the rbios
846 * waiting for the chance to lock this stripe.
847 * hand the lock over to one of them.
848 */
849 if (!list_empty(&rbio->plug_list)) {
850 struct btrfs_raid_bio *next;
851 struct list_head *head = rbio->plug_list.next;
852
853 next = list_entry(head, struct btrfs_raid_bio,
854 plug_list);
855
856 list_del_init(&rbio->plug_list);
857
858 list_add(&next->hash_list, &h->hash_list);
859 refcount_inc(&next->refs);
860 spin_unlock(&rbio->bio_list_lock);
861 spin_unlock(&h->lock);
862
863 if (next->operation == BTRFS_RBIO_READ_REBUILD) {
864 start_async_work(next, recover_rbio_work_locked);
865 } else if (next->operation == BTRFS_RBIO_WRITE) {
866 steal_rbio(rbio, next);
867 start_async_work(next, rmw_rbio_work_locked);
868 } else if (next->operation == BTRFS_RBIO_PARITY_SCRUB) {
869 steal_rbio(rbio, next);
870 start_async_work(next, scrub_rbio_work_locked);
871 }
872
873 goto done_nolock;
874 }
875 }
876done:
877 spin_unlock(&rbio->bio_list_lock);
878 spin_unlock(&h->lock);
879
880done_nolock:
881 if (!keep_cache)
882 remove_rbio_from_cache(rbio);
883}
884
885static void rbio_endio_bio_list(struct bio *cur, blk_status_t err)
886{
887 struct bio *next;
888
889 while (cur) {
890 next = cur->bi_next;
891 cur->bi_next = NULL;
892 cur->bi_status = err;
893 bio_endio(cur);
894 cur = next;
895 }
896}
897
898/*
899 * this frees the rbio and runs through all the bios in the
900 * bio_list and calls end_io on them
901 */
902static void rbio_orig_end_io(struct btrfs_raid_bio *rbio, blk_status_t err)
903{
904 struct bio *cur = bio_list_get(&rbio->bio_list);
905 struct bio *extra;
906
907 kfree(rbio->csum_buf);
908 bitmap_free(rbio->csum_bitmap);
909 rbio->csum_buf = NULL;
910 rbio->csum_bitmap = NULL;
911
912 /*
913 * Clear the data bitmap, as the rbio may be cached for later usage.
914 * do this before before unlock_stripe() so there will be no new bio
915 * for this bio.
916 */
917 bitmap_clear(&rbio->dbitmap, 0, rbio->stripe_nsectors);
918
919 /*
920 * At this moment, rbio->bio_list is empty, however since rbio does not
921 * always have RBIO_RMW_LOCKED_BIT set and rbio is still linked on the
922 * hash list, rbio may be merged with others so that rbio->bio_list
923 * becomes non-empty.
924 * Once unlock_stripe() is done, rbio->bio_list will not be updated any
925 * more and we can call bio_endio() on all queued bios.
926 */
927 unlock_stripe(rbio);
928 extra = bio_list_get(&rbio->bio_list);
929 free_raid_bio(rbio);
930
931 rbio_endio_bio_list(cur, err);
932 if (extra)
933 rbio_endio_bio_list(extra, err);
934}
935
936/*
937 * Get a sector pointer specified by its @stripe_nr and @sector_nr.
938 *
939 * @rbio: The raid bio
940 * @stripe_nr: Stripe number, valid range [0, real_stripe)
941 * @sector_nr: Sector number inside the stripe,
942 * valid range [0, stripe_nsectors)
943 * @bio_list_only: Whether to use sectors inside the bio list only.
944 *
945 * The read/modify/write code wants to reuse the original bio page as much
946 * as possible, and only use stripe_sectors as fallback.
947 */
948static struct sector_ptr *sector_in_rbio(struct btrfs_raid_bio *rbio,
949 int stripe_nr, int sector_nr,
950 bool bio_list_only)
951{
952 struct sector_ptr *sector;
953 int index;
954
955 ASSERT_RBIO_STRIPE(stripe_nr >= 0 && stripe_nr < rbio->real_stripes,
956 rbio, stripe_nr);
957 ASSERT_RBIO_SECTOR(sector_nr >= 0 && sector_nr < rbio->stripe_nsectors,
958 rbio, sector_nr);
959
960 index = stripe_nr * rbio->stripe_nsectors + sector_nr;
961 ASSERT(index >= 0 && index < rbio->nr_sectors);
962
963 spin_lock(&rbio->bio_list_lock);
964 sector = &rbio->bio_sectors[index];
965 if (sector->page || bio_list_only) {
966 /* Don't return sector without a valid page pointer */
967 if (!sector->page)
968 sector = NULL;
969 spin_unlock(&rbio->bio_list_lock);
970 return sector;
971 }
972 spin_unlock(&rbio->bio_list_lock);
973
974 return &rbio->stripe_sectors[index];
975}
976
977/*
978 * allocation and initial setup for the btrfs_raid_bio. Not
979 * this does not allocate any pages for rbio->pages.
980 */
981static struct btrfs_raid_bio *alloc_rbio(struct btrfs_fs_info *fs_info,
982 struct btrfs_io_context *bioc)
983{
984 const unsigned int real_stripes = bioc->num_stripes - bioc->replace_nr_stripes;
985 const unsigned int stripe_npages = BTRFS_STRIPE_LEN >> PAGE_SHIFT;
986 const unsigned int num_pages = stripe_npages * real_stripes;
987 const unsigned int stripe_nsectors =
988 BTRFS_STRIPE_LEN >> fs_info->sectorsize_bits;
989 const unsigned int num_sectors = stripe_nsectors * real_stripes;
990 struct btrfs_raid_bio *rbio;
991
992 /* PAGE_SIZE must also be aligned to sectorsize for subpage support */
993 ASSERT(IS_ALIGNED(PAGE_SIZE, fs_info->sectorsize));
994 /*
995 * Our current stripe len should be fixed to 64k thus stripe_nsectors
996 * (at most 16) should be no larger than BITS_PER_LONG.
997 */
998 ASSERT(stripe_nsectors <= BITS_PER_LONG);
999
1000 /*
1001 * Real stripes must be between 2 (2 disks RAID5, aka RAID1) and 256
1002 * (limited by u8).
1003 */
1004 ASSERT(real_stripes >= 2);
1005 ASSERT(real_stripes <= U8_MAX);
1006
1007 rbio = kzalloc(sizeof(*rbio), GFP_NOFS);
1008 if (!rbio)
1009 return ERR_PTR(-ENOMEM);
1010 rbio->stripe_pages = kcalloc(num_pages, sizeof(struct page *),
1011 GFP_NOFS);
1012 rbio->bio_sectors = kcalloc(num_sectors, sizeof(struct sector_ptr),
1013 GFP_NOFS);
1014 rbio->stripe_sectors = kcalloc(num_sectors, sizeof(struct sector_ptr),
1015 GFP_NOFS);
1016 rbio->finish_pointers = kcalloc(real_stripes, sizeof(void *), GFP_NOFS);
1017 rbio->error_bitmap = bitmap_zalloc(num_sectors, GFP_NOFS);
1018
1019 if (!rbio->stripe_pages || !rbio->bio_sectors || !rbio->stripe_sectors ||
1020 !rbio->finish_pointers || !rbio->error_bitmap) {
1021 free_raid_bio_pointers(rbio);
1022 kfree(rbio);
1023 return ERR_PTR(-ENOMEM);
1024 }
1025
1026 bio_list_init(&rbio->bio_list);
1027 init_waitqueue_head(&rbio->io_wait);
1028 INIT_LIST_HEAD(&rbio->plug_list);
1029 spin_lock_init(&rbio->bio_list_lock);
1030 INIT_LIST_HEAD(&rbio->stripe_cache);
1031 INIT_LIST_HEAD(&rbio->hash_list);
1032 btrfs_get_bioc(bioc);
1033 rbio->bioc = bioc;
1034 rbio->nr_pages = num_pages;
1035 rbio->nr_sectors = num_sectors;
1036 rbio->real_stripes = real_stripes;
1037 rbio->stripe_npages = stripe_npages;
1038 rbio->stripe_nsectors = stripe_nsectors;
1039 refcount_set(&rbio->refs, 1);
1040 atomic_set(&rbio->stripes_pending, 0);
1041
1042 ASSERT(btrfs_nr_parity_stripes(bioc->map_type));
1043 rbio->nr_data = real_stripes - btrfs_nr_parity_stripes(bioc->map_type);
1044 ASSERT(rbio->nr_data > 0);
1045
1046 return rbio;
1047}
1048
1049/* allocate pages for all the stripes in the bio, including parity */
1050static int alloc_rbio_pages(struct btrfs_raid_bio *rbio)
1051{
1052 int ret;
1053
1054 ret = btrfs_alloc_page_array(rbio->nr_pages, rbio->stripe_pages, false);
1055 if (ret < 0)
1056 return ret;
1057 /* Mapping all sectors */
1058 index_stripe_sectors(rbio);
1059 return 0;
1060}
1061
1062/* only allocate pages for p/q stripes */
1063static int alloc_rbio_parity_pages(struct btrfs_raid_bio *rbio)
1064{
1065 const int data_pages = rbio->nr_data * rbio->stripe_npages;
1066 int ret;
1067
1068 ret = btrfs_alloc_page_array(rbio->nr_pages - data_pages,
1069 rbio->stripe_pages + data_pages, false);
1070 if (ret < 0)
1071 return ret;
1072
1073 index_stripe_sectors(rbio);
1074 return 0;
1075}
1076
1077/*
1078 * Return the total number of errors found in the vertical stripe of @sector_nr.
1079 *
1080 * @faila and @failb will also be updated to the first and second stripe
1081 * number of the errors.
1082 */
1083static int get_rbio_veritical_errors(struct btrfs_raid_bio *rbio, int sector_nr,
1084 int *faila, int *failb)
1085{
1086 int stripe_nr;
1087 int found_errors = 0;
1088
1089 if (faila || failb) {
1090 /*
1091 * Both @faila and @failb should be valid pointers if any of
1092 * them is specified.
1093 */
1094 ASSERT(faila && failb);
1095 *faila = -1;
1096 *failb = -1;
1097 }
1098
1099 for (stripe_nr = 0; stripe_nr < rbio->real_stripes; stripe_nr++) {
1100 int total_sector_nr = stripe_nr * rbio->stripe_nsectors + sector_nr;
1101
1102 if (test_bit(total_sector_nr, rbio->error_bitmap)) {
1103 found_errors++;
1104 if (faila) {
1105 /* Update faila and failb. */
1106 if (*faila < 0)
1107 *faila = stripe_nr;
1108 else if (*failb < 0)
1109 *failb = stripe_nr;
1110 }
1111 }
1112 }
1113 return found_errors;
1114}
1115
1116/*
1117 * Add a single sector @sector into our list of bios for IO.
1118 *
1119 * Return 0 if everything went well.
1120 * Return <0 for error.
1121 */
1122static int rbio_add_io_sector(struct btrfs_raid_bio *rbio,
1123 struct bio_list *bio_list,
1124 struct sector_ptr *sector,
1125 unsigned int stripe_nr,
1126 unsigned int sector_nr,
1127 enum req_op op)
1128{
1129 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
1130 struct bio *last = bio_list->tail;
1131 int ret;
1132 struct bio *bio;
1133 struct btrfs_io_stripe *stripe;
1134 u64 disk_start;
1135
1136 /*
1137 * Note: here stripe_nr has taken device replace into consideration,
1138 * thus it can be larger than rbio->real_stripe.
1139 * So here we check against bioc->num_stripes, not rbio->real_stripes.
1140 */
1141 ASSERT_RBIO_STRIPE(stripe_nr >= 0 && stripe_nr < rbio->bioc->num_stripes,
1142 rbio, stripe_nr);
1143 ASSERT_RBIO_SECTOR(sector_nr >= 0 && sector_nr < rbio->stripe_nsectors,
1144 rbio, sector_nr);
1145 ASSERT(sector->page);
1146
1147 stripe = &rbio->bioc->stripes[stripe_nr];
1148 disk_start = stripe->physical + sector_nr * sectorsize;
1149
1150 /* if the device is missing, just fail this stripe */
1151 if (!stripe->dev->bdev) {
1152 int found_errors;
1153
1154 set_bit(stripe_nr * rbio->stripe_nsectors + sector_nr,
1155 rbio->error_bitmap);
1156
1157 /* Check if we have reached tolerance early. */
1158 found_errors = get_rbio_veritical_errors(rbio, sector_nr,
1159 NULL, NULL);
1160 if (found_errors > rbio->bioc->max_errors)
1161 return -EIO;
1162 return 0;
1163 }
1164
1165 /* see if we can add this page onto our existing bio */
1166 if (last) {
1167 u64 last_end = last->bi_iter.bi_sector << SECTOR_SHIFT;
1168 last_end += last->bi_iter.bi_size;
1169
1170 /*
1171 * we can't merge these if they are from different
1172 * devices or if they are not contiguous
1173 */
1174 if (last_end == disk_start && !last->bi_status &&
1175 last->bi_bdev == stripe->dev->bdev) {
1176 ret = bio_add_page(last, sector->page, sectorsize,
1177 sector->pgoff);
1178 if (ret == sectorsize)
1179 return 0;
1180 }
1181 }
1182
1183 /* put a new bio on the list */
1184 bio = bio_alloc(stripe->dev->bdev,
1185 max(BTRFS_STRIPE_LEN >> PAGE_SHIFT, 1),
1186 op, GFP_NOFS);
1187 bio->bi_iter.bi_sector = disk_start >> SECTOR_SHIFT;
1188 bio->bi_private = rbio;
1189
1190 __bio_add_page(bio, sector->page, sectorsize, sector->pgoff);
1191 bio_list_add(bio_list, bio);
1192 return 0;
1193}
1194
1195static void index_one_bio(struct btrfs_raid_bio *rbio, struct bio *bio)
1196{
1197 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
1198 struct bio_vec bvec;
1199 struct bvec_iter iter;
1200 u32 offset = (bio->bi_iter.bi_sector << SECTOR_SHIFT) -
1201 rbio->bioc->full_stripe_logical;
1202
1203 bio_for_each_segment(bvec, bio, iter) {
1204 u32 bvec_offset;
1205
1206 for (bvec_offset = 0; bvec_offset < bvec.bv_len;
1207 bvec_offset += sectorsize, offset += sectorsize) {
1208 int index = offset / sectorsize;
1209 struct sector_ptr *sector = &rbio->bio_sectors[index];
1210
1211 sector->page = bvec.bv_page;
1212 sector->pgoff = bvec.bv_offset + bvec_offset;
1213 ASSERT(sector->pgoff < PAGE_SIZE);
1214 }
1215 }
1216}
1217
1218/*
1219 * helper function to walk our bio list and populate the bio_pages array with
1220 * the result. This seems expensive, but it is faster than constantly
1221 * searching through the bio list as we setup the IO in finish_rmw or stripe
1222 * reconstruction.
1223 *
1224 * This must be called before you trust the answers from page_in_rbio
1225 */
1226static void index_rbio_pages(struct btrfs_raid_bio *rbio)
1227{
1228 struct bio *bio;
1229
1230 spin_lock(&rbio->bio_list_lock);
1231 bio_list_for_each(bio, &rbio->bio_list)
1232 index_one_bio(rbio, bio);
1233
1234 spin_unlock(&rbio->bio_list_lock);
1235}
1236
1237static void bio_get_trace_info(struct btrfs_raid_bio *rbio, struct bio *bio,
1238 struct raid56_bio_trace_info *trace_info)
1239{
1240 const struct btrfs_io_context *bioc = rbio->bioc;
1241 int i;
1242
1243 ASSERT(bioc);
1244
1245 /* We rely on bio->bi_bdev to find the stripe number. */
1246 if (!bio->bi_bdev)
1247 goto not_found;
1248
1249 for (i = 0; i < bioc->num_stripes; i++) {
1250 if (bio->bi_bdev != bioc->stripes[i].dev->bdev)
1251 continue;
1252 trace_info->stripe_nr = i;
1253 trace_info->devid = bioc->stripes[i].dev->devid;
1254 trace_info->offset = (bio->bi_iter.bi_sector << SECTOR_SHIFT) -
1255 bioc->stripes[i].physical;
1256 return;
1257 }
1258
1259not_found:
1260 trace_info->devid = -1;
1261 trace_info->offset = -1;
1262 trace_info->stripe_nr = -1;
1263}
1264
1265static inline void bio_list_put(struct bio_list *bio_list)
1266{
1267 struct bio *bio;
1268
1269 while ((bio = bio_list_pop(bio_list)))
1270 bio_put(bio);
1271}
1272
1273static void assert_rbio(struct btrfs_raid_bio *rbio)
1274{
1275 if (!IS_ENABLED(CONFIG_BTRFS_ASSERT))
1276 return;
1277
1278 /*
1279 * At least two stripes (2 disks RAID5), and since real_stripes is U8,
1280 * we won't go beyond 256 disks anyway.
1281 */
1282 ASSERT_RBIO(rbio->real_stripes >= 2, rbio);
1283 ASSERT_RBIO(rbio->nr_data > 0, rbio);
1284
1285 /*
1286 * This is another check to make sure nr data stripes is smaller
1287 * than total stripes.
1288 */
1289 ASSERT_RBIO(rbio->nr_data < rbio->real_stripes, rbio);
1290}
1291
1292/* Generate PQ for one vertical stripe. */
1293static void generate_pq_vertical(struct btrfs_raid_bio *rbio, int sectornr)
1294{
1295 void **pointers = rbio->finish_pointers;
1296 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
1297 struct sector_ptr *sector;
1298 int stripe;
1299 const bool has_qstripe = rbio->bioc->map_type & BTRFS_BLOCK_GROUP_RAID6;
1300
1301 /* First collect one sector from each data stripe */
1302 for (stripe = 0; stripe < rbio->nr_data; stripe++) {
1303 sector = sector_in_rbio(rbio, stripe, sectornr, 0);
1304 pointers[stripe] = kmap_local_page(sector->page) +
1305 sector->pgoff;
1306 }
1307
1308 /* Then add the parity stripe */
1309 sector = rbio_pstripe_sector(rbio, sectornr);
1310 sector->uptodate = 1;
1311 pointers[stripe++] = kmap_local_page(sector->page) + sector->pgoff;
1312
1313 if (has_qstripe) {
1314 /*
1315 * RAID6, add the qstripe and call the library function
1316 * to fill in our p/q
1317 */
1318 sector = rbio_qstripe_sector(rbio, sectornr);
1319 sector->uptodate = 1;
1320 pointers[stripe++] = kmap_local_page(sector->page) +
1321 sector->pgoff;
1322
1323 assert_rbio(rbio);
1324 raid6_call.gen_syndrome(rbio->real_stripes, sectorsize,
1325 pointers);
1326 } else {
1327 /* raid5 */
1328 memcpy(pointers[rbio->nr_data], pointers[0], sectorsize);
1329 run_xor(pointers + 1, rbio->nr_data - 1, sectorsize);
1330 }
1331 for (stripe = stripe - 1; stripe >= 0; stripe--)
1332 kunmap_local(pointers[stripe]);
1333}
1334
1335static int rmw_assemble_write_bios(struct btrfs_raid_bio *rbio,
1336 struct bio_list *bio_list)
1337{
1338 /* The total sector number inside the full stripe. */
1339 int total_sector_nr;
1340 int sectornr;
1341 int stripe;
1342 int ret;
1343
1344 ASSERT(bio_list_size(bio_list) == 0);
1345
1346 /* We should have at least one data sector. */
1347 ASSERT(bitmap_weight(&rbio->dbitmap, rbio->stripe_nsectors));
1348
1349 /*
1350 * Reset errors, as we may have errors inherited from from degraded
1351 * write.
1352 */
1353 bitmap_clear(rbio->error_bitmap, 0, rbio->nr_sectors);
1354
1355 /*
1356 * Start assembly. Make bios for everything from the higher layers (the
1357 * bio_list in our rbio) and our P/Q. Ignore everything else.
1358 */
1359 for (total_sector_nr = 0; total_sector_nr < rbio->nr_sectors;
1360 total_sector_nr++) {
1361 struct sector_ptr *sector;
1362
1363 stripe = total_sector_nr / rbio->stripe_nsectors;
1364 sectornr = total_sector_nr % rbio->stripe_nsectors;
1365
1366 /* This vertical stripe has no data, skip it. */
1367 if (!test_bit(sectornr, &rbio->dbitmap))
1368 continue;
1369
1370 if (stripe < rbio->nr_data) {
1371 sector = sector_in_rbio(rbio, stripe, sectornr, 1);
1372 if (!sector)
1373 continue;
1374 } else {
1375 sector = rbio_stripe_sector(rbio, stripe, sectornr);
1376 }
1377
1378 ret = rbio_add_io_sector(rbio, bio_list, sector, stripe,
1379 sectornr, REQ_OP_WRITE);
1380 if (ret)
1381 goto error;
1382 }
1383
1384 if (likely(!rbio->bioc->replace_nr_stripes))
1385 return 0;
1386
1387 /*
1388 * Make a copy for the replace target device.
1389 *
1390 * Thus the source stripe number (in replace_stripe_src) should be valid.
1391 */
1392 ASSERT(rbio->bioc->replace_stripe_src >= 0);
1393
1394 for (total_sector_nr = 0; total_sector_nr < rbio->nr_sectors;
1395 total_sector_nr++) {
1396 struct sector_ptr *sector;
1397
1398 stripe = total_sector_nr / rbio->stripe_nsectors;
1399 sectornr = total_sector_nr % rbio->stripe_nsectors;
1400
1401 /*
1402 * For RAID56, there is only one device that can be replaced,
1403 * and replace_stripe_src[0] indicates the stripe number we
1404 * need to copy from.
1405 */
1406 if (stripe != rbio->bioc->replace_stripe_src) {
1407 /*
1408 * We can skip the whole stripe completely, note
1409 * total_sector_nr will be increased by one anyway.
1410 */
1411 ASSERT(sectornr == 0);
1412 total_sector_nr += rbio->stripe_nsectors - 1;
1413 continue;
1414 }
1415
1416 /* This vertical stripe has no data, skip it. */
1417 if (!test_bit(sectornr, &rbio->dbitmap))
1418 continue;
1419
1420 if (stripe < rbio->nr_data) {
1421 sector = sector_in_rbio(rbio, stripe, sectornr, 1);
1422 if (!sector)
1423 continue;
1424 } else {
1425 sector = rbio_stripe_sector(rbio, stripe, sectornr);
1426 }
1427
1428 ret = rbio_add_io_sector(rbio, bio_list, sector,
1429 rbio->real_stripes,
1430 sectornr, REQ_OP_WRITE);
1431 if (ret)
1432 goto error;
1433 }
1434
1435 return 0;
1436error:
1437 bio_list_put(bio_list);
1438 return -EIO;
1439}
1440
1441static void set_rbio_range_error(struct btrfs_raid_bio *rbio, struct bio *bio)
1442{
1443 struct btrfs_fs_info *fs_info = rbio->bioc->fs_info;
1444 u32 offset = (bio->bi_iter.bi_sector << SECTOR_SHIFT) -
1445 rbio->bioc->full_stripe_logical;
1446 int total_nr_sector = offset >> fs_info->sectorsize_bits;
1447
1448 ASSERT(total_nr_sector < rbio->nr_data * rbio->stripe_nsectors);
1449
1450 bitmap_set(rbio->error_bitmap, total_nr_sector,
1451 bio->bi_iter.bi_size >> fs_info->sectorsize_bits);
1452
1453 /*
1454 * Special handling for raid56_alloc_missing_rbio() used by
1455 * scrub/replace. Unlike call path in raid56_parity_recover(), they
1456 * pass an empty bio here. Thus we have to find out the missing device
1457 * and mark the stripe error instead.
1458 */
1459 if (bio->bi_iter.bi_size == 0) {
1460 bool found_missing = false;
1461 int stripe_nr;
1462
1463 for (stripe_nr = 0; stripe_nr < rbio->real_stripes; stripe_nr++) {
1464 if (!rbio->bioc->stripes[stripe_nr].dev->bdev) {
1465 found_missing = true;
1466 bitmap_set(rbio->error_bitmap,
1467 stripe_nr * rbio->stripe_nsectors,
1468 rbio->stripe_nsectors);
1469 }
1470 }
1471 ASSERT(found_missing);
1472 }
1473}
1474
1475/*
1476 * For subpage case, we can no longer set page Up-to-date directly for
1477 * stripe_pages[], thus we need to locate the sector.
1478 */
1479static struct sector_ptr *find_stripe_sector(struct btrfs_raid_bio *rbio,
1480 struct page *page,
1481 unsigned int pgoff)
1482{
1483 int i;
1484
1485 for (i = 0; i < rbio->nr_sectors; i++) {
1486 struct sector_ptr *sector = &rbio->stripe_sectors[i];
1487
1488 if (sector->page == page && sector->pgoff == pgoff)
1489 return sector;
1490 }
1491 return NULL;
1492}
1493
1494/*
1495 * this sets each page in the bio uptodate. It should only be used on private
1496 * rbio pages, nothing that comes in from the higher layers
1497 */
1498static void set_bio_pages_uptodate(struct btrfs_raid_bio *rbio, struct bio *bio)
1499{
1500 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
1501 struct bio_vec *bvec;
1502 struct bvec_iter_all iter_all;
1503
1504 ASSERT(!bio_flagged(bio, BIO_CLONED));
1505
1506 bio_for_each_segment_all(bvec, bio, iter_all) {
1507 struct sector_ptr *sector;
1508 int pgoff;
1509
1510 for (pgoff = bvec->bv_offset; pgoff - bvec->bv_offset < bvec->bv_len;
1511 pgoff += sectorsize) {
1512 sector = find_stripe_sector(rbio, bvec->bv_page, pgoff);
1513 ASSERT(sector);
1514 if (sector)
1515 sector->uptodate = 1;
1516 }
1517 }
1518}
1519
1520static int get_bio_sector_nr(struct btrfs_raid_bio *rbio, struct bio *bio)
1521{
1522 struct bio_vec *bv = bio_first_bvec_all(bio);
1523 int i;
1524
1525 for (i = 0; i < rbio->nr_sectors; i++) {
1526 struct sector_ptr *sector;
1527
1528 sector = &rbio->stripe_sectors[i];
1529 if (sector->page == bv->bv_page && sector->pgoff == bv->bv_offset)
1530 break;
1531 sector = &rbio->bio_sectors[i];
1532 if (sector->page == bv->bv_page && sector->pgoff == bv->bv_offset)
1533 break;
1534 }
1535 ASSERT(i < rbio->nr_sectors);
1536 return i;
1537}
1538
1539static void rbio_update_error_bitmap(struct btrfs_raid_bio *rbio, struct bio *bio)
1540{
1541 int total_sector_nr = get_bio_sector_nr(rbio, bio);
1542 u32 bio_size = 0;
1543 struct bio_vec *bvec;
1544 int i;
1545
1546 bio_for_each_bvec_all(bvec, bio, i)
1547 bio_size += bvec->bv_len;
1548
1549 /*
1550 * Since we can have multiple bios touching the error_bitmap, we cannot
1551 * call bitmap_set() without protection.
1552 *
1553 * Instead use set_bit() for each bit, as set_bit() itself is atomic.
1554 */
1555 for (i = total_sector_nr; i < total_sector_nr +
1556 (bio_size >> rbio->bioc->fs_info->sectorsize_bits); i++)
1557 set_bit(i, rbio->error_bitmap);
1558}
1559
1560/* Verify the data sectors at read time. */
1561static void verify_bio_data_sectors(struct btrfs_raid_bio *rbio,
1562 struct bio *bio)
1563{
1564 struct btrfs_fs_info *fs_info = rbio->bioc->fs_info;
1565 int total_sector_nr = get_bio_sector_nr(rbio, bio);
1566 struct bio_vec *bvec;
1567 struct bvec_iter_all iter_all;
1568
1569 /* No data csum for the whole stripe, no need to verify. */
1570 if (!rbio->csum_bitmap || !rbio->csum_buf)
1571 return;
1572
1573 /* P/Q stripes, they have no data csum to verify against. */
1574 if (total_sector_nr >= rbio->nr_data * rbio->stripe_nsectors)
1575 return;
1576
1577 bio_for_each_segment_all(bvec, bio, iter_all) {
1578 int bv_offset;
1579
1580 for (bv_offset = bvec->bv_offset;
1581 bv_offset < bvec->bv_offset + bvec->bv_len;
1582 bv_offset += fs_info->sectorsize, total_sector_nr++) {
1583 u8 csum_buf[BTRFS_CSUM_SIZE];
1584 u8 *expected_csum = rbio->csum_buf +
1585 total_sector_nr * fs_info->csum_size;
1586 int ret;
1587
1588 /* No csum for this sector, skip to the next sector. */
1589 if (!test_bit(total_sector_nr, rbio->csum_bitmap))
1590 continue;
1591
1592 ret = btrfs_check_sector_csum(fs_info, bvec->bv_page,
1593 bv_offset, csum_buf, expected_csum);
1594 if (ret < 0)
1595 set_bit(total_sector_nr, rbio->error_bitmap);
1596 }
1597 }
1598}
1599
1600static void raid_wait_read_end_io(struct bio *bio)
1601{
1602 struct btrfs_raid_bio *rbio = bio->bi_private;
1603
1604 if (bio->bi_status) {
1605 rbio_update_error_bitmap(rbio, bio);
1606 } else {
1607 set_bio_pages_uptodate(rbio, bio);
1608 verify_bio_data_sectors(rbio, bio);
1609 }
1610
1611 bio_put(bio);
1612 if (atomic_dec_and_test(&rbio->stripes_pending))
1613 wake_up(&rbio->io_wait);
1614}
1615
1616static void submit_read_wait_bio_list(struct btrfs_raid_bio *rbio,
1617 struct bio_list *bio_list)
1618{
1619 struct bio *bio;
1620
1621 atomic_set(&rbio->stripes_pending, bio_list_size(bio_list));
1622 while ((bio = bio_list_pop(bio_list))) {
1623 bio->bi_end_io = raid_wait_read_end_io;
1624
1625 if (trace_raid56_read_enabled()) {
1626 struct raid56_bio_trace_info trace_info = { 0 };
1627
1628 bio_get_trace_info(rbio, bio, &trace_info);
1629 trace_raid56_read(rbio, bio, &trace_info);
1630 }
1631 submit_bio(bio);
1632 }
1633
1634 wait_event(rbio->io_wait, atomic_read(&rbio->stripes_pending) == 0);
1635}
1636
1637static int alloc_rbio_data_pages(struct btrfs_raid_bio *rbio)
1638{
1639 const int data_pages = rbio->nr_data * rbio->stripe_npages;
1640 int ret;
1641
1642 ret = btrfs_alloc_page_array(data_pages, rbio->stripe_pages, false);
1643 if (ret < 0)
1644 return ret;
1645
1646 index_stripe_sectors(rbio);
1647 return 0;
1648}
1649
1650/*
1651 * We use plugging call backs to collect full stripes.
1652 * Any time we get a partial stripe write while plugged
1653 * we collect it into a list. When the unplug comes down,
1654 * we sort the list by logical block number and merge
1655 * everything we can into the same rbios
1656 */
1657struct btrfs_plug_cb {
1658 struct blk_plug_cb cb;
1659 struct btrfs_fs_info *info;
1660 struct list_head rbio_list;
1661};
1662
1663/*
1664 * rbios on the plug list are sorted for easier merging.
1665 */
1666static int plug_cmp(void *priv, const struct list_head *a,
1667 const struct list_head *b)
1668{
1669 const struct btrfs_raid_bio *ra = container_of(a, struct btrfs_raid_bio,
1670 plug_list);
1671 const struct btrfs_raid_bio *rb = container_of(b, struct btrfs_raid_bio,
1672 plug_list);
1673 u64 a_sector = ra->bio_list.head->bi_iter.bi_sector;
1674 u64 b_sector = rb->bio_list.head->bi_iter.bi_sector;
1675
1676 if (a_sector < b_sector)
1677 return -1;
1678 if (a_sector > b_sector)
1679 return 1;
1680 return 0;
1681}
1682
1683static void raid_unplug(struct blk_plug_cb *cb, bool from_schedule)
1684{
1685 struct btrfs_plug_cb *plug = container_of(cb, struct btrfs_plug_cb, cb);
1686 struct btrfs_raid_bio *cur;
1687 struct btrfs_raid_bio *last = NULL;
1688
1689 list_sort(NULL, &plug->rbio_list, plug_cmp);
1690
1691 while (!list_empty(&plug->rbio_list)) {
1692 cur = list_entry(plug->rbio_list.next,
1693 struct btrfs_raid_bio, plug_list);
1694 list_del_init(&cur->plug_list);
1695
1696 if (rbio_is_full(cur)) {
1697 /* We have a full stripe, queue it down. */
1698 start_async_work(cur, rmw_rbio_work);
1699 continue;
1700 }
1701 if (last) {
1702 if (rbio_can_merge(last, cur)) {
1703 merge_rbio(last, cur);
1704 free_raid_bio(cur);
1705 continue;
1706 }
1707 start_async_work(last, rmw_rbio_work);
1708 }
1709 last = cur;
1710 }
1711 if (last)
1712 start_async_work(last, rmw_rbio_work);
1713 kfree(plug);
1714}
1715
1716/* Add the original bio into rbio->bio_list, and update rbio::dbitmap. */
1717static void rbio_add_bio(struct btrfs_raid_bio *rbio, struct bio *orig_bio)
1718{
1719 const struct btrfs_fs_info *fs_info = rbio->bioc->fs_info;
1720 const u64 orig_logical = orig_bio->bi_iter.bi_sector << SECTOR_SHIFT;
1721 const u64 full_stripe_start = rbio->bioc->full_stripe_logical;
1722 const u32 orig_len = orig_bio->bi_iter.bi_size;
1723 const u32 sectorsize = fs_info->sectorsize;
1724 u64 cur_logical;
1725
1726 ASSERT_RBIO_LOGICAL(orig_logical >= full_stripe_start &&
1727 orig_logical + orig_len <= full_stripe_start +
1728 rbio->nr_data * BTRFS_STRIPE_LEN,
1729 rbio, orig_logical);
1730
1731 bio_list_add(&rbio->bio_list, orig_bio);
1732 rbio->bio_list_bytes += orig_bio->bi_iter.bi_size;
1733
1734 /* Update the dbitmap. */
1735 for (cur_logical = orig_logical; cur_logical < orig_logical + orig_len;
1736 cur_logical += sectorsize) {
1737 int bit = ((u32)(cur_logical - full_stripe_start) >>
1738 fs_info->sectorsize_bits) % rbio->stripe_nsectors;
1739
1740 set_bit(bit, &rbio->dbitmap);
1741 }
1742}
1743
1744/*
1745 * our main entry point for writes from the rest of the FS.
1746 */
1747void raid56_parity_write(struct bio *bio, struct btrfs_io_context *bioc)
1748{
1749 struct btrfs_fs_info *fs_info = bioc->fs_info;
1750 struct btrfs_raid_bio *rbio;
1751 struct btrfs_plug_cb *plug = NULL;
1752 struct blk_plug_cb *cb;
1753
1754 rbio = alloc_rbio(fs_info, bioc);
1755 if (IS_ERR(rbio)) {
1756 bio->bi_status = errno_to_blk_status(PTR_ERR(rbio));
1757 bio_endio(bio);
1758 return;
1759 }
1760 rbio->operation = BTRFS_RBIO_WRITE;
1761 rbio_add_bio(rbio, bio);
1762
1763 /*
1764 * Don't plug on full rbios, just get them out the door
1765 * as quickly as we can
1766 */
1767 if (!rbio_is_full(rbio)) {
1768 cb = blk_check_plugged(raid_unplug, fs_info, sizeof(*plug));
1769 if (cb) {
1770 plug = container_of(cb, struct btrfs_plug_cb, cb);
1771 if (!plug->info) {
1772 plug->info = fs_info;
1773 INIT_LIST_HEAD(&plug->rbio_list);
1774 }
1775 list_add_tail(&rbio->plug_list, &plug->rbio_list);
1776 return;
1777 }
1778 }
1779
1780 /*
1781 * Either we don't have any existing plug, or we're doing a full stripe,
1782 * queue the rmw work now.
1783 */
1784 start_async_work(rbio, rmw_rbio_work);
1785}
1786
1787static int verify_one_sector(struct btrfs_raid_bio *rbio,
1788 int stripe_nr, int sector_nr)
1789{
1790 struct btrfs_fs_info *fs_info = rbio->bioc->fs_info;
1791 struct sector_ptr *sector;
1792 u8 csum_buf[BTRFS_CSUM_SIZE];
1793 u8 *csum_expected;
1794 int ret;
1795
1796 if (!rbio->csum_bitmap || !rbio->csum_buf)
1797 return 0;
1798
1799 /* No way to verify P/Q as they are not covered by data csum. */
1800 if (stripe_nr >= rbio->nr_data)
1801 return 0;
1802 /*
1803 * If we're rebuilding a read, we have to use pages from the
1804 * bio list if possible.
1805 */
1806 if (rbio->operation == BTRFS_RBIO_READ_REBUILD) {
1807 sector = sector_in_rbio(rbio, stripe_nr, sector_nr, 0);
1808 } else {
1809 sector = rbio_stripe_sector(rbio, stripe_nr, sector_nr);
1810 }
1811
1812 ASSERT(sector->page);
1813
1814 csum_expected = rbio->csum_buf +
1815 (stripe_nr * rbio->stripe_nsectors + sector_nr) *
1816 fs_info->csum_size;
1817 ret = btrfs_check_sector_csum(fs_info, sector->page, sector->pgoff,
1818 csum_buf, csum_expected);
1819 return ret;
1820}
1821
1822/*
1823 * Recover a vertical stripe specified by @sector_nr.
1824 * @*pointers are the pre-allocated pointers by the caller, so we don't
1825 * need to allocate/free the pointers again and again.
1826 */
1827static int recover_vertical(struct btrfs_raid_bio *rbio, int sector_nr,
1828 void **pointers, void **unmap_array)
1829{
1830 struct btrfs_fs_info *fs_info = rbio->bioc->fs_info;
1831 struct sector_ptr *sector;
1832 const u32 sectorsize = fs_info->sectorsize;
1833 int found_errors;
1834 int faila;
1835 int failb;
1836 int stripe_nr;
1837 int ret = 0;
1838
1839 /*
1840 * Now we just use bitmap to mark the horizontal stripes in
1841 * which we have data when doing parity scrub.
1842 */
1843 if (rbio->operation == BTRFS_RBIO_PARITY_SCRUB &&
1844 !test_bit(sector_nr, &rbio->dbitmap))
1845 return 0;
1846
1847 found_errors = get_rbio_veritical_errors(rbio, sector_nr, &faila,
1848 &failb);
1849 /*
1850 * No errors in the vertical stripe, skip it. Can happen for recovery
1851 * which only part of a stripe failed csum check.
1852 */
1853 if (!found_errors)
1854 return 0;
1855
1856 if (found_errors > rbio->bioc->max_errors)
1857 return -EIO;
1858
1859 /*
1860 * Setup our array of pointers with sectors from each stripe
1861 *
1862 * NOTE: store a duplicate array of pointers to preserve the
1863 * pointer order.
1864 */
1865 for (stripe_nr = 0; stripe_nr < rbio->real_stripes; stripe_nr++) {
1866 /*
1867 * If we're rebuilding a read, we have to use pages from the
1868 * bio list if possible.
1869 */
1870 if (rbio->operation == BTRFS_RBIO_READ_REBUILD) {
1871 sector = sector_in_rbio(rbio, stripe_nr, sector_nr, 0);
1872 } else {
1873 sector = rbio_stripe_sector(rbio, stripe_nr, sector_nr);
1874 }
1875 ASSERT(sector->page);
1876 pointers[stripe_nr] = kmap_local_page(sector->page) +
1877 sector->pgoff;
1878 unmap_array[stripe_nr] = pointers[stripe_nr];
1879 }
1880
1881 /* All raid6 handling here */
1882 if (rbio->bioc->map_type & BTRFS_BLOCK_GROUP_RAID6) {
1883 /* Single failure, rebuild from parity raid5 style */
1884 if (failb < 0) {
1885 if (faila == rbio->nr_data)
1886 /*
1887 * Just the P stripe has failed, without
1888 * a bad data or Q stripe.
1889 * We have nothing to do, just skip the
1890 * recovery for this stripe.
1891 */
1892 goto cleanup;
1893 /*
1894 * a single failure in raid6 is rebuilt
1895 * in the pstripe code below
1896 */
1897 goto pstripe;
1898 }
1899
1900 /*
1901 * If the q stripe is failed, do a pstripe reconstruction from
1902 * the xors.
1903 * If both the q stripe and the P stripe are failed, we're
1904 * here due to a crc mismatch and we can't give them the
1905 * data they want.
1906 */
1907 if (failb == rbio->real_stripes - 1) {
1908 if (faila == rbio->real_stripes - 2)
1909 /*
1910 * Only P and Q are corrupted.
1911 * We only care about data stripes recovery,
1912 * can skip this vertical stripe.
1913 */
1914 goto cleanup;
1915 /*
1916 * Otherwise we have one bad data stripe and
1917 * a good P stripe. raid5!
1918 */
1919 goto pstripe;
1920 }
1921
1922 if (failb == rbio->real_stripes - 2) {
1923 raid6_datap_recov(rbio->real_stripes, sectorsize,
1924 faila, pointers);
1925 } else {
1926 raid6_2data_recov(rbio->real_stripes, sectorsize,
1927 faila, failb, pointers);
1928 }
1929 } else {
1930 void *p;
1931
1932 /* Rebuild from P stripe here (raid5 or raid6). */
1933 ASSERT(failb == -1);
1934pstripe:
1935 /* Copy parity block into failed block to start with */
1936 memcpy(pointers[faila], pointers[rbio->nr_data], sectorsize);
1937
1938 /* Rearrange the pointer array */
1939 p = pointers[faila];
1940 for (stripe_nr = faila; stripe_nr < rbio->nr_data - 1;
1941 stripe_nr++)
1942 pointers[stripe_nr] = pointers[stripe_nr + 1];
1943 pointers[rbio->nr_data - 1] = p;
1944
1945 /* Xor in the rest */
1946 run_xor(pointers, rbio->nr_data - 1, sectorsize);
1947
1948 }
1949
1950 /*
1951 * No matter if this is a RMW or recovery, we should have all
1952 * failed sectors repaired in the vertical stripe, thus they are now
1953 * uptodate.
1954 * Especially if we determine to cache the rbio, we need to
1955 * have at least all data sectors uptodate.
1956 *
1957 * If possible, also check if the repaired sector matches its data
1958 * checksum.
1959 */
1960 if (faila >= 0) {
1961 ret = verify_one_sector(rbio, faila, sector_nr);
1962 if (ret < 0)
1963 goto cleanup;
1964
1965 sector = rbio_stripe_sector(rbio, faila, sector_nr);
1966 sector->uptodate = 1;
1967 }
1968 if (failb >= 0) {
1969 ret = verify_one_sector(rbio, failb, sector_nr);
1970 if (ret < 0)
1971 goto cleanup;
1972
1973 sector = rbio_stripe_sector(rbio, failb, sector_nr);
1974 sector->uptodate = 1;
1975 }
1976
1977cleanup:
1978 for (stripe_nr = rbio->real_stripes - 1; stripe_nr >= 0; stripe_nr--)
1979 kunmap_local(unmap_array[stripe_nr]);
1980 return ret;
1981}
1982
1983static int recover_sectors(struct btrfs_raid_bio *rbio)
1984{
1985 void **pointers = NULL;
1986 void **unmap_array = NULL;
1987 int sectornr;
1988 int ret = 0;
1989
1990 /*
1991 * @pointers array stores the pointer for each sector.
1992 *
1993 * @unmap_array stores copy of pointers that does not get reordered
1994 * during reconstruction so that kunmap_local works.
1995 */
1996 pointers = kcalloc(rbio->real_stripes, sizeof(void *), GFP_NOFS);
1997 unmap_array = kcalloc(rbio->real_stripes, sizeof(void *), GFP_NOFS);
1998 if (!pointers || !unmap_array) {
1999 ret = -ENOMEM;
2000 goto out;
2001 }
2002
2003 if (rbio->operation == BTRFS_RBIO_READ_REBUILD) {
2004 spin_lock(&rbio->bio_list_lock);
2005 set_bit(RBIO_RMW_LOCKED_BIT, &rbio->flags);
2006 spin_unlock(&rbio->bio_list_lock);
2007 }
2008
2009 index_rbio_pages(rbio);
2010
2011 for (sectornr = 0; sectornr < rbio->stripe_nsectors; sectornr++) {
2012 ret = recover_vertical(rbio, sectornr, pointers, unmap_array);
2013 if (ret < 0)
2014 break;
2015 }
2016
2017out:
2018 kfree(pointers);
2019 kfree(unmap_array);
2020 return ret;
2021}
2022
2023static void recover_rbio(struct btrfs_raid_bio *rbio)
2024{
2025 struct bio_list bio_list = BIO_EMPTY_LIST;
2026 int total_sector_nr;
2027 int ret = 0;
2028
2029 /*
2030 * Either we're doing recover for a read failure or degraded write,
2031 * caller should have set error bitmap correctly.
2032 */
2033 ASSERT(bitmap_weight(rbio->error_bitmap, rbio->nr_sectors));
2034
2035 /* For recovery, we need to read all sectors including P/Q. */
2036 ret = alloc_rbio_pages(rbio);
2037 if (ret < 0)
2038 goto out;
2039
2040 index_rbio_pages(rbio);
2041
2042 /*
2043 * Read everything that hasn't failed. However this time we will
2044 * not trust any cached sector.
2045 * As we may read out some stale data but higher layer is not reading
2046 * that stale part.
2047 *
2048 * So here we always re-read everything in recovery path.
2049 */
2050 for (total_sector_nr = 0; total_sector_nr < rbio->nr_sectors;
2051 total_sector_nr++) {
2052 int stripe = total_sector_nr / rbio->stripe_nsectors;
2053 int sectornr = total_sector_nr % rbio->stripe_nsectors;
2054 struct sector_ptr *sector;
2055
2056 /*
2057 * Skip the range which has error. It can be a range which is
2058 * marked error (for csum mismatch), or it can be a missing
2059 * device.
2060 */
2061 if (!rbio->bioc->stripes[stripe].dev->bdev ||
2062 test_bit(total_sector_nr, rbio->error_bitmap)) {
2063 /*
2064 * Also set the error bit for missing device, which
2065 * may not yet have its error bit set.
2066 */
2067 set_bit(total_sector_nr, rbio->error_bitmap);
2068 continue;
2069 }
2070
2071 sector = rbio_stripe_sector(rbio, stripe, sectornr);
2072 ret = rbio_add_io_sector(rbio, &bio_list, sector, stripe,
2073 sectornr, REQ_OP_READ);
2074 if (ret < 0) {
2075 bio_list_put(&bio_list);
2076 goto out;
2077 }
2078 }
2079
2080 submit_read_wait_bio_list(rbio, &bio_list);
2081 ret = recover_sectors(rbio);
2082out:
2083 rbio_orig_end_io(rbio, errno_to_blk_status(ret));
2084}
2085
2086static void recover_rbio_work(struct work_struct *work)
2087{
2088 struct btrfs_raid_bio *rbio;
2089
2090 rbio = container_of(work, struct btrfs_raid_bio, work);
2091 if (!lock_stripe_add(rbio))
2092 recover_rbio(rbio);
2093}
2094
2095static void recover_rbio_work_locked(struct work_struct *work)
2096{
2097 recover_rbio(container_of(work, struct btrfs_raid_bio, work));
2098}
2099
2100static void set_rbio_raid6_extra_error(struct btrfs_raid_bio *rbio, int mirror_num)
2101{
2102 bool found = false;
2103 int sector_nr;
2104
2105 /*
2106 * This is for RAID6 extra recovery tries, thus mirror number should
2107 * be large than 2.
2108 * Mirror 1 means read from data stripes. Mirror 2 means rebuild using
2109 * RAID5 methods.
2110 */
2111 ASSERT(mirror_num > 2);
2112 for (sector_nr = 0; sector_nr < rbio->stripe_nsectors; sector_nr++) {
2113 int found_errors;
2114 int faila;
2115 int failb;
2116
2117 found_errors = get_rbio_veritical_errors(rbio, sector_nr,
2118 &faila, &failb);
2119 /* This vertical stripe doesn't have errors. */
2120 if (!found_errors)
2121 continue;
2122
2123 /*
2124 * If we found errors, there should be only one error marked
2125 * by previous set_rbio_range_error().
2126 */
2127 ASSERT(found_errors == 1);
2128 found = true;
2129
2130 /* Now select another stripe to mark as error. */
2131 failb = rbio->real_stripes - (mirror_num - 1);
2132 if (failb <= faila)
2133 failb--;
2134
2135 /* Set the extra bit in error bitmap. */
2136 if (failb >= 0)
2137 set_bit(failb * rbio->stripe_nsectors + sector_nr,
2138 rbio->error_bitmap);
2139 }
2140
2141 /* We should found at least one vertical stripe with error.*/
2142 ASSERT(found);
2143}
2144
2145/*
2146 * the main entry point for reads from the higher layers. This
2147 * is really only called when the normal read path had a failure,
2148 * so we assume the bio they send down corresponds to a failed part
2149 * of the drive.
2150 */
2151void raid56_parity_recover(struct bio *bio, struct btrfs_io_context *bioc,
2152 int mirror_num)
2153{
2154 struct btrfs_fs_info *fs_info = bioc->fs_info;
2155 struct btrfs_raid_bio *rbio;
2156
2157 rbio = alloc_rbio(fs_info, bioc);
2158 if (IS_ERR(rbio)) {
2159 bio->bi_status = errno_to_blk_status(PTR_ERR(rbio));
2160 bio_endio(bio);
2161 return;
2162 }
2163
2164 rbio->operation = BTRFS_RBIO_READ_REBUILD;
2165 rbio_add_bio(rbio, bio);
2166
2167 set_rbio_range_error(rbio, bio);
2168
2169 /*
2170 * Loop retry:
2171 * for 'mirror == 2', reconstruct from all other stripes.
2172 * for 'mirror_num > 2', select a stripe to fail on every retry.
2173 */
2174 if (mirror_num > 2)
2175 set_rbio_raid6_extra_error(rbio, mirror_num);
2176
2177 start_async_work(rbio, recover_rbio_work);
2178}
2179
2180static void fill_data_csums(struct btrfs_raid_bio *rbio)
2181{
2182 struct btrfs_fs_info *fs_info = rbio->bioc->fs_info;
2183 struct btrfs_root *csum_root = btrfs_csum_root(fs_info,
2184 rbio->bioc->full_stripe_logical);
2185 const u64 start = rbio->bioc->full_stripe_logical;
2186 const u32 len = (rbio->nr_data * rbio->stripe_nsectors) <<
2187 fs_info->sectorsize_bits;
2188 int ret;
2189
2190 /* The rbio should not have its csum buffer initialized. */
2191 ASSERT(!rbio->csum_buf && !rbio->csum_bitmap);
2192
2193 /*
2194 * Skip the csum search if:
2195 *
2196 * - The rbio doesn't belong to data block groups
2197 * Then we are doing IO for tree blocks, no need to search csums.
2198 *
2199 * - The rbio belongs to mixed block groups
2200 * This is to avoid deadlock, as we're already holding the full
2201 * stripe lock, if we trigger a metadata read, and it needs to do
2202 * raid56 recovery, we will deadlock.
2203 */
2204 if (!(rbio->bioc->map_type & BTRFS_BLOCK_GROUP_DATA) ||
2205 rbio->bioc->map_type & BTRFS_BLOCK_GROUP_METADATA)
2206 return;
2207
2208 rbio->csum_buf = kzalloc(rbio->nr_data * rbio->stripe_nsectors *
2209 fs_info->csum_size, GFP_NOFS);
2210 rbio->csum_bitmap = bitmap_zalloc(rbio->nr_data * rbio->stripe_nsectors,
2211 GFP_NOFS);
2212 if (!rbio->csum_buf || !rbio->csum_bitmap) {
2213 ret = -ENOMEM;
2214 goto error;
2215 }
2216
2217 ret = btrfs_lookup_csums_bitmap(csum_root, NULL, start, start + len - 1,
2218 rbio->csum_buf, rbio->csum_bitmap);
2219 if (ret < 0)
2220 goto error;
2221 if (bitmap_empty(rbio->csum_bitmap, len >> fs_info->sectorsize_bits))
2222 goto no_csum;
2223 return;
2224
2225error:
2226 /*
2227 * We failed to allocate memory or grab the csum, but it's not fatal,
2228 * we can still continue. But better to warn users that RMW is no
2229 * longer safe for this particular sub-stripe write.
2230 */
2231 btrfs_warn_rl(fs_info,
2232"sub-stripe write for full stripe %llu is not safe, failed to get csum: %d",
2233 rbio->bioc->full_stripe_logical, ret);
2234no_csum:
2235 kfree(rbio->csum_buf);
2236 bitmap_free(rbio->csum_bitmap);
2237 rbio->csum_buf = NULL;
2238 rbio->csum_bitmap = NULL;
2239}
2240
2241static int rmw_read_wait_recover(struct btrfs_raid_bio *rbio)
2242{
2243 struct bio_list bio_list = BIO_EMPTY_LIST;
2244 int total_sector_nr;
2245 int ret = 0;
2246
2247 /*
2248 * Fill the data csums we need for data verification. We need to fill
2249 * the csum_bitmap/csum_buf first, as our endio function will try to
2250 * verify the data sectors.
2251 */
2252 fill_data_csums(rbio);
2253
2254 /*
2255 * Build a list of bios to read all sectors (including data and P/Q).
2256 *
2257 * This behavior is to compensate the later csum verification and recovery.
2258 */
2259 for (total_sector_nr = 0; total_sector_nr < rbio->nr_sectors;
2260 total_sector_nr++) {
2261 struct sector_ptr *sector;
2262 int stripe = total_sector_nr / rbio->stripe_nsectors;
2263 int sectornr = total_sector_nr % rbio->stripe_nsectors;
2264
2265 sector = rbio_stripe_sector(rbio, stripe, sectornr);
2266 ret = rbio_add_io_sector(rbio, &bio_list, sector,
2267 stripe, sectornr, REQ_OP_READ);
2268 if (ret) {
2269 bio_list_put(&bio_list);
2270 return ret;
2271 }
2272 }
2273
2274 /*
2275 * We may or may not have any corrupted sectors (including missing dev
2276 * and csum mismatch), just let recover_sectors() to handle them all.
2277 */
2278 submit_read_wait_bio_list(rbio, &bio_list);
2279 return recover_sectors(rbio);
2280}
2281
2282static void raid_wait_write_end_io(struct bio *bio)
2283{
2284 struct btrfs_raid_bio *rbio = bio->bi_private;
2285 blk_status_t err = bio->bi_status;
2286
2287 if (err)
2288 rbio_update_error_bitmap(rbio, bio);
2289 bio_put(bio);
2290 if (atomic_dec_and_test(&rbio->stripes_pending))
2291 wake_up(&rbio->io_wait);
2292}
2293
2294static void submit_write_bios(struct btrfs_raid_bio *rbio,
2295 struct bio_list *bio_list)
2296{
2297 struct bio *bio;
2298
2299 atomic_set(&rbio->stripes_pending, bio_list_size(bio_list));
2300 while ((bio = bio_list_pop(bio_list))) {
2301 bio->bi_end_io = raid_wait_write_end_io;
2302
2303 if (trace_raid56_write_enabled()) {
2304 struct raid56_bio_trace_info trace_info = { 0 };
2305
2306 bio_get_trace_info(rbio, bio, &trace_info);
2307 trace_raid56_write(rbio, bio, &trace_info);
2308 }
2309 submit_bio(bio);
2310 }
2311}
2312
2313/*
2314 * To determine if we need to read any sector from the disk.
2315 * Should only be utilized in RMW path, to skip cached rbio.
2316 */
2317static bool need_read_stripe_sectors(struct btrfs_raid_bio *rbio)
2318{
2319 int i;
2320
2321 for (i = 0; i < rbio->nr_data * rbio->stripe_nsectors; i++) {
2322 struct sector_ptr *sector = &rbio->stripe_sectors[i];
2323
2324 /*
2325 * We have a sector which doesn't have page nor uptodate,
2326 * thus this rbio can not be cached one, as cached one must
2327 * have all its data sectors present and uptodate.
2328 */
2329 if (!sector->page || !sector->uptodate)
2330 return true;
2331 }
2332 return false;
2333}
2334
2335static void rmw_rbio(struct btrfs_raid_bio *rbio)
2336{
2337 struct bio_list bio_list;
2338 int sectornr;
2339 int ret = 0;
2340
2341 /*
2342 * Allocate the pages for parity first, as P/Q pages will always be
2343 * needed for both full-stripe and sub-stripe writes.
2344 */
2345 ret = alloc_rbio_parity_pages(rbio);
2346 if (ret < 0)
2347 goto out;
2348
2349 /*
2350 * Either full stripe write, or we have every data sector already
2351 * cached, can go to write path immediately.
2352 */
2353 if (!rbio_is_full(rbio) && need_read_stripe_sectors(rbio)) {
2354 /*
2355 * Now we're doing sub-stripe write, also need all data stripes
2356 * to do the full RMW.
2357 */
2358 ret = alloc_rbio_data_pages(rbio);
2359 if (ret < 0)
2360 goto out;
2361
2362 index_rbio_pages(rbio);
2363
2364 ret = rmw_read_wait_recover(rbio);
2365 if (ret < 0)
2366 goto out;
2367 }
2368
2369 /*
2370 * At this stage we're not allowed to add any new bios to the
2371 * bio list any more, anyone else that wants to change this stripe
2372 * needs to do their own rmw.
2373 */
2374 spin_lock(&rbio->bio_list_lock);
2375 set_bit(RBIO_RMW_LOCKED_BIT, &rbio->flags);
2376 spin_unlock(&rbio->bio_list_lock);
2377
2378 bitmap_clear(rbio->error_bitmap, 0, rbio->nr_sectors);
2379
2380 index_rbio_pages(rbio);
2381
2382 /*
2383 * We don't cache full rbios because we're assuming
2384 * the higher layers are unlikely to use this area of
2385 * the disk again soon. If they do use it again,
2386 * hopefully they will send another full bio.
2387 */
2388 if (!rbio_is_full(rbio))
2389 cache_rbio_pages(rbio);
2390 else
2391 clear_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
2392
2393 for (sectornr = 0; sectornr < rbio->stripe_nsectors; sectornr++)
2394 generate_pq_vertical(rbio, sectornr);
2395
2396 bio_list_init(&bio_list);
2397 ret = rmw_assemble_write_bios(rbio, &bio_list);
2398 if (ret < 0)
2399 goto out;
2400
2401 /* We should have at least one bio assembled. */
2402 ASSERT(bio_list_size(&bio_list));
2403 submit_write_bios(rbio, &bio_list);
2404 wait_event(rbio->io_wait, atomic_read(&rbio->stripes_pending) == 0);
2405
2406 /* We may have more errors than our tolerance during the read. */
2407 for (sectornr = 0; sectornr < rbio->stripe_nsectors; sectornr++) {
2408 int found_errors;
2409
2410 found_errors = get_rbio_veritical_errors(rbio, sectornr, NULL, NULL);
2411 if (found_errors > rbio->bioc->max_errors) {
2412 ret = -EIO;
2413 break;
2414 }
2415 }
2416out:
2417 rbio_orig_end_io(rbio, errno_to_blk_status(ret));
2418}
2419
2420static void rmw_rbio_work(struct work_struct *work)
2421{
2422 struct btrfs_raid_bio *rbio;
2423
2424 rbio = container_of(work, struct btrfs_raid_bio, work);
2425 if (lock_stripe_add(rbio) == 0)
2426 rmw_rbio(rbio);
2427}
2428
2429static void rmw_rbio_work_locked(struct work_struct *work)
2430{
2431 rmw_rbio(container_of(work, struct btrfs_raid_bio, work));
2432}
2433
2434/*
2435 * The following code is used to scrub/replace the parity stripe
2436 *
2437 * Caller must have already increased bio_counter for getting @bioc.
2438 *
2439 * Note: We need make sure all the pages that add into the scrub/replace
2440 * raid bio are correct and not be changed during the scrub/replace. That
2441 * is those pages just hold metadata or file data with checksum.
2442 */
2443
2444struct btrfs_raid_bio *raid56_parity_alloc_scrub_rbio(struct bio *bio,
2445 struct btrfs_io_context *bioc,
2446 struct btrfs_device *scrub_dev,
2447 unsigned long *dbitmap, int stripe_nsectors)
2448{
2449 struct btrfs_fs_info *fs_info = bioc->fs_info;
2450 struct btrfs_raid_bio *rbio;
2451 int i;
2452
2453 rbio = alloc_rbio(fs_info, bioc);
2454 if (IS_ERR(rbio))
2455 return NULL;
2456 bio_list_add(&rbio->bio_list, bio);
2457 /*
2458 * This is a special bio which is used to hold the completion handler
2459 * and make the scrub rbio is similar to the other types
2460 */
2461 ASSERT(!bio->bi_iter.bi_size);
2462 rbio->operation = BTRFS_RBIO_PARITY_SCRUB;
2463
2464 /*
2465 * After mapping bioc with BTRFS_MAP_WRITE, parities have been sorted
2466 * to the end position, so this search can start from the first parity
2467 * stripe.
2468 */
2469 for (i = rbio->nr_data; i < rbio->real_stripes; i++) {
2470 if (bioc->stripes[i].dev == scrub_dev) {
2471 rbio->scrubp = i;
2472 break;
2473 }
2474 }
2475 ASSERT_RBIO_STRIPE(i < rbio->real_stripes, rbio, i);
2476
2477 bitmap_copy(&rbio->dbitmap, dbitmap, stripe_nsectors);
2478 return rbio;
2479}
2480
2481/*
2482 * We just scrub the parity that we have correct data on the same horizontal,
2483 * so we needn't allocate all pages for all the stripes.
2484 */
2485static int alloc_rbio_essential_pages(struct btrfs_raid_bio *rbio)
2486{
2487 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
2488 int total_sector_nr;
2489
2490 for (total_sector_nr = 0; total_sector_nr < rbio->nr_sectors;
2491 total_sector_nr++) {
2492 struct page *page;
2493 int sectornr = total_sector_nr % rbio->stripe_nsectors;
2494 int index = (total_sector_nr * sectorsize) >> PAGE_SHIFT;
2495
2496 if (!test_bit(sectornr, &rbio->dbitmap))
2497 continue;
2498 if (rbio->stripe_pages[index])
2499 continue;
2500 page = alloc_page(GFP_NOFS);
2501 if (!page)
2502 return -ENOMEM;
2503 rbio->stripe_pages[index] = page;
2504 }
2505 index_stripe_sectors(rbio);
2506 return 0;
2507}
2508
2509static int finish_parity_scrub(struct btrfs_raid_bio *rbio)
2510{
2511 struct btrfs_io_context *bioc = rbio->bioc;
2512 const u32 sectorsize = bioc->fs_info->sectorsize;
2513 void **pointers = rbio->finish_pointers;
2514 unsigned long *pbitmap = &rbio->finish_pbitmap;
2515 int nr_data = rbio->nr_data;
2516 int stripe;
2517 int sectornr;
2518 bool has_qstripe;
2519 struct sector_ptr p_sector = { 0 };
2520 struct sector_ptr q_sector = { 0 };
2521 struct bio_list bio_list;
2522 int is_replace = 0;
2523 int ret;
2524
2525 bio_list_init(&bio_list);
2526
2527 if (rbio->real_stripes - rbio->nr_data == 1)
2528 has_qstripe = false;
2529 else if (rbio->real_stripes - rbio->nr_data == 2)
2530 has_qstripe = true;
2531 else
2532 BUG();
2533
2534 /*
2535 * Replace is running and our P/Q stripe is being replaced, then we
2536 * need to duplicate the final write to replace target.
2537 */
2538 if (bioc->replace_nr_stripes && bioc->replace_stripe_src == rbio->scrubp) {
2539 is_replace = 1;
2540 bitmap_copy(pbitmap, &rbio->dbitmap, rbio->stripe_nsectors);
2541 }
2542
2543 /*
2544 * Because the higher layers(scrubber) are unlikely to
2545 * use this area of the disk again soon, so don't cache
2546 * it.
2547 */
2548 clear_bit(RBIO_CACHE_READY_BIT, &rbio->flags);
2549
2550 p_sector.page = alloc_page(GFP_NOFS);
2551 if (!p_sector.page)
2552 return -ENOMEM;
2553 p_sector.pgoff = 0;
2554 p_sector.uptodate = 1;
2555
2556 if (has_qstripe) {
2557 /* RAID6, allocate and map temp space for the Q stripe */
2558 q_sector.page = alloc_page(GFP_NOFS);
2559 if (!q_sector.page) {
2560 __free_page(p_sector.page);
2561 p_sector.page = NULL;
2562 return -ENOMEM;
2563 }
2564 q_sector.pgoff = 0;
2565 q_sector.uptodate = 1;
2566 pointers[rbio->real_stripes - 1] = kmap_local_page(q_sector.page);
2567 }
2568
2569 bitmap_clear(rbio->error_bitmap, 0, rbio->nr_sectors);
2570
2571 /* Map the parity stripe just once */
2572 pointers[nr_data] = kmap_local_page(p_sector.page);
2573
2574 for_each_set_bit(sectornr, &rbio->dbitmap, rbio->stripe_nsectors) {
2575 struct sector_ptr *sector;
2576 void *parity;
2577
2578 /* first collect one page from each data stripe */
2579 for (stripe = 0; stripe < nr_data; stripe++) {
2580 sector = sector_in_rbio(rbio, stripe, sectornr, 0);
2581 pointers[stripe] = kmap_local_page(sector->page) +
2582 sector->pgoff;
2583 }
2584
2585 if (has_qstripe) {
2586 assert_rbio(rbio);
2587 /* RAID6, call the library function to fill in our P/Q */
2588 raid6_call.gen_syndrome(rbio->real_stripes, sectorsize,
2589 pointers);
2590 } else {
2591 /* raid5 */
2592 memcpy(pointers[nr_data], pointers[0], sectorsize);
2593 run_xor(pointers + 1, nr_data - 1, sectorsize);
2594 }
2595
2596 /* Check scrubbing parity and repair it */
2597 sector = rbio_stripe_sector(rbio, rbio->scrubp, sectornr);
2598 parity = kmap_local_page(sector->page) + sector->pgoff;
2599 if (memcmp(parity, pointers[rbio->scrubp], sectorsize) != 0)
2600 memcpy(parity, pointers[rbio->scrubp], sectorsize);
2601 else
2602 /* Parity is right, needn't writeback */
2603 bitmap_clear(&rbio->dbitmap, sectornr, 1);
2604 kunmap_local(parity);
2605
2606 for (stripe = nr_data - 1; stripe >= 0; stripe--)
2607 kunmap_local(pointers[stripe]);
2608 }
2609
2610 kunmap_local(pointers[nr_data]);
2611 __free_page(p_sector.page);
2612 p_sector.page = NULL;
2613 if (q_sector.page) {
2614 kunmap_local(pointers[rbio->real_stripes - 1]);
2615 __free_page(q_sector.page);
2616 q_sector.page = NULL;
2617 }
2618
2619 /*
2620 * time to start writing. Make bios for everything from the
2621 * higher layers (the bio_list in our rbio) and our p/q. Ignore
2622 * everything else.
2623 */
2624 for_each_set_bit(sectornr, &rbio->dbitmap, rbio->stripe_nsectors) {
2625 struct sector_ptr *sector;
2626
2627 sector = rbio_stripe_sector(rbio, rbio->scrubp, sectornr);
2628 ret = rbio_add_io_sector(rbio, &bio_list, sector, rbio->scrubp,
2629 sectornr, REQ_OP_WRITE);
2630 if (ret)
2631 goto cleanup;
2632 }
2633
2634 if (!is_replace)
2635 goto submit_write;
2636
2637 /*
2638 * Replace is running and our parity stripe needs to be duplicated to
2639 * the target device. Check we have a valid source stripe number.
2640 */
2641 ASSERT_RBIO(rbio->bioc->replace_stripe_src >= 0, rbio);
2642 for_each_set_bit(sectornr, pbitmap, rbio->stripe_nsectors) {
2643 struct sector_ptr *sector;
2644
2645 sector = rbio_stripe_sector(rbio, rbio->scrubp, sectornr);
2646 ret = rbio_add_io_sector(rbio, &bio_list, sector,
2647 rbio->real_stripes,
2648 sectornr, REQ_OP_WRITE);
2649 if (ret)
2650 goto cleanup;
2651 }
2652
2653submit_write:
2654 submit_write_bios(rbio, &bio_list);
2655 return 0;
2656
2657cleanup:
2658 bio_list_put(&bio_list);
2659 return ret;
2660}
2661
2662static inline int is_data_stripe(struct btrfs_raid_bio *rbio, int stripe)
2663{
2664 if (stripe >= 0 && stripe < rbio->nr_data)
2665 return 1;
2666 return 0;
2667}
2668
2669static int recover_scrub_rbio(struct btrfs_raid_bio *rbio)
2670{
2671 void **pointers = NULL;
2672 void **unmap_array = NULL;
2673 int sector_nr;
2674 int ret = 0;
2675
2676 /*
2677 * @pointers array stores the pointer for each sector.
2678 *
2679 * @unmap_array stores copy of pointers that does not get reordered
2680 * during reconstruction so that kunmap_local works.
2681 */
2682 pointers = kcalloc(rbio->real_stripes, sizeof(void *), GFP_NOFS);
2683 unmap_array = kcalloc(rbio->real_stripes, sizeof(void *), GFP_NOFS);
2684 if (!pointers || !unmap_array) {
2685 ret = -ENOMEM;
2686 goto out;
2687 }
2688
2689 for (sector_nr = 0; sector_nr < rbio->stripe_nsectors; sector_nr++) {
2690 int dfail = 0, failp = -1;
2691 int faila;
2692 int failb;
2693 int found_errors;
2694
2695 found_errors = get_rbio_veritical_errors(rbio, sector_nr,
2696 &faila, &failb);
2697 if (found_errors > rbio->bioc->max_errors) {
2698 ret = -EIO;
2699 goto out;
2700 }
2701 if (found_errors == 0)
2702 continue;
2703
2704 /* We should have at least one error here. */
2705 ASSERT(faila >= 0 || failb >= 0);
2706
2707 if (is_data_stripe(rbio, faila))
2708 dfail++;
2709 else if (is_parity_stripe(faila))
2710 failp = faila;
2711
2712 if (is_data_stripe(rbio, failb))
2713 dfail++;
2714 else if (is_parity_stripe(failb))
2715 failp = failb;
2716 /*
2717 * Because we can not use a scrubbing parity to repair the
2718 * data, so the capability of the repair is declined. (In the
2719 * case of RAID5, we can not repair anything.)
2720 */
2721 if (dfail > rbio->bioc->max_errors - 1) {
2722 ret = -EIO;
2723 goto out;
2724 }
2725 /*
2726 * If all data is good, only parity is correctly, just repair
2727 * the parity, no need to recover data stripes.
2728 */
2729 if (dfail == 0)
2730 continue;
2731
2732 /*
2733 * Here means we got one corrupted data stripe and one
2734 * corrupted parity on RAID6, if the corrupted parity is
2735 * scrubbing parity, luckily, use the other one to repair the
2736 * data, or we can not repair the data stripe.
2737 */
2738 if (failp != rbio->scrubp) {
2739 ret = -EIO;
2740 goto out;
2741 }
2742
2743 ret = recover_vertical(rbio, sector_nr, pointers, unmap_array);
2744 if (ret < 0)
2745 goto out;
2746 }
2747out:
2748 kfree(pointers);
2749 kfree(unmap_array);
2750 return ret;
2751}
2752
2753static int scrub_assemble_read_bios(struct btrfs_raid_bio *rbio)
2754{
2755 struct bio_list bio_list = BIO_EMPTY_LIST;
2756 int total_sector_nr;
2757 int ret = 0;
2758
2759 /* Build a list of bios to read all the missing parts. */
2760 for (total_sector_nr = 0; total_sector_nr < rbio->nr_sectors;
2761 total_sector_nr++) {
2762 int sectornr = total_sector_nr % rbio->stripe_nsectors;
2763 int stripe = total_sector_nr / rbio->stripe_nsectors;
2764 struct sector_ptr *sector;
2765
2766 /* No data in the vertical stripe, no need to read. */
2767 if (!test_bit(sectornr, &rbio->dbitmap))
2768 continue;
2769
2770 /*
2771 * We want to find all the sectors missing from the rbio and
2772 * read them from the disk. If sector_in_rbio() finds a sector
2773 * in the bio list we don't need to read it off the stripe.
2774 */
2775 sector = sector_in_rbio(rbio, stripe, sectornr, 1);
2776 if (sector)
2777 continue;
2778
2779 sector = rbio_stripe_sector(rbio, stripe, sectornr);
2780 /*
2781 * The bio cache may have handed us an uptodate sector. If so,
2782 * use it.
2783 */
2784 if (sector->uptodate)
2785 continue;
2786
2787 ret = rbio_add_io_sector(rbio, &bio_list, sector, stripe,
2788 sectornr, REQ_OP_READ);
2789 if (ret) {
2790 bio_list_put(&bio_list);
2791 return ret;
2792 }
2793 }
2794
2795 submit_read_wait_bio_list(rbio, &bio_list);
2796 return 0;
2797}
2798
2799static void scrub_rbio(struct btrfs_raid_bio *rbio)
2800{
2801 int sector_nr;
2802 int ret;
2803
2804 ret = alloc_rbio_essential_pages(rbio);
2805 if (ret)
2806 goto out;
2807
2808 bitmap_clear(rbio->error_bitmap, 0, rbio->nr_sectors);
2809
2810 ret = scrub_assemble_read_bios(rbio);
2811 if (ret < 0)
2812 goto out;
2813
2814 /* We may have some failures, recover the failed sectors first. */
2815 ret = recover_scrub_rbio(rbio);
2816 if (ret < 0)
2817 goto out;
2818
2819 /*
2820 * We have every sector properly prepared. Can finish the scrub
2821 * and writeback the good content.
2822 */
2823 ret = finish_parity_scrub(rbio);
2824 wait_event(rbio->io_wait, atomic_read(&rbio->stripes_pending) == 0);
2825 for (sector_nr = 0; sector_nr < rbio->stripe_nsectors; sector_nr++) {
2826 int found_errors;
2827
2828 found_errors = get_rbio_veritical_errors(rbio, sector_nr, NULL, NULL);
2829 if (found_errors > rbio->bioc->max_errors) {
2830 ret = -EIO;
2831 break;
2832 }
2833 }
2834out:
2835 rbio_orig_end_io(rbio, errno_to_blk_status(ret));
2836}
2837
2838static void scrub_rbio_work_locked(struct work_struct *work)
2839{
2840 scrub_rbio(container_of(work, struct btrfs_raid_bio, work));
2841}
2842
2843void raid56_parity_submit_scrub_rbio(struct btrfs_raid_bio *rbio)
2844{
2845 if (!lock_stripe_add(rbio))
2846 start_async_work(rbio, scrub_rbio_work_locked);
2847}
2848
2849/*
2850 * This is for scrub call sites where we already have correct data contents.
2851 * This allows us to avoid reading data stripes again.
2852 *
2853 * Unfortunately here we have to do page copy, other than reusing the pages.
2854 * This is due to the fact rbio has its own page management for its cache.
2855 */
2856void raid56_parity_cache_data_pages(struct btrfs_raid_bio *rbio,
2857 struct page **data_pages, u64 data_logical)
2858{
2859 const u64 offset_in_full_stripe = data_logical -
2860 rbio->bioc->full_stripe_logical;
2861 const int page_index = offset_in_full_stripe >> PAGE_SHIFT;
2862 const u32 sectorsize = rbio->bioc->fs_info->sectorsize;
2863 const u32 sectors_per_page = PAGE_SIZE / sectorsize;
2864 int ret;
2865
2866 /*
2867 * If we hit ENOMEM temporarily, but later at
2868 * raid56_parity_submit_scrub_rbio() time it succeeded, we just do
2869 * the extra read, not a big deal.
2870 *
2871 * If we hit ENOMEM later at raid56_parity_submit_scrub_rbio() time,
2872 * the bio would got proper error number set.
2873 */
2874 ret = alloc_rbio_data_pages(rbio);
2875 if (ret < 0)
2876 return;
2877
2878 /* data_logical must be at stripe boundary and inside the full stripe. */
2879 ASSERT(IS_ALIGNED(offset_in_full_stripe, BTRFS_STRIPE_LEN));
2880 ASSERT(offset_in_full_stripe < (rbio->nr_data << BTRFS_STRIPE_LEN_SHIFT));
2881
2882 for (int page_nr = 0; page_nr < (BTRFS_STRIPE_LEN >> PAGE_SHIFT); page_nr++) {
2883 struct page *dst = rbio->stripe_pages[page_nr + page_index];
2884 struct page *src = data_pages[page_nr];
2885
2886 memcpy_page(dst, 0, src, 0, PAGE_SIZE);
2887 for (int sector_nr = sectors_per_page * page_index;
2888 sector_nr < sectors_per_page * (page_index + 1);
2889 sector_nr++)
2890 rbio->stripe_sectors[sector_nr].uptodate = true;
2891 }
2892}