git.sesse.net Git - bcachefs-tools-debian/blob - libbcachefs/ec.c

   1 // SPDX-License-Identifier: GPL-2.0
   2
   3 /* erasure coding */
   4
   5 #include "bcachefs.h"
   6 #include "alloc_foreground.h"
   7 #include "backpointers.h"
   8 #include "bkey_buf.h"
   9 #include "bset.h"
  10 #include "btree_gc.h"
  11 #include "btree_update.h"
  12 #include "btree_write_buffer.h"
  13 #include "buckets.h"
  14 #include "disk_groups.h"
  15 #include "ec.h"
  16 #include "error.h"
  17 #include "io.h"
  18 #include "keylist.h"
  19 #include "recovery.h"
  20 #include "replicas.h"
  21 #include "super-io.h"
  22 #include "util.h"
  23
  24 #include <linux/sort.h>
  25
  26 #ifdef __KERNEL__
  27
  28 #include <linux/raid/pq.h>
  29 #include <linux/raid/xor.h>
  30
  31 static void raid5_recov(unsigned disks, unsigned failed_idx,
  32                         size_t size, void **data)
  33 {
  34         unsigned i = 2, nr;
  35
  36         BUG_ON(failed_idx >= disks);
  37
  38         swap(data[0], data[failed_idx]);
  39         memcpy(data[0], data[1], size);
  40
  41         while (i < disks) {
  42                 nr = min_t(unsigned, disks - i, MAX_XOR_BLOCKS);
  43                 xor_blocks(nr, size, data[0], data + i);
  44                 i += nr;
  45         }
  46
  47         swap(data[0], data[failed_idx]);
  48 }
  49
  50 static void raid_gen(int nd, int np, size_t size, void **v)
  51 {
  52         if (np >= 1)
  53                 raid5_recov(nd + np, nd, size, v);
  54         if (np >= 2)
  55                 raid6_call.gen_syndrome(nd + np, size, v);
  56         BUG_ON(np > 2);
  57 }
  58
  59 static void raid_rec(int nr, int *ir, int nd, int np, size_t size, void **v)
  60 {
  61         switch (nr) {
  62         case 0:
  63                 break;
  64         case 1:
  65                 if (ir[0] < nd + 1)
  66                         raid5_recov(nd + 1, ir[0], size, v);
  67                 else
  68                         raid6_call.gen_syndrome(nd + np, size, v);
  69                 break;
  70         case 2:
  71                 if (ir[1] < nd) {
  72                         /* data+data failure. */
  73                         raid6_2data_recov(nd + np, size, ir[0], ir[1], v);
  74                 } else if (ir[0] < nd) {
  75                         /* data + p/q failure */
  76
  77                         if (ir[1] == nd) /* data + p failure */
  78                                 raid6_datap_recov(nd + np, size, ir[0], v);
  79                         else { /* data + q failure */
  80                                 raid5_recov(nd + 1, ir[0], size, v);
  81                                 raid6_call.gen_syndrome(nd + np, size, v);
  82                         }
  83                 } else {
  84                         raid_gen(nd, np, size, v);
  85                 }
  86                 break;
  87         default:
  88                 BUG();
  89         }
  90 }
  91
  92 #else
  93
  94 #include <raid/raid.h>
  95
  96 #endif
  97
  98 struct ec_bio {
  99         struct bch_dev          *ca;
 100         struct ec_stripe_buf    *buf;
 101         size_t                  idx;
 102         struct bio              bio;
 103 };
 104
 105 /* Stripes btree keys: */
 106
 107 int bch2_stripe_invalid(const struct bch_fs *c, struct bkey_s_c k,
 108                         unsigned flags, struct printbuf *err)
 109 {
 110         const struct bch_stripe *s = bkey_s_c_to_stripe(k).v;
 111
 112         if (bkey_eq(k.k->p, POS_MIN)) {
 113                 prt_printf(err, "stripe at POS_MIN");
 114                 return -BCH_ERR_invalid_bkey;
 115         }
 116
 117         if (k.k->p.inode) {
 118                 prt_printf(err, "nonzero inode field");
 119                 return -BCH_ERR_invalid_bkey;
 120         }
 121
 122         if (bkey_val_bytes(k.k) < sizeof(*s)) {
 123                 prt_printf(err, "incorrect value size (%zu < %zu)",
 124                        bkey_val_bytes(k.k), sizeof(*s));
 125                 return -BCH_ERR_invalid_bkey;
 126         }
 127
 128         if (bkey_val_u64s(k.k) < stripe_val_u64s(s)) {
 129                 prt_printf(err, "incorrect value size (%zu < %u)",
 130                        bkey_val_u64s(k.k), stripe_val_u64s(s));
 131                 return -BCH_ERR_invalid_bkey;
 132         }
 133
 134         return bch2_bkey_ptrs_invalid(c, k, flags, err);
 135 }
 136
 137 void bch2_stripe_to_text(struct printbuf *out, struct bch_fs *c,
 138                          struct bkey_s_c k)
 139 {
 140         const struct bch_stripe *s = bkey_s_c_to_stripe(k).v;
 141         unsigned i, nr_data = s->nr_blocks - s->nr_redundant;
 142
 143         prt_printf(out, "algo %u sectors %u blocks %u:%u csum %u gran %u",
 144                s->algorithm,
 145                le16_to_cpu(s->sectors),
 146                nr_data,
 147                s->nr_redundant,
 148                s->csum_type,
 149                1U << s->csum_granularity_bits);
 150
 151         for (i = 0; i < s->nr_blocks; i++) {
 152                 const struct bch_extent_ptr *ptr = s->ptrs + i;
 153                 struct bch_dev *ca = bch_dev_bkey_exists(c, ptr->dev);
 154                 u32 offset;
 155                 u64 b = sector_to_bucket_and_offset(ca, ptr->offset, &offset);
 156
 157                 prt_printf(out, " %u:%llu:%u", ptr->dev, b, offset);
 158                 if (i < nr_data)
 159                         prt_printf(out, "#%u", stripe_blockcount_get(s, i));
 160                 if (ptr_stale(ca, ptr))
 161                         prt_printf(out, " stale");
 162         }
 163 }
 164
 165 /* returns blocknr in stripe that we matched: */
 166 static const struct bch_extent_ptr *bkey_matches_stripe(struct bch_stripe *s,
 167                                                 struct bkey_s_c k, unsigned *block)
 168 {
 169         struct bkey_ptrs_c ptrs = bch2_bkey_ptrs_c(k);
 170         const struct bch_extent_ptr *ptr;
 171         unsigned i, nr_data = s->nr_blocks - s->nr_redundant;
 172
 173         bkey_for_each_ptr(ptrs, ptr)
 174                 for (i = 0; i < nr_data; i++)
 175                         if (__bch2_ptr_matches_stripe(&s->ptrs[i], ptr,
 176                                                       le16_to_cpu(s->sectors))) {
 177                                 *block = i;
 178                                 return ptr;
 179                         }
 180
 181         return NULL;
 182 }
 183
 184 static bool extent_has_stripe_ptr(struct bkey_s_c k, u64 idx)
 185 {
 186         switch (k.k->type) {
 187         case KEY_TYPE_extent: {
 188                 struct bkey_s_c_extent e = bkey_s_c_to_extent(k);
 189                 const union bch_extent_entry *entry;
 190
 191                 extent_for_each_entry(e, entry)
 192                         if (extent_entry_type(entry) ==
 193                             BCH_EXTENT_ENTRY_stripe_ptr &&
 194                             entry->stripe_ptr.idx == idx)
 195                                 return true;
 196
 197                 break;
 198         }
 199         }
 200
 201         return false;
 202 }
 203
 204 /* Stripe bufs: */
 205
 206 static void ec_stripe_buf_exit(struct ec_stripe_buf *buf)
 207 {
 208         unsigned i;
 209
 210         for (i = 0; i < buf->key.v.nr_blocks; i++) {
 211                 kvpfree(buf->data[i], buf->size << 9);
 212                 buf->data[i] = NULL;
 213         }
 214 }
 215
 216 static int ec_stripe_buf_init(struct ec_stripe_buf *buf,
 217                                unsigned offset, unsigned size)
 218 {
 219         struct bch_stripe *v = &buf->key.v;
 220         unsigned csum_granularity = 1U << v->csum_granularity_bits;
 221         unsigned end = offset + size;
 222         unsigned i;
 223
 224         BUG_ON(end > le16_to_cpu(v->sectors));
 225
 226         offset  = round_down(offset, csum_granularity);
 227         end     = min_t(unsigned, le16_to_cpu(v->sectors),
 228                         round_up(end, csum_granularity));
 229
 230         buf->offset     = offset;
 231         buf->size       = end - offset;
 232
 233         memset(buf->valid, 0xFF, sizeof(buf->valid));
 234
 235         for (i = 0; i < buf->key.v.nr_blocks; i++) {
 236                 buf->data[i] = kvpmalloc(buf->size << 9, GFP_KERNEL);
 237                 if (!buf->data[i])
 238                         goto err;
 239         }
 240
 241         return 0;
 242 err:
 243         ec_stripe_buf_exit(buf);
 244         return -ENOMEM;
 245 }
 246
 247 /* Checksumming: */
 248
 249 static struct bch_csum ec_block_checksum(struct ec_stripe_buf *buf,
 250                                          unsigned block, unsigned offset)
 251 {
 252         struct bch_stripe *v = &buf->key.v;
 253         unsigned csum_granularity = 1 << v->csum_granularity_bits;
 254         unsigned end = buf->offset + buf->size;
 255         unsigned len = min(csum_granularity, end - offset);
 256
 257         BUG_ON(offset >= end);
 258         BUG_ON(offset <  buf->offset);
 259         BUG_ON(offset & (csum_granularity - 1));
 260         BUG_ON(offset + len != le16_to_cpu(v->sectors) &&
 261                (len & (csum_granularity - 1)));
 262
 263         return bch2_checksum(NULL, v->csum_type,
 264                              null_nonce(),
 265                              buf->data[block] + ((offset - buf->offset) << 9),
 266                              len << 9);
 267 }
 268
 269 static void ec_generate_checksums(struct ec_stripe_buf *buf)
 270 {
 271         struct bch_stripe *v = &buf->key.v;
 272         unsigned i, j, csums_per_device = stripe_csums_per_device(v);
 273
 274         if (!v->csum_type)
 275                 return;
 276
 277         BUG_ON(buf->offset);
 278         BUG_ON(buf->size != le16_to_cpu(v->sectors));
 279
 280         for (i = 0; i < v->nr_blocks; i++)
 281                 for (j = 0; j < csums_per_device; j++)
 282                         stripe_csum_set(v, i, j,
 283                                 ec_block_checksum(buf, i, j << v->csum_granularity_bits));
 284 }
 285
 286 static void ec_validate_checksums(struct bch_fs *c, struct ec_stripe_buf *buf)
 287 {
 288         struct bch_stripe *v = &buf->key.v;
 289         unsigned csum_granularity = 1 << v->csum_granularity_bits;
 290         unsigned i;
 291
 292         if (!v->csum_type)
 293                 return;
 294
 295         for (i = 0; i < v->nr_blocks; i++) {
 296                 unsigned offset = buf->offset;
 297                 unsigned end = buf->offset + buf->size;
 298
 299                 if (!test_bit(i, buf->valid))
 300                         continue;
 301
 302                 while (offset < end) {
 303                         unsigned j = offset >> v->csum_granularity_bits;
 304                         unsigned len = min(csum_granularity, end - offset);
 305                         struct bch_csum want = stripe_csum_get(v, i, j);
 306                         struct bch_csum got = ec_block_checksum(buf, i, offset);
 307
 308                         if (bch2_crc_cmp(want, got)) {
 309                                 struct printbuf buf2 = PRINTBUF;
 310
 311                                 bch2_bkey_val_to_text(&buf2, c, bkey_i_to_s_c(&buf->key.k_i));
 312
 313                                 bch_err_ratelimited(c,
 314                                         "stripe checksum error for %ps at %u:%u: csum type %u, expected %llx got %llx\n%s",
 315                                         (void *) _RET_IP_, i, j, v->csum_type,
 316                                         want.lo, got.lo, buf2.buf);
 317                                 printbuf_exit(&buf2);
 318                                 clear_bit(i, buf->valid);
 319                                 break;
 320                         }
 321
 322                         offset += len;
 323                 }
 324         }
 325 }
 326
 327 /* Erasure coding: */
 328
 329 static void ec_generate_ec(struct ec_stripe_buf *buf)
 330 {
 331         struct bch_stripe *v = &buf->key.v;
 332         unsigned nr_data = v->nr_blocks - v->nr_redundant;
 333         unsigned bytes = le16_to_cpu(v->sectors) << 9;
 334
 335         raid_gen(nr_data, v->nr_redundant, bytes, buf->data);
 336 }
 337
 338 static unsigned ec_nr_failed(struct ec_stripe_buf *buf)
 339 {
 340         return buf->key.v.nr_blocks -
 341                 bitmap_weight(buf->valid, buf->key.v.nr_blocks);
 342 }
 343
 344 static int ec_do_recov(struct bch_fs *c, struct ec_stripe_buf *buf)
 345 {
 346         struct bch_stripe *v = &buf->key.v;
 347         unsigned i, failed[BCH_BKEY_PTRS_MAX], nr_failed = 0;
 348         unsigned nr_data = v->nr_blocks - v->nr_redundant;
 349         unsigned bytes = buf->size << 9;
 350
 351         if (ec_nr_failed(buf) > v->nr_redundant) {
 352                 bch_err_ratelimited(c,
 353                         "error doing reconstruct read: unable to read enough blocks");
 354                 return -1;
 355         }
 356
 357         for (i = 0; i < nr_data; i++)
 358                 if (!test_bit(i, buf->valid))
 359                         failed[nr_failed++] = i;
 360
 361         raid_rec(nr_failed, failed, nr_data, v->nr_redundant, bytes, buf->data);
 362         return 0;
 363 }
 364
 365 /* IO: */
 366
 367 static void ec_block_endio(struct bio *bio)
 368 {
 369         struct ec_bio *ec_bio = container_of(bio, struct ec_bio, bio);
 370         struct bch_stripe *v = &ec_bio->buf->key.v;
 371         struct bch_extent_ptr *ptr = &v->ptrs[ec_bio->idx];
 372         struct bch_dev *ca = ec_bio->ca;
 373         struct closure *cl = bio->bi_private;
 374
 375         if (bch2_dev_io_err_on(bio->bi_status, ca, "erasure coding %s error: %s",
 376                                bio_data_dir(bio) ? "write" : "read",
 377                                bch2_blk_status_to_str(bio->bi_status)))
 378                 clear_bit(ec_bio->idx, ec_bio->buf->valid);
 379
 380         if (ptr_stale(ca, ptr)) {
 381                 bch_err_ratelimited(ca->fs,
 382                                     "error %s stripe: stale pointer after io",
 383                                     bio_data_dir(bio) == READ ? "reading from" : "writing to");
 384                 clear_bit(ec_bio->idx, ec_bio->buf->valid);
 385         }
 386
 387         bio_put(&ec_bio->bio);
 388         percpu_ref_put(&ca->io_ref);
 389         closure_put(cl);
 390 }
 391
 392 static void ec_block_io(struct bch_fs *c, struct ec_stripe_buf *buf,
 393                         unsigned rw, unsigned idx, struct closure *cl)
 394 {
 395         struct bch_stripe *v = &buf->key.v;
 396         unsigned offset = 0, bytes = buf->size << 9;
 397         struct bch_extent_ptr *ptr = &v->ptrs[idx];
 398         struct bch_dev *ca = bch_dev_bkey_exists(c, ptr->dev);
 399         enum bch_data_type data_type = idx < buf->key.v.nr_blocks - buf->key.v.nr_redundant
 400                 ? BCH_DATA_user
 401                 : BCH_DATA_parity;
 402
 403         if (ptr_stale(ca, ptr)) {
 404                 bch_err_ratelimited(c,
 405                                     "error %s stripe: stale pointer",
 406                                     rw == READ ? "reading from" : "writing to");
 407                 clear_bit(idx, buf->valid);
 408                 return;
 409         }
 410
 411         if (!bch2_dev_get_ioref(ca, rw)) {
 412                 clear_bit(idx, buf->valid);
 413                 return;
 414         }
 415
 416         this_cpu_add(ca->io_done->sectors[rw][data_type], buf->size);
 417
 418         while (offset < bytes) {
 419                 unsigned nr_iovecs = min_t(size_t, BIO_MAX_VECS,
 420                                            DIV_ROUND_UP(bytes, PAGE_SIZE));
 421                 unsigned b = min_t(size_t, bytes - offset,
 422                                    nr_iovecs << PAGE_SHIFT);
 423                 struct ec_bio *ec_bio;
 424
 425                 ec_bio = container_of(bio_alloc_bioset(ca->disk_sb.bdev,
 426                                                        nr_iovecs,
 427                                                        rw,
 428                                                        GFP_KERNEL,
 429                                                        &c->ec_bioset),
 430                                       struct ec_bio, bio);
 431
 432                 ec_bio->ca                      = ca;
 433                 ec_bio->buf                     = buf;
 434                 ec_bio->idx                     = idx;
 435
 436                 ec_bio->bio.bi_iter.bi_sector   = ptr->offset + buf->offset + (offset >> 9);
 437                 ec_bio->bio.bi_end_io           = ec_block_endio;
 438                 ec_bio->bio.bi_private          = cl;
 439
 440                 bch2_bio_map(&ec_bio->bio, buf->data[idx] + offset, b);
 441
 442                 closure_get(cl);
 443                 percpu_ref_get(&ca->io_ref);
 444
 445                 submit_bio(&ec_bio->bio);
 446
 447                 offset += b;
 448         }
 449
 450         percpu_ref_put(&ca->io_ref);
 451 }
 452
 453 static int get_stripe_key_trans(struct btree_trans *trans, u64 idx,
 454                                 struct ec_stripe_buf *stripe)
 455 {
 456         struct btree_iter iter;
 457         struct bkey_s_c k;
 458         int ret;
 459
 460         bch2_trans_iter_init(trans, &iter, BTREE_ID_stripes,
 461                              POS(0, idx), BTREE_ITER_SLOTS);
 462         k = bch2_btree_iter_peek_slot(&iter);
 463         ret = bkey_err(k);
 464         if (ret)
 465                 goto err;
 466         if (k.k->type != KEY_TYPE_stripe) {
 467                 ret = -ENOENT;
 468                 goto err;
 469         }
 470         bkey_reassemble(&stripe->key.k_i, k);
 471 err:
 472         bch2_trans_iter_exit(trans, &iter);
 473         return ret;
 474 }
 475
 476 static int get_stripe_key(struct bch_fs *c, u64 idx, struct ec_stripe_buf *stripe)
 477 {
 478         return bch2_trans_run(c, get_stripe_key_trans(&trans, idx, stripe));
 479 }
 480
 481 /* recovery read path: */
 482 int bch2_ec_read_extent(struct bch_fs *c, struct bch_read_bio *rbio)
 483 {
 484         struct ec_stripe_buf *buf;
 485         struct closure cl;
 486         struct bch_stripe *v;
 487         unsigned i, offset;
 488         int ret = 0;
 489
 490         closure_init_stack(&cl);
 491
 492         BUG_ON(!rbio->pick.has_ec);
 493
 494         buf = kzalloc(sizeof(*buf), GFP_NOIO);
 495         if (!buf)
 496                 return -ENOMEM;
 497
 498         ret = get_stripe_key(c, rbio->pick.ec.idx, buf);
 499         if (ret) {
 500                 bch_err_ratelimited(c,
 501                         "error doing reconstruct read: error %i looking up stripe", ret);
 502                 kfree(buf);
 503                 return -EIO;
 504         }
 505
 506         v = &buf->key.v;
 507
 508         if (!bch2_ptr_matches_stripe(v, rbio->pick)) {
 509                 bch_err_ratelimited(c,
 510                         "error doing reconstruct read: pointer doesn't match stripe");
 511                 ret = -EIO;
 512                 goto err;
 513         }
 514
 515         offset = rbio->bio.bi_iter.bi_sector - v->ptrs[rbio->pick.ec.block].offset;
 516         if (offset + bio_sectors(&rbio->bio) > le16_to_cpu(v->sectors)) {
 517                 bch_err_ratelimited(c,
 518                         "error doing reconstruct read: read is bigger than stripe");
 519                 ret = -EIO;
 520                 goto err;
 521         }
 522
 523         ret = ec_stripe_buf_init(buf, offset, bio_sectors(&rbio->bio));
 524         if (ret)
 525                 goto err;
 526
 527         for (i = 0; i < v->nr_blocks; i++)
 528                 ec_block_io(c, buf, REQ_OP_READ, i, &cl);
 529
 530         closure_sync(&cl);
 531
 532         if (ec_nr_failed(buf) > v->nr_redundant) {
 533                 bch_err_ratelimited(c,
 534                         "error doing reconstruct read: unable to read enough blocks");
 535                 ret = -EIO;
 536                 goto err;
 537         }
 538
 539         ec_validate_checksums(c, buf);
 540
 541         ret = ec_do_recov(c, buf);
 542         if (ret)
 543                 goto err;
 544
 545         memcpy_to_bio(&rbio->bio, rbio->bio.bi_iter,
 546                       buf->data[rbio->pick.ec.block] + ((offset - buf->offset) << 9));
 547 err:
 548         ec_stripe_buf_exit(buf);
 549         kfree(buf);
 550         return ret;
 551 }
 552
 553 /* stripe bucket accounting: */
 554
 555 static int __ec_stripe_mem_alloc(struct bch_fs *c, size_t idx, gfp_t gfp)
 556 {
 557         ec_stripes_heap n, *h = &c->ec_stripes_heap;
 558
 559         if (idx >= h->size) {
 560                 if (!init_heap(&n, max(1024UL, roundup_pow_of_two(idx + 1)), gfp))
 561                         return -ENOMEM;
 562
 563                 mutex_lock(&c->ec_stripes_heap_lock);
 564                 if (n.size > h->size) {
 565                         memcpy(n.data, h->data, h->used * sizeof(h->data[0]));
 566                         n.used = h->used;
 567                         swap(*h, n);
 568                 }
 569                 mutex_unlock(&c->ec_stripes_heap_lock);
 570
 571                 free_heap(&n);
 572         }
 573
 574         if (!genradix_ptr_alloc(&c->stripes, idx, gfp))
 575                 return -ENOMEM;
 576
 577         if (c->gc_pos.phase != GC_PHASE_NOT_RUNNING &&
 578             !genradix_ptr_alloc(&c->gc_stripes, idx, gfp))
 579                 return -ENOMEM;
 580
 581         return 0;
 582 }
 583
 584 static int ec_stripe_mem_alloc(struct btree_trans *trans,
 585                                struct btree_iter *iter)
 586 {
 587         size_t idx = iter->pos.offset;
 588
 589         if (!__ec_stripe_mem_alloc(trans->c, idx, GFP_NOWAIT|__GFP_NOWARN))
 590                 return 0;
 591
 592         bch2_trans_unlock(trans);
 593
 594         return   __ec_stripe_mem_alloc(trans->c, idx, GFP_KERNEL) ?:
 595                 bch2_trans_relock(trans);
 596 }
 597
 598 /*
 599  * Hash table of open stripes:
 600  * Stripes that are being created or modified are kept in a hash table, so that
 601  * stripe deletion can skip them.
 602  */
 603
 604 static bool __bch2_stripe_is_open(struct bch_fs *c, u64 idx)
 605 {
 606         unsigned hash = hash_64(idx, ilog2(ARRAY_SIZE(c->ec_stripes_new)));
 607         struct ec_stripe_new *s;
 608
 609         hlist_for_each_entry(s, &c->ec_stripes_new[hash], hash)
 610                 if (s->idx == idx)
 611                         return true;
 612         return false;
 613 }
 614
 615 static bool bch2_stripe_is_open(struct bch_fs *c, u64 idx)
 616 {
 617         bool ret = false;
 618
 619         spin_lock(&c->ec_stripes_new_lock);
 620         ret = __bch2_stripe_is_open(c, idx);
 621         spin_unlock(&c->ec_stripes_new_lock);
 622
 623         return ret;
 624 }
 625
 626 static bool bch2_try_open_stripe(struct bch_fs *c,
 627                                  struct ec_stripe_new *s,
 628                                  u64 idx)
 629 {
 630         bool ret;
 631
 632         spin_lock(&c->ec_stripes_new_lock);
 633         ret = !__bch2_stripe_is_open(c, idx);
 634         if (ret) {
 635                 unsigned hash = hash_64(idx, ilog2(ARRAY_SIZE(c->ec_stripes_new)));
 636
 637                 s->idx = idx;
 638                 hlist_add_head(&s->hash, &c->ec_stripes_new[hash]);
 639         }
 640         spin_unlock(&c->ec_stripes_new_lock);
 641
 642         return ret;
 643 }
 644
 645 static void bch2_stripe_close(struct bch_fs *c, struct ec_stripe_new *s)
 646 {
 647         BUG_ON(!s->idx);
 648
 649         spin_lock(&c->ec_stripes_new_lock);
 650         hlist_del_init(&s->hash);
 651         spin_unlock(&c->ec_stripes_new_lock);
 652
 653         s->idx = 0;
 654 }
 655
 656 /* Heap of all existing stripes, ordered by blocks_nonempty */
 657
 658 static u64 stripe_idx_to_delete(struct bch_fs *c)
 659 {
 660         ec_stripes_heap *h = &c->ec_stripes_heap;
 661         size_t heap_idx;
 662
 663         lockdep_assert_held(&c->ec_stripes_heap_lock);
 664
 665         for (heap_idx = 0; heap_idx < h->used; heap_idx++)
 666                 if (h->data[heap_idx].blocks_nonempty == 0 &&
 667                     !bch2_stripe_is_open(c, h->data[heap_idx].idx))
 668                         return h->data[heap_idx].idx;
 669
 670         return 0;
 671 }
 672
 673 static inline int ec_stripes_heap_cmp(ec_stripes_heap *h,
 674                                       struct ec_stripe_heap_entry l,
 675                                       struct ec_stripe_heap_entry r)
 676 {
 677         return ((l.blocks_nonempty > r.blocks_nonempty) -
 678                 (l.blocks_nonempty < r.blocks_nonempty));
 679 }
 680
 681 static inline void ec_stripes_heap_set_backpointer(ec_stripes_heap *h,
 682                                                    size_t i)
 683 {
 684         struct bch_fs *c = container_of(h, struct bch_fs, ec_stripes_heap);
 685
 686         genradix_ptr(&c->stripes, h->data[i].idx)->heap_idx = i;
 687 }
 688
 689 static void heap_verify_backpointer(struct bch_fs *c, size_t idx)
 690 {
 691         ec_stripes_heap *h = &c->ec_stripes_heap;
 692         struct stripe *m = genradix_ptr(&c->stripes, idx);
 693
 694         BUG_ON(m->heap_idx >= h->used);
 695         BUG_ON(h->data[m->heap_idx].idx != idx);
 696 }
 697
 698 void bch2_stripes_heap_del(struct bch_fs *c,
 699                            struct stripe *m, size_t idx)
 700 {
 701         mutex_lock(&c->ec_stripes_heap_lock);
 702         heap_verify_backpointer(c, idx);
 703
 704         heap_del(&c->ec_stripes_heap, m->heap_idx,
 705                  ec_stripes_heap_cmp,
 706                  ec_stripes_heap_set_backpointer);
 707         mutex_unlock(&c->ec_stripes_heap_lock);
 708 }
 709
 710 void bch2_stripes_heap_insert(struct bch_fs *c,
 711                               struct stripe *m, size_t idx)
 712 {
 713         mutex_lock(&c->ec_stripes_heap_lock);
 714         BUG_ON(heap_full(&c->ec_stripes_heap));
 715
 716         heap_add(&c->ec_stripes_heap, ((struct ec_stripe_heap_entry) {
 717                         .idx = idx,
 718                         .blocks_nonempty = m->blocks_nonempty,
 719                 }),
 720                  ec_stripes_heap_cmp,
 721                  ec_stripes_heap_set_backpointer);
 722
 723         heap_verify_backpointer(c, idx);
 724         mutex_unlock(&c->ec_stripes_heap_lock);
 725 }
 726
 727 void bch2_stripes_heap_update(struct bch_fs *c,
 728                               struct stripe *m, size_t idx)
 729 {
 730         ec_stripes_heap *h = &c->ec_stripes_heap;
 731         bool do_deletes;
 732         size_t i;
 733
 734         mutex_lock(&c->ec_stripes_heap_lock);
 735         heap_verify_backpointer(c, idx);
 736
 737         h->data[m->heap_idx].blocks_nonempty = m->blocks_nonempty;
 738
 739         i = m->heap_idx;
 740         heap_sift_up(h,   i, ec_stripes_heap_cmp,
 741                      ec_stripes_heap_set_backpointer);
 742         heap_sift_down(h, i, ec_stripes_heap_cmp,
 743                        ec_stripes_heap_set_backpointer);
 744
 745         heap_verify_backpointer(c, idx);
 746
 747         do_deletes = stripe_idx_to_delete(c) != 0;
 748         mutex_unlock(&c->ec_stripes_heap_lock);
 749
 750         if (do_deletes)
 751                 bch2_do_stripe_deletes(c);
 752 }
 753
 754 /* stripe deletion */
 755
 756 static int ec_stripe_delete(struct btree_trans *trans, u64 idx)
 757 {
 758         struct bch_fs *c = trans->c;
 759         struct btree_iter iter;
 760         struct bkey_s_c k;
 761         struct bkey_s_c_stripe s;
 762         int ret;
 763
 764         bch2_trans_iter_init(trans, &iter, BTREE_ID_stripes, POS(0, idx),
 765                              BTREE_ITER_INTENT);
 766         k = bch2_btree_iter_peek_slot(&iter);
 767         ret = bkey_err(k);
 768         if (ret)
 769                 goto err;
 770
 771         if (k.k->type != KEY_TYPE_stripe) {
 772                 bch2_fs_inconsistent(c, "attempting to delete nonexistent stripe %llu", idx);
 773                 ret = -EINVAL;
 774                 goto err;
 775         }
 776
 777         s = bkey_s_c_to_stripe(k);
 778         for (unsigned i = 0; i < s.v->nr_blocks; i++)
 779                 if (stripe_blockcount_get(s.v, i)) {
 780                         struct printbuf buf = PRINTBUF;
 781
 782                         bch2_bkey_val_to_text(&buf, c, k);
 783                         bch2_fs_inconsistent(c, "attempting to delete nonempty stripe %s", buf.buf);
 784                         printbuf_exit(&buf);
 785                         ret = -EINVAL;
 786                         goto err;
 787                 }
 788
 789         ret = bch2_btree_delete_at(trans, &iter, 0);
 790 err:
 791         bch2_trans_iter_exit(trans, &iter);
 792         return ret;
 793 }
 794
 795 static void ec_stripe_delete_work(struct work_struct *work)
 796 {
 797         struct bch_fs *c =
 798                 container_of(work, struct bch_fs, ec_stripe_delete_work);
 799         struct btree_trans trans;
 800         int ret;
 801         u64 idx;
 802
 803         bch2_trans_init(&trans, c, 0, 0);
 804
 805         while (1) {
 806                 mutex_lock(&c->ec_stripes_heap_lock);
 807                 idx = stripe_idx_to_delete(c);
 808                 mutex_unlock(&c->ec_stripes_heap_lock);
 809
 810                 if (!idx)
 811                         break;
 812
 813                 ret = commit_do(&trans, NULL, NULL, BTREE_INSERT_NOFAIL,
 814                                 ec_stripe_delete(&trans, idx));
 815                 if (ret) {
 816                         bch_err(c, "%s: err %s", __func__, bch2_err_str(ret));
 817                         break;
 818                 }
 819         }
 820
 821         bch2_trans_exit(&trans);
 822
 823         bch2_write_ref_put(c, BCH_WRITE_REF_stripe_delete);
 824 }
 825
 826 void bch2_do_stripe_deletes(struct bch_fs *c)
 827 {
 828         if (bch2_write_ref_tryget(c, BCH_WRITE_REF_stripe_delete) &&
 829             !schedule_work(&c->ec_stripe_delete_work))
 830                 bch2_write_ref_put(c, BCH_WRITE_REF_stripe_delete);
 831 }
 832
 833 /* stripe creation: */
 834
 835 static int ec_stripe_key_update(struct btree_trans *trans,
 836                                 struct bkey_i_stripe *new,
 837                                 bool create)
 838 {
 839         struct bch_fs *c = trans->c;
 840         struct btree_iter iter;
 841         struct bkey_s_c k;
 842         int ret;
 843
 844         bch2_trans_iter_init(trans, &iter, BTREE_ID_stripes,
 845                              new->k.p, BTREE_ITER_INTENT);
 846         k = bch2_btree_iter_peek_slot(&iter);
 847         ret = bkey_err(k);
 848         if (ret)
 849                 goto err;
 850
 851         if (k.k->type != (create ? KEY_TYPE_deleted : KEY_TYPE_stripe)) {
 852                 bch2_fs_inconsistent(c, "error %s stripe: got existing key type %s",
 853                                      create ? "creating" : "updating",
 854                                      bch2_bkey_types[k.k->type]);
 855                 ret = -EINVAL;
 856                 goto err;
 857         }
 858
 859         if (k.k->type == KEY_TYPE_stripe) {
 860                 const struct bch_stripe *old = bkey_s_c_to_stripe(k).v;
 861                 unsigned i;
 862
 863                 if (old->nr_blocks != new->v.nr_blocks) {
 864                         bch_err(c, "error updating stripe: nr_blocks does not match");
 865                         ret = -EINVAL;
 866                         goto err;
 867                 }
 868
 869                 for (i = 0; i < new->v.nr_blocks; i++)
 870                         stripe_blockcount_set(&new->v, i, stripe_blockcount_get(old, i));
 871         }
 872
 873         ret = bch2_trans_update(trans, &iter, &new->k_i, 0);
 874 err:
 875         bch2_trans_iter_exit(trans, &iter);
 876         return ret;
 877 }
 878
 879 static int ec_stripe_update_extent(struct btree_trans *trans,
 880                                    struct bpos bucket, u8 gen,
 881                                    struct ec_stripe_buf *s,
 882                                    u64 *bp_offset)
 883 {
 884         struct bch_fs *c = trans->c;
 885         struct bch_backpointer bp;
 886         struct btree_iter iter;
 887         struct bkey_s_c k;
 888         const struct bch_extent_ptr *ptr_c;
 889         struct bch_extent_ptr *ptr, *ec_ptr = NULL;
 890         struct bch_extent_stripe_ptr stripe_ptr;
 891         struct bkey_i *n;
 892         int ret, dev, block;
 893
 894         ret = bch2_get_next_backpointer(trans, bucket, gen,
 895                                 bp_offset, &bp, BTREE_ITER_CACHED);
 896         if (ret)
 897                 return ret;
 898         if (*bp_offset == U64_MAX)
 899                 return 0;
 900
 901         if (bp.level) {
 902                 struct printbuf buf = PRINTBUF;
 903                 struct btree_iter node_iter;
 904                 struct btree *b;
 905
 906                 b = bch2_backpointer_get_node(trans, &node_iter, bucket, *bp_offset, bp);
 907                 bch2_trans_iter_exit(trans, &node_iter);
 908
 909                 prt_printf(&buf, "found btree node in erasure coded bucket: b=%px\n", b);
 910                 bch2_backpointer_to_text(&buf, &bp);
 911
 912                 bch2_fs_inconsistent(c, "%s", buf.buf);
 913                 printbuf_exit(&buf);
 914                 return -EIO;
 915         }
 916
 917         k = bch2_backpointer_get_key(trans, &iter, bucket, *bp_offset, bp);
 918         ret = bkey_err(k);
 919         if (ret)
 920                 return ret;
 921         if (!k.k) {
 922                 /*
 923                  * extent no longer exists - we could flush the btree
 924                  * write buffer and retry to verify, but no need:
 925                  */
 926                 return 0;
 927         }
 928
 929         if (extent_has_stripe_ptr(k, s->key.k.p.offset))
 930                 goto out;
 931
 932         ptr_c = bkey_matches_stripe(&s->key.v, k, &block);
 933         /*
 934          * It doesn't generally make sense to erasure code cached ptrs:
 935          * XXX: should we be incrementing a counter?
 936          */
 937         if (!ptr_c || ptr_c->cached)
 938                 goto out;
 939
 940         dev = s->key.v.ptrs[block].dev;
 941
 942         n = bch2_trans_kmalloc(trans, bkey_bytes(k.k) + sizeof(stripe_ptr));
 943         ret = PTR_ERR_OR_ZERO(n);
 944         if (ret)
 945                 goto out;
 946
 947         bkey_reassemble(n, k);
 948
 949         bch2_bkey_drop_ptrs(bkey_i_to_s(n), ptr, ptr->dev != dev);
 950         ec_ptr = (void *) bch2_bkey_has_device(bkey_i_to_s_c(n), dev);
 951         BUG_ON(!ec_ptr);
 952
 953         stripe_ptr = (struct bch_extent_stripe_ptr) {
 954                 .type = 1 << BCH_EXTENT_ENTRY_stripe_ptr,
 955                 .block          = block,
 956                 .redundancy     = s->key.v.nr_redundant,
 957                 .idx            = s->key.k.p.offset,
 958         };
 959
 960         __extent_entry_insert(n,
 961                         (union bch_extent_entry *) ec_ptr,
 962                         (union bch_extent_entry *) &stripe_ptr);
 963
 964         ret = bch2_trans_update(trans, &iter, n, 0);
 965 out:
 966         bch2_trans_iter_exit(trans, &iter);
 967         return ret;
 968 }
 969
 970 static int ec_stripe_update_bucket(struct btree_trans *trans, struct ec_stripe_buf *s,
 971                                    unsigned block)
 972 {
 973         struct bch_fs *c = trans->c;
 974         struct bch_extent_ptr bucket = s->key.v.ptrs[block];
 975         struct bpos bucket_pos = PTR_BUCKET_POS(c, &bucket);
 976         u64 bp_offset = 0;
 977         int ret = 0;
 978
 979         while (1) {
 980                 ret = commit_do(trans, NULL, NULL,
 981                                 BTREE_INSERT_NOFAIL,
 982                         ec_stripe_update_extent(trans, bucket_pos, bucket.gen,
 983                                                 s, &bp_offset));
 984                 if (ret)
 985                         break;
 986                 if (bp_offset == U64_MAX)
 987                         break;
 988
 989                 bp_offset++;
 990         }
 991
 992         return ret;
 993 }
 994
 995 static int ec_stripe_update_extents(struct bch_fs *c, struct ec_stripe_buf *s)
 996 {
 997         struct btree_trans trans;
 998         struct bch_stripe *v = &s->key.v;
 999         unsigned i, nr_data = v->nr_blocks - v->nr_redundant;
1000         int ret = 0;
1001
1002         bch2_trans_init(&trans, c, 0, 0);
1003
1004         ret = bch2_btree_write_buffer_flush(&trans);
1005         if (ret)
1006                 goto err;
1007
1008         for (i = 0; i < nr_data; i++) {
1009                 ret = ec_stripe_update_bucket(&trans, s, i);
1010                 if (ret)
1011                         break;
1012         }
1013 err:
1014         bch2_trans_exit(&trans);
1015
1016         return ret;
1017 }
1018
1019 static void zero_out_rest_of_ec_bucket(struct bch_fs *c,
1020                                        struct ec_stripe_new *s,
1021                                        unsigned block,
1022                                        struct open_bucket *ob)
1023 {
1024         struct bch_dev *ca = bch_dev_bkey_exists(c, ob->dev);
1025         unsigned offset = ca->mi.bucket_size - ob->sectors_free;
1026         int ret;
1027
1028         if (!bch2_dev_get_ioref(ca, WRITE)) {
1029                 s->err = -EROFS;
1030                 return;
1031         }
1032
1033         memset(s->new_stripe.data[block] + (offset << 9),
1034                0,
1035                ob->sectors_free << 9);
1036
1037         ret = blkdev_issue_zeroout(ca->disk_sb.bdev,
1038                         ob->bucket * ca->mi.bucket_size + offset,
1039                         ob->sectors_free,
1040                         GFP_KERNEL, 0);
1041
1042         percpu_ref_put(&ca->io_ref);
1043
1044         if (ret)
1045                 s->err = ret;
1046 }
1047
1048 /*
1049  * data buckets of new stripe all written: create the stripe
1050  */
1051 static void ec_stripe_create(struct ec_stripe_new *s)
1052 {
1053         struct bch_fs *c = s->c;
1054         struct open_bucket *ob;
1055         struct bch_stripe *v = &s->new_stripe.key.v;
1056         unsigned i, nr_data = v->nr_blocks - v->nr_redundant;
1057         int ret;
1058
1059         BUG_ON(s->h->s == s);
1060
1061         closure_sync(&s->iodone);
1062
1063         for (i = 0; i < nr_data; i++)
1064                 if (s->blocks[i]) {
1065                         ob = c->open_buckets + s->blocks[i];
1066
1067                         if (ob->sectors_free)
1068                                 zero_out_rest_of_ec_bucket(c, s, i, ob);
1069                 }
1070
1071         if (s->err) {
1072                 if (!bch2_err_matches(s->err, EROFS))
1073                         bch_err(c, "error creating stripe: error writing data buckets");
1074                 goto err;
1075         }
1076
1077         if (s->have_existing_stripe) {
1078                 ec_validate_checksums(c, &s->existing_stripe);
1079
1080                 if (ec_do_recov(c, &s->existing_stripe)) {
1081                         bch_err(c, "error creating stripe: error reading existing stripe");
1082                         goto err;
1083                 }
1084
1085                 for (i = 0; i < nr_data; i++)
1086                         if (stripe_blockcount_get(&s->existing_stripe.key.v, i))
1087                                 swap(s->new_stripe.data[i],
1088                                      s->existing_stripe.data[i]);
1089
1090                 ec_stripe_buf_exit(&s->existing_stripe);
1091         }
1092
1093         BUG_ON(!s->allocated);
1094
1095         ec_generate_ec(&s->new_stripe);
1096
1097         ec_generate_checksums(&s->new_stripe);
1098
1099         /* write p/q: */
1100         for (i = nr_data; i < v->nr_blocks; i++)
1101                 ec_block_io(c, &s->new_stripe, REQ_OP_WRITE, i, &s->iodone);
1102         closure_sync(&s->iodone);
1103
1104         if (ec_nr_failed(&s->new_stripe)) {
1105                 bch_err(c, "error creating stripe: error writing redundancy buckets");
1106                 goto err;
1107         }
1108
1109         ret = bch2_trans_do(c, &s->res, NULL, BTREE_INSERT_NOFAIL,
1110                             ec_stripe_key_update(&trans, &s->new_stripe.key,
1111                                                  !s->have_existing_stripe));
1112         if (ret) {
1113                 bch_err(c, "error creating stripe: error creating stripe key");
1114                 goto err;
1115         }
1116
1117         ret = ec_stripe_update_extents(c, &s->new_stripe);
1118         if (ret) {
1119                 bch_err(c, "error creating stripe: error updating pointers: %s",
1120                         bch2_err_str(ret));
1121                 goto err;
1122         }
1123 err:
1124         bch2_disk_reservation_put(c, &s->res);
1125
1126         for (i = 0; i < v->nr_blocks; i++)
1127                 if (s->blocks[i]) {
1128                         ob = c->open_buckets + s->blocks[i];
1129
1130                         if (i < nr_data) {
1131                                 ob->ec = NULL;
1132                                 __bch2_open_bucket_put(c, ob);
1133                         } else {
1134                                 bch2_open_bucket_put(c, ob);
1135                         }
1136                 }
1137
1138         bch2_stripe_close(c, s);
1139
1140         ec_stripe_buf_exit(&s->existing_stripe);
1141         ec_stripe_buf_exit(&s->new_stripe);
1142         closure_debug_destroy(&s->iodone);
1143         kfree(s);
1144 }
1145
1146 static struct ec_stripe_new *get_pending_stripe(struct bch_fs *c)
1147 {
1148         struct ec_stripe_new *s;
1149
1150         mutex_lock(&c->ec_stripe_new_lock);
1151         list_for_each_entry(s, &c->ec_stripe_new_list, list)
1152                 if (!atomic_read(&s->pin)) {
1153                         list_del(&s->list);
1154                         goto out;
1155                 }
1156         s = NULL;
1157 out:
1158         mutex_unlock(&c->ec_stripe_new_lock);
1159
1160         return s;
1161 }
1162
1163 static void ec_stripe_create_work(struct work_struct *work)
1164 {
1165         struct bch_fs *c = container_of(work,
1166                 struct bch_fs, ec_stripe_create_work);
1167         struct ec_stripe_new *s;
1168
1169         while ((s = get_pending_stripe(c)))
1170                 ec_stripe_create(s);
1171
1172         bch2_write_ref_put(c, BCH_WRITE_REF_stripe_create);
1173 }
1174
1175 void bch2_ec_do_stripe_creates(struct bch_fs *c)
1176 {
1177         bch2_write_ref_get(c, BCH_WRITE_REF_stripe_create);
1178
1179         if (!queue_work(system_long_wq, &c->ec_stripe_create_work))
1180                 bch2_write_ref_put(c, BCH_WRITE_REF_stripe_create);
1181 }
1182
1183 static void ec_stripe_new_put(struct bch_fs *c, struct ec_stripe_new *s)
1184 {
1185         BUG_ON(atomic_read(&s->pin) <= 0);
1186
1187         if (atomic_dec_and_test(&s->pin))
1188                 bch2_ec_do_stripe_creates(c);
1189 }
1190
1191 static void ec_stripe_set_pending(struct bch_fs *c, struct ec_stripe_head *h)
1192 {
1193         struct ec_stripe_new *s = h->s;
1194
1195         BUG_ON(!s->allocated && !s->err);
1196
1197         h->s            = NULL;
1198         s->pending      = true;
1199
1200         mutex_lock(&c->ec_stripe_new_lock);
1201         list_add(&s->list, &c->ec_stripe_new_list);
1202         mutex_unlock(&c->ec_stripe_new_lock);
1203
1204         ec_stripe_new_put(c, s);
1205 }
1206
1207 /* have a full bucket - hand it off to be erasure coded: */
1208 void bch2_ec_bucket_written(struct bch_fs *c, struct open_bucket *ob)
1209 {
1210         struct ec_stripe_new *s = ob->ec;
1211
1212         ec_stripe_new_put(c, s);
1213 }
1214
1215 void bch2_ec_bucket_cancel(struct bch_fs *c, struct open_bucket *ob)
1216 {
1217         struct ec_stripe_new *s = ob->ec;
1218
1219         s->err = -EIO;
1220 }
1221
1222 void *bch2_writepoint_ec_buf(struct bch_fs *c, struct write_point *wp)
1223 {
1224         struct open_bucket *ob = ec_open_bucket(c, &wp->ptrs);
1225         struct bch_dev *ca;
1226         unsigned offset;
1227
1228         if (!ob)
1229                 return NULL;
1230
1231         ca      = bch_dev_bkey_exists(c, ob->dev);
1232         offset  = ca->mi.bucket_size - ob->sectors_free;
1233
1234         return ob->ec->new_stripe.data[ob->ec_idx] + (offset << 9);
1235 }
1236
1237 static int unsigned_cmp(const void *_l, const void *_r)
1238 {
1239         unsigned l = *((const unsigned *) _l);
1240         unsigned r = *((const unsigned *) _r);
1241
1242         return cmp_int(l, r);
1243 }
1244
1245 /* pick most common bucket size: */
1246 static unsigned pick_blocksize(struct bch_fs *c,
1247                                struct bch_devs_mask *devs)
1248 {
1249         struct bch_dev *ca;
1250         unsigned i, nr = 0, sizes[BCH_SB_MEMBERS_MAX];
1251         struct {
1252                 unsigned nr, size;
1253         } cur = { 0, 0 }, best = { 0, 0 };
1254
1255         for_each_member_device_rcu(ca, c, i, devs)
1256                 sizes[nr++] = ca->mi.bucket_size;
1257
1258         sort(sizes, nr, sizeof(unsigned), unsigned_cmp, NULL);
1259
1260         for (i = 0; i < nr; i++) {
1261                 if (sizes[i] != cur.size) {
1262                         if (cur.nr > best.nr)
1263                                 best = cur;
1264
1265                         cur.nr = 0;
1266                         cur.size = sizes[i];
1267                 }
1268
1269                 cur.nr++;
1270         }
1271
1272         if (cur.nr > best.nr)
1273                 best = cur;
1274
1275         return best.size;
1276 }
1277
1278 static bool may_create_new_stripe(struct bch_fs *c)
1279 {
1280         return false;
1281 }
1282
1283 static void ec_stripe_key_init(struct bch_fs *c,
1284                                struct bkey_i_stripe *s,
1285                                unsigned nr_data,
1286                                unsigned nr_parity,
1287                                unsigned stripe_size)
1288 {
1289         unsigned u64s;
1290
1291         bkey_stripe_init(&s->k_i);
1292         s->v.sectors                    = cpu_to_le16(stripe_size);
1293         s->v.algorithm                  = 0;
1294         s->v.nr_blocks                  = nr_data + nr_parity;
1295         s->v.nr_redundant               = nr_parity;
1296         s->v.csum_granularity_bits      = ilog2(c->opts.encoded_extent_max >> 9);
1297         s->v.csum_type                  = BCH_CSUM_crc32c;
1298         s->v.pad                        = 0;
1299
1300         while ((u64s = stripe_val_u64s(&s->v)) > BKEY_VAL_U64s_MAX) {
1301                 BUG_ON(1 << s->v.csum_granularity_bits >=
1302                        le16_to_cpu(s->v.sectors) ||
1303                        s->v.csum_granularity_bits == U8_MAX);
1304                 s->v.csum_granularity_bits++;
1305         }
1306
1307         set_bkey_val_u64s(&s->k, u64s);
1308 }
1309
1310 static int ec_new_stripe_alloc(struct bch_fs *c, struct ec_stripe_head *h)
1311 {
1312         struct ec_stripe_new *s;
1313
1314         lockdep_assert_held(&h->lock);
1315
1316         s = kzalloc(sizeof(*s), GFP_KERNEL);
1317         if (!s)
1318                 return -ENOMEM;
1319
1320         mutex_init(&s->lock);
1321         closure_init(&s->iodone, NULL);
1322         atomic_set(&s->pin, 1);
1323         s->c            = c;
1324         s->h            = h;
1325         s->nr_data      = min_t(unsigned, h->nr_active_devs,
1326                                 BCH_BKEY_PTRS_MAX) - h->redundancy;
1327         s->nr_parity    = h->redundancy;
1328
1329         ec_stripe_key_init(c, &s->new_stripe.key, s->nr_data,
1330                            s->nr_parity, h->blocksize);
1331
1332         h->s = s;
1333         return 0;
1334 }
1335
1336 static struct ec_stripe_head *
1337 ec_new_stripe_head_alloc(struct bch_fs *c, unsigned target,
1338                          unsigned algo, unsigned redundancy,
1339                          bool copygc)
1340 {
1341         struct ec_stripe_head *h;
1342         struct bch_dev *ca;
1343         unsigned i;
1344
1345         h = kzalloc(sizeof(*h), GFP_KERNEL);
1346         if (!h)
1347                 return NULL;
1348
1349         mutex_init(&h->lock);
1350         BUG_ON(!mutex_trylock(&h->lock));
1351
1352         h->target       = target;
1353         h->algo         = algo;
1354         h->redundancy   = redundancy;
1355         h->copygc       = copygc;
1356
1357         rcu_read_lock();
1358         h->devs = target_rw_devs(c, BCH_DATA_user, target);
1359
1360         for_each_member_device_rcu(ca, c, i, &h->devs)
1361                 if (!ca->mi.durability)
1362                         __clear_bit(i, h->devs.d);
1363
1364         h->blocksize = pick_blocksize(c, &h->devs);
1365
1366         for_each_member_device_rcu(ca, c, i, &h->devs)
1367                 if (ca->mi.bucket_size == h->blocksize)
1368                         h->nr_active_devs++;
1369
1370         rcu_read_unlock();
1371         list_add(&h->list, &c->ec_stripe_head_list);
1372         return h;
1373 }
1374
1375 void bch2_ec_stripe_head_put(struct bch_fs *c, struct ec_stripe_head *h)
1376 {
1377         if (h->s &&
1378             h->s->allocated &&
1379             bitmap_weight(h->s->blocks_allocated,
1380                           h->s->nr_data) == h->s->nr_data)
1381                 ec_stripe_set_pending(c, h);
1382
1383         mutex_unlock(&h->lock);
1384 }
1385
1386 struct ec_stripe_head *__bch2_ec_stripe_head_get(struct btree_trans *trans,
1387                                                  unsigned target,
1388                                                  unsigned algo,
1389                                                  unsigned redundancy,
1390                                                  bool copygc)
1391 {
1392         struct bch_fs *c = trans->c;
1393         struct ec_stripe_head *h;
1394         int ret;
1395
1396         if (!redundancy)
1397                 return NULL;
1398
1399         ret = bch2_trans_mutex_lock(trans, &c->ec_stripe_head_lock);
1400         if (ret)
1401                 return ERR_PTR(ret);
1402
1403         list_for_each_entry(h, &c->ec_stripe_head_list, list)
1404                 if (h->target           == target &&
1405                     h->algo             == algo &&
1406                     h->redundancy       == redundancy &&
1407                     h->copygc           == copygc) {
1408                         ret = bch2_trans_mutex_lock(trans, &h->lock);
1409                         if (ret)
1410                                 h = ERR_PTR(ret);
1411                         goto found;
1412                 }
1413
1414         h = ec_new_stripe_head_alloc(c, target, algo, redundancy, copygc);
1415 found:
1416         mutex_unlock(&c->ec_stripe_head_lock);
1417         return h;
1418 }
1419
1420 static int new_stripe_alloc_buckets(struct btree_trans *trans, struct ec_stripe_head *h,
1421                                     struct closure *cl)
1422 {
1423         struct bch_fs *c = trans->c;
1424         struct bch_devs_mask devs = h->devs;
1425         struct open_bucket *ob;
1426         struct open_buckets buckets;
1427         unsigned i, j, nr_have_parity = 0, nr_have_data = 0;
1428         bool have_cache = true;
1429         int ret = 0;
1430
1431         for (i = 0; i < h->s->new_stripe.key.v.nr_blocks; i++) {
1432                 if (test_bit(i, h->s->blocks_gotten)) {
1433                         __clear_bit(h->s->new_stripe.key.v.ptrs[i].dev, devs.d);
1434                         if (i < h->s->nr_data)
1435                                 nr_have_data++;
1436                         else
1437                                 nr_have_parity++;
1438                 }
1439         }
1440
1441         BUG_ON(nr_have_data     > h->s->nr_data);
1442         BUG_ON(nr_have_parity   > h->s->nr_parity);
1443
1444         buckets.nr = 0;
1445         if (nr_have_parity < h->s->nr_parity) {
1446                 ret = bch2_bucket_alloc_set_trans(trans, &buckets,
1447                                             &h->parity_stripe,
1448                                             &devs,
1449                                             h->s->nr_parity,
1450                                             &nr_have_parity,
1451                                             &have_cache,
1452                                             BCH_DATA_parity,
1453                                             h->copygc
1454                                             ? RESERVE_movinggc
1455                                             : RESERVE_none,
1456                                             cl);
1457
1458                 open_bucket_for_each(c, &buckets, ob, i) {
1459                         j = find_next_zero_bit(h->s->blocks_gotten,
1460                                                h->s->nr_data + h->s->nr_parity,
1461                                                h->s->nr_data);
1462                         BUG_ON(j >= h->s->nr_data + h->s->nr_parity);
1463
1464                         h->s->blocks[j] = buckets.v[i];
1465                         h->s->new_stripe.key.v.ptrs[j] = bch2_ob_ptr(c, ob);
1466                         __set_bit(j, h->s->blocks_gotten);
1467                 }
1468
1469                 if (ret)
1470                         return ret;
1471         }
1472
1473         buckets.nr = 0;
1474         if (nr_have_data < h->s->nr_data) {
1475                 ret = bch2_bucket_alloc_set_trans(trans, &buckets,
1476                                             &h->block_stripe,
1477                                             &devs,
1478                                             h->s->nr_data,
1479                                             &nr_have_data,
1480                                             &have_cache,
1481                                             BCH_DATA_user,
1482                                             h->copygc
1483                                             ? RESERVE_movinggc
1484                                             : RESERVE_none,
1485                                             cl);
1486
1487                 open_bucket_for_each(c, &buckets, ob, i) {
1488                         j = find_next_zero_bit(h->s->blocks_gotten,
1489                                                h->s->nr_data, 0);
1490                         BUG_ON(j >= h->s->nr_data);
1491
1492                         h->s->blocks[j] = buckets.v[i];
1493                         h->s->new_stripe.key.v.ptrs[j] = bch2_ob_ptr(c, ob);
1494                         __set_bit(j, h->s->blocks_gotten);
1495                 }
1496
1497                 if (ret)
1498                         return ret;
1499         }
1500
1501         return 0;
1502 }
1503
1504 /* XXX: doesn't obey target: */
1505 static s64 get_existing_stripe(struct bch_fs *c,
1506                                struct ec_stripe_head *head)
1507 {
1508         ec_stripes_heap *h = &c->ec_stripes_heap;
1509         struct stripe *m;
1510         size_t heap_idx;
1511         u64 stripe_idx;
1512         s64 ret = -1;
1513
1514         if (may_create_new_stripe(c))
1515                 return -1;
1516
1517         mutex_lock(&c->ec_stripes_heap_lock);
1518         for (heap_idx = 0; heap_idx < h->used; heap_idx++) {
1519                 /* No blocks worth reusing, stripe will just be deleted: */
1520                 if (!h->data[heap_idx].blocks_nonempty)
1521                         continue;
1522
1523                 stripe_idx = h->data[heap_idx].idx;
1524
1525                 m = genradix_ptr(&c->stripes, stripe_idx);
1526
1527                 if (m->algorithm        == head->algo &&
1528                     m->nr_redundant     == head->redundancy &&
1529                     m->sectors          == head->blocksize &&
1530                     m->blocks_nonempty  < m->nr_blocks - m->nr_redundant &&
1531                     bch2_try_open_stripe(c, head->s, stripe_idx)) {
1532                         ret = stripe_idx;
1533                         break;
1534                 }
1535         }
1536         mutex_unlock(&c->ec_stripes_heap_lock);
1537         return ret;
1538 }
1539
1540 static int __bch2_ec_stripe_head_reuse(struct btree_trans *trans, struct ec_stripe_head *h)
1541 {
1542         struct bch_fs *c = trans->c;
1543         unsigned i;
1544         s64 idx;
1545         int ret;
1546
1547         idx = get_existing_stripe(c, h);
1548         if (idx < 0)
1549                 return -BCH_ERR_ENOSPC_stripe_reuse;
1550
1551         h->s->have_existing_stripe = true;
1552         ret = get_stripe_key_trans(trans, idx, &h->s->existing_stripe);
1553         if (ret) {
1554                 bch2_fs_fatal_error(c, "error reading stripe key: %i", ret);
1555                 return ret;
1556         }
1557
1558         if (ec_stripe_buf_init(&h->s->existing_stripe, 0, h->blocksize)) {
1559                 /*
1560                  * this is a problem: we have deleted from the
1561                  * stripes heap already
1562                  */
1563                 BUG();
1564         }
1565
1566         BUG_ON(h->s->existing_stripe.size != h->blocksize);
1567         BUG_ON(h->s->existing_stripe.size != h->s->existing_stripe.key.v.sectors);
1568
1569         for (i = 0; i < h->s->existing_stripe.key.v.nr_blocks; i++) {
1570                 if (stripe_blockcount_get(&h->s->existing_stripe.key.v, i)) {
1571                         __set_bit(i, h->s->blocks_gotten);
1572                         __set_bit(i, h->s->blocks_allocated);
1573                 }
1574
1575                 ec_block_io(c, &h->s->existing_stripe, READ, i, &h->s->iodone);
1576         }
1577
1578         bkey_copy(&h->s->new_stripe.key.k_i,
1579                   &h->s->existing_stripe.key.k_i);
1580
1581         return 0;
1582 }
1583
1584 static int __bch2_ec_stripe_head_reserve(struct btree_trans *trans, struct ec_stripe_head *h)
1585 {
1586         struct bch_fs *c = trans->c;
1587         struct btree_iter iter;
1588         struct bkey_s_c k;
1589         struct bpos min_pos = POS(0, 1);
1590         struct bpos start_pos = bpos_max(min_pos, POS(0, c->ec_stripe_hint));
1591         int ret;
1592
1593         BUG_ON(h->s->res.sectors);
1594
1595         ret = bch2_disk_reservation_get(c, &h->s->res,
1596                                         h->blocksize,
1597                                         h->s->nr_parity, 0);
1598         if (ret)
1599                 return ret;
1600
1601         for_each_btree_key_norestart(trans, iter, BTREE_ID_stripes, start_pos,
1602                            BTREE_ITER_SLOTS|BTREE_ITER_INTENT, k, ret) {
1603                 if (bkey_gt(k.k->p, POS(0, U32_MAX))) {
1604                         if (start_pos.offset) {
1605                                 start_pos = min_pos;
1606                                 bch2_btree_iter_set_pos(&iter, start_pos);
1607                                 continue;
1608                         }
1609
1610                         ret = -BCH_ERR_ENOSPC_stripe_create;
1611                         break;
1612                 }
1613
1614                 if (bkey_deleted(k.k) &&
1615                     bch2_try_open_stripe(c, h->s, k.k->p.offset))
1616                         break;
1617         }
1618
1619         c->ec_stripe_hint = iter.pos.offset;
1620
1621         if (ret)
1622                 goto err;
1623
1624         ret = ec_stripe_mem_alloc(trans, &iter);
1625         if (ret) {
1626                 bch2_stripe_close(c, h->s);
1627                 goto err;
1628         }
1629
1630         h->s->new_stripe.key.k.p = iter.pos;
1631 out:
1632         bch2_trans_iter_exit(trans, &iter);
1633         return ret;
1634 err:
1635         bch2_disk_reservation_put(c, &h->s->res);
1636         goto out;
1637 }
1638
1639 struct ec_stripe_head *bch2_ec_stripe_head_get(struct btree_trans *trans,
1640                                                unsigned target,
1641                                                unsigned algo,
1642                                                unsigned redundancy,
1643                                                bool copygc,
1644                                                struct closure *cl)
1645 {
1646         struct bch_fs *c = trans->c;
1647         struct ec_stripe_head *h;
1648         int ret;
1649         bool needs_stripe_new;
1650
1651         h = __bch2_ec_stripe_head_get(trans, target, algo, redundancy, copygc);
1652         if (!h)
1653                 bch_err(c, "no stripe head");
1654         if (IS_ERR_OR_NULL(h))
1655                 return h;
1656
1657         needs_stripe_new = !h->s;
1658         if (needs_stripe_new) {
1659                 if (ec_new_stripe_alloc(c, h)) {
1660                         ret = -ENOMEM;
1661                         bch_err(c, "failed to allocate new stripe");
1662                         goto err;
1663                 }
1664
1665                 if (ec_stripe_buf_init(&h->s->new_stripe, 0, h->blocksize))
1666                         BUG();
1667         }
1668
1669         /*
1670          * Try reserve a new stripe before reusing an
1671          * existing stripe. This will prevent unnecessary
1672          * read amplification during write oriented workloads.
1673          */
1674         ret = 0;
1675         if (!h->s->allocated && !h->s->res.sectors && !h->s->have_existing_stripe)
1676                 ret = __bch2_ec_stripe_head_reserve(trans, h);
1677         if (bch2_err_matches(ret, BCH_ERR_transaction_restart))
1678                 goto err;
1679
1680         if (ret && needs_stripe_new)
1681                 ret = __bch2_ec_stripe_head_reuse(trans, h);
1682         if (ret) {
1683                 bch_err_ratelimited(c, "failed to get stripe: %s", bch2_err_str(ret));
1684                 goto err;
1685         }
1686
1687         if (!h->s->allocated) {
1688                 ret = new_stripe_alloc_buckets(trans, h, cl);
1689                 if (ret)
1690                         goto err;
1691
1692                 h->s->allocated = true;
1693         }
1694
1695         BUG_ON(trans->restarted);
1696         return h;
1697 err:
1698         bch2_ec_stripe_head_put(c, h);
1699         return ERR_PTR(ret);
1700 }
1701
1702 void bch2_ec_stop_dev(struct bch_fs *c, struct bch_dev *ca)
1703 {
1704         struct ec_stripe_head *h;
1705         struct open_bucket *ob;
1706         unsigned i;
1707
1708         mutex_lock(&c->ec_stripe_head_lock);
1709         list_for_each_entry(h, &c->ec_stripe_head_list, list) {
1710
1711                 mutex_lock(&h->lock);
1712                 if (!h->s)
1713                         goto unlock;
1714
1715                 for (i = 0; i < h->s->new_stripe.key.v.nr_blocks; i++) {
1716                         if (!h->s->blocks[i])
1717                                 continue;
1718
1719                         ob = c->open_buckets + h->s->blocks[i];
1720                         if (ob->dev == ca->dev_idx)
1721                                 goto found;
1722                 }
1723                 goto unlock;
1724 found:
1725                 h->s->err = -EROFS;
1726                 ec_stripe_set_pending(c, h);
1727 unlock:
1728                 mutex_unlock(&h->lock);
1729         }
1730         mutex_unlock(&c->ec_stripe_head_lock);
1731 }
1732
1733 int bch2_stripes_read(struct bch_fs *c)
1734 {
1735         struct btree_trans trans;
1736         struct btree_iter iter;
1737         struct bkey_s_c k;
1738         const struct bch_stripe *s;
1739         struct stripe *m;
1740         unsigned i;
1741         int ret;
1742
1743         bch2_trans_init(&trans, c, 0, 0);
1744
1745         for_each_btree_key(&trans, iter, BTREE_ID_stripes, POS_MIN,
1746                            BTREE_ITER_PREFETCH, k, ret) {
1747                 if (k.k->type != KEY_TYPE_stripe)
1748                         continue;
1749
1750                 ret = __ec_stripe_mem_alloc(c, k.k->p.offset, GFP_KERNEL);
1751                 if (ret)
1752                         break;
1753
1754                 s = bkey_s_c_to_stripe(k).v;
1755
1756                 m = genradix_ptr(&c->stripes, k.k->p.offset);
1757                 m->sectors      = le16_to_cpu(s->sectors);
1758                 m->algorithm    = s->algorithm;
1759                 m->nr_blocks    = s->nr_blocks;
1760                 m->nr_redundant = s->nr_redundant;
1761                 m->blocks_nonempty = 0;
1762
1763                 for (i = 0; i < s->nr_blocks; i++)
1764                         m->blocks_nonempty += !!stripe_blockcount_get(s, i);
1765
1766                 bch2_stripes_heap_insert(c, m, k.k->p.offset);
1767         }
1768         bch2_trans_iter_exit(&trans, &iter);
1769
1770         bch2_trans_exit(&trans);
1771
1772         if (ret)
1773                 bch_err(c, "error reading stripes: %i", ret);
1774
1775         return ret;
1776 }
1777
1778 void bch2_stripes_heap_to_text(struct printbuf *out, struct bch_fs *c)
1779 {
1780         ec_stripes_heap *h = &c->ec_stripes_heap;
1781         struct stripe *m;
1782         size_t i;
1783
1784         mutex_lock(&c->ec_stripes_heap_lock);
1785         for (i = 0; i < min_t(size_t, h->used, 20); i++) {
1786                 m = genradix_ptr(&c->stripes, h->data[i].idx);
1787
1788                 prt_printf(out, "%zu %u/%u+%u\n", h->data[i].idx,
1789                        h->data[i].blocks_nonempty,
1790                        m->nr_blocks - m->nr_redundant,
1791                        m->nr_redundant);
1792         }
1793         mutex_unlock(&c->ec_stripes_heap_lock);
1794 }
1795
1796 void bch2_new_stripes_to_text(struct printbuf *out, struct bch_fs *c)
1797 {
1798         struct ec_stripe_head *h;
1799         struct ec_stripe_new *s;
1800
1801         mutex_lock(&c->ec_stripe_head_lock);
1802         list_for_each_entry(h, &c->ec_stripe_head_list, list) {
1803                 prt_printf(out, "target %u algo %u redundancy %u:\n",
1804                        h->target, h->algo, h->redundancy);
1805
1806                 if (h->s)
1807                         prt_printf(out, "\tpending: blocks %u+%u allocated %u\n",
1808                                h->s->nr_data, h->s->nr_parity,
1809                                bitmap_weight(h->s->blocks_allocated,
1810                                              h->s->nr_data));
1811         }
1812         mutex_unlock(&c->ec_stripe_head_lock);
1813
1814         mutex_lock(&c->ec_stripe_new_lock);
1815         list_for_each_entry(s, &c->ec_stripe_new_list, list) {
1816                 prt_printf(out, "\tin flight: blocks %u+%u pin %u\n",
1817                        s->nr_data, s->nr_parity,
1818                        atomic_read(&s->pin));
1819         }
1820         mutex_unlock(&c->ec_stripe_new_lock);
1821 }
1822
1823 void bch2_fs_ec_exit(struct bch_fs *c)
1824 {
1825         struct ec_stripe_head *h;
1826         unsigned i;
1827
1828         while (1) {
1829                 mutex_lock(&c->ec_stripe_head_lock);
1830                 h = list_first_entry_or_null(&c->ec_stripe_head_list,
1831                                              struct ec_stripe_head, list);
1832                 if (h)
1833                         list_del(&h->list);
1834                 mutex_unlock(&c->ec_stripe_head_lock);
1835                 if (!h)
1836                         break;
1837
1838                 if (h->s) {
1839                         for (i = 0; i < h->s->new_stripe.key.v.nr_blocks; i++)
1840                                 BUG_ON(h->s->blocks[i]);
1841
1842                         kfree(h->s);
1843                 }
1844                 kfree(h);
1845         }
1846
1847         BUG_ON(!list_empty(&c->ec_stripe_new_list));
1848
1849         free_heap(&c->ec_stripes_heap);
1850         genradix_free(&c->stripes);
1851         bioset_exit(&c->ec_bioset);
1852 }
1853
1854 void bch2_fs_ec_init_early(struct bch_fs *c)
1855 {
1856         INIT_WORK(&c->ec_stripe_create_work, ec_stripe_create_work);
1857         INIT_WORK(&c->ec_stripe_delete_work, ec_stripe_delete_work);
1858 }
1859
1860 int bch2_fs_ec_init(struct bch_fs *c)
1861 {
1862         spin_lock_init(&c->ec_stripes_new_lock);
1863
1864         return bioset_init(&c->ec_bioset, 1, offsetof(struct ec_bio, bio),
1865                            BIOSET_NEED_BVECS);
1866 }