of: overlay: Remove redundant assignment to ret
[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 = dm_vcalloc(size, sizeof(struct hlist_bl_head));
667         if (!et->table)
668                 return -ENOMEM;
669
670         for (i = 0; i < size; i++)
671                 INIT_HLIST_BL_HEAD(et->table + i);
672
673         return 0;
674 }
675
676 static void dm_exception_table_exit(struct dm_exception_table *et,
677                                     struct kmem_cache *mem)
678 {
679         struct hlist_bl_head *slot;
680         struct dm_exception *ex;
681         struct hlist_bl_node *pos, *n;
682         int i, size;
683
684         size = et->hash_mask + 1;
685         for (i = 0; i < size; i++) {
686                 slot = et->table + i;
687
688                 hlist_bl_for_each_entry_safe(ex, pos, n, slot, hash_list)
689                         kmem_cache_free(mem, ex);
690         }
691
692         vfree(et->table);
693 }
694
695 static uint32_t exception_hash(struct dm_exception_table *et, chunk_t chunk)
696 {
697         return (chunk >> et->hash_shift) & et->hash_mask;
698 }
699
700 static void dm_remove_exception(struct dm_exception *e)
701 {
702         hlist_bl_del(&e->hash_list);
703 }
704
705 /*
706  * Return the exception data for a sector, or NULL if not
707  * remapped.
708  */
709 static struct dm_exception *dm_lookup_exception(struct dm_exception_table *et,
710                                                 chunk_t chunk)
711 {
712         struct hlist_bl_head *slot;
713         struct hlist_bl_node *pos;
714         struct dm_exception *e;
715
716         slot = &et->table[exception_hash(et, chunk)];
717         hlist_bl_for_each_entry(e, pos, slot, hash_list)
718                 if (chunk >= e->old_chunk &&
719                     chunk <= e->old_chunk + dm_consecutive_chunk_count(e))
720                         return e;
721
722         return NULL;
723 }
724
725 static struct dm_exception *alloc_completed_exception(gfp_t gfp)
726 {
727         struct dm_exception *e;
728
729         e = kmem_cache_alloc(exception_cache, gfp);
730         if (!e && gfp == GFP_NOIO)
731                 e = kmem_cache_alloc(exception_cache, GFP_ATOMIC);
732
733         return e;
734 }
735
736 static void free_completed_exception(struct dm_exception *e)
737 {
738         kmem_cache_free(exception_cache, e);
739 }
740
741 static struct dm_snap_pending_exception *alloc_pending_exception(struct dm_snapshot *s)
742 {
743         struct dm_snap_pending_exception *pe = mempool_alloc(&s->pending_pool,
744                                                              GFP_NOIO);
745
746         atomic_inc(&s->pending_exceptions_count);
747         pe->snap = s;
748
749         return pe;
750 }
751
752 static void free_pending_exception(struct dm_snap_pending_exception *pe)
753 {
754         struct dm_snapshot *s = pe->snap;
755
756         mempool_free(pe, &s->pending_pool);
757         smp_mb__before_atomic();
758         atomic_dec(&s->pending_exceptions_count);
759 }
760
761 static void dm_insert_exception(struct dm_exception_table *eh,
762                                 struct dm_exception *new_e)
763 {
764         struct hlist_bl_head *l;
765         struct hlist_bl_node *pos;
766         struct dm_exception *e = NULL;
767
768         l = &eh->table[exception_hash(eh, new_e->old_chunk)];
769
770         /* Add immediately if this table doesn't support consecutive chunks */
771         if (!eh->hash_shift)
772                 goto out;
773
774         /* List is ordered by old_chunk */
775         hlist_bl_for_each_entry(e, pos, l, hash_list) {
776                 /* Insert after an existing chunk? */
777                 if (new_e->old_chunk == (e->old_chunk +
778                                          dm_consecutive_chunk_count(e) + 1) &&
779                     new_e->new_chunk == (dm_chunk_number(e->new_chunk) +
780                                          dm_consecutive_chunk_count(e) + 1)) {
781                         dm_consecutive_chunk_count_inc(e);
782                         free_completed_exception(new_e);
783                         return;
784                 }
785
786                 /* Insert before an existing chunk? */
787                 if (new_e->old_chunk == (e->old_chunk - 1) &&
788                     new_e->new_chunk == (dm_chunk_number(e->new_chunk) - 1)) {
789                         dm_consecutive_chunk_count_inc(e);
790                         e->old_chunk--;
791                         e->new_chunk--;
792                         free_completed_exception(new_e);
793                         return;
794                 }
795
796                 if (new_e->old_chunk < e->old_chunk)
797                         break;
798         }
799
800 out:
801         if (!e) {
802                 /*
803                  * Either the table doesn't support consecutive chunks or slot
804                  * l is empty.
805                  */
806                 hlist_bl_add_head(&new_e->hash_list, l);
807         } else if (new_e->old_chunk < e->old_chunk) {
808                 /* Add before an existing exception */
809                 hlist_bl_add_before(&new_e->hash_list, &e->hash_list);
810         } else {
811                 /* Add to l's tail: e is the last exception in this slot */
812                 hlist_bl_add_behind(&new_e->hash_list, &e->hash_list);
813         }
814 }
815
816 /*
817  * Callback used by the exception stores to load exceptions when
818  * initialising.
819  */
820 static int dm_add_exception(void *context, chunk_t old, chunk_t new)
821 {
822         struct dm_exception_table_lock lock;
823         struct dm_snapshot *s = context;
824         struct dm_exception *e;
825
826         e = alloc_completed_exception(GFP_KERNEL);
827         if (!e)
828                 return -ENOMEM;
829
830         e->old_chunk = old;
831
832         /* Consecutive_count is implicitly initialised to zero */
833         e->new_chunk = new;
834
835         /*
836          * Although there is no need to lock access to the exception tables
837          * here, if we don't then hlist_bl_add_head(), called by
838          * dm_insert_exception(), will complain about accessing the
839          * corresponding list without locking it first.
840          */
841         dm_exception_table_lock_init(s, old, &lock);
842
843         dm_exception_table_lock(&lock);
844         dm_insert_exception(&s->complete, e);
845         dm_exception_table_unlock(&lock);
846
847         return 0;
848 }
849
850 /*
851  * Return a minimum chunk size of all snapshots that have the specified origin.
852  * Return zero if the origin has no snapshots.
853  */
854 static uint32_t __minimum_chunk_size(struct origin *o)
855 {
856         struct dm_snapshot *snap;
857         unsigned chunk_size = 0;
858
859         if (o)
860                 list_for_each_entry(snap, &o->snapshots, list)
861                         chunk_size = min_not_zero(chunk_size,
862                                                   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                 goto bad_read_metadata;
1412         }
1413
1414         r = dm_set_target_max_io_len(ti, s->store->chunk_size);
1415         if (r)
1416                 goto bad_read_metadata;
1417
1418         return 0;
1419
1420 bad_read_metadata:
1421         unregister_snapshot(s);
1422 bad_load_and_register:
1423         mempool_exit(&s->pending_pool);
1424 bad_pending_pool:
1425         dm_kcopyd_client_destroy(s->kcopyd_client);
1426 bad_kcopyd:
1427         dm_exception_table_exit(&s->pending, pending_cache);
1428         dm_exception_table_exit(&s->complete, exception_cache);
1429 bad_hash_tables:
1430         dm_exception_store_destroy(s->store);
1431 bad_store:
1432         dm_put_device(ti, s->cow);
1433 bad_cow:
1434         dm_put_device(ti, s->origin);
1435 bad_origin:
1436 bad_features:
1437         kfree(s);
1438 bad:
1439         return r;
1440 }
1441
1442 static void __free_exceptions(struct dm_snapshot *s)
1443 {
1444         dm_kcopyd_client_destroy(s->kcopyd_client);
1445         s->kcopyd_client = NULL;
1446
1447         dm_exception_table_exit(&s->pending, pending_cache);
1448         dm_exception_table_exit(&s->complete, exception_cache);
1449 }
1450
1451 static void __handover_exceptions(struct dm_snapshot *snap_src,
1452                                   struct dm_snapshot *snap_dest)
1453 {
1454         union {
1455                 struct dm_exception_table table_swap;
1456                 struct dm_exception_store *store_swap;
1457         } u;
1458
1459         /*
1460          * Swap all snapshot context information between the two instances.
1461          */
1462         u.table_swap = snap_dest->complete;
1463         snap_dest->complete = snap_src->complete;
1464         snap_src->complete = u.table_swap;
1465
1466         u.store_swap = snap_dest->store;
1467         snap_dest->store = snap_src->store;
1468         snap_dest->store->userspace_supports_overflow = u.store_swap->userspace_supports_overflow;
1469         snap_src->store = u.store_swap;
1470
1471         snap_dest->store->snap = snap_dest;
1472         snap_src->store->snap = snap_src;
1473
1474         snap_dest->ti->max_io_len = snap_dest->store->chunk_size;
1475         snap_dest->valid = snap_src->valid;
1476         snap_dest->snapshot_overflowed = snap_src->snapshot_overflowed;
1477
1478         /*
1479          * Set source invalid to ensure it receives no further I/O.
1480          */
1481         snap_src->valid = 0;
1482 }
1483
1484 static void snapshot_dtr(struct dm_target *ti)
1485 {
1486 #ifdef CONFIG_DM_DEBUG
1487         int i;
1488 #endif
1489         struct dm_snapshot *s = ti->private;
1490         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
1491
1492         down_read(&_origins_lock);
1493         /* Check whether exception handover must be cancelled */
1494         (void) __find_snapshots_sharing_cow(s, &snap_src, &snap_dest, NULL);
1495         if (snap_src && snap_dest && (s == snap_src)) {
1496                 down_write(&snap_dest->lock);
1497                 snap_dest->valid = 0;
1498                 up_write(&snap_dest->lock);
1499                 DMERR("Cancelling snapshot handover.");
1500         }
1501         up_read(&_origins_lock);
1502
1503         if (dm_target_is_snapshot_merge(ti))
1504                 stop_merge(s);
1505
1506         /* Prevent further origin writes from using this snapshot. */
1507         /* After this returns there can be no new kcopyd jobs. */
1508         unregister_snapshot(s);
1509
1510         while (atomic_read(&s->pending_exceptions_count))
1511                 msleep(1);
1512         /*
1513          * Ensure instructions in mempool_exit aren't reordered
1514          * before atomic_read.
1515          */
1516         smp_mb();
1517
1518 #ifdef CONFIG_DM_DEBUG
1519         for (i = 0; i < DM_TRACKED_CHUNK_HASH_SIZE; i++)
1520                 BUG_ON(!hlist_empty(&s->tracked_chunk_hash[i]));
1521 #endif
1522
1523         __free_exceptions(s);
1524
1525         mempool_exit(&s->pending_pool);
1526
1527         dm_exception_store_destroy(s->store);
1528
1529         bio_uninit(&s->flush_bio);
1530
1531         dm_put_device(ti, s->cow);
1532
1533         dm_put_device(ti, s->origin);
1534
1535         WARN_ON(s->in_progress);
1536
1537         kfree(s);
1538 }
1539
1540 static void account_start_copy(struct dm_snapshot *s)
1541 {
1542         spin_lock(&s->in_progress_wait.lock);
1543         s->in_progress++;
1544         spin_unlock(&s->in_progress_wait.lock);
1545 }
1546
1547 static void account_end_copy(struct dm_snapshot *s)
1548 {
1549         spin_lock(&s->in_progress_wait.lock);
1550         BUG_ON(!s->in_progress);
1551         s->in_progress--;
1552         if (likely(s->in_progress <= cow_threshold) &&
1553             unlikely(waitqueue_active(&s->in_progress_wait)))
1554                 wake_up_locked(&s->in_progress_wait);
1555         spin_unlock(&s->in_progress_wait.lock);
1556 }
1557
1558 static bool wait_for_in_progress(struct dm_snapshot *s, bool unlock_origins)
1559 {
1560         if (unlikely(s->in_progress > cow_threshold)) {
1561                 spin_lock(&s->in_progress_wait.lock);
1562                 if (likely(s->in_progress > cow_threshold)) {
1563                         /*
1564                          * NOTE: this throttle doesn't account for whether
1565                          * the caller is servicing an IO that will trigger a COW
1566                          * so excess throttling may result for chunks not required
1567                          * to be COW'd.  But if cow_threshold was reached, extra
1568                          * throttling is unlikely to negatively impact performance.
1569                          */
1570                         DECLARE_WAITQUEUE(wait, current);
1571                         __add_wait_queue(&s->in_progress_wait, &wait);
1572                         __set_current_state(TASK_UNINTERRUPTIBLE);
1573                         spin_unlock(&s->in_progress_wait.lock);
1574                         if (unlock_origins)
1575                                 up_read(&_origins_lock);
1576                         io_schedule();
1577                         remove_wait_queue(&s->in_progress_wait, &wait);
1578                         return false;
1579                 }
1580                 spin_unlock(&s->in_progress_wait.lock);
1581         }
1582         return true;
1583 }
1584
1585 /*
1586  * Flush a list of buffers.
1587  */
1588 static void flush_bios(struct bio *bio)
1589 {
1590         struct bio *n;
1591
1592         while (bio) {
1593                 n = bio->bi_next;
1594                 bio->bi_next = NULL;
1595                 submit_bio_noacct(bio);
1596                 bio = n;
1597         }
1598 }
1599
1600 static int do_origin(struct dm_dev *origin, struct bio *bio, bool limit);
1601
1602 /*
1603  * Flush a list of buffers.
1604  */
1605 static void retry_origin_bios(struct dm_snapshot *s, struct bio *bio)
1606 {
1607         struct bio *n;
1608         int r;
1609
1610         while (bio) {
1611                 n = bio->bi_next;
1612                 bio->bi_next = NULL;
1613                 r = do_origin(s->origin, bio, false);
1614                 if (r == DM_MAPIO_REMAPPED)
1615                         submit_bio_noacct(bio);
1616                 bio = n;
1617         }
1618 }
1619
1620 /*
1621  * Error a list of buffers.
1622  */
1623 static void error_bios(struct bio *bio)
1624 {
1625         struct bio *n;
1626
1627         while (bio) {
1628                 n = bio->bi_next;
1629                 bio->bi_next = NULL;
1630                 bio_io_error(bio);
1631                 bio = n;
1632         }
1633 }
1634
1635 static void __invalidate_snapshot(struct dm_snapshot *s, int err)
1636 {
1637         if (!s->valid)
1638                 return;
1639
1640         if (err == -EIO)
1641                 DMERR("Invalidating snapshot: Error reading/writing.");
1642         else if (err == -ENOMEM)
1643                 DMERR("Invalidating snapshot: Unable to allocate exception.");
1644
1645         if (s->store->type->drop_snapshot)
1646                 s->store->type->drop_snapshot(s->store);
1647
1648         s->valid = 0;
1649
1650         dm_table_event(s->ti->table);
1651 }
1652
1653 static void invalidate_snapshot(struct dm_snapshot *s, int err)
1654 {
1655         down_write(&s->lock);
1656         __invalidate_snapshot(s, err);
1657         up_write(&s->lock);
1658 }
1659
1660 static void pending_complete(void *context, int success)
1661 {
1662         struct dm_snap_pending_exception *pe = context;
1663         struct dm_exception *e;
1664         struct dm_snapshot *s = pe->snap;
1665         struct bio *origin_bios = NULL;
1666         struct bio *snapshot_bios = NULL;
1667         struct bio *full_bio = NULL;
1668         struct dm_exception_table_lock lock;
1669         int error = 0;
1670
1671         dm_exception_table_lock_init(s, pe->e.old_chunk, &lock);
1672
1673         if (!success) {
1674                 /* Read/write error - snapshot is unusable */
1675                 invalidate_snapshot(s, -EIO);
1676                 error = 1;
1677
1678                 dm_exception_table_lock(&lock);
1679                 goto out;
1680         }
1681
1682         e = alloc_completed_exception(GFP_NOIO);
1683         if (!e) {
1684                 invalidate_snapshot(s, -ENOMEM);
1685                 error = 1;
1686
1687                 dm_exception_table_lock(&lock);
1688                 goto out;
1689         }
1690         *e = pe->e;
1691
1692         down_read(&s->lock);
1693         dm_exception_table_lock(&lock);
1694         if (!s->valid) {
1695                 up_read(&s->lock);
1696                 free_completed_exception(e);
1697                 error = 1;
1698
1699                 goto out;
1700         }
1701
1702         /*
1703          * Add a proper exception. After inserting the completed exception all
1704          * subsequent snapshot reads to this chunk will be redirected to the
1705          * COW device.  This ensures that we do not starve. Moreover, as long
1706          * as the pending exception exists, neither origin writes nor snapshot
1707          * merging can overwrite the chunk in origin.
1708          */
1709         dm_insert_exception(&s->complete, e);
1710         up_read(&s->lock);
1711
1712         /* Wait for conflicting reads to drain */
1713         if (__chunk_is_tracked(s, pe->e.old_chunk)) {
1714                 dm_exception_table_unlock(&lock);
1715                 __check_for_conflicting_io(s, pe->e.old_chunk);
1716                 dm_exception_table_lock(&lock);
1717         }
1718
1719 out:
1720         /* Remove the in-flight exception from the list */
1721         dm_remove_exception(&pe->e);
1722
1723         dm_exception_table_unlock(&lock);
1724
1725         snapshot_bios = bio_list_get(&pe->snapshot_bios);
1726         origin_bios = bio_list_get(&pe->origin_bios);
1727         full_bio = pe->full_bio;
1728         if (full_bio)
1729                 full_bio->bi_end_io = pe->full_bio_end_io;
1730         increment_pending_exceptions_done_count();
1731
1732         /* Submit any pending write bios */
1733         if (error) {
1734                 if (full_bio)
1735                         bio_io_error(full_bio);
1736                 error_bios(snapshot_bios);
1737         } else {
1738                 if (full_bio)
1739                         bio_endio(full_bio);
1740                 flush_bios(snapshot_bios);
1741         }
1742
1743         retry_origin_bios(s, origin_bios);
1744
1745         free_pending_exception(pe);
1746 }
1747
1748 static void complete_exception(struct dm_snap_pending_exception *pe)
1749 {
1750         struct dm_snapshot *s = pe->snap;
1751
1752         /* Update the metadata if we are persistent */
1753         s->store->type->commit_exception(s->store, &pe->e, !pe->copy_error,
1754                                          pending_complete, pe);
1755 }
1756
1757 /*
1758  * Called when the copy I/O has finished.  kcopyd actually runs
1759  * this code so don't block.
1760  */
1761 static void copy_callback(int read_err, unsigned long write_err, void *context)
1762 {
1763         struct dm_snap_pending_exception *pe = context;
1764         struct dm_snapshot *s = pe->snap;
1765
1766         pe->copy_error = read_err || write_err;
1767
1768         if (pe->exception_sequence == s->exception_complete_sequence) {
1769                 struct rb_node *next;
1770
1771                 s->exception_complete_sequence++;
1772                 complete_exception(pe);
1773
1774                 next = rb_first(&s->out_of_order_tree);
1775                 while (next) {
1776                         pe = rb_entry(next, struct dm_snap_pending_exception,
1777                                         out_of_order_node);
1778                         if (pe->exception_sequence != s->exception_complete_sequence)
1779                                 break;
1780                         next = rb_next(next);
1781                         s->exception_complete_sequence++;
1782                         rb_erase(&pe->out_of_order_node, &s->out_of_order_tree);
1783                         complete_exception(pe);
1784                         cond_resched();
1785                 }
1786         } else {
1787                 struct rb_node *parent = NULL;
1788                 struct rb_node **p = &s->out_of_order_tree.rb_node;
1789                 struct dm_snap_pending_exception *pe2;
1790
1791                 while (*p) {
1792                         pe2 = rb_entry(*p, struct dm_snap_pending_exception, out_of_order_node);
1793                         parent = *p;
1794
1795                         BUG_ON(pe->exception_sequence == pe2->exception_sequence);
1796                         if (pe->exception_sequence < pe2->exception_sequence)
1797                                 p = &((*p)->rb_left);
1798                         else
1799                                 p = &((*p)->rb_right);
1800                 }
1801
1802                 rb_link_node(&pe->out_of_order_node, parent, p);
1803                 rb_insert_color(&pe->out_of_order_node, &s->out_of_order_tree);
1804         }
1805         account_end_copy(s);
1806 }
1807
1808 /*
1809  * Dispatches the copy operation to kcopyd.
1810  */
1811 static void start_copy(struct dm_snap_pending_exception *pe)
1812 {
1813         struct dm_snapshot *s = pe->snap;
1814         struct dm_io_region src, dest;
1815         struct block_device *bdev = s->origin->bdev;
1816         sector_t dev_size;
1817
1818         dev_size = get_dev_size(bdev);
1819
1820         src.bdev = bdev;
1821         src.sector = chunk_to_sector(s->store, pe->e.old_chunk);
1822         src.count = min((sector_t)s->store->chunk_size, dev_size - src.sector);
1823
1824         dest.bdev = s->cow->bdev;
1825         dest.sector = chunk_to_sector(s->store, pe->e.new_chunk);
1826         dest.count = src.count;
1827
1828         /* Hand over to kcopyd */
1829         account_start_copy(s);
1830         dm_kcopyd_copy(s->kcopyd_client, &src, 1, &dest, 0, copy_callback, pe);
1831 }
1832
1833 static void full_bio_end_io(struct bio *bio)
1834 {
1835         void *callback_data = bio->bi_private;
1836
1837         dm_kcopyd_do_callback(callback_data, 0, bio->bi_status ? 1 : 0);
1838 }
1839
1840 static void start_full_bio(struct dm_snap_pending_exception *pe,
1841                            struct bio *bio)
1842 {
1843         struct dm_snapshot *s = pe->snap;
1844         void *callback_data;
1845
1846         pe->full_bio = bio;
1847         pe->full_bio_end_io = bio->bi_end_io;
1848
1849         account_start_copy(s);
1850         callback_data = dm_kcopyd_prepare_callback(s->kcopyd_client,
1851                                                    copy_callback, pe);
1852
1853         bio->bi_end_io = full_bio_end_io;
1854         bio->bi_private = callback_data;
1855
1856         submit_bio_noacct(bio);
1857 }
1858
1859 static struct dm_snap_pending_exception *
1860 __lookup_pending_exception(struct dm_snapshot *s, chunk_t chunk)
1861 {
1862         struct dm_exception *e = dm_lookup_exception(&s->pending, chunk);
1863
1864         if (!e)
1865                 return NULL;
1866
1867         return container_of(e, struct dm_snap_pending_exception, e);
1868 }
1869
1870 /*
1871  * Inserts a pending exception into the pending table.
1872  *
1873  * NOTE: a write lock must be held on the chunk's pending exception table slot
1874  * before calling this.
1875  */
1876 static struct dm_snap_pending_exception *
1877 __insert_pending_exception(struct dm_snapshot *s,
1878                            struct dm_snap_pending_exception *pe, chunk_t chunk)
1879 {
1880         pe->e.old_chunk = chunk;
1881         bio_list_init(&pe->origin_bios);
1882         bio_list_init(&pe->snapshot_bios);
1883         pe->started = 0;
1884         pe->full_bio = NULL;
1885
1886         spin_lock(&s->pe_allocation_lock);
1887         if (s->store->type->prepare_exception(s->store, &pe->e)) {
1888                 spin_unlock(&s->pe_allocation_lock);
1889                 free_pending_exception(pe);
1890                 return NULL;
1891         }
1892
1893         pe->exception_sequence = s->exception_start_sequence++;
1894         spin_unlock(&s->pe_allocation_lock);
1895
1896         dm_insert_exception(&s->pending, &pe->e);
1897
1898         return pe;
1899 }
1900
1901 /*
1902  * Looks to see if this snapshot already has a pending exception
1903  * for this chunk, otherwise it allocates a new one and inserts
1904  * it into the pending table.
1905  *
1906  * NOTE: a write lock must be held on the chunk's pending exception table slot
1907  * before calling this.
1908  */
1909 static struct dm_snap_pending_exception *
1910 __find_pending_exception(struct dm_snapshot *s,
1911                          struct dm_snap_pending_exception *pe, chunk_t chunk)
1912 {
1913         struct dm_snap_pending_exception *pe2;
1914
1915         pe2 = __lookup_pending_exception(s, chunk);
1916         if (pe2) {
1917                 free_pending_exception(pe);
1918                 return pe2;
1919         }
1920
1921         return __insert_pending_exception(s, pe, chunk);
1922 }
1923
1924 static void remap_exception(struct dm_snapshot *s, struct dm_exception *e,
1925                             struct bio *bio, chunk_t chunk)
1926 {
1927         bio_set_dev(bio, s->cow->bdev);
1928         bio->bi_iter.bi_sector =
1929                 chunk_to_sector(s->store, dm_chunk_number(e->new_chunk) +
1930                                 (chunk - e->old_chunk)) +
1931                 (bio->bi_iter.bi_sector & s->store->chunk_mask);
1932 }
1933
1934 static void zero_callback(int read_err, unsigned long write_err, void *context)
1935 {
1936         struct bio *bio = context;
1937         struct dm_snapshot *s = bio->bi_private;
1938
1939         account_end_copy(s);
1940         bio->bi_status = write_err ? BLK_STS_IOERR : 0;
1941         bio_endio(bio);
1942 }
1943
1944 static void zero_exception(struct dm_snapshot *s, struct dm_exception *e,
1945                            struct bio *bio, chunk_t chunk)
1946 {
1947         struct dm_io_region dest;
1948
1949         dest.bdev = s->cow->bdev;
1950         dest.sector = bio->bi_iter.bi_sector;
1951         dest.count = s->store->chunk_size;
1952
1953         account_start_copy(s);
1954         WARN_ON_ONCE(bio->bi_private);
1955         bio->bi_private = s;
1956         dm_kcopyd_zero(s->kcopyd_client, 1, &dest, 0, zero_callback, bio);
1957 }
1958
1959 static bool io_overlaps_chunk(struct dm_snapshot *s, struct bio *bio)
1960 {
1961         return bio->bi_iter.bi_size ==
1962                 (s->store->chunk_size << SECTOR_SHIFT);
1963 }
1964
1965 static int snapshot_map(struct dm_target *ti, struct bio *bio)
1966 {
1967         struct dm_exception *e;
1968         struct dm_snapshot *s = ti->private;
1969         int r = DM_MAPIO_REMAPPED;
1970         chunk_t chunk;
1971         struct dm_snap_pending_exception *pe = NULL;
1972         struct dm_exception_table_lock lock;
1973
1974         init_tracked_chunk(bio);
1975
1976         if (bio->bi_opf & REQ_PREFLUSH) {
1977                 bio_set_dev(bio, s->cow->bdev);
1978                 return DM_MAPIO_REMAPPED;
1979         }
1980
1981         chunk = sector_to_chunk(s->store, bio->bi_iter.bi_sector);
1982         dm_exception_table_lock_init(s, chunk, &lock);
1983
1984         /* Full snapshots are not usable */
1985         /* To get here the table must be live so s->active is always set. */
1986         if (!s->valid)
1987                 return DM_MAPIO_KILL;
1988
1989         if (bio_data_dir(bio) == WRITE) {
1990                 while (unlikely(!wait_for_in_progress(s, false)))
1991                         ; /* wait_for_in_progress() has slept */
1992         }
1993
1994         down_read(&s->lock);
1995         dm_exception_table_lock(&lock);
1996
1997         if (!s->valid || (unlikely(s->snapshot_overflowed) &&
1998             bio_data_dir(bio) == WRITE)) {
1999                 r = DM_MAPIO_KILL;
2000                 goto out_unlock;
2001         }
2002
2003         if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) {
2004                 if (s->discard_passdown_origin && dm_bio_get_target_bio_nr(bio)) {
2005                         /*
2006                          * passdown discard to origin (without triggering
2007                          * snapshot exceptions via do_origin; doing so would
2008                          * defeat the goal of freeing space in origin that is
2009                          * implied by the "discard_passdown_origin" feature)
2010                          */
2011                         bio_set_dev(bio, s->origin->bdev);
2012                         track_chunk(s, bio, chunk);
2013                         goto out_unlock;
2014                 }
2015                 /* discard to snapshot (target_bio_nr == 0) zeroes exceptions */
2016         }
2017
2018         /* If the block is already remapped - use that, else remap it */
2019         e = dm_lookup_exception(&s->complete, chunk);
2020         if (e) {
2021                 remap_exception(s, e, bio, chunk);
2022                 if (unlikely(bio_op(bio) == REQ_OP_DISCARD) &&
2023                     io_overlaps_chunk(s, bio)) {
2024                         dm_exception_table_unlock(&lock);
2025                         up_read(&s->lock);
2026                         zero_exception(s, e, bio, chunk);
2027                         r = DM_MAPIO_SUBMITTED; /* discard is not issued */
2028                         goto out;
2029                 }
2030                 goto out_unlock;
2031         }
2032
2033         if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) {
2034                 /*
2035                  * If no exception exists, complete discard immediately
2036                  * otherwise it'll trigger copy-out.
2037                  */
2038                 bio_endio(bio);
2039                 r = DM_MAPIO_SUBMITTED;
2040                 goto out_unlock;
2041         }
2042
2043         /*
2044          * Write to snapshot - higher level takes care of RW/RO
2045          * flags so we should only get this if we are
2046          * writeable.
2047          */
2048         if (bio_data_dir(bio) == WRITE) {
2049                 pe = __lookup_pending_exception(s, chunk);
2050                 if (!pe) {
2051                         dm_exception_table_unlock(&lock);
2052                         pe = alloc_pending_exception(s);
2053                         dm_exception_table_lock(&lock);
2054
2055                         e = dm_lookup_exception(&s->complete, chunk);
2056                         if (e) {
2057                                 free_pending_exception(pe);
2058                                 remap_exception(s, e, bio, chunk);
2059                                 goto out_unlock;
2060                         }
2061
2062                         pe = __find_pending_exception(s, pe, chunk);
2063                         if (!pe) {
2064                                 dm_exception_table_unlock(&lock);
2065                                 up_read(&s->lock);
2066
2067                                 down_write(&s->lock);
2068
2069                                 if (s->store->userspace_supports_overflow) {
2070                                         if (s->valid && !s->snapshot_overflowed) {
2071                                                 s->snapshot_overflowed = 1;
2072                                                 DMERR("Snapshot overflowed: Unable to allocate exception.");
2073                                         }
2074                                 } else
2075                                         __invalidate_snapshot(s, -ENOMEM);
2076                                 up_write(&s->lock);
2077
2078                                 r = DM_MAPIO_KILL;
2079                                 goto out;
2080                         }
2081                 }
2082
2083                 remap_exception(s, &pe->e, bio, chunk);
2084
2085                 r = DM_MAPIO_SUBMITTED;
2086
2087                 if (!pe->started && io_overlaps_chunk(s, bio)) {
2088                         pe->started = 1;
2089
2090                         dm_exception_table_unlock(&lock);
2091                         up_read(&s->lock);
2092
2093                         start_full_bio(pe, bio);
2094                         goto out;
2095                 }
2096
2097                 bio_list_add(&pe->snapshot_bios, bio);
2098
2099                 if (!pe->started) {
2100                         /* this is protected by the exception table lock */
2101                         pe->started = 1;
2102
2103                         dm_exception_table_unlock(&lock);
2104                         up_read(&s->lock);
2105
2106                         start_copy(pe);
2107                         goto out;
2108                 }
2109         } else {
2110                 bio_set_dev(bio, s->origin->bdev);
2111                 track_chunk(s, bio, chunk);
2112         }
2113
2114 out_unlock:
2115         dm_exception_table_unlock(&lock);
2116         up_read(&s->lock);
2117 out:
2118         return r;
2119 }
2120
2121 /*
2122  * A snapshot-merge target behaves like a combination of a snapshot
2123  * target and a snapshot-origin target.  It only generates new
2124  * exceptions in other snapshots and not in the one that is being
2125  * merged.
2126  *
2127  * For each chunk, if there is an existing exception, it is used to
2128  * redirect I/O to the cow device.  Otherwise I/O is sent to the origin,
2129  * which in turn might generate exceptions in other snapshots.
2130  * If merging is currently taking place on the chunk in question, the
2131  * I/O is deferred by adding it to s->bios_queued_during_merge.
2132  */
2133 static int snapshot_merge_map(struct dm_target *ti, struct bio *bio)
2134 {
2135         struct dm_exception *e;
2136         struct dm_snapshot *s = ti->private;
2137         int r = DM_MAPIO_REMAPPED;
2138         chunk_t chunk;
2139
2140         init_tracked_chunk(bio);
2141
2142         if (bio->bi_opf & REQ_PREFLUSH) {
2143                 if (!dm_bio_get_target_bio_nr(bio))
2144                         bio_set_dev(bio, s->origin->bdev);
2145                 else
2146                         bio_set_dev(bio, s->cow->bdev);
2147                 return DM_MAPIO_REMAPPED;
2148         }
2149
2150         if (unlikely(bio_op(bio) == REQ_OP_DISCARD)) {
2151                 /* Once merging, discards no longer effect change */
2152                 bio_endio(bio);
2153                 return DM_MAPIO_SUBMITTED;
2154         }
2155
2156         chunk = sector_to_chunk(s->store, bio->bi_iter.bi_sector);
2157
2158         down_write(&s->lock);
2159
2160         /* Full merging snapshots are redirected to the origin */
2161         if (!s->valid)
2162                 goto redirect_to_origin;
2163
2164         /* If the block is already remapped - use that */
2165         e = dm_lookup_exception(&s->complete, chunk);
2166         if (e) {
2167                 /* Queue writes overlapping with chunks being merged */
2168                 if (bio_data_dir(bio) == WRITE &&
2169                     chunk >= s->first_merging_chunk &&
2170                     chunk < (s->first_merging_chunk +
2171                              s->num_merging_chunks)) {
2172                         bio_set_dev(bio, s->origin->bdev);
2173                         bio_list_add(&s->bios_queued_during_merge, bio);
2174                         r = DM_MAPIO_SUBMITTED;
2175                         goto out_unlock;
2176                 }
2177
2178                 remap_exception(s, e, bio, chunk);
2179
2180                 if (bio_data_dir(bio) == WRITE)
2181                         track_chunk(s, bio, chunk);
2182                 goto out_unlock;
2183         }
2184
2185 redirect_to_origin:
2186         bio_set_dev(bio, s->origin->bdev);
2187
2188         if (bio_data_dir(bio) == WRITE) {
2189                 up_write(&s->lock);
2190                 return do_origin(s->origin, bio, false);
2191         }
2192
2193 out_unlock:
2194         up_write(&s->lock);
2195
2196         return r;
2197 }
2198
2199 static int snapshot_end_io(struct dm_target *ti, struct bio *bio,
2200                 blk_status_t *error)
2201 {
2202         struct dm_snapshot *s = ti->private;
2203
2204         if (is_bio_tracked(bio))
2205                 stop_tracking_chunk(s, bio);
2206
2207         return DM_ENDIO_DONE;
2208 }
2209
2210 static void snapshot_merge_presuspend(struct dm_target *ti)
2211 {
2212         struct dm_snapshot *s = ti->private;
2213
2214         stop_merge(s);
2215 }
2216
2217 static int snapshot_preresume(struct dm_target *ti)
2218 {
2219         int r = 0;
2220         struct dm_snapshot *s = ti->private;
2221         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
2222
2223         down_read(&_origins_lock);
2224         (void) __find_snapshots_sharing_cow(s, &snap_src, &snap_dest, NULL);
2225         if (snap_src && snap_dest) {
2226                 down_read(&snap_src->lock);
2227                 if (s == snap_src) {
2228                         DMERR("Unable to resume snapshot source until "
2229                               "handover completes.");
2230                         r = -EINVAL;
2231                 } else if (!dm_suspended(snap_src->ti)) {
2232                         DMERR("Unable to perform snapshot handover until "
2233                               "source is suspended.");
2234                         r = -EINVAL;
2235                 }
2236                 up_read(&snap_src->lock);
2237         }
2238         up_read(&_origins_lock);
2239
2240         return r;
2241 }
2242
2243 static void snapshot_resume(struct dm_target *ti)
2244 {
2245         struct dm_snapshot *s = ti->private;
2246         struct dm_snapshot *snap_src = NULL, *snap_dest = NULL, *snap_merging = NULL;
2247         struct dm_origin *o;
2248         struct mapped_device *origin_md = NULL;
2249         bool must_restart_merging = false;
2250
2251         down_read(&_origins_lock);
2252
2253         o = __lookup_dm_origin(s->origin->bdev);
2254         if (o)
2255                 origin_md = dm_table_get_md(o->ti->table);
2256         if (!origin_md) {
2257                 (void) __find_snapshots_sharing_cow(s, NULL, NULL, &snap_merging);
2258                 if (snap_merging)
2259                         origin_md = dm_table_get_md(snap_merging->ti->table);
2260         }
2261         if (origin_md == dm_table_get_md(ti->table))
2262                 origin_md = NULL;
2263         if (origin_md) {
2264                 if (dm_hold(origin_md))
2265                         origin_md = NULL;
2266         }
2267
2268         up_read(&_origins_lock);
2269
2270         if (origin_md) {
2271                 dm_internal_suspend_fast(origin_md);
2272                 if (snap_merging && test_bit(RUNNING_MERGE, &snap_merging->state_bits)) {
2273                         must_restart_merging = true;
2274                         stop_merge(snap_merging);
2275                 }
2276         }
2277
2278         down_read(&_origins_lock);
2279
2280         (void) __find_snapshots_sharing_cow(s, &snap_src, &snap_dest, NULL);
2281         if (snap_src && snap_dest) {
2282                 down_write(&snap_src->lock);
2283                 down_write_nested(&snap_dest->lock, SINGLE_DEPTH_NESTING);
2284                 __handover_exceptions(snap_src, snap_dest);
2285                 up_write(&snap_dest->lock);
2286                 up_write(&snap_src->lock);
2287         }
2288
2289         up_read(&_origins_lock);
2290
2291         if (origin_md) {
2292                 if (must_restart_merging)
2293                         start_merge(snap_merging);
2294                 dm_internal_resume_fast(origin_md);
2295                 dm_put(origin_md);
2296         }
2297
2298         /* Now we have correct chunk size, reregister */
2299         reregister_snapshot(s);
2300
2301         down_write(&s->lock);
2302         s->active = 1;
2303         up_write(&s->lock);
2304 }
2305
2306 static uint32_t get_origin_minimum_chunksize(struct block_device *bdev)
2307 {
2308         uint32_t min_chunksize;
2309
2310         down_read(&_origins_lock);
2311         min_chunksize = __minimum_chunk_size(__lookup_origin(bdev));
2312         up_read(&_origins_lock);
2313
2314         return min_chunksize;
2315 }
2316
2317 static void snapshot_merge_resume(struct dm_target *ti)
2318 {
2319         struct dm_snapshot *s = ti->private;
2320
2321         /*
2322          * Handover exceptions from existing snapshot.
2323          */
2324         snapshot_resume(ti);
2325
2326         /*
2327          * snapshot-merge acts as an origin, so set ti->max_io_len
2328          */
2329         ti->max_io_len = get_origin_minimum_chunksize(s->origin->bdev);
2330
2331         start_merge(s);
2332 }
2333
2334 static void snapshot_status(struct dm_target *ti, status_type_t type,
2335                             unsigned status_flags, char *result, unsigned maxlen)
2336 {
2337         unsigned sz = 0;
2338         struct dm_snapshot *snap = ti->private;
2339         unsigned num_features;
2340
2341         switch (type) {
2342         case STATUSTYPE_INFO:
2343
2344                 down_write(&snap->lock);
2345
2346                 if (!snap->valid)
2347                         DMEMIT("Invalid");
2348                 else if (snap->merge_failed)
2349                         DMEMIT("Merge failed");
2350                 else if (snap->snapshot_overflowed)
2351                         DMEMIT("Overflow");
2352                 else {
2353                         if (snap->store->type->usage) {
2354                                 sector_t total_sectors, sectors_allocated,
2355                                          metadata_sectors;
2356                                 snap->store->type->usage(snap->store,
2357                                                          &total_sectors,
2358                                                          &sectors_allocated,
2359                                                          &metadata_sectors);
2360                                 DMEMIT("%llu/%llu %llu",
2361                                        (unsigned long long)sectors_allocated,
2362                                        (unsigned long long)total_sectors,
2363                                        (unsigned long long)metadata_sectors);
2364                         }
2365                         else
2366                                 DMEMIT("Unknown");
2367                 }
2368
2369                 up_write(&snap->lock);
2370
2371                 break;
2372
2373         case STATUSTYPE_TABLE:
2374                 /*
2375                  * kdevname returns a static pointer so we need
2376                  * to make private copies if the output is to
2377                  * make sense.
2378                  */
2379                 DMEMIT("%s %s", snap->origin->name, snap->cow->name);
2380                 sz += snap->store->type->status(snap->store, type, result + sz,
2381                                                 maxlen - sz);
2382                 num_features = snap->discard_zeroes_cow + snap->discard_passdown_origin;
2383                 if (num_features) {
2384                         DMEMIT(" %u", num_features);
2385                         if (snap->discard_zeroes_cow)
2386                                 DMEMIT(" discard_zeroes_cow");
2387                         if (snap->discard_passdown_origin)
2388                                 DMEMIT(" discard_passdown_origin");
2389                 }
2390                 break;
2391         }
2392 }
2393
2394 static int snapshot_iterate_devices(struct dm_target *ti,
2395                                     iterate_devices_callout_fn fn, void *data)
2396 {
2397         struct dm_snapshot *snap = ti->private;
2398         int r;
2399
2400         r = fn(ti, snap->origin, 0, ti->len, data);
2401
2402         if (!r)
2403                 r = fn(ti, snap->cow, 0, get_dev_size(snap->cow->bdev), data);
2404
2405         return r;
2406 }
2407
2408 static void snapshot_io_hints(struct dm_target *ti, struct queue_limits *limits)
2409 {
2410         struct dm_snapshot *snap = ti->private;
2411
2412         if (snap->discard_zeroes_cow) {
2413                 struct dm_snapshot *snap_src = NULL, *snap_dest = NULL;
2414
2415                 down_read(&_origins_lock);
2416
2417                 (void) __find_snapshots_sharing_cow(snap, &snap_src, &snap_dest, NULL);
2418                 if (snap_src && snap_dest)
2419                         snap = snap_src;
2420
2421                 /* All discards are split on chunk_size boundary */
2422                 limits->discard_granularity = snap->store->chunk_size;
2423                 limits->max_discard_sectors = snap->store->chunk_size;
2424
2425                 up_read(&_origins_lock);
2426         }
2427 }
2428
2429 /*-----------------------------------------------------------------
2430  * Origin methods
2431  *---------------------------------------------------------------*/
2432
2433 /*
2434  * If no exceptions need creating, DM_MAPIO_REMAPPED is returned and any
2435  * supplied bio was ignored.  The caller may submit it immediately.
2436  * (No remapping actually occurs as the origin is always a direct linear
2437  * map.)
2438  *
2439  * If further exceptions are required, DM_MAPIO_SUBMITTED is returned
2440  * and any supplied bio is added to a list to be submitted once all
2441  * the necessary exceptions exist.
2442  */
2443 static int __origin_write(struct list_head *snapshots, sector_t sector,
2444                           struct bio *bio)
2445 {
2446         int r = DM_MAPIO_REMAPPED;
2447         struct dm_snapshot *snap;
2448         struct dm_exception *e;
2449         struct dm_snap_pending_exception *pe, *pe2;
2450         struct dm_snap_pending_exception *pe_to_start_now = NULL;
2451         struct dm_snap_pending_exception *pe_to_start_last = NULL;
2452         struct dm_exception_table_lock lock;
2453         chunk_t chunk;
2454
2455         /* Do all the snapshots on this origin */
2456         list_for_each_entry (snap, snapshots, list) {
2457                 /*
2458                  * Don't make new exceptions in a merging snapshot
2459                  * because it has effectively been deleted
2460                  */
2461                 if (dm_target_is_snapshot_merge(snap->ti))
2462                         continue;
2463
2464                 /* Nothing to do if writing beyond end of snapshot */
2465                 if (sector >= dm_table_get_size(snap->ti->table))
2466                         continue;
2467
2468                 /*
2469                  * Remember, different snapshots can have
2470                  * different chunk sizes.
2471                  */
2472                 chunk = sector_to_chunk(snap->store, sector);
2473                 dm_exception_table_lock_init(snap, chunk, &lock);
2474
2475                 down_read(&snap->lock);
2476                 dm_exception_table_lock(&lock);
2477
2478                 /* Only deal with valid and active snapshots */
2479                 if (!snap->valid || !snap->active)
2480                         goto next_snapshot;
2481
2482                 pe = __lookup_pending_exception(snap, chunk);
2483                 if (!pe) {
2484                         /*
2485                          * Check exception table to see if block is already
2486                          * remapped in this snapshot and trigger an exception
2487                          * if not.
2488                          */
2489                         e = dm_lookup_exception(&snap->complete, chunk);
2490                         if (e)
2491                                 goto next_snapshot;
2492
2493                         dm_exception_table_unlock(&lock);
2494                         pe = alloc_pending_exception(snap);
2495                         dm_exception_table_lock(&lock);
2496
2497                         pe2 = __lookup_pending_exception(snap, chunk);
2498
2499                         if (!pe2) {
2500                                 e = dm_lookup_exception(&snap->complete, chunk);
2501                                 if (e) {
2502                                         free_pending_exception(pe);
2503                                         goto next_snapshot;
2504                                 }
2505
2506                                 pe = __insert_pending_exception(snap, pe, chunk);
2507                                 if (!pe) {
2508                                         dm_exception_table_unlock(&lock);
2509                                         up_read(&snap->lock);
2510
2511                                         invalidate_snapshot(snap, -ENOMEM);
2512                                         continue;
2513                                 }
2514                         } else {
2515                                 free_pending_exception(pe);
2516                                 pe = pe2;
2517                         }
2518                 }
2519
2520                 r = DM_MAPIO_SUBMITTED;
2521
2522                 /*
2523                  * If an origin bio was supplied, queue it to wait for the
2524                  * completion of this exception, and start this one last,
2525                  * at the end of the function.
2526                  */
2527                 if (bio) {
2528                         bio_list_add(&pe->origin_bios, bio);
2529                         bio = NULL;
2530
2531                         if (!pe->started) {
2532                                 pe->started = 1;
2533                                 pe_to_start_last = pe;
2534                         }
2535                 }
2536
2537                 if (!pe->started) {
2538                         pe->started = 1;
2539                         pe_to_start_now = pe;
2540                 }
2541
2542 next_snapshot:
2543                 dm_exception_table_unlock(&lock);
2544                 up_read(&snap->lock);
2545
2546                 if (pe_to_start_now) {
2547                         start_copy(pe_to_start_now);
2548                         pe_to_start_now = NULL;
2549                 }
2550         }
2551
2552         /*
2553          * Submit the exception against which the bio is queued last,
2554          * to give the other exceptions a head start.
2555          */
2556         if (pe_to_start_last)
2557                 start_copy(pe_to_start_last);
2558
2559         return r;
2560 }
2561
2562 /*
2563  * Called on a write from the origin driver.
2564  */
2565 static int do_origin(struct dm_dev *origin, struct bio *bio, bool limit)
2566 {
2567         struct origin *o;
2568         int r = DM_MAPIO_REMAPPED;
2569
2570 again:
2571         down_read(&_origins_lock);
2572         o = __lookup_origin(origin->bdev);
2573         if (o) {
2574                 if (limit) {
2575                         struct dm_snapshot *s;
2576                         list_for_each_entry(s, &o->snapshots, list)
2577                                 if (unlikely(!wait_for_in_progress(s, true)))
2578                                         goto again;
2579                 }
2580
2581                 r = __origin_write(&o->snapshots, bio->bi_iter.bi_sector, bio);
2582         }
2583         up_read(&_origins_lock);
2584
2585         return r;
2586 }
2587
2588 /*
2589  * Trigger exceptions in all non-merging snapshots.
2590  *
2591  * The chunk size of the merging snapshot may be larger than the chunk
2592  * size of some other snapshot so we may need to reallocate multiple
2593  * chunks in other snapshots.
2594  *
2595  * We scan all the overlapping exceptions in the other snapshots.
2596  * Returns 1 if anything was reallocated and must be waited for,
2597  * otherwise returns 0.
2598  *
2599  * size must be a multiple of merging_snap's chunk_size.
2600  */
2601 static int origin_write_extent(struct dm_snapshot *merging_snap,
2602                                sector_t sector, unsigned size)
2603 {
2604         int must_wait = 0;
2605         sector_t n;
2606         struct origin *o;
2607
2608         /*
2609          * The origin's __minimum_chunk_size() got stored in max_io_len
2610          * by snapshot_merge_resume().
2611          */
2612         down_read(&_origins_lock);
2613         o = __lookup_origin(merging_snap->origin->bdev);
2614         for (n = 0; n < size; n += merging_snap->ti->max_io_len)
2615                 if (__origin_write(&o->snapshots, sector + n, NULL) ==
2616                     DM_MAPIO_SUBMITTED)
2617                         must_wait = 1;
2618         up_read(&_origins_lock);
2619
2620         return must_wait;
2621 }
2622
2623 /*
2624  * Origin: maps a linear range of a device, with hooks for snapshotting.
2625  */
2626
2627 /*
2628  * Construct an origin mapping: <dev_path>
2629  * The context for an origin is merely a 'struct dm_dev *'
2630  * pointing to the real device.
2631  */
2632 static int origin_ctr(struct dm_target *ti, unsigned int argc, char **argv)
2633 {
2634         int r;
2635         struct dm_origin *o;
2636
2637         if (argc != 1) {
2638                 ti->error = "origin: incorrect number of arguments";
2639                 return -EINVAL;
2640         }
2641
2642         o = kmalloc(sizeof(struct dm_origin), GFP_KERNEL);
2643         if (!o) {
2644                 ti->error = "Cannot allocate private origin structure";
2645                 r = -ENOMEM;
2646                 goto bad_alloc;
2647         }
2648
2649         r = dm_get_device(ti, argv[0], dm_table_get_mode(ti->table), &o->dev);
2650         if (r) {
2651                 ti->error = "Cannot get target device";
2652                 goto bad_open;
2653         }
2654
2655         o->ti = ti;
2656         ti->private = o;
2657         ti->num_flush_bios = 1;
2658
2659         return 0;
2660
2661 bad_open:
2662         kfree(o);
2663 bad_alloc:
2664         return r;
2665 }
2666
2667 static void origin_dtr(struct dm_target *ti)
2668 {
2669         struct dm_origin *o = ti->private;
2670
2671         dm_put_device(ti, o->dev);
2672         kfree(o);
2673 }
2674
2675 static int origin_map(struct dm_target *ti, struct bio *bio)
2676 {
2677         struct dm_origin *o = ti->private;
2678         unsigned available_sectors;
2679
2680         bio_set_dev(bio, o->dev->bdev);
2681
2682         if (unlikely(bio->bi_opf & REQ_PREFLUSH))
2683                 return DM_MAPIO_REMAPPED;
2684
2685         if (bio_data_dir(bio) != WRITE)
2686                 return DM_MAPIO_REMAPPED;
2687
2688         available_sectors = o->split_boundary -
2689                 ((unsigned)bio->bi_iter.bi_sector & (o->split_boundary - 1));
2690
2691         if (bio_sectors(bio) > available_sectors)
2692                 dm_accept_partial_bio(bio, available_sectors);
2693
2694         /* Only tell snapshots if this is a write */
2695         return do_origin(o->dev, bio, true);
2696 }
2697
2698 /*
2699  * Set the target "max_io_len" field to the minimum of all the snapshots'
2700  * chunk sizes.
2701  */
2702 static void origin_resume(struct dm_target *ti)
2703 {
2704         struct dm_origin *o = ti->private;
2705
2706         o->split_boundary = get_origin_minimum_chunksize(o->dev->bdev);
2707
2708         down_write(&_origins_lock);
2709         __insert_dm_origin(o);
2710         up_write(&_origins_lock);
2711 }
2712
2713 static void origin_postsuspend(struct dm_target *ti)
2714 {
2715         struct dm_origin *o = ti->private;
2716
2717         down_write(&_origins_lock);
2718         __remove_dm_origin(o);
2719         up_write(&_origins_lock);
2720 }
2721
2722 static void origin_status(struct dm_target *ti, status_type_t type,
2723                           unsigned status_flags, char *result, unsigned maxlen)
2724 {
2725         struct dm_origin *o = ti->private;
2726
2727         switch (type) {
2728         case STATUSTYPE_INFO:
2729                 result[0] = '\0';
2730                 break;
2731
2732         case STATUSTYPE_TABLE:
2733                 snprintf(result, maxlen, "%s", o->dev->name);
2734                 break;
2735         }
2736 }
2737
2738 static int origin_iterate_devices(struct dm_target *ti,
2739                                   iterate_devices_callout_fn fn, void *data)
2740 {
2741         struct dm_origin *o = ti->private;
2742
2743         return fn(ti, o->dev, 0, ti->len, data);
2744 }
2745
2746 static struct target_type origin_target = {
2747         .name    = "snapshot-origin",
2748         .version = {1, 9, 0},
2749         .module  = THIS_MODULE,
2750         .ctr     = origin_ctr,
2751         .dtr     = origin_dtr,
2752         .map     = origin_map,
2753         .resume  = origin_resume,
2754         .postsuspend = origin_postsuspend,
2755         .status  = origin_status,
2756         .iterate_devices = origin_iterate_devices,
2757 };
2758
2759 static struct target_type snapshot_target = {
2760         .name    = "snapshot",
2761         .version = {1, 16, 0},
2762         .module  = THIS_MODULE,
2763         .ctr     = snapshot_ctr,
2764         .dtr     = snapshot_dtr,
2765         .map     = snapshot_map,
2766         .end_io  = snapshot_end_io,
2767         .preresume  = snapshot_preresume,
2768         .resume  = snapshot_resume,
2769         .status  = snapshot_status,
2770         .iterate_devices = snapshot_iterate_devices,
2771         .io_hints = snapshot_io_hints,
2772 };
2773
2774 static struct target_type merge_target = {
2775         .name    = dm_snapshot_merge_target_name,
2776         .version = {1, 5, 0},
2777         .module  = THIS_MODULE,
2778         .ctr     = snapshot_ctr,
2779         .dtr     = snapshot_dtr,
2780         .map     = snapshot_merge_map,
2781         .end_io  = snapshot_end_io,
2782         .presuspend = snapshot_merge_presuspend,
2783         .preresume  = snapshot_preresume,
2784         .resume  = snapshot_merge_resume,
2785         .status  = snapshot_status,
2786         .iterate_devices = snapshot_iterate_devices,
2787         .io_hints = snapshot_io_hints,
2788 };
2789
2790 static int __init dm_snapshot_init(void)
2791 {
2792         int r;
2793
2794         r = dm_exception_store_init();
2795         if (r) {
2796                 DMERR("Failed to initialize exception stores");
2797                 return r;
2798         }
2799
2800         r = init_origin_hash();
2801         if (r) {
2802                 DMERR("init_origin_hash failed.");
2803                 goto bad_origin_hash;
2804         }
2805
2806         exception_cache = KMEM_CACHE(dm_exception, 0);
2807         if (!exception_cache) {
2808                 DMERR("Couldn't create exception cache.");
2809                 r = -ENOMEM;
2810                 goto bad_exception_cache;
2811         }
2812
2813         pending_cache = KMEM_CACHE(dm_snap_pending_exception, 0);
2814         if (!pending_cache) {
2815                 DMERR("Couldn't create pending cache.");
2816                 r = -ENOMEM;
2817                 goto bad_pending_cache;
2818         }
2819
2820         r = dm_register_target(&snapshot_target);
2821         if (r < 0) {
2822                 DMERR("snapshot target register failed %d", r);
2823                 goto bad_register_snapshot_target;
2824         }
2825
2826         r = dm_register_target(&origin_target);
2827         if (r < 0) {
2828                 DMERR("Origin target register failed %d", r);
2829                 goto bad_register_origin_target;
2830         }
2831
2832         r = dm_register_target(&merge_target);
2833         if (r < 0) {
2834                 DMERR("Merge target register failed %d", r);
2835                 goto bad_register_merge_target;
2836         }
2837
2838         return 0;
2839
2840 bad_register_merge_target:
2841         dm_unregister_target(&origin_target);
2842 bad_register_origin_target:
2843         dm_unregister_target(&snapshot_target);
2844 bad_register_snapshot_target:
2845         kmem_cache_destroy(pending_cache);
2846 bad_pending_cache:
2847         kmem_cache_destroy(exception_cache);
2848 bad_exception_cache:
2849         exit_origin_hash();
2850 bad_origin_hash:
2851         dm_exception_store_exit();
2852
2853         return r;
2854 }
2855
2856 static void __exit dm_snapshot_exit(void)
2857 {
2858         dm_unregister_target(&snapshot_target);
2859         dm_unregister_target(&origin_target);
2860         dm_unregister_target(&merge_target);
2861
2862         exit_origin_hash();
2863         kmem_cache_destroy(pending_cache);
2864         kmem_cache_destroy(exception_cache);
2865
2866         dm_exception_store_exit();
2867 }
2868
2869 /* Module hooks */
2870 module_init(dm_snapshot_init);
2871 module_exit(dm_snapshot_exit);
2872
2873 MODULE_DESCRIPTION(DM_NAME " snapshot target");
2874 MODULE_AUTHOR("Joe Thornber");
2875 MODULE_LICENSE("GPL");
2876 MODULE_ALIAS("dm-snapshot-origin");
2877 MODULE_ALIAS("dm-snapshot-merge");