Merge tag 'gpio-fixes-for-v5.13-rc3' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6-microblaze.git] / drivers / md / dm-snap.c
1 /*
2  * Copyright (C) 2001-2002 Sistina Software (UK) Limited.
3  *
4  * This file is released under the GPL.
5  */
6
7 #include <linux/blkdev.h>
8 #include <linux/device-mapper.h>
9 #include <linux/delay.h>
10 #include <linux/fs.h>
11 #include <linux/init.h>
12 #include <linux/kdev_t.h>
13 #include <linux/list.h>
14 #include <linux/list_bl.h>
15 #include <linux/mempool.h>
16 #include <linux/module.h>
17 #include <linux/slab.h>
18 #include <linux/vmalloc.h>
19 #include <linux/log2.h>
20 #include <linux/dm-kcopyd.h>
21
22 #include "dm.h"
23
24 #include "dm-exception-store.h"
25
26 #define DM_MSG_PREFIX "snapshots"
27
28 static const char dm_snapshot_merge_target_name[] = "snapshot-merge";
29
30 #define dm_target_is_snapshot_merge(ti) \
31         ((ti)->type->name == dm_snapshot_merge_target_name)
32
33 /*
34  * The size of the mempool used to track chunks in use.
35  */
36 #define MIN_IOS 256
37
38 #define DM_TRACKED_CHUNK_HASH_SIZE      16
39 #define DM_TRACKED_CHUNK_HASH(x)        ((unsigned long)(x) & \
40                                          (DM_TRACKED_CHUNK_HASH_SIZE - 1))
41
42 struct dm_exception_table {
43         uint32_t hash_mask;
44         unsigned hash_shift;
45         struct hlist_bl_head *table;
46 };
47
48 struct dm_snapshot {
49         struct rw_semaphore lock;
50
51         struct dm_dev *origin;
52         struct dm_dev *cow;
53
54         struct dm_target *ti;
55
56         /* List of snapshots per Origin */
57         struct list_head list;
58
59         /*
60          * You can't use a snapshot if this is 0 (e.g. if full).
61          * A snapshot-merge target never clears this.
62          */
63         int valid;
64
65         /*
66          * The snapshot overflowed because of a write to the snapshot device.
67          * We don't have to invalidate the snapshot in this case, but we need
68          * to prevent further writes.
69          */
70         int snapshot_overflowed;
71
72         /* Origin writes don't trigger exceptions until this is set */
73         int active;
74
75         atomic_t pending_exceptions_count;
76
77         spinlock_t pe_allocation_lock;
78
79         /* Protected by "pe_allocation_lock" */
80         sector_t exception_start_sequence;
81
82         /* Protected by kcopyd single-threaded callback */
83         sector_t exception_complete_sequence;
84
85         /*
86          * A list of pending exceptions that completed out of order.
87          * Protected by kcopyd single-threaded callback.
88          */
89         struct rb_root out_of_order_tree;
90
91         mempool_t pending_pool;
92
93         struct dm_exception_table pending;
94         struct dm_exception_table complete;
95
96         /*
97          * pe_lock protects all pending_exception operations and access
98          * as well as the snapshot_bios list.
99          */
100         spinlock_t pe_lock;
101
102         /* Chunks with outstanding reads */
103         spinlock_t tracked_chunk_lock;
104         struct hlist_head tracked_chunk_hash[DM_TRACKED_CHUNK_HASH_SIZE];
105
106         /* The on disk metadata handler */
107         struct dm_exception_store *store;
108
109         unsigned in_progress;
110         struct wait_queue_head in_progress_wait;
111
112         struct dm_kcopyd_client *kcopyd_client;
113
114         /* Wait for events based on state_bits */
115         unsigned long state_bits;
116
117         /* Range of chunks currently being merged. */
118         chunk_t first_merging_chunk;
119         int num_merging_chunks;
120
121         /*
122          * The merge operation failed if this flag is set.
123          * Failure modes are handled as follows:
124          * - I/O error reading the header
125          *      => don't load the target; abort.
126          * - Header does not have "valid" flag set
127          *      => use the origin; forget about the snapshot.
128          * - I/O error when reading exceptions
129          *      => don't load the target; abort.
130          *         (We can't use the intermediate origin state.)
131          * - I/O error while merging
132          *      => stop merging; set merge_failed; process I/O normally.
133          */
134         bool merge_failed:1;
135
136         bool discard_zeroes_cow:1;
137         bool discard_passdown_origin:1;
138
139         /*
140          * Incoming bios that overlap with chunks being merged must wait
141          * for them to be committed.
142          */
143         struct bio_list bios_queued_during_merge;
144
145         /*
146          * Flush data after merge.
147          */
148         struct bio flush_bio;
149 };
150
151 /*
152  * state_bits:
153  *   RUNNING_MERGE  - Merge operation is in progress.
154  *   SHUTDOWN_MERGE - Set to signal that merge needs to be stopped;
155  *                    cleared afterwards.
156  */
157 #define RUNNING_MERGE          0
158 #define SHUTDOWN_MERGE         1
159
160 /*
161  * Maximum number of chunks being copied on write.
162  *
163  * The value was decided experimentally as a trade-off between memory
164  * consumption, stalling the kernel's workqueues and maintaining a high enough
165  * throughput.
166  */
167 #define DEFAULT_COW_THRESHOLD 2048
168
169 static unsigned cow_threshold = DEFAULT_COW_THRESHOLD;
170 module_param_named(snapshot_cow_threshold, cow_threshold, uint, 0644);
171 MODULE_PARM_DESC(snapshot_cow_threshold, "Maximum number of chunks being copied on write");
172
173 DECLARE_DM_KCOPYD_THROTTLE_WITH_MODULE_PARM(snapshot_copy_throttle,
174                 "A percentage of time allocated for copy on write");
175
176 struct dm_dev *dm_snap_origin(struct dm_snapshot *s)
177 {
178         return s->origin;
179 }
180 EXPORT_SYMBOL(dm_snap_origin);
181
182 struct dm_dev *dm_snap_cow(struct dm_snapshot *s)
183 {
184         return s->cow;
185 }
186 EXPORT_SYMBOL(dm_snap_cow);
187
188 static sector_t chunk_to_sector(struct dm_exception_store *store,
189                                 chunk_t chunk)
190 {
191         return chunk << store->chunk_shift;
192 }
193
194 static int bdev_equal(struct block_device *lhs, struct block_device *rhs)
195 {
196         /*
197          * There is only ever one instance of a particular block
198          * device so we can compare pointers safely.
199          */
200         return lhs == rhs;
201 }
202
203 struct dm_snap_pending_exception {
204         struct dm_exception e;
205
206         /*
207          * Origin buffers waiting for this to complete are held
208          * in a bio list
209          */
210         struct bio_list origin_bios;
211         struct bio_list snapshot_bios;
212
213         /* Pointer back to snapshot context */
214         struct dm_snapshot *snap;
215
216         /*
217          * 1 indicates the exception has already been sent to
218          * kcopyd.
219          */
220         int started;
221
222         /* There was copying error. */
223         int copy_error;
224
225         /* A sequence number, it is used for in-order completion. */
226         sector_t exception_sequence;
227
228         struct rb_node out_of_order_node;
229
230         /*
231          * For writing a complete chunk, bypassing the copy.
232          */
233         struct bio *full_bio;
234         bio_end_io_t *full_bio_end_io;
235 };
236
237 /*
238  * Hash table mapping origin volumes to lists of snapshots and
239  * a lock to protect it
240  */
241 static struct kmem_cache *exception_cache;
242 static struct kmem_cache *pending_cache;
243
244 struct dm_snap_tracked_chunk {
245         struct hlist_node node;
246         chunk_t chunk;
247 };
248
249 static void init_tracked_chunk(struct bio *bio)
250 {
251         struct dm_snap_tracked_chunk *c = dm_per_bio_data(bio, sizeof(struct dm_snap_tracked_chunk));
252         INIT_HLIST_NODE(&c->node);
253 }
254
255 static bool is_bio_tracked(struct bio *bio)
256 {
257         struct dm_snap_tracked_chunk *c = dm_per_bio_data(bio, sizeof(struct dm_snap_tracked_chunk));
258         return !hlist_unhashed(&c->node);
259 }
260
261 static void track_chunk(struct dm_snapshot *s, struct bio *bio, chunk_t chunk)
262 {
263         struct dm_snap_tracked_chunk *c = dm_per_bio_data(bio, sizeof(struct dm_snap_tracked_chunk));
264
265         c->chunk = chunk;
266
267         spin_lock_irq(&s->tracked_chunk_lock);
268         hlist_add_head(&c->node,
269                        &s->tracked_chunk_hash[DM_TRACKED_CHUNK_HASH(chunk)]);
270         spin_unlock_irq(&s->tracked_chunk_lock);
271 }
272
273 static void stop_tracking_chunk(struct dm_snapshot *s, struct bio *bio)
274 {
275         struct dm_snap_tracked_chunk *c = dm_per_bio_data(bio, sizeof(struct dm_snap_tracked_chunk));
276         unsigned long flags;
277
278         spin_lock_irqsave(&s->tracked_chunk_lock, flags);
279         hlist_del(&c->node);
280         spin_unlock_irqrestore(&s->tracked_chunk_lock, flags);
281 }
282
283 static int __chunk_is_tracked(struct dm_snapshot *s, chunk_t chunk)
284 {
285         struct dm_snap_tracked_chunk *c;
286         int found = 0;
287
288         spin_lock_irq(&s->tracked_chunk_lock);
289
290         hlist_for_each_entry(c,
291             &s->tracked_chunk_hash[DM_TRACKED_CHUNK_HASH(chunk)], node) {
292                 if (c->chunk == chunk) {
293                         found = 1;
294                         break;
295                 }
296         }
297
298         spin_unlock_irq(&s->tracked_chunk_lock);
299
300         return found;
301 }
302
303 /*
304  * This conflicting I/O is extremely improbable in the caller,
305  * so msleep(1) is sufficient and there is no need for a wait queue.
306  */
307 static void __check_for_conflicting_io(struct dm_snapshot *s, chunk_t chunk)
308 {
309         while (__chunk_is_tracked(s, chunk))
310                 msleep(1);
311 }
312
313 /*
314  * One of these per registered origin, held in the snapshot_origins hash
315  */
316 struct origin {
317         /* The origin device */
318         struct block_device *bdev;
319
320         struct list_head hash_list;
321
322         /* List of snapshots for this origin */
323         struct list_head snapshots;
324 };
325
326 /*
327  * This structure is allocated for each origin target
328  */
329 struct dm_origin {
330         struct dm_dev *dev;
331         struct dm_target *ti;
332         unsigned split_boundary;
333         struct list_head hash_list;
334 };
335
336 /*
337  * Size of the hash table for origin volumes. If we make this
338  * the size of the minors list then it should be nearly perfect
339  */
340 #define ORIGIN_HASH_SIZE 256
341 #define ORIGIN_MASK      0xFF
342 static struct list_head *_origins;
343 static struct list_head *_dm_origins;
344 static struct rw_semaphore _origins_lock;
345
346 static DECLARE_WAIT_QUEUE_HEAD(_pending_exceptions_done);
347 static DEFINE_SPINLOCK(_pending_exceptions_done_spinlock);
348 static uint64_t _pending_exceptions_done_count;
349
350 static int init_origin_hash(void)
351 {
352         int i;
353
354         _origins = kmalloc_array(ORIGIN_HASH_SIZE, sizeof(struct list_head),
355                                  GFP_KERNEL);
356         if (!_origins) {
357                 DMERR("unable to allocate memory for _origins");
358                 return -ENOMEM;
359         }
360         for (i = 0; i < ORIGIN_HASH_SIZE; i++)
361                 INIT_LIST_HEAD(_origins + i);
362
363         _dm_origins = kmalloc_array(ORIGIN_HASH_SIZE,
364                                     sizeof(struct list_head),
365                                     GFP_KERNEL);
366         if (!_dm_origins) {
367                 DMERR("unable to allocate memory for _dm_origins");
368                 kfree(_origins);
369                 return -ENOMEM;
370         }
371         for (i = 0; i < ORIGIN_HASH_SIZE; i++)
372                 INIT_LIST_HEAD(_dm_origins + i);
373
374         init_rwsem(&_origins_lock);
375
376         return 0;
377 }
378
379 static void exit_origin_hash(void)
380 {
381         kfree(_origins);
382         kfree(_dm_origins);
383 }
384
385 static unsigned origin_hash(struct block_device *bdev)
386 {
387         return bdev->bd_dev & ORIGIN_MASK;
388 }
389
390 static struct origin *__lookup_origin(struct block_device *origin)
391 {
392         struct list_head *ol;
393         struct origin *o;
394
395         ol = &_origins[origin_hash(origin)];
396         list_for_each_entry (o, ol, hash_list)
397                 if (bdev_equal(o->bdev, origin))
398                         return o;
399
400         return NULL;
401 }
402
403 static void __insert_origin(struct origin *o)
404 {
405         struct list_head *sl = &_origins[origin_hash(o->bdev)];
406         list_add_tail(&o->hash_list, sl);
407 }
408
409 static struct dm_origin *__lookup_dm_origin(struct block_device *origin)
410 {
411         struct list_head *ol;
412         struct dm_origin *o;
413
414         ol = &_dm_origins[origin_hash(origin)];
415         list_for_each_entry (o, ol, hash_list)
416                 if (bdev_equal(o->dev->bdev, origin))
417                         return o;
418
419         return NULL;
420 }
421
422 static void __insert_dm_origin(struct dm_origin *o)
423 {
424         struct list_head *sl = &_dm_origins[origin_hash(o->dev->bdev)];
425         list_add_tail(&o->hash_list, sl);
426 }
427
428 static void __remove_dm_origin(struct dm_origin *o)
429 {
430         list_del(&o->hash_list);
431 }
432
433 /*
434  * _origins_lock must be held when calling this function.
435  * Returns number of snapshots registered using the supplied cow device, plus:
436  * snap_src - a snapshot suitable for use as a source of exception handover
437  * snap_dest - a snapshot capable of receiving exception handover.
438  * snap_merge - an existing snapshot-merge target linked to the same origin.
439  *   There can be at most one snapshot-merge target. The parameter is optional.
440  *
441  * Possible return values and states of snap_src and snap_dest.
442  *   0: NULL, NULL  - first new snapshot
443  *   1: snap_src, NULL - normal snapshot
444  *   2: snap_src, snap_dest  - waiting for handover
445  *   2: snap_src, NULL - handed over, waiting for old to be deleted
446  *   1: NULL, snap_dest - source got destroyed without handover
447  */
448 static int __find_snapshots_sharing_cow(struct dm_snapshot *snap,
449                                         struct dm_snapshot **snap_src,
450                                         struct dm_snapshot **snap_dest,
451                                         struct dm_snapshot **snap_merge)
452 {
453         struct dm_snapshot *s;
454         struct origin *o;
455         int count = 0;
456         int active;
457
458         o = __lookup_origin(snap->origin->bdev);
459         if (!o)
460                 goto out;
461
462         list_for_each_entry(s, &o->snapshots, list) {
463                 if (dm_target_is_snapshot_merge(s->ti) && snap_merge)
464                         *snap_merge = s;
465                 if (!bdev_equal(s->cow->bdev, snap->cow->bdev))
466                         continue;
467
468                 down_read(&s->lock);
469                 active = s->active;
470                 up_read(&s->lock);
471
472                 if (active) {
473                         if (snap_src)
474                                 *snap_src = s;
475                 } else if (snap_dest)
476                         *snap_dest = s;
477
478                 count++;
479         }
480
481 out:
482         return count;
483 }
484
485 /*
486  * On success, returns 1 if this snapshot is a handover destination,
487  * otherwise returns 0.
488  */
489 static int __validate_exception_handover(struct dm_snapshot *snap)
490 {
491         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
492         struct dm_snapshot *snap_merge = NULL;
493
494         /* Does snapshot need exceptions handed over to it? */
495         if ((__find_snapshots_sharing_cow(snap, &snap_src, &snap_dest,
496                                           &snap_merge) == 2) ||
497             snap_dest) {
498                 snap->ti->error = "Snapshot cow pairing for exception "
499                                   "table handover failed";
500                 return -EINVAL;
501         }
502
503         /*
504          * If no snap_src was found, snap cannot become a handover
505          * destination.
506          */
507         if (!snap_src)
508                 return 0;
509
510         /*
511          * Non-snapshot-merge handover?
512          */
513         if (!dm_target_is_snapshot_merge(snap->ti))
514                 return 1;
515
516         /*
517          * Do not allow more than one merging snapshot.
518          */
519         if (snap_merge) {
520                 snap->ti->error = "A snapshot is already merging.";
521                 return -EINVAL;
522         }
523
524         if (!snap_src->store->type->prepare_merge ||
525             !snap_src->store->type->commit_merge) {
526                 snap->ti->error = "Snapshot exception store does not "
527                                   "support snapshot-merge.";
528                 return -EINVAL;
529         }
530
531         return 1;
532 }
533
534 static void __insert_snapshot(struct origin *o, struct dm_snapshot *s)
535 {
536         struct dm_snapshot *l;
537
538         /* Sort the list according to chunk size, largest-first smallest-last */
539         list_for_each_entry(l, &o->snapshots, list)
540                 if (l->store->chunk_size < s->store->chunk_size)
541                         break;
542         list_add_tail(&s->list, &l->list);
543 }
544
545 /*
546  * Make a note of the snapshot and its origin so we can look it
547  * up when the origin has a write on it.
548  *
549  * Also validate snapshot exception store handovers.
550  * On success, returns 1 if this registration is a handover destination,
551  * otherwise returns 0.
552  */
553 static int register_snapshot(struct dm_snapshot *snap)
554 {
555         struct origin *o, *new_o = NULL;
556         struct block_device *bdev = snap->origin->bdev;
557         int r = 0;
558
559         new_o = kmalloc(sizeof(*new_o), GFP_KERNEL);
560         if (!new_o)
561                 return -ENOMEM;
562
563         down_write(&_origins_lock);
564
565         r = __validate_exception_handover(snap);
566         if (r < 0) {
567                 kfree(new_o);
568                 goto out;
569         }
570
571         o = __lookup_origin(bdev);
572         if (o)
573                 kfree(new_o);
574         else {
575                 /* New origin */
576                 o = new_o;
577
578                 /* Initialise the struct */
579                 INIT_LIST_HEAD(&o->snapshots);
580                 o->bdev = bdev;
581
582                 __insert_origin(o);
583         }
584
585         __insert_snapshot(o, snap);
586
587 out:
588         up_write(&_origins_lock);
589
590         return r;
591 }
592
593 /*
594  * Move snapshot to correct place in list according to chunk size.
595  */
596 static void reregister_snapshot(struct dm_snapshot *s)
597 {
598         struct block_device *bdev = s->origin->bdev;
599
600         down_write(&_origins_lock);
601
602         list_del(&s->list);
603         __insert_snapshot(__lookup_origin(bdev), s);
604
605         up_write(&_origins_lock);
606 }
607
608 static void unregister_snapshot(struct dm_snapshot *s)
609 {
610         struct origin *o;
611
612         down_write(&_origins_lock);
613         o = __lookup_origin(s->origin->bdev);
614
615         list_del(&s->list);
616         if (o && list_empty(&o->snapshots)) {
617                 list_del(&o->hash_list);
618                 kfree(o);
619         }
620
621         up_write(&_origins_lock);
622 }
623
624 /*
625  * Implementation of the exception hash tables.
626  * The lowest hash_shift bits of the chunk number are ignored, allowing
627  * some consecutive chunks to be grouped together.
628  */
629 static uint32_t exception_hash(struct dm_exception_table *et, chunk_t chunk);
630
631 /* Lock to protect access to the completed and pending exception hash tables. */
632 struct dm_exception_table_lock {
633         struct hlist_bl_head *complete_slot;
634         struct hlist_bl_head *pending_slot;
635 };
636
637 static void dm_exception_table_lock_init(struct dm_snapshot *s, chunk_t chunk,
638                                          struct dm_exception_table_lock *lock)
639 {
640         struct dm_exception_table *complete = &s->complete;
641         struct dm_exception_table *pending = &s->pending;
642
643         lock->complete_slot = &complete->table[exception_hash(complete, chunk)];
644         lock->pending_slot = &pending->table[exception_hash(pending, chunk)];
645 }
646
647 static void dm_exception_table_lock(struct dm_exception_table_lock *lock)
648 {
649         hlist_bl_lock(lock->complete_slot);
650         hlist_bl_lock(lock->pending_slot);
651 }
652
653 static void dm_exception_table_unlock(struct dm_exception_table_lock *lock)
654 {
655         hlist_bl_unlock(lock->pending_slot);
656         hlist_bl_unlock(lock->complete_slot);
657 }
658
659 static int dm_exception_table_init(struct dm_exception_table *et,
660                                    uint32_t size, unsigned hash_shift)
661 {
662         unsigned int i;
663
664         et->hash_shift = hash_shift;
665         et->hash_mask = size - 1;
666         et->table = kvmalloc_array(size, sizeof(struct hlist_bl_head),
667                                    GFP_KERNEL);
668         if (!et->table)
669                 return -ENOMEM;
670
671         for (i = 0; i < size; i++)
672                 INIT_HLIST_BL_HEAD(et->table + i);
673
674         return 0;
675 }
676
677 static void dm_exception_table_exit(struct dm_exception_table *et,
678                                     struct kmem_cache *mem)
679 {
680         struct hlist_bl_head *slot;
681         struct dm_exception *ex;
682         struct hlist_bl_node *pos, *n;
683         int i, size;
684
685         size = et->hash_mask + 1;
686         for (i = 0; i < size; i++) {
687                 slot = et->table + i;
688
689                 hlist_bl_for_each_entry_safe(ex, pos, n, slot, hash_list)
690                         kmem_cache_free(mem, ex);
691         }
692
693         kvfree(et->table);
694 }
695
696 static uint32_t exception_hash(struct dm_exception_table *et, chunk_t chunk)
697 {
698         return (chunk >> et->hash_shift) & et->hash_mask;
699 }
700
701 static void dm_remove_exception(struct dm_exception *e)
702 {
703         hlist_bl_del(&e->hash_list);
704 }
705
706 /*
707  * Return the exception data for a sector, or NULL if not
708  * remapped.
709  */
710 static struct dm_exception *dm_lookup_exception(struct dm_exception_table *et,
711                                                 chunk_t chunk)
712 {
713         struct hlist_bl_head *slot;
714         struct hlist_bl_node *pos;
715         struct dm_exception *e;
716
717         slot = &et->table[exception_hash(et, chunk)];
718         hlist_bl_for_each_entry(e, pos, slot, hash_list)
719                 if (chunk >= e->old_chunk &&
720                     chunk <= e->old_chunk + dm_consecutive_chunk_count(e))
721                         return e;
722
723         return NULL;
724 }
725
726 static struct dm_exception *alloc_completed_exception(gfp_t gfp)
727 {
728         struct dm_exception *e;
729
730         e = kmem_cache_alloc(exception_cache, gfp);
731         if (!e && gfp == GFP_NOIO)
732                 e = kmem_cache_alloc(exception_cache, GFP_ATOMIC);
733
734         return e;
735 }
736
737 static void free_completed_exception(struct dm_exception *e)
738 {
739         kmem_cache_free(exception_cache, e);
740 }
741
742 static struct dm_snap_pending_exception *alloc_pending_exception(struct dm_snapshot *s)
743 {
744         struct dm_snap_pending_exception *pe = mempool_alloc(&s->pending_pool,
745                                                              GFP_NOIO);
746
747         atomic_inc(&s->pending_exceptions_count);
748         pe->snap = s;
749
750         return pe;
751 }
752
753 static void free_pending_exception(struct dm_snap_pending_exception *pe)
754 {
755         struct dm_snapshot *s = pe->snap;
756
757         mempool_free(pe, &s->pending_pool);
758         smp_mb__before_atomic();
759         atomic_dec(&s->pending_exceptions_count);
760 }
761
762 static void dm_insert_exception(struct dm_exception_table *eh,
763                                 struct dm_exception *new_e)
764 {
765         struct hlist_bl_head *l;
766         struct hlist_bl_node *pos;
767         struct dm_exception *e = NULL;
768
769         l = &eh->table[exception_hash(eh, new_e->old_chunk)];
770
771         /* Add immediately if this table doesn't support consecutive chunks */
772         if (!eh->hash_shift)
773                 goto out;
774
775         /* List is ordered by old_chunk */
776         hlist_bl_for_each_entry(e, pos, l, hash_list) {
777                 /* Insert after an existing chunk? */
778                 if (new_e->old_chunk == (e->old_chunk +
779                                          dm_consecutive_chunk_count(e) + 1) &&
780                     new_e->new_chunk == (dm_chunk_number(e->new_chunk) +
781                                          dm_consecutive_chunk_count(e) + 1)) {
782                         dm_consecutive_chunk_count_inc(e);
783                         free_completed_exception(new_e);
784                         return;
785                 }
786
787                 /* Insert before an existing chunk? */
788                 if (new_e->old_chunk == (e->old_chunk - 1) &&
789                     new_e->new_chunk == (dm_chunk_number(e->new_chunk) - 1)) {
790                         dm_consecutive_chunk_count_inc(e);
791                         e->old_chunk--;
792                         e->new_chunk--;
793                         free_completed_exception(new_e);
794                         return;
795                 }
796
797                 if (new_e->old_chunk < e->old_chunk)
798                         break;
799         }
800
801 out:
802         if (!e) {
803                 /*
804                  * Either the table doesn't support consecutive chunks or slot
805                  * l is empty.
806                  */
807                 hlist_bl_add_head(&new_e->hash_list, l);
808         } else if (new_e->old_chunk < e->old_chunk) {
809                 /* Add before an existing exception */
810                 hlist_bl_add_before(&new_e->hash_list, &e->hash_list);
811         } else {
812                 /* Add to l's tail: e is the last exception in this slot */
813                 hlist_bl_add_behind(&new_e->hash_list, &e->hash_list);
814         }
815 }
816
817 /*
818  * Callback used by the exception stores to load exceptions when
819  * initialising.
820  */
821 static int dm_add_exception(void *context, chunk_t old, chunk_t new)
822 {
823         struct dm_exception_table_lock lock;
824         struct dm_snapshot *s = context;
825         struct dm_exception *e;
826
827         e = alloc_completed_exception(GFP_KERNEL);
828         if (!e)
829                 return -ENOMEM;
830
831         e->old_chunk = old;
832
833         /* Consecutive_count is implicitly initialised to zero */
834         e->new_chunk = new;
835
836         /*
837          * Although there is no need to lock access to the exception tables
838          * here, if we don't then hlist_bl_add_head(), called by
839          * dm_insert_exception(), will complain about accessing the
840          * corresponding list without locking it first.
841          */
842         dm_exception_table_lock_init(s, old, &lock);
843
844         dm_exception_table_lock(&lock);
845         dm_insert_exception(&s->complete, e);
846         dm_exception_table_unlock(&lock);
847
848         return 0;
849 }
850
851 /*
852  * Return a minimum chunk size of all snapshots that have the specified origin.
853  * Return zero if the origin has no snapshots.
854  */
855 static uint32_t __minimum_chunk_size(struct origin *o)
856 {
857         struct dm_snapshot *snap;
858         unsigned chunk_size = rounddown_pow_of_two(UINT_MAX);
859
860         if (o)
861                 list_for_each_entry(snap, &o->snapshots, list)
862                         chunk_size = min(chunk_size, snap->store->chunk_size);
863
864         return (uint32_t) chunk_size;
865 }
866
867 /*
868  * Hard coded magic.
869  */
870 static int calc_max_buckets(void)
871 {
872         /* use a fixed size of 2MB */
873         unsigned long mem = 2 * 1024 * 1024;
874         mem /= sizeof(struct hlist_bl_head);
875
876         return mem;
877 }
878
879 /*
880  * Allocate room for a suitable hash table.
881  */
882 static int init_hash_tables(struct dm_snapshot *s)
883 {
884         sector_t hash_size, cow_dev_size, max_buckets;
885
886         /*
887          * Calculate based on the size of the original volume or
888          * the COW volume...
889          */
890         cow_dev_size = get_dev_size(s->cow->bdev);
891         max_buckets = calc_max_buckets();
892
893         hash_size = cow_dev_size >> s->store->chunk_shift;
894         hash_size = min(hash_size, max_buckets);
895
896         if (hash_size < 64)
897                 hash_size = 64;
898         hash_size = rounddown_pow_of_two(hash_size);
899         if (dm_exception_table_init(&s->complete, hash_size,
900                                     DM_CHUNK_CONSECUTIVE_BITS))
901                 return -ENOMEM;
902
903         /*
904          * Allocate hash table for in-flight exceptions
905          * Make this smaller than the real hash table
906          */
907         hash_size >>= 3;
908         if (hash_size < 64)
909                 hash_size = 64;
910
911         if (dm_exception_table_init(&s->pending, hash_size, 0)) {
912                 dm_exception_table_exit(&s->complete, exception_cache);
913                 return -ENOMEM;
914         }
915
916         return 0;
917 }
918
919 static void merge_shutdown(struct dm_snapshot *s)
920 {
921         clear_bit_unlock(RUNNING_MERGE, &s->state_bits);
922         smp_mb__after_atomic();
923         wake_up_bit(&s->state_bits, RUNNING_MERGE);
924 }
925
926 static struct bio *__release_queued_bios_after_merge(struct dm_snapshot *s)
927 {
928         s->first_merging_chunk = 0;
929         s->num_merging_chunks = 0;
930
931         return bio_list_get(&s->bios_queued_during_merge);
932 }
933
934 /*
935  * Remove one chunk from the index of completed exceptions.
936  */
937 static int __remove_single_exception_chunk(struct dm_snapshot *s,
938                                            chunk_t old_chunk)
939 {
940         struct dm_exception *e;
941
942         e = dm_lookup_exception(&s->complete, old_chunk);
943         if (!e) {
944                 DMERR("Corruption detected: exception for block %llu is "
945                       "on disk but not in memory",
946                       (unsigned long long)old_chunk);
947                 return -EINVAL;
948         }
949
950         /*
951          * If this is the only chunk using this exception, remove exception.
952          */
953         if (!dm_consecutive_chunk_count(e)) {
954                 dm_remove_exception(e);
955                 free_completed_exception(e);
956                 return 0;
957         }
958
959         /*
960          * The chunk may be either at the beginning or the end of a
961          * group of consecutive chunks - never in the middle.  We are
962          * removing chunks in the opposite order to that in which they
963          * were added, so this should always be true.
964          * Decrement the consecutive chunk counter and adjust the
965          * starting point if necessary.
966          */
967         if (old_chunk == e->old_chunk) {
968                 e->old_chunk++;
969                 e->new_chunk++;
970         } else if (old_chunk != e->old_chunk +
971                    dm_consecutive_chunk_count(e)) {
972                 DMERR("Attempt to merge block %llu from the "
973                       "middle of a chunk range [%llu - %llu]",
974                       (unsigned long long)old_chunk,
975                       (unsigned long long)e->old_chunk,
976                       (unsigned long long)
977                       e->old_chunk + dm_consecutive_chunk_count(e));
978                 return -EINVAL;
979         }
980
981         dm_consecutive_chunk_count_dec(e);
982
983         return 0;
984 }
985
986 static void flush_bios(struct bio *bio);
987
988 static int remove_single_exception_chunk(struct dm_snapshot *s)
989 {
990         struct bio *b = NULL;
991         int r;
992         chunk_t old_chunk = s->first_merging_chunk + s->num_merging_chunks - 1;
993
994         down_write(&s->lock);
995
996         /*
997          * Process chunks (and associated exceptions) in reverse order
998          * so that dm_consecutive_chunk_count_dec() accounting works.
999          */
1000         do {
1001                 r = __remove_single_exception_chunk(s, old_chunk);
1002                 if (r)
1003                         goto out;
1004         } while (old_chunk-- > s->first_merging_chunk);
1005
1006         b = __release_queued_bios_after_merge(s);
1007
1008 out:
1009         up_write(&s->lock);
1010         if (b)
1011                 flush_bios(b);
1012
1013         return r;
1014 }
1015
1016 static int origin_write_extent(struct dm_snapshot *merging_snap,
1017                                sector_t sector, unsigned chunk_size);
1018
1019 static void merge_callback(int read_err, unsigned long write_err,
1020                            void *context);
1021
1022 static uint64_t read_pending_exceptions_done_count(void)
1023 {
1024         uint64_t pending_exceptions_done;
1025
1026         spin_lock(&_pending_exceptions_done_spinlock);
1027         pending_exceptions_done = _pending_exceptions_done_count;
1028         spin_unlock(&_pending_exceptions_done_spinlock);
1029
1030         return pending_exceptions_done;
1031 }
1032
1033 static void increment_pending_exceptions_done_count(void)
1034 {
1035         spin_lock(&_pending_exceptions_done_spinlock);
1036         _pending_exceptions_done_count++;
1037         spin_unlock(&_pending_exceptions_done_spinlock);
1038
1039         wake_up_all(&_pending_exceptions_done);
1040 }
1041
1042 static void snapshot_merge_next_chunks(struct dm_snapshot *s)
1043 {
1044         int i, linear_chunks;
1045         chunk_t old_chunk, new_chunk;
1046         struct dm_io_region src, dest;
1047         sector_t io_size;
1048         uint64_t previous_count;
1049
1050         BUG_ON(!test_bit(RUNNING_MERGE, &s->state_bits));
1051         if (unlikely(test_bit(SHUTDOWN_MERGE, &s->state_bits)))
1052                 goto shut;
1053
1054         /*
1055          * valid flag never changes during merge, so no lock required.
1056          */
1057         if (!s->valid) {
1058                 DMERR("Snapshot is invalid: can't merge");
1059                 goto shut;
1060         }
1061
1062         linear_chunks = s->store->type->prepare_merge(s->store, &old_chunk,
1063                                                       &new_chunk);
1064         if (linear_chunks <= 0) {
1065                 if (linear_chunks < 0) {
1066                         DMERR("Read error in exception store: "
1067                               "shutting down merge");
1068                         down_write(&s->lock);
1069                         s->merge_failed = true;
1070                         up_write(&s->lock);
1071                 }
1072                 goto shut;
1073         }
1074
1075         /* Adjust old_chunk and new_chunk to reflect start of linear region */
1076         old_chunk = old_chunk + 1 - linear_chunks;
1077         new_chunk = new_chunk + 1 - linear_chunks;
1078
1079         /*
1080          * Use one (potentially large) I/O to copy all 'linear_chunks'
1081          * from the exception store to the origin
1082          */
1083         io_size = linear_chunks * s->store->chunk_size;
1084
1085         dest.bdev = s->origin->bdev;
1086         dest.sector = chunk_to_sector(s->store, old_chunk);
1087         dest.count = min(io_size, get_dev_size(dest.bdev) - dest.sector);
1088
1089         src.bdev = s->cow->bdev;
1090         src.sector = chunk_to_sector(s->store, new_chunk);
1091         src.count = dest.count;
1092
1093         /*
1094          * Reallocate any exceptions needed in other snapshots then
1095          * wait for the pending exceptions to complete.
1096          * Each time any pending exception (globally on the system)
1097          * completes we are woken and repeat the process to find out
1098          * if we can proceed.  While this may not seem a particularly
1099          * efficient algorithm, it is not expected to have any
1100          * significant impact on performance.
1101          */
1102         previous_count = read_pending_exceptions_done_count();
1103         while (origin_write_extent(s, dest.sector, io_size)) {
1104                 wait_event(_pending_exceptions_done,
1105                            (read_pending_exceptions_done_count() !=
1106                             previous_count));
1107                 /* Retry after the wait, until all exceptions are done. */
1108                 previous_count = read_pending_exceptions_done_count();
1109         }
1110
1111         down_write(&s->lock);
1112         s->first_merging_chunk = old_chunk;
1113         s->num_merging_chunks = linear_chunks;
1114         up_write(&s->lock);
1115
1116         /* Wait until writes to all 'linear_chunks' drain */
1117         for (i = 0; i < linear_chunks; i++)
1118                 __check_for_conflicting_io(s, old_chunk + i);
1119
1120         dm_kcopyd_copy(s->kcopyd_client, &src, 1, &dest, 0, merge_callback, s);
1121         return;
1122
1123 shut:
1124         merge_shutdown(s);
1125 }
1126
1127 static void error_bios(struct bio *bio);
1128
1129 static int flush_data(struct dm_snapshot *s)
1130 {
1131         struct bio *flush_bio = &s->flush_bio;
1132
1133         bio_reset(flush_bio);
1134         bio_set_dev(flush_bio, s->origin->bdev);
1135         flush_bio->bi_opf = REQ_OP_WRITE | REQ_PREFLUSH;
1136
1137         return submit_bio_wait(flush_bio);
1138 }
1139
1140 static void merge_callback(int read_err, unsigned long write_err, void *context)
1141 {
1142         struct dm_snapshot *s = context;
1143         struct bio *b = NULL;
1144
1145         if (read_err || write_err) {
1146                 if (read_err)
1147                         DMERR("Read error: shutting down merge.");
1148                 else
1149                         DMERR("Write error: shutting down merge.");
1150                 goto shut;
1151         }
1152
1153         if (flush_data(s) < 0) {
1154                 DMERR("Flush after merge failed: shutting down merge");
1155                 goto shut;
1156         }
1157
1158         if (s->store->type->commit_merge(s->store,
1159                                          s->num_merging_chunks) < 0) {
1160                 DMERR("Write error in exception store: shutting down merge");
1161                 goto shut;
1162         }
1163
1164         if (remove_single_exception_chunk(s) < 0)
1165                 goto shut;
1166
1167         snapshot_merge_next_chunks(s);
1168
1169         return;
1170
1171 shut:
1172         down_write(&s->lock);
1173         s->merge_failed = true;
1174         b = __release_queued_bios_after_merge(s);
1175         up_write(&s->lock);
1176         error_bios(b);
1177
1178         merge_shutdown(s);
1179 }
1180
1181 static void start_merge(struct dm_snapshot *s)
1182 {
1183         if (!test_and_set_bit(RUNNING_MERGE, &s->state_bits))
1184                 snapshot_merge_next_chunks(s);
1185 }
1186
1187 /*
1188  * Stop the merging process and wait until it finishes.
1189  */
1190 static void stop_merge(struct dm_snapshot *s)
1191 {
1192         set_bit(SHUTDOWN_MERGE, &s->state_bits);
1193         wait_on_bit(&s->state_bits, RUNNING_MERGE, TASK_UNINTERRUPTIBLE);
1194         clear_bit(SHUTDOWN_MERGE, &s->state_bits);
1195 }
1196
1197 static int parse_snapshot_features(struct dm_arg_set *as, struct dm_snapshot *s,
1198                                    struct dm_target *ti)
1199 {
1200         int r;
1201         unsigned argc;
1202         const char *arg_name;
1203
1204         static const struct dm_arg _args[] = {
1205                 {0, 2, "Invalid number of feature arguments"},
1206         };
1207
1208         /*
1209          * No feature arguments supplied.
1210          */
1211         if (!as->argc)
1212                 return 0;
1213
1214         r = dm_read_arg_group(_args, as, &argc, &ti->error);
1215         if (r)
1216                 return -EINVAL;
1217
1218         while (argc && !r) {
1219                 arg_name = dm_shift_arg(as);
1220                 argc--;
1221
1222                 if (!strcasecmp(arg_name, "discard_zeroes_cow"))
1223                         s->discard_zeroes_cow = true;
1224
1225                 else if (!strcasecmp(arg_name, "discard_passdown_origin"))
1226                         s->discard_passdown_origin = true;
1227
1228                 else {
1229                         ti->error = "Unrecognised feature requested";
1230                         r = -EINVAL;
1231                         break;
1232                 }
1233         }
1234
1235         if (!s->discard_zeroes_cow && s->discard_passdown_origin) {
1236                 /*
1237                  * TODO: really these are disjoint.. but ti->num_discard_bios
1238                  * and dm_bio_get_target_bio_nr() require rigid constraints.
1239                  */
1240                 ti->error = "discard_passdown_origin feature depends on discard_zeroes_cow";
1241                 r = -EINVAL;
1242         }
1243
1244         return r;
1245 }
1246
1247 /*
1248  * Construct a snapshot mapping:
1249  * <origin_dev> <COW-dev> <p|po|n> <chunk-size> [<# feature args> [<arg>]*]
1250  */
1251 static int snapshot_ctr(struct dm_target *ti, unsigned int argc, char **argv)
1252 {
1253         struct dm_snapshot *s;
1254         struct dm_arg_set as;
1255         int i;
1256         int r = -EINVAL;
1257         char *origin_path, *cow_path;
1258         dev_t origin_dev, cow_dev;
1259         unsigned args_used, num_flush_bios = 1;
1260         fmode_t origin_mode = FMODE_READ;
1261
1262         if (argc < 4) {
1263                 ti->error = "requires 4 or more arguments";
1264                 r = -EINVAL;
1265                 goto bad;
1266         }
1267
1268         if (dm_target_is_snapshot_merge(ti)) {
1269                 num_flush_bios = 2;
1270                 origin_mode = FMODE_WRITE;
1271         }
1272
1273         s = kzalloc(sizeof(*s), GFP_KERNEL);
1274         if (!s) {
1275                 ti->error = "Cannot allocate private snapshot structure";
1276                 r = -ENOMEM;
1277                 goto bad;
1278         }
1279
1280         as.argc = argc;
1281         as.argv = argv;
1282         dm_consume_args(&as, 4);
1283         r = parse_snapshot_features(&as, s, ti);
1284         if (r)
1285                 goto bad_features;
1286
1287         origin_path = argv[0];
1288         argv++;
1289         argc--;
1290
1291         r = dm_get_device(ti, origin_path, origin_mode, &s->origin);
1292         if (r) {
1293                 ti->error = "Cannot get origin device";
1294                 goto bad_origin;
1295         }
1296         origin_dev = s->origin->bdev->bd_dev;
1297
1298         cow_path = argv[0];
1299         argv++;
1300         argc--;
1301
1302         cow_dev = dm_get_dev_t(cow_path);
1303         if (cow_dev && cow_dev == origin_dev) {
1304                 ti->error = "COW device cannot be the same as origin device";
1305                 r = -EINVAL;
1306                 goto bad_cow;
1307         }
1308
1309         r = dm_get_device(ti, cow_path, dm_table_get_mode(ti->table), &s->cow);
1310         if (r) {
1311                 ti->error = "Cannot get COW device";
1312                 goto bad_cow;
1313         }
1314
1315         r = dm_exception_store_create(ti, argc, argv, s, &args_used, &s->store);
1316         if (r) {
1317                 ti->error = "Couldn't create exception store";
1318                 r = -EINVAL;
1319                 goto bad_store;
1320         }
1321
1322         argv += args_used;
1323         argc -= args_used;
1324
1325         s->ti = ti;
1326         s->valid = 1;
1327         s->snapshot_overflowed = 0;
1328         s->active = 0;
1329         atomic_set(&s->pending_exceptions_count, 0);
1330         spin_lock_init(&s->pe_allocation_lock);
1331         s->exception_start_sequence = 0;
1332         s->exception_complete_sequence = 0;
1333         s->out_of_order_tree = RB_ROOT;
1334         init_rwsem(&s->lock);
1335         INIT_LIST_HEAD(&s->list);
1336         spin_lock_init(&s->pe_lock);
1337         s->state_bits = 0;
1338         s->merge_failed = false;
1339         s->first_merging_chunk = 0;
1340         s->num_merging_chunks = 0;
1341         bio_list_init(&s->bios_queued_during_merge);
1342         bio_init(&s->flush_bio, NULL, 0);
1343
1344         /* Allocate hash table for COW data */
1345         if (init_hash_tables(s)) {
1346                 ti->error = "Unable to allocate hash table space";
1347                 r = -ENOMEM;
1348                 goto bad_hash_tables;
1349         }
1350
1351         init_waitqueue_head(&s->in_progress_wait);
1352
1353         s->kcopyd_client = dm_kcopyd_client_create(&dm_kcopyd_throttle);
1354         if (IS_ERR(s->kcopyd_client)) {
1355                 r = PTR_ERR(s->kcopyd_client);
1356                 ti->error = "Could not create kcopyd client";
1357                 goto bad_kcopyd;
1358         }
1359
1360         r = mempool_init_slab_pool(&s->pending_pool, MIN_IOS, pending_cache);
1361         if (r) {
1362                 ti->error = "Could not allocate mempool for pending exceptions";
1363                 goto bad_pending_pool;
1364         }
1365
1366         for (i = 0; i < DM_TRACKED_CHUNK_HASH_SIZE; i++)
1367                 INIT_HLIST_HEAD(&s->tracked_chunk_hash[i]);
1368
1369         spin_lock_init(&s->tracked_chunk_lock);
1370
1371         ti->private = s;
1372         ti->num_flush_bios = num_flush_bios;
1373         if (s->discard_zeroes_cow)
1374                 ti->num_discard_bios = (s->discard_passdown_origin ? 2 : 1);
1375         ti->per_io_data_size = sizeof(struct dm_snap_tracked_chunk);
1376
1377         /* Add snapshot to the list of snapshots for this origin */
1378         /* Exceptions aren't triggered till snapshot_resume() is called */
1379         r = register_snapshot(s);
1380         if (r == -ENOMEM) {
1381                 ti->error = "Snapshot origin struct allocation failed";
1382                 goto bad_load_and_register;
1383         } else if (r < 0) {
1384                 /* invalid handover, register_snapshot has set ti->error */
1385                 goto bad_load_and_register;
1386         }
1387
1388         /*
1389          * Metadata must only be loaded into one table at once, so skip this
1390          * if metadata will be handed over during resume.
1391          * Chunk size will be set during the handover - set it to zero to
1392          * ensure it's ignored.
1393          */
1394         if (r > 0) {
1395                 s->store->chunk_size = 0;
1396                 return 0;
1397         }
1398
1399         r = s->store->type->read_metadata(s->store, dm_add_exception,
1400                                           (void *)s);
1401         if (r < 0) {
1402                 ti->error = "Failed to read snapshot metadata";
1403                 goto bad_read_metadata;
1404         } else if (r > 0) {
1405                 s->valid = 0;
1406                 DMWARN("Snapshot is marked invalid.");
1407         }
1408
1409         if (!s->store->chunk_size) {
1410                 ti->error = "Chunk size not set";
1411                 r = -EINVAL;
1412                 goto bad_read_metadata;
1413         }
1414
1415         r = dm_set_target_max_io_len(ti, s->store->chunk_size);
1416         if (r)
1417                 goto bad_read_metadata;
1418
1419         return 0;
1420
1421 bad_read_metadata:
1422         unregister_snapshot(s);
1423 bad_load_and_register:
1424         mempool_exit(&s->pending_pool);
1425 bad_pending_pool:
1426         dm_kcopyd_client_destroy(s->kcopyd_client);
1427 bad_kcopyd:
1428         dm_exception_table_exit(&s->pending, pending_cache);
1429         dm_exception_table_exit(&s->complete, exception_cache);
1430 bad_hash_tables:
1431         dm_exception_store_destroy(s->store);
1432 bad_store:
1433         dm_put_device(ti, s->cow);
1434 bad_cow:
1435         dm_put_device(ti, s->origin);
1436 bad_origin:
1437 bad_features:
1438         kfree(s);
1439 bad:
1440         return r;
1441 }
1442
1443 static void __free_exceptions(struct dm_snapshot *s)
1444 {
1445         dm_kcopyd_client_destroy(s->kcopyd_client);
1446         s->kcopyd_client = NULL;
1447
1448         dm_exception_table_exit(&s->pending, pending_cache);
1449         dm_exception_table_exit(&s->complete, exception_cache);
1450 }
1451
1452 static void __handover_exceptions(struct dm_snapshot *snap_src,
1453                                   struct dm_snapshot *snap_dest)
1454 {
1455         union {
1456                 struct dm_exception_table table_swap;
1457                 struct dm_exception_store *store_swap;
1458         } u;
1459
1460         /*
1461          * Swap all snapshot context information between the two instances.
1462          */
1463         u.table_swap = snap_dest->complete;
1464         snap_dest->complete = snap_src->complete;
1465         snap_src->complete = u.table_swap;
1466
1467         u.store_swap = snap_dest->store;
1468         snap_dest->store = snap_src->store;
1469         snap_dest->store->userspace_supports_overflow = u.store_swap->userspace_supports_overflow;
1470         snap_src->store = u.store_swap;
1471
1472         snap_dest->store->snap = snap_dest;
1473         snap_src->store->snap = snap_src;
1474
1475         snap_dest->ti->max_io_len = snap_dest->store->chunk_size;
1476         snap_dest->valid = snap_src->valid;
1477         snap_dest->snapshot_overflowed = snap_src->snapshot_overflowed;
1478
1479         /*
1480          * Set source invalid to ensure it receives no further I/O.
1481          */
1482         snap_src->valid = 0;
1483 }
1484
1485 static void snapshot_dtr(struct dm_target *ti)
1486 {
1487 #ifdef CONFIG_DM_DEBUG
1488         int i;
1489 #endif
1490         struct dm_snapshot *s = ti->private;
1491         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
1492
1493         down_read(&_origins_lock);
1494         /* Check whether exception handover must be cancelled */
1495         (void) __find_snapshots_sharing_cow(s, &snap_src, &snap_dest, NULL);
1496         if (snap_src && snap_dest && (s == snap_src)) {
1497                 down_write(&snap_dest->lock);
1498                 snap_dest->valid = 0;
1499                 up_write(&snap_dest->lock);
1500                 DMERR("Cancelling snapshot handover.");
1501         }
1502         up_read(&_origins_lock);
1503
1504         if (dm_target_is_snapshot_merge(ti))
1505                 stop_merge(s);
1506
1507         /* Prevent further origin writes from using this snapshot. */
1508         /* After this returns there can be no new kcopyd jobs. */
1509         unregister_snapshot(s);
1510
1511         while (atomic_read(&s->pending_exceptions_count))
1512                 msleep(1);
1513         /*
1514          * Ensure instructions in mempool_exit aren't reordered
1515          * before atomic_read.
1516          */
1517         smp_mb();
1518
1519 #ifdef CONFIG_DM_DEBUG
1520         for (i = 0; i < DM_TRACKED_CHUNK_HASH_SIZE; i++)
1521                 BUG_ON(!hlist_empty(&s->tracked_chunk_hash[i]));
1522 #endif
1523
1524         __free_exceptions(s);
1525
1526         mempool_exit(&s->pending_pool);
1527
1528         dm_exception_store_destroy(s->store);
1529
1530         bio_uninit(&s->flush_bio);
1531
1532         dm_put_device(ti, s->cow);
1533
1534         dm_put_device(ti, s->origin);
1535
1536         WARN_ON(s->in_progress);
1537
1538         kfree(s);
1539 }
1540
1541 static void account_start_copy(struct dm_snapshot *s)
1542 {
1543         spin_lock(&s->in_progress_wait.lock);
1544         s->in_progress++;
1545         spin_unlock(&s->in_progress_wait.lock);
1546 }
1547
1548 static void account_end_copy(struct dm_snapshot *s)
1549 {
1550         spin_lock(&s->in_progress_wait.lock);
1551         BUG_ON(!s->in_progress);
1552         s->in_progress--;
1553         if (likely(s->in_progress <= cow_threshold) &&
1554             unlikely(waitqueue_active(&s->in_progress_wait)))
1555                 wake_up_locked(&s->in_progress_wait);
1556         spin_unlock(&s->in_progress_wait.lock);
1557 }
1558
1559 static bool wait_for_in_progress(struct dm_snapshot *s, bool unlock_origins)
1560 {
1561         if (unlikely(s->in_progress > cow_threshold)) {
1562                 spin_lock(&s->in_progress_wait.lock);
1563                 if (likely(s->in_progress > cow_threshold)) {
1564                         /*
1565                          * NOTE: this throttle doesn't account for whether
1566                          * the caller is servicing an IO that will trigger a COW
1567                          * so excess throttling may result for chunks not required
1568                          * to be COW'd.  But if cow_threshold was reached, extra
1569                          * throttling is unlikely to negatively impact performance.
1570                          */
1571                         DECLARE_WAITQUEUE(wait, current);
1572                         __add_wait_queue(&s->in_progress_wait, &wait);
1573                         __set_current_state(TASK_UNINTERRUPTIBLE);
1574                         spin_unlock(&s->in_progress_wait.lock);
1575                         if (unlock_origins)
1576                                 up_read(&_origins_lock);
1577                         io_schedule();
1578                         remove_wait_queue(&s->in_progress_wait, &wait);
1579                         return false;
1580                 }
1581                 spin_unlock(&s->in_progress_wait.lock);
1582         }
1583         return true;
1584 }
1585
1586 /*
1587  * Flush a list of buffers.
1588  */
1589 static void flush_bios(struct bio *bio)
1590 {
1591         struct bio *n;
1592
1593         while (bio) {
1594                 n = bio->bi_next;
1595                 bio->bi_next = NULL;
1596                 submit_bio_noacct(bio);
1597                 bio = n;
1598         }
1599 }
1600
1601 static int do_origin(struct dm_dev *origin, struct bio *bio, bool limit);
1602
1603 /*
1604  * Flush a list of buffers.
1605  */
1606 static void retry_origin_bios(struct dm_snapshot *s, struct bio *bio)
1607 {
1608         struct bio *n;
1609         int r;
1610
1611         while (bio) {
1612                 n = bio->bi_next;
1613                 bio->bi_next = NULL;
1614                 r = do_origin(s->origin, bio, false);
1615                 if (r == DM_MAPIO_REMAPPED)
1616                         submit_bio_noacct(bio);
1617                 bio = n;
1618         }
1619 }
1620
1621 /*
1622  * Error a list of buffers.
1623  */
1624 static void error_bios(struct bio *bio)
1625 {
1626         struct bio *n;
1627
1628         while (bio) {
1629                 n = bio->bi_next;
1630                 bio->bi_next = NULL;
1631                 bio_io_error(bio);
1632                 bio = n;
1633         }
1634 }
1635
1636 static void __invalidate_snapshot(struct dm_snapshot *s, int err)
1637 {
1638         if (!s->valid)
1639                 return;
1640
1641         if (err == -EIO)
1642                 DMERR("Invalidating snapshot: Error reading/writing.");
1643         else if (err == -ENOMEM)
1644                 DMERR("Invalidating snapshot: Unable to allocate exception.");
1645
1646         if (s->store->type->drop_snapshot)
1647                 s->store->type->drop_snapshot(s->store);
1648
1649         s->valid = 0;
1650
1651         dm_table_event(s->ti->table);
1652 }
1653
1654 static void invalidate_snapshot(struct dm_snapshot *s, int err)
1655 {
1656         down_write(&s->lock);
1657         __invalidate_snapshot(s, err);
1658         up_write(&s->lock);
1659 }
1660
1661 static void pending_complete(void *context, int success)
1662 {
1663         struct dm_snap_pending_exception *pe = context;
1664         struct dm_exception *e;
1665         struct dm_snapshot *s = pe->snap;
1666         struct bio *origin_bios = NULL;
1667         struct bio *snapshot_bios = NULL;
1668         struct bio *full_bio = NULL;
1669         struct dm_exception_table_lock lock;
1670         int error = 0;
1671
1672         dm_exception_table_lock_init(s, pe->e.old_chunk, &lock);
1673
1674         if (!success) {
1675                 /* Read/write error - snapshot is unusable */
1676                 invalidate_snapshot(s, -EIO);
1677                 error = 1;
1678
1679                 dm_exception_table_lock(&lock);
1680                 goto out;
1681         }
1682
1683         e = alloc_completed_exception(GFP_NOIO);
1684         if (!e) {
1685                 invalidate_snapshot(s, -ENOMEM);
1686                 error = 1;
1687
1688                 dm_exception_table_lock(&lock);
1689                 goto out;
1690         }
1691         *e = pe->e;
1692
1693         down_read(&s->lock);
1694         dm_exception_table_lock(&lock);
1695         if (!s->valid) {
1696                 up_read(&s->lock);
1697                 free_completed_exception(e);
1698                 error = 1;
1699
1700                 goto out;
1701         }
1702
1703         /*
1704          * Add a proper exception. After inserting the completed exception all
1705          * subsequent snapshot reads to this chunk will be redirected to the
1706          * COW device.  This ensures that we do not starve. Moreover, as long
1707          * as the pending exception exists, neither origin writes nor snapshot
1708          * merging can overwrite the chunk in origin.
1709          */
1710         dm_insert_exception(&s->complete, e);
1711         up_read(&s->lock);
1712
1713         /* Wait for conflicting reads to drain */
1714         if (__chunk_is_tracked(s, pe->e.old_chunk)) {
1715                 dm_exception_table_unlock(&lock);
1716                 __check_for_conflicting_io(s, pe->e.old_chunk);
1717                 dm_exception_table_lock(&lock);
1718         }
1719
1720 out:
1721         /* Remove the in-flight exception from the list */
1722         dm_remove_exception(&pe->e);
1723
1724         dm_exception_table_unlock(&lock);
1725
1726         snapshot_bios = bio_list_get(&pe->snapshot_bios);
1727         origin_bios = bio_list_get(&pe->origin_bios);
1728         full_bio = pe->full_bio;
1729         if (full_bio)
1730                 full_bio->bi_end_io = pe->full_bio_end_io;
1731         increment_pending_exceptions_done_count();
1732
1733         /* Submit any pending write bios */
1734         if (error) {
1735                 if (full_bio)
1736                         bio_io_error(full_bio);
1737                 error_bios(snapshot_bios);
1738         } else {
1739                 if (full_bio)
1740                         bio_endio(full_bio);
1741                 flush_bios(snapshot_bios);
1742         }
1743
1744         retry_origin_bios(s, origin_bios);
1745
1746         free_pending_exception(pe);
1747 }
1748
1749 static void complete_exception(struct dm_snap_pending_exception *pe)
1750 {
1751         struct dm_snapshot *s = pe->snap;
1752
1753         /* Update the metadata if we are persistent */
1754         s->store->type->commit_exception(s->store, &pe->e, !pe->copy_error,
1755                                          pending_complete, pe);
1756 }
1757
1758 /*
1759  * Called when the copy I/O has finished.  kcopyd actually runs
1760  * this code so don't block.
1761  */
1762 static void copy_callback(int read_err, unsigned long write_err, void *context)
1763 {
1764         struct dm_snap_pending_exception *pe = context;
1765         struct dm_snapshot *s = pe->snap;
1766
1767         pe->copy_error = read_err || write_err;
1768
1769         if (pe->exception_sequence == s->exception_complete_sequence) {
1770                 struct rb_node *next;
1771
1772                 s->exception_complete_sequence++;
1773                 complete_exception(pe);
1774
1775                 next = rb_first(&s->out_of_order_tree);
1776                 while (next) {
1777                         pe = rb_entry(next, struct dm_snap_pending_exception,
1778                                         out_of_order_node);
1779                         if (pe->exception_sequence != s->exception_complete_sequence)
1780                                 break;
1781                         next = rb_next(next);
1782                         s->exception_complete_sequence++;
1783                         rb_erase(&pe->out_of_order_node, &s->out_of_order_tree);
1784                         complete_exception(pe);
1785                         cond_resched();
1786                 }
1787         } else {
1788                 struct rb_node *parent = NULL;
1789                 struct rb_node **p = &s->out_of_order_tree.rb_node;
1790                 struct dm_snap_pending_exception *pe2;
1791
1792                 while (*p) {
1793                         pe2 = rb_entry(*p, struct dm_snap_pending_exception, out_of_order_node);
1794                         parent = *p;
1795
1796                         BUG_ON(pe->exception_sequence == pe2->exception_sequence);
1797                         if (pe->exception_sequence < pe2->exception_sequence)
1798                                 p = &((*p)->rb_left);
1799                         else
1800                                 p = &((*p)->rb_right);
1801                 }
1802
1803                 rb_link_node(&pe->out_of_order_node, parent, p);
1804                 rb_insert_color(&pe->out_of_order_node, &s->out_of_order_tree);
1805         }
1806         account_end_copy(s);
1807 }
1808
1809 /*
1810  * Dispatches the copy operation to kcopyd.
1811  */
1812 static void start_copy(struct dm_snap_pending_exception *pe)
1813 {
1814         struct dm_snapshot *s = pe->snap;
1815         struct dm_io_region src, dest;
1816         struct block_device *bdev = s->origin->bdev;
1817         sector_t dev_size;
1818
1819         dev_size = get_dev_size(bdev);
1820
1821         src.bdev = bdev;
1822         src.sector = chunk_to_sector(s->store, pe->e.old_chunk);
1823         src.count = min((sector_t)s->store->chunk_size, dev_size - src.sector);
1824
1825         dest.bdev = s->cow->bdev;
1826         dest.sector = chunk_to_sector(s->store, pe->e.new_chunk);
1827         dest.count = src.count;
1828
1829         /* Hand over to kcopyd */
1830         account_start_copy(s);
1831         dm_kcopyd_copy(s->kcopyd_client, &src, 1, &dest, 0, copy_callback, pe);
1832 }
1833
1834 static void full_bio_end_io(struct bio *bio)
1835 {
1836         void *callback_data = bio->bi_private;
1837
1838         dm_kcopyd_do_callback(callback_data, 0, bio->bi_status ? 1 : 0);
1839 }
1840
1841 static void start_full_bio(struct dm_snap_pending_exception *pe,
1842                            struct bio *bio)
1843 {
1844         struct dm_snapshot *s = pe->snap;
1845         void *callback_data;
1846
1847         pe->full_bio = bio;
1848         pe->full_bio_end_io = bio->bi_end_io;
1849
1850         account_start_copy(s);
1851         callback_data = dm_kcopyd_prepare_callback(s->kcopyd_client,
1852                                                    copy_callback, pe);
1853
1854         bio->bi_end_io = full_bio_end_io;
1855         bio->bi_private = callback_data;
1856
1857         submit_bio_noacct(bio);
1858 }
1859
1860 static struct dm_snap_pending_exception *
1861 __lookup_pending_exception(struct dm_snapshot *s, chunk_t chunk)
1862 {
1863         struct dm_exception *e = dm_lookup_exception(&s->pending, chunk);
1864
1865         if (!e)
1866                 return NULL;
1867
1868         return container_of(e, struct dm_snap_pending_exception, e);
1869 }
1870
1871 /*
1872  * Inserts a pending exception into the pending table.
1873  *
1874  * NOTE: a write lock must be held on the chunk's pending exception table slot
1875  * before calling this.
1876  */
1877 static struct dm_snap_pending_exception *
1878 __insert_pending_exception(struct dm_snapshot *s,
1879                            struct dm_snap_pending_exception *pe, chunk_t chunk)
1880 {
1881         pe->e.old_chunk = chunk;
1882         bio_list_init(&pe->origin_bios);
1883         bio_list_init(&pe->snapshot_bios);
1884         pe->started = 0;
1885         pe->full_bio = NULL;
1886
1887         spin_lock(&s->pe_allocation_lock);
1888         if (s->store->type->prepare_exception(s->store, &pe->e)) {
1889                 spin_unlock(&s->pe_allocation_lock);
1890                 free_pending_exception(pe);
1891                 return NULL;
1892         }
1893
1894         pe->exception_sequence = s->exception_start_sequence++;
1895         spin_unlock(&s->pe_allocation_lock);
1896
1897         dm_insert_exception(&s->pending, &pe->e);
1898
1899         return pe;
1900 }
1901
1902 /*
1903  * Looks to see if this snapshot already has a pending exception
1904  * for this chunk, otherwise it allocates a new one and inserts
1905  * it into the pending table.
1906  *
1907  * NOTE: a write lock must be held on the chunk's pending exception table slot
1908  * before calling this.
1909  */
1910 static struct dm_snap_pending_exception *
1911 __find_pending_exception(struct dm_snapshot *s,
1912                          struct dm_snap_pending_exception *pe, chunk_t chunk)
1913 {
1914         struct dm_snap_pending_exception *pe2;
1915
1916         pe2 = __lookup_pending_exception(s, chunk);
1917         if (pe2) {
1918                 free_pending_exception(pe);
1919                 return pe2;
1920         }
1921
1922         return __insert_pending_exception(s, pe, chunk);
1923 }
1924
1925 static void remap_exception(struct dm_snapshot *s, struct dm_exception *e,
1926                             struct bio *bio, chunk_t chunk)
1927 {
1928         bio_set_dev(bio, s->cow->bdev);
1929         bio->bi_iter.bi_sector =
1930                 chunk_to_sector(s->store, dm_chunk_number(e->new_chunk) +
1931                                 (chunk - e->old_chunk)) +
1932                 (bio->bi_iter.bi_sector & s->store->chunk_mask);
1933 }
1934
1935 static void zero_callback(int read_err, unsigned long write_err, void *context)
1936 {
1937         struct bio *bio = context;
1938         struct dm_snapshot *s = bio->bi_private;
1939
1940         account_end_copy(s);
1941         bio->bi_status = write_err ? BLK_STS_IOERR : 0;
1942         bio_endio(bio);
1943 }
1944
1945 static void zero_exception(struct dm_snapshot *s, struct dm_exception *e,
1946                            struct bio *bio, chunk_t chunk)
1947 {
1948         struct dm_io_region dest;
1949
1950         dest.bdev = s->cow->bdev;
1951         dest.sector = bio->bi_iter.bi_sector;
1952         dest.count = s->store->chunk_size;
1953
1954         account_start_copy(s);
1955         WARN_ON_ONCE(bio->bi_private);
1956         bio->bi_private = s;
1957         dm_kcopyd_zero(s->kcopyd_client, 1, &dest, 0, zero_callback, bio);
1958 }
1959
1960 static bool io_overlaps_chunk(struct dm_snapshot *s, struct bio *bio)
1961 {
1962         return bio->bi_iter.bi_size ==
1963                 (s->store->chunk_size << SECTOR_SHIFT);
1964 }
1965
1966 static int snapshot_map(struct dm_target *ti, struct bio *bio)
1967 {
1968         struct dm_exception *e;
1969         struct dm_snapshot *s = ti->private;
1970         int r = DM_MAPIO_REMAPPED;
1971         chunk_t chunk;
1972         struct dm_snap_pending_exception *pe = NULL;
1973         struct dm_exception_table_lock lock;
1974
1975         init_tracked_chunk(bio);
1976
1977         if (bio->bi_opf & REQ_PREFLUSH) {
1978                 bio_set_dev(bio, s->cow->bdev);
1979                 return DM_MAPIO_REMAPPED;
1980         }
1981
1982         chunk = sector_to_chunk(s->store, bio->bi_iter.bi_sector);
1983         dm_exception_table_lock_init(s, chunk, &lock);
1984
1985         /* Full snapshots are not usable */
1986         /* To get here the table must be live so s->active is always set. */
1987         if (!s->valid)
1988                 return DM_MAPIO_KILL;
1989
1990         if (bio_data_dir(bio) == WRITE) {
1991                 while (unlikely(!wait_for_in_progress(s, false)))
1992                         ; /* wait_for_in_progress() has slept */
1993         }
1994
1995         down_read(&s->lock);
1996         dm_exception_table_lock(&lock);
1997
1998         if (!s->valid || (unlikely(s->snapshot_overflowed) &&
1999             bio_data_dir(bio) == WRITE)) {
2000                 r = DM_MAPIO_KILL;
2001                 goto out_unlock;
2002         }
2003
2004         if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) {
2005                 if (s->discard_passdown_origin && dm_bio_get_target_bio_nr(bio)) {
2006                         /*
2007                          * passdown discard to origin (without triggering
2008                          * snapshot exceptions via do_origin; doing so would
2009                          * defeat the goal of freeing space in origin that is
2010                          * implied by the "discard_passdown_origin" feature)
2011                          */
2012                         bio_set_dev(bio, s->origin->bdev);
2013                         track_chunk(s, bio, chunk);
2014                         goto out_unlock;
2015                 }
2016                 /* discard to snapshot (target_bio_nr == 0) zeroes exceptions */
2017         }
2018
2019         /* If the block is already remapped - use that, else remap it */
2020         e = dm_lookup_exception(&s->complete, chunk);
2021         if (e) {
2022                 remap_exception(s, e, bio, chunk);
2023                 if (unlikely(bio_op(bio) == REQ_OP_DISCARD) &&
2024                     io_overlaps_chunk(s, bio)) {
2025                         dm_exception_table_unlock(&lock);
2026                         up_read(&s->lock);
2027                         zero_exception(s, e, bio, chunk);
2028                         r = DM_MAPIO_SUBMITTED; /* discard is not issued */
2029                         goto out;
2030                 }
2031                 goto out_unlock;
2032         }
2033
2034         if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) {
2035                 /*
2036                  * If no exception exists, complete discard immediately
2037                  * otherwise it'll trigger copy-out.
2038                  */
2039                 bio_endio(bio);
2040                 r = DM_MAPIO_SUBMITTED;
2041                 goto out_unlock;
2042         }
2043
2044         /*
2045          * Write to snapshot - higher level takes care of RW/RO
2046          * flags so we should only get this if we are
2047          * writeable.
2048          */
2049         if (bio_data_dir(bio) == WRITE) {
2050                 pe = __lookup_pending_exception(s, chunk);
2051                 if (!pe) {
2052                         dm_exception_table_unlock(&lock);
2053                         pe = alloc_pending_exception(s);
2054                         dm_exception_table_lock(&lock);
2055
2056                         e = dm_lookup_exception(&s->complete, chunk);
2057                         if (e) {
2058                                 free_pending_exception(pe);
2059                                 remap_exception(s, e, bio, chunk);
2060                                 goto out_unlock;
2061                         }
2062
2063                         pe = __find_pending_exception(s, pe, chunk);
2064                         if (!pe) {
2065                                 dm_exception_table_unlock(&lock);
2066                                 up_read(&s->lock);
2067
2068                                 down_write(&s->lock);
2069
2070                                 if (s->store->userspace_supports_overflow) {
2071                                         if (s->valid && !s->snapshot_overflowed) {
2072                                                 s->snapshot_overflowed = 1;
2073                                                 DMERR("Snapshot overflowed: Unable to allocate exception.");
2074                                         }
2075                                 } else
2076                                         __invalidate_snapshot(s, -ENOMEM);
2077                                 up_write(&s->lock);
2078
2079                                 r = DM_MAPIO_KILL;
2080                                 goto out;
2081                         }
2082                 }
2083
2084                 remap_exception(s, &pe->e, bio, chunk);
2085
2086                 r = DM_MAPIO_SUBMITTED;
2087
2088                 if (!pe->started && io_overlaps_chunk(s, bio)) {
2089                         pe->started = 1;
2090
2091                         dm_exception_table_unlock(&lock);
2092                         up_read(&s->lock);
2093
2094                         start_full_bio(pe, bio);
2095                         goto out;
2096                 }
2097
2098                 bio_list_add(&pe->snapshot_bios, bio);
2099
2100                 if (!pe->started) {
2101                         /* this is protected by the exception table lock */
2102                         pe->started = 1;
2103
2104                         dm_exception_table_unlock(&lock);
2105                         up_read(&s->lock);
2106
2107                         start_copy(pe);
2108                         goto out;
2109                 }
2110         } else {
2111                 bio_set_dev(bio, s->origin->bdev);
2112                 track_chunk(s, bio, chunk);
2113         }
2114
2115 out_unlock:
2116         dm_exception_table_unlock(&lock);
2117         up_read(&s->lock);
2118 out:
2119         return r;
2120 }
2121
2122 /*
2123  * A snapshot-merge target behaves like a combination of a snapshot
2124  * target and a snapshot-origin target.  It only generates new
2125  * exceptions in other snapshots and not in the one that is being
2126  * merged.
2127  *
2128  * For each chunk, if there is an existing exception, it is used to
2129  * redirect I/O to the cow device.  Otherwise I/O is sent to the origin,
2130  * which in turn might generate exceptions in other snapshots.
2131  * If merging is currently taking place on the chunk in question, the
2132  * I/O is deferred by adding it to s->bios_queued_during_merge.
2133  */
2134 static int snapshot_merge_map(struct dm_target *ti, struct bio *bio)
2135 {
2136         struct dm_exception *e;
2137         struct dm_snapshot *s = ti->private;
2138         int r = DM_MAPIO_REMAPPED;
2139         chunk_t chunk;
2140
2141         init_tracked_chunk(bio);
2142
2143         if (bio->bi_opf & REQ_PREFLUSH) {
2144                 if (!dm_bio_get_target_bio_nr(bio))
2145                         bio_set_dev(bio, s->origin->bdev);
2146                 else
2147                         bio_set_dev(bio, s->cow->bdev);
2148                 return DM_MAPIO_REMAPPED;
2149         }
2150
2151         if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) {
2152                 /* Once merging, discards no longer effect change */
2153                 bio_endio(bio);
2154                 return DM_MAPIO_SUBMITTED;
2155         }
2156
2157         chunk = sector_to_chunk(s->store, bio->bi_iter.bi_sector);
2158
2159         down_write(&s->lock);
2160
2161         /* Full merging snapshots are redirected to the origin */
2162         if (!s->valid)
2163                 goto redirect_to_origin;
2164
2165         /* If the block is already remapped - use that */
2166         e = dm_lookup_exception(&s->complete, chunk);
2167         if (e) {
2168                 /* Queue writes overlapping with chunks being merged */
2169                 if (bio_data_dir(bio) == WRITE &&
2170                     chunk >= s->first_merging_chunk &&
2171                     chunk < (s->first_merging_chunk +
2172                              s->num_merging_chunks)) {
2173                         bio_set_dev(bio, s->origin->bdev);
2174                         bio_list_add(&s->bios_queued_during_merge, bio);
2175                         r = DM_MAPIO_SUBMITTED;
2176                         goto out_unlock;
2177                 }
2178
2179                 remap_exception(s, e, bio, chunk);
2180
2181                 if (bio_data_dir(bio) == WRITE)
2182                         track_chunk(s, bio, chunk);
2183                 goto out_unlock;
2184         }
2185
2186 redirect_to_origin:
2187         bio_set_dev(bio, s->origin->bdev);
2188
2189         if (bio_data_dir(bio) == WRITE) {
2190                 up_write(&s->lock);
2191                 return do_origin(s->origin, bio, false);
2192         }
2193
2194 out_unlock:
2195         up_write(&s->lock);
2196
2197         return r;
2198 }
2199
2200 static int snapshot_end_io(struct dm_target *ti, struct bio *bio,
2201                 blk_status_t *error)
2202 {
2203         struct dm_snapshot *s = ti->private;
2204
2205         if (is_bio_tracked(bio))
2206                 stop_tracking_chunk(s, bio);
2207
2208         return DM_ENDIO_DONE;
2209 }
2210
2211 static void snapshot_merge_presuspend(struct dm_target *ti)
2212 {
2213         struct dm_snapshot *s = ti->private;
2214
2215         stop_merge(s);
2216 }
2217
2218 static int snapshot_preresume(struct dm_target *ti)
2219 {
2220         int r = 0;
2221         struct dm_snapshot *s = ti->private;
2222         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
2223
2224         down_read(&_origins_lock);
2225         (void) __find_snapshots_sharing_cow(s, &snap_src, &snap_dest, NULL);
2226         if (snap_src && snap_dest) {
2227                 down_read(&snap_src->lock);
2228                 if (s == snap_src) {
2229                         DMERR("Unable to resume snapshot source until "
2230                               "handover completes.");
2231                         r = -EINVAL;
2232                 } else if (!dm_suspended(snap_src->ti)) {
2233                         DMERR("Unable to perform snapshot handover until "
2234                               "source is suspended.");
2235                         r = -EINVAL;
2236                 }
2237                 up_read(&snap_src->lock);
2238         }
2239         up_read(&_origins_lock);
2240
2241         return r;
2242 }
2243
2244 static void snapshot_resume(struct dm_target *ti)
2245 {
2246         struct dm_snapshot *s = ti->private;
2247         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL, *snap_merging = NULL;
2248         struct dm_origin *o;
2249         struct mapped_device *origin_md = NULL;
2250         bool must_restart_merging = false;
2251
2252         down_read(&_origins_lock);
2253
2254         o = __lookup_dm_origin(s->origin->bdev);
2255         if (o)
2256                 origin_md = dm_table_get_md(o->ti->table);
2257         if (!origin_md) {
2258                 (void) __find_snapshots_sharing_cow(s, NULL, NULL, &snap_merging);
2259                 if (snap_merging)
2260                         origin_md = dm_table_get_md(snap_merging->ti->table);
2261         }
2262         if (origin_md == dm_table_get_md(ti->table))
2263                 origin_md = NULL;
2264         if (origin_md) {
2265                 if (dm_hold(origin_md))
2266                         origin_md = NULL;
2267         }
2268
2269         up_read(&_origins_lock);
2270
2271         if (origin_md) {
2272                 dm_internal_suspend_fast(origin_md);
2273                 if (snap_merging && test_bit(RUNNING_MERGE, &snap_merging->state_bits)) {
2274                         must_restart_merging = true;
2275                         stop_merge(snap_merging);
2276                 }
2277         }
2278
2279         down_read(&_origins_lock);
2280
2281         (void) __find_snapshots_sharing_cow(s, &snap_src, &snap_dest, NULL);
2282         if (snap_src && snap_dest) {
2283                 down_write(&snap_src->lock);
2284                 down_write_nested(&snap_dest->lock, SINGLE_DEPTH_NESTING);
2285                 __handover_exceptions(snap_src, snap_dest);
2286                 up_write(&snap_dest->lock);
2287                 up_write(&snap_src->lock);
2288         }
2289
2290         up_read(&_origins_lock);
2291
2292         if (origin_md) {
2293                 if (must_restart_merging)
2294                         start_merge(snap_merging);
2295                 dm_internal_resume_fast(origin_md);
2296                 dm_put(origin_md);
2297         }
2298
2299         /* Now we have correct chunk size, reregister */
2300         reregister_snapshot(s);
2301
2302         down_write(&s->lock);
2303         s->active = 1;
2304         up_write(&s->lock);
2305 }
2306
2307 static uint32_t get_origin_minimum_chunksize(struct block_device *bdev)
2308 {
2309         uint32_t min_chunksize;
2310
2311         down_read(&_origins_lock);
2312         min_chunksize = __minimum_chunk_size(__lookup_origin(bdev));
2313         up_read(&_origins_lock);
2314
2315         return min_chunksize;
2316 }
2317
2318 static void snapshot_merge_resume(struct dm_target *ti)
2319 {
2320         struct dm_snapshot *s = ti->private;
2321
2322         /*
2323          * Handover exceptions from existing snapshot.
2324          */
2325         snapshot_resume(ti);
2326
2327         /*
2328          * snapshot-merge acts as an origin, so set ti->max_io_len
2329          */
2330         ti->max_io_len = get_origin_minimum_chunksize(s->origin->bdev);
2331
2332         start_merge(s);
2333 }
2334
2335 static void snapshot_status(struct dm_target *ti, status_type_t type,
2336                             unsigned status_flags, char *result, unsigned maxlen)
2337 {
2338         unsigned sz = 0;
2339         struct dm_snapshot *snap = ti->private;
2340         unsigned num_features;
2341
2342         switch (type) {
2343         case STATUSTYPE_INFO:
2344
2345                 down_write(&snap->lock);
2346
2347                 if (!snap->valid)
2348                         DMEMIT("Invalid");
2349                 else if (snap->merge_failed)
2350                         DMEMIT("Merge failed");
2351                 else if (snap->snapshot_overflowed)
2352                         DMEMIT("Overflow");
2353                 else {
2354                         if (snap->store->type->usage) {
2355                                 sector_t total_sectors, sectors_allocated,
2356                                          metadata_sectors;
2357                                 snap->store->type->usage(snap->store,
2358                                                          &total_sectors,
2359                                                          &sectors_allocated,
2360                                                          &metadata_sectors);
2361                                 DMEMIT("%llu/%llu %llu",
2362                                        (unsigned long long)sectors_allocated,
2363                                        (unsigned long long)total_sectors,
2364                                        (unsigned long long)metadata_sectors);
2365                         }
2366                         else
2367                                 DMEMIT("Unknown");
2368                 }
2369
2370                 up_write(&snap->lock);
2371
2372                 break;
2373
2374         case STATUSTYPE_TABLE:
2375                 /*
2376                  * kdevname returns a static pointer so we need
2377                  * to make private copies if the output is to
2378                  * make sense.
2379                  */
2380                 DMEMIT("%s %s", snap->origin->name, snap->cow->name);
2381                 sz += snap->store->type->status(snap->store, type, result + sz,
2382                                                 maxlen - sz);
2383                 num_features = snap->discard_zeroes_cow + snap->discard_passdown_origin;
2384                 if (num_features) {
2385                         DMEMIT(" %u", num_features);
2386                         if (snap->discard_zeroes_cow)
2387                                 DMEMIT(" discard_zeroes_cow");
2388                         if (snap->discard_passdown_origin)
2389                                 DMEMIT(" discard_passdown_origin");
2390                 }
2391                 break;
2392         }
2393 }
2394
2395 static int snapshot_iterate_devices(struct dm_target *ti,
2396                                     iterate_devices_callout_fn fn, void *data)
2397 {
2398         struct dm_snapshot *snap = ti->private;
2399         int r;
2400
2401         r = fn(ti, snap->origin, 0, ti->len, data);
2402
2403         if (!r)
2404                 r = fn(ti, snap->cow, 0, get_dev_size(snap->cow->bdev), data);
2405
2406         return r;
2407 }
2408
2409 static void snapshot_io_hints(struct dm_target *ti, struct queue_limits *limits)
2410 {
2411         struct dm_snapshot *snap = ti->private;
2412
2413         if (snap->discard_zeroes_cow) {
2414                 struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
2415
2416                 down_read(&_origins_lock);
2417
2418                 (void) __find_snapshots_sharing_cow(snap, &snap_src, &snap_dest, NULL);
2419                 if (snap_src && snap_dest)
2420                         snap = snap_src;
2421
2422                 /* All discards are split on chunk_size boundary */
2423                 limits->discard_granularity = snap->store->chunk_size;
2424                 limits->max_discard_sectors = snap->store->chunk_size;
2425
2426                 up_read(&_origins_lock);
2427         }
2428 }
2429
2430 /*-----------------------------------------------------------------
2431  * Origin methods
2432  *---------------------------------------------------------------*/
2433
2434 /*
2435  * If no exceptions need creating, DM_MAPIO_REMAPPED is returned and any
2436  * supplied bio was ignored.  The caller may submit it immediately.
2437  * (No remapping actually occurs as the origin is always a direct linear
2438  * map.)
2439  *
2440  * If further exceptions are required, DM_MAPIO_SUBMITTED is returned
2441  * and any supplied bio is added to a list to be submitted once all
2442  * the necessary exceptions exist.
2443  */
2444 static int __origin_write(struct list_head *snapshots, sector_t sector,
2445                           struct bio *bio)
2446 {
2447         int r = DM_MAPIO_REMAPPED;
2448         struct dm_snapshot *snap;
2449         struct dm_exception *e;
2450         struct dm_snap_pending_exception *pe, *pe2;
2451         struct dm_snap_pending_exception *pe_to_start_now = NULL;
2452         struct dm_snap_pending_exception *pe_to_start_last = NULL;
2453         struct dm_exception_table_lock lock;
2454         chunk_t chunk;
2455
2456         /* Do all the snapshots on this origin */
2457         list_for_each_entry (snap, snapshots, list) {
2458                 /*
2459                  * Don't make new exceptions in a merging snapshot
2460                  * because it has effectively been deleted
2461                  */
2462                 if (dm_target_is_snapshot_merge(snap->ti))
2463                         continue;
2464
2465                 /* Nothing to do if writing beyond end of snapshot */
2466                 if (sector >= dm_table_get_size(snap->ti->table))
2467                         continue;
2468
2469                 /*
2470                  * Remember, different snapshots can have
2471                  * different chunk sizes.
2472                  */
2473                 chunk = sector_to_chunk(snap->store, sector);
2474                 dm_exception_table_lock_init(snap, chunk, &lock);
2475
2476                 down_read(&snap->lock);
2477                 dm_exception_table_lock(&lock);
2478
2479                 /* Only deal with valid and active snapshots */
2480                 if (!snap->valid || !snap->active)
2481                         goto next_snapshot;
2482
2483                 pe = __lookup_pending_exception(snap, chunk);
2484                 if (!pe) {
2485                         /*
2486                          * Check exception table to see if block is already
2487                          * remapped in this snapshot and trigger an exception
2488                          * if not.
2489                          */
2490                         e = dm_lookup_exception(&snap->complete, chunk);
2491                         if (e)
2492                                 goto next_snapshot;
2493
2494                         dm_exception_table_unlock(&lock);
2495                         pe = alloc_pending_exception(snap);
2496                         dm_exception_table_lock(&lock);
2497
2498                         pe2 = __lookup_pending_exception(snap, chunk);
2499
2500                         if (!pe2) {
2501                                 e = dm_lookup_exception(&snap->complete, chunk);
2502                                 if (e) {
2503                                         free_pending_exception(pe);
2504                                         goto next_snapshot;
2505                                 }
2506
2507                                 pe = __insert_pending_exception(snap, pe, chunk);
2508                                 if (!pe) {
2509                                         dm_exception_table_unlock(&lock);
2510                                         up_read(&snap->lock);
2511
2512                                         invalidate_snapshot(snap, -ENOMEM);
2513                                         continue;
2514                                 }
2515                         } else {
2516                                 free_pending_exception(pe);
2517                                 pe = pe2;
2518                         }
2519                 }
2520
2521                 r = DM_MAPIO_SUBMITTED;
2522
2523                 /*
2524                  * If an origin bio was supplied, queue it to wait for the
2525                  * completion of this exception, and start this one last,
2526                  * at the end of the function.
2527                  */
2528                 if (bio) {
2529                         bio_list_add(&pe->origin_bios, bio);
2530                         bio = NULL;
2531
2532                         if (!pe->started) {
2533                                 pe->started = 1;
2534                                 pe_to_start_last = pe;
2535                         }
2536                 }
2537
2538                 if (!pe->started) {
2539                         pe->started = 1;
2540                         pe_to_start_now = pe;
2541                 }
2542
2543 next_snapshot:
2544                 dm_exception_table_unlock(&lock);
2545                 up_read(&snap->lock);
2546
2547                 if (pe_to_start_now) {
2548                         start_copy(pe_to_start_now);
2549                         pe_to_start_now = NULL;
2550                 }
2551         }
2552
2553         /*
2554          * Submit the exception against which the bio is queued last,
2555          * to give the other exceptions a head start.
2556          */
2557         if (pe_to_start_last)
2558                 start_copy(pe_to_start_last);
2559
2560         return r;
2561 }
2562
2563 /*
2564  * Called on a write from the origin driver.
2565  */
2566 static int do_origin(struct dm_dev *origin, struct bio *bio, bool limit)
2567 {
2568         struct origin *o;
2569         int r = DM_MAPIO_REMAPPED;
2570
2571 again:
2572         down_read(&_origins_lock);
2573         o = __lookup_origin(origin->bdev);
2574         if (o) {
2575                 if (limit) {
2576                         struct dm_snapshot *s;
2577                         list_for_each_entry(s, &o->snapshots, list)
2578                                 if (unlikely(!wait_for_in_progress(s, true)))
2579                                         goto again;
2580                 }
2581
2582                 r = __origin_write(&o->snapshots, bio->bi_iter.bi_sector, bio);
2583         }
2584         up_read(&_origins_lock);
2585
2586         return r;
2587 }
2588
2589 /*
2590  * Trigger exceptions in all non-merging snapshots.
2591  *
2592  * The chunk size of the merging snapshot may be larger than the chunk
2593  * size of some other snapshot so we may need to reallocate multiple
2594  * chunks in other snapshots.
2595  *
2596  * We scan all the overlapping exceptions in the other snapshots.
2597  * Returns 1 if anything was reallocated and must be waited for,
2598  * otherwise returns 0.
2599  *
2600  * size must be a multiple of merging_snap's chunk_size.
2601  */
2602 static int origin_write_extent(struct dm_snapshot *merging_snap,
2603                                sector_t sector, unsigned size)
2604 {
2605         int must_wait = 0;
2606         sector_t n;
2607         struct origin *o;
2608
2609         /*
2610          * The origin's __minimum_chunk_size() got stored in max_io_len
2611          * by snapshot_merge_resume().
2612          */
2613         down_read(&_origins_lock);
2614         o = __lookup_origin(merging_snap->origin->bdev);
2615         for (n = 0; n < size; n += merging_snap->ti->max_io_len)
2616                 if (__origin_write(&o->snapshots, sector + n, NULL) ==
2617                     DM_MAPIO_SUBMITTED)
2618                         must_wait = 1;
2619         up_read(&_origins_lock);
2620
2621         return must_wait;
2622 }
2623
2624 /*
2625  * Origin: maps a linear range of a device, with hooks for snapshotting.
2626  */
2627
2628 /*
2629  * Construct an origin mapping: <dev_path>
2630  * The context for an origin is merely a 'struct dm_dev *'
2631  * pointing to the real device.
2632  */
2633 static int origin_ctr(struct dm_target *ti, unsigned int argc, char **argv)
2634 {
2635         int r;
2636         struct dm_origin *o;
2637
2638         if (argc != 1) {
2639                 ti->error = "origin: incorrect number of arguments";
2640                 return -EINVAL;
2641         }
2642
2643         o = kmalloc(sizeof(struct dm_origin), GFP_KERNEL);
2644         if (!o) {
2645                 ti->error = "Cannot allocate private origin structure";
2646                 r = -ENOMEM;
2647                 goto bad_alloc;
2648         }
2649
2650         r = dm_get_device(ti, argv[0], dm_table_get_mode(ti->table), &o->dev);
2651         if (r) {
2652                 ti->error = "Cannot get target device";
2653                 goto bad_open;
2654         }
2655
2656         o->ti = ti;
2657         ti->private = o;
2658         ti->num_flush_bios = 1;
2659
2660         return 0;
2661
2662 bad_open:
2663         kfree(o);
2664 bad_alloc:
2665         return r;
2666 }
2667
2668 static void origin_dtr(struct dm_target *ti)
2669 {
2670         struct dm_origin *o = ti->private;
2671
2672         dm_put_device(ti, o->dev);
2673         kfree(o);
2674 }
2675
2676 static int origin_map(struct dm_target *ti, struct bio *bio)
2677 {
2678         struct dm_origin *o = ti->private;
2679         unsigned available_sectors;
2680
2681         bio_set_dev(bio, o->dev->bdev);
2682
2683         if (unlikely(bio->bi_opf & REQ_PREFLUSH))
2684                 return DM_MAPIO_REMAPPED;
2685
2686         if (bio_data_dir(bio) != WRITE)
2687                 return DM_MAPIO_REMAPPED;
2688
2689         available_sectors = o->split_boundary -
2690                 ((unsigned)bio->bi_iter.bi_sector & (o->split_boundary - 1));
2691
2692         if (bio_sectors(bio) > available_sectors)
2693                 dm_accept_partial_bio(bio, available_sectors);
2694
2695         /* Only tell snapshots if this is a write */
2696         return do_origin(o->dev, bio, true);
2697 }
2698
2699 /*
2700  * Set the target "max_io_len" field to the minimum of all the snapshots'
2701  * chunk sizes.
2702  */
2703 static void origin_resume(struct dm_target *ti)
2704 {
2705         struct dm_origin *o = ti->private;
2706
2707         o->split_boundary = get_origin_minimum_chunksize(o->dev->bdev);
2708
2709         down_write(&_origins_lock);
2710         __insert_dm_origin(o);
2711         up_write(&_origins_lock);
2712 }
2713
2714 static void origin_postsuspend(struct dm_target *ti)
2715 {
2716         struct dm_origin *o = ti->private;
2717
2718         down_write(&_origins_lock);
2719         __remove_dm_origin(o);
2720         up_write(&_origins_lock);
2721 }
2722
2723 static void origin_status(struct dm_target *ti, status_type_t type,
2724                           unsigned status_flags, char *result, unsigned maxlen)
2725 {
2726         struct dm_origin *o = ti->private;
2727
2728         switch (type) {
2729         case STATUSTYPE_INFO:
2730                 result[0] = '\0';
2731                 break;
2732
2733         case STATUSTYPE_TABLE:
2734                 snprintf(result, maxlen, "%s", o->dev->name);
2735                 break;
2736         }
2737 }
2738
2739 static int origin_iterate_devices(struct dm_target *ti,
2740                                   iterate_devices_callout_fn fn, void *data)
2741 {
2742         struct dm_origin *o = ti->private;
2743
2744         return fn(ti, o->dev, 0, ti->len, data);
2745 }
2746
2747 static struct target_type origin_target = {
2748         .name    = "snapshot-origin",
2749         .version = {1, 9, 0},
2750         .module  = THIS_MODULE,
2751         .ctr     = origin_ctr,
2752         .dtr     = origin_dtr,
2753         .map     = origin_map,
2754         .resume  = origin_resume,
2755         .postsuspend = origin_postsuspend,
2756         .status  = origin_status,
2757         .iterate_devices = origin_iterate_devices,
2758 };
2759
2760 static struct target_type snapshot_target = {
2761         .name    = "snapshot",
2762         .version = {1, 16, 0},
2763         .module  = THIS_MODULE,
2764         .ctr     = snapshot_ctr,
2765         .dtr     = snapshot_dtr,
2766         .map     = snapshot_map,
2767         .end_io  = snapshot_end_io,
2768         .preresume  = snapshot_preresume,
2769         .resume  = snapshot_resume,
2770         .status  = snapshot_status,
2771         .iterate_devices = snapshot_iterate_devices,
2772         .io_hints = snapshot_io_hints,
2773 };
2774
2775 static struct target_type merge_target = {
2776         .name    = dm_snapshot_merge_target_name,
2777         .version = {1, 5, 0},
2778         .module  = THIS_MODULE,
2779         .ctr     = snapshot_ctr,
2780         .dtr     = snapshot_dtr,
2781         .map     = snapshot_merge_map,
2782         .end_io  = snapshot_end_io,
2783         .presuspend = snapshot_merge_presuspend,
2784         .preresume  = snapshot_preresume,
2785         .resume  = snapshot_merge_resume,
2786         .status  = snapshot_status,
2787         .iterate_devices = snapshot_iterate_devices,
2788         .io_hints = snapshot_io_hints,
2789 };
2790
2791 static int __init dm_snapshot_init(void)
2792 {
2793         int r;
2794
2795         r = dm_exception_store_init();
2796         if (r) {
2797                 DMERR("Failed to initialize exception stores");
2798                 return r;
2799         }
2800
2801         r = init_origin_hash();
2802         if (r) {
2803                 DMERR("init_origin_hash failed.");
2804                 goto bad_origin_hash;
2805         }
2806
2807         exception_cache = KMEM_CACHE(dm_exception, 0);
2808         if (!exception_cache) {
2809                 DMERR("Couldn't create exception cache.");
2810                 r = -ENOMEM;
2811                 goto bad_exception_cache;
2812         }
2813
2814         pending_cache = KMEM_CACHE(dm_snap_pending_exception, 0);
2815         if (!pending_cache) {
2816                 DMERR("Couldn't create pending cache.");
2817                 r = -ENOMEM;
2818                 goto bad_pending_cache;
2819         }
2820
2821         r = dm_register_target(&snapshot_target);
2822         if (r < 0) {
2823                 DMERR("snapshot target register failed %d", r);
2824                 goto bad_register_snapshot_target;
2825         }
2826
2827         r = dm_register_target(&origin_target);
2828         if (r < 0) {
2829                 DMERR("Origin target register failed %d", r);
2830                 goto bad_register_origin_target;
2831         }
2832
2833         r = dm_register_target(&merge_target);
2834         if (r < 0) {
2835                 DMERR("Merge target register failed %d", r);
2836                 goto bad_register_merge_target;
2837         }
2838
2839         return 0;
2840
2841 bad_register_merge_target:
2842         dm_unregister_target(&origin_target);
2843 bad_register_origin_target:
2844         dm_unregister_target(&snapshot_target);
2845 bad_register_snapshot_target:
2846         kmem_cache_destroy(pending_cache);
2847 bad_pending_cache:
2848         kmem_cache_destroy(exception_cache);
2849 bad_exception_cache:
2850         exit_origin_hash();
2851 bad_origin_hash:
2852         dm_exception_store_exit();
2853
2854         return r;
2855 }
2856
2857 static void __exit dm_snapshot_exit(void)
2858 {
2859         dm_unregister_target(&snapshot_target);
2860         dm_unregister_target(&origin_target);
2861         dm_unregister_target(&merge_target);
2862
2863         exit_origin_hash();
2864         kmem_cache_destroy(pending_cache);
2865         kmem_cache_destroy(exception_cache);
2866
2867         dm_exception_store_exit();
2868 }
2869
2870 /* Module hooks */
2871 module_init(dm_snapshot_init);
2872 module_exit(dm_snapshot_exit);
2873
2874 MODULE_DESCRIPTION(DM_NAME " snapshot target");
2875 MODULE_AUTHOR("Joe Thornber");
2876 MODULE_LICENSE("GPL");
2877 MODULE_ALIAS("dm-snapshot-origin");
2878 MODULE_ALIAS("dm-snapshot-merge");