| /* |
| * Copyright (C) 2014 Facebook. All rights reserved. |
| * |
| * This file is released under the GPL. |
| */ |
| |
| #include <linux/device-mapper.h> |
| |
| #include <linux/module.h> |
| #include <linux/init.h> |
| #include <linux/blkdev.h> |
| #include <linux/bio.h> |
| #include <linux/dax.h> |
| #include <linux/slab.h> |
| #include <linux/kthread.h> |
| #include <linux/freezer.h> |
| #include <linux/uio.h> |
| |
| #define DM_MSG_PREFIX "log-writes" |
| |
| /* |
| * This target will sequentially log all writes to the target device onto the |
| * log device. This is helpful for replaying writes to check for fs consistency |
| * at all times. This target provides a mechanism to mark specific events to |
| * check data at a later time. So for example you would: |
| * |
| * write data |
| * fsync |
| * dmsetup message /dev/whatever mark mymark |
| * unmount /mnt/test |
| * |
| * Then replay the log up to mymark and check the contents of the replay to |
| * verify it matches what was written. |
| * |
| * We log writes only after they have been flushed, this makes the log describe |
| * close to the order in which the data hits the actual disk, not its cache. So |
| * for example the following sequence (W means write, C means complete) |
| * |
| * Wa,Wb,Wc,Cc,Ca,FLUSH,FUAd,Cb,CFLUSH,CFUAd |
| * |
| * Would result in the log looking like this: |
| * |
| * c,a,b,flush,fuad,<other writes>,<next flush> |
| * |
| * This is meant to help expose problems where file systems do not properly wait |
| * on data being written before invoking a FLUSH. FUA bypasses cache so once it |
| * completes it is added to the log as it should be on disk. |
| * |
| * We treat DISCARDs as if they don't bypass cache so that they are logged in |
| * order of completion along with the normal writes. If we didn't do it this |
| * way we would process all the discards first and then write all the data, when |
| * in fact we want to do the data and the discard in the order that they |
| * completed. |
| */ |
| #define LOG_FLUSH_FLAG (1 << 0) |
| #define LOG_FUA_FLAG (1 << 1) |
| #define LOG_DISCARD_FLAG (1 << 2) |
| #define LOG_MARK_FLAG (1 << 3) |
| #define LOG_METADATA_FLAG (1 << 4) |
| |
| #define WRITE_LOG_VERSION 1ULL |
| #define WRITE_LOG_MAGIC 0x6a736677736872ULL |
| #define WRITE_LOG_SUPER_SECTOR 0 |
| |
| /* |
| * The disk format for this is braindead simple. |
| * |
| * At byte 0 we have our super, followed by the following sequence for |
| * nr_entries: |
| * |
| * [ 1 sector ][ entry->nr_sectors ] |
| * [log_write_entry][ data written ] |
| * |
| * The log_write_entry takes up a full sector so we can have arbitrary length |
| * marks and it leaves us room for extra content in the future. |
| */ |
| |
| /* |
| * Basic info about the log for userspace. |
| */ |
| struct log_write_super { |
| __le64 magic; |
| __le64 version; |
| __le64 nr_entries; |
| __le32 sectorsize; |
| }; |
| |
| /* |
| * sector - the sector we wrote. |
| * nr_sectors - the number of sectors we wrote. |
| * flags - flags for this log entry. |
| * data_len - the size of the data in this log entry, this is for private log |
| * entry stuff, the MARK data provided by userspace for example. |
| */ |
| struct log_write_entry { |
| __le64 sector; |
| __le64 nr_sectors; |
| __le64 flags; |
| __le64 data_len; |
| }; |
| |
| struct log_writes_c { |
| struct dm_dev *dev; |
| struct dm_dev *logdev; |
| u64 logged_entries; |
| u32 sectorsize; |
| u32 sectorshift; |
| atomic_t io_blocks; |
| atomic_t pending_blocks; |
| sector_t next_sector; |
| sector_t end_sector; |
| bool logging_enabled; |
| bool device_supports_discard; |
| spinlock_t blocks_lock; |
| struct list_head unflushed_blocks; |
| struct list_head logging_blocks; |
| wait_queue_head_t wait; |
| struct task_struct *log_kthread; |
| struct completion super_done; |
| }; |
| |
| struct pending_block { |
| int vec_cnt; |
| u64 flags; |
| sector_t sector; |
| sector_t nr_sectors; |
| char *data; |
| u32 datalen; |
| struct list_head list; |
| struct bio_vec vecs[]; |
| }; |
| |
| struct per_bio_data { |
| struct pending_block *block; |
| }; |
| |
| static inline sector_t bio_to_dev_sectors(struct log_writes_c *lc, |
| sector_t sectors) |
| { |
| return sectors >> (lc->sectorshift - SECTOR_SHIFT); |
| } |
| |
| static inline sector_t dev_to_bio_sectors(struct log_writes_c *lc, |
| sector_t sectors) |
| { |
| return sectors << (lc->sectorshift - SECTOR_SHIFT); |
| } |
| |
| static void put_pending_block(struct log_writes_c *lc) |
| { |
| if (atomic_dec_and_test(&lc->pending_blocks)) { |
| smp_mb__after_atomic(); |
| if (waitqueue_active(&lc->wait)) |
| wake_up(&lc->wait); |
| } |
| } |
| |
| static void put_io_block(struct log_writes_c *lc) |
| { |
| if (atomic_dec_and_test(&lc->io_blocks)) { |
| smp_mb__after_atomic(); |
| if (waitqueue_active(&lc->wait)) |
| wake_up(&lc->wait); |
| } |
| } |
| |
| static void log_end_io(struct bio *bio) |
| { |
| struct log_writes_c *lc = bio->bi_private; |
| |
| if (bio->bi_status) { |
| unsigned long flags; |
| |
| DMERR("Error writing log block, error=%d", bio->bi_status); |
| spin_lock_irqsave(&lc->blocks_lock, flags); |
| lc->logging_enabled = false; |
| spin_unlock_irqrestore(&lc->blocks_lock, flags); |
| } |
| |
| bio_free_pages(bio); |
| put_io_block(lc); |
| bio_put(bio); |
| } |
| |
| static void log_end_super(struct bio *bio) |
| { |
| struct log_writes_c *lc = bio->bi_private; |
| |
| complete(&lc->super_done); |
| log_end_io(bio); |
| } |
| |
| /* |
| * Meant to be called if there is an error, it will free all the pages |
| * associated with the block. |
| */ |
| static void free_pending_block(struct log_writes_c *lc, |
| struct pending_block *block) |
| { |
| int i; |
| |
| for (i = 0; i < block->vec_cnt; i++) { |
| if (block->vecs[i].bv_page) |
| __free_page(block->vecs[i].bv_page); |
| } |
| kfree(block->data); |
| kfree(block); |
| put_pending_block(lc); |
| } |
| |
| static int write_metadata(struct log_writes_c *lc, void *entry, |
| size_t entrylen, void *data, size_t datalen, |
| sector_t sector) |
| { |
| struct bio *bio; |
| struct page *page; |
| void *ptr; |
| size_t ret; |
| |
| bio = bio_alloc(GFP_KERNEL, 1); |
| if (!bio) { |
| DMERR("Couldn't alloc log bio"); |
| goto error; |
| } |
| bio->bi_iter.bi_size = 0; |
| bio->bi_iter.bi_sector = sector; |
| bio_set_dev(bio, lc->logdev->bdev); |
| bio->bi_end_io = (sector == WRITE_LOG_SUPER_SECTOR) ? |
| log_end_super : log_end_io; |
| bio->bi_private = lc; |
| bio_set_op_attrs(bio, REQ_OP_WRITE, 0); |
| |
| page = alloc_page(GFP_KERNEL); |
| if (!page) { |
| DMERR("Couldn't alloc log page"); |
| bio_put(bio); |
| goto error; |
| } |
| |
| ptr = kmap_atomic(page); |
| memcpy(ptr, entry, entrylen); |
| if (datalen) |
| memcpy(ptr + entrylen, data, datalen); |
| memset(ptr + entrylen + datalen, 0, |
| lc->sectorsize - entrylen - datalen); |
| kunmap_atomic(ptr); |
| |
| ret = bio_add_page(bio, page, lc->sectorsize, 0); |
| if (ret != lc->sectorsize) { |
| DMERR("Couldn't add page to the log block"); |
| goto error_bio; |
| } |
| submit_bio(bio); |
| return 0; |
| error_bio: |
| bio_put(bio); |
| __free_page(page); |
| error: |
| put_io_block(lc); |
| return -1; |
| } |
| |
| static int write_inline_data(struct log_writes_c *lc, void *entry, |
| size_t entrylen, void *data, size_t datalen, |
| sector_t sector) |
| { |
| int bio_pages, pg_datalen, pg_sectorlen, i; |
| struct page *page; |
| struct bio *bio; |
| size_t ret; |
| void *ptr; |
| |
| while (datalen) { |
| bio_pages = bio_max_segs(DIV_ROUND_UP(datalen, PAGE_SIZE)); |
| |
| atomic_inc(&lc->io_blocks); |
| |
| bio = bio_alloc(GFP_KERNEL, bio_pages); |
| if (!bio) { |
| DMERR("Couldn't alloc inline data bio"); |
| goto error; |
| } |
| |
| bio->bi_iter.bi_size = 0; |
| bio->bi_iter.bi_sector = sector; |
| bio_set_dev(bio, lc->logdev->bdev); |
| bio->bi_end_io = log_end_io; |
| bio->bi_private = lc; |
| bio_set_op_attrs(bio, REQ_OP_WRITE, 0); |
| |
| for (i = 0; i < bio_pages; i++) { |
| pg_datalen = min_t(int, datalen, PAGE_SIZE); |
| pg_sectorlen = ALIGN(pg_datalen, lc->sectorsize); |
| |
| page = alloc_page(GFP_KERNEL); |
| if (!page) { |
| DMERR("Couldn't alloc inline data page"); |
| goto error_bio; |
| } |
| |
| ptr = kmap_atomic(page); |
| memcpy(ptr, data, pg_datalen); |
| if (pg_sectorlen > pg_datalen) |
| memset(ptr + pg_datalen, 0, pg_sectorlen - pg_datalen); |
| kunmap_atomic(ptr); |
| |
| ret = bio_add_page(bio, page, pg_sectorlen, 0); |
| if (ret != pg_sectorlen) { |
| DMERR("Couldn't add page of inline data"); |
| __free_page(page); |
| goto error_bio; |
| } |
| |
| datalen -= pg_datalen; |
| data += pg_datalen; |
| } |
| submit_bio(bio); |
| |
| sector += bio_pages * PAGE_SECTORS; |
| } |
| return 0; |
| error_bio: |
| bio_free_pages(bio); |
| bio_put(bio); |
| error: |
| put_io_block(lc); |
| return -1; |
| } |
| |
| static int log_one_block(struct log_writes_c *lc, |
| struct pending_block *block, sector_t sector) |
| { |
| struct bio *bio; |
| struct log_write_entry entry; |
| size_t metadatalen, ret; |
| int i; |
| |
| entry.sector = cpu_to_le64(block->sector); |
| entry.nr_sectors = cpu_to_le64(block->nr_sectors); |
| entry.flags = cpu_to_le64(block->flags); |
| entry.data_len = cpu_to_le64(block->datalen); |
| |
| metadatalen = (block->flags & LOG_MARK_FLAG) ? block->datalen : 0; |
| if (write_metadata(lc, &entry, sizeof(entry), block->data, |
| metadatalen, sector)) { |
| free_pending_block(lc, block); |
| return -1; |
| } |
| |
| sector += dev_to_bio_sectors(lc, 1); |
| |
| if (block->datalen && metadatalen == 0) { |
| if (write_inline_data(lc, &entry, sizeof(entry), block->data, |
| block->datalen, sector)) { |
| free_pending_block(lc, block); |
| return -1; |
| } |
| /* we don't support both inline data & bio data */ |
| goto out; |
| } |
| |
| if (!block->vec_cnt) |
| goto out; |
| |
| atomic_inc(&lc->io_blocks); |
| bio = bio_alloc(GFP_KERNEL, bio_max_segs(block->vec_cnt)); |
| if (!bio) { |
| DMERR("Couldn't alloc log bio"); |
| goto error; |
| } |
| bio->bi_iter.bi_size = 0; |
| bio->bi_iter.bi_sector = sector; |
| bio_set_dev(bio, lc->logdev->bdev); |
| bio->bi_end_io = log_end_io; |
| bio->bi_private = lc; |
| bio_set_op_attrs(bio, REQ_OP_WRITE, 0); |
| |
| for (i = 0; i < block->vec_cnt; i++) { |
| /* |
| * The page offset is always 0 because we allocate a new page |
| * for every bvec in the original bio for simplicity sake. |
| */ |
| ret = bio_add_page(bio, block->vecs[i].bv_page, |
| block->vecs[i].bv_len, 0); |
| if (ret != block->vecs[i].bv_len) { |
| atomic_inc(&lc->io_blocks); |
| submit_bio(bio); |
| bio = bio_alloc(GFP_KERNEL, |
| bio_max_segs(block->vec_cnt - i)); |
| if (!bio) { |
| DMERR("Couldn't alloc log bio"); |
| goto error; |
| } |
| bio->bi_iter.bi_size = 0; |
| bio->bi_iter.bi_sector = sector; |
| bio_set_dev(bio, lc->logdev->bdev); |
| bio->bi_end_io = log_end_io; |
| bio->bi_private = lc; |
| bio_set_op_attrs(bio, REQ_OP_WRITE, 0); |
| |
| ret = bio_add_page(bio, block->vecs[i].bv_page, |
| block->vecs[i].bv_len, 0); |
| if (ret != block->vecs[i].bv_len) { |
| DMERR("Couldn't add page on new bio?"); |
| bio_put(bio); |
| goto error; |
| } |
| } |
| sector += block->vecs[i].bv_len >> SECTOR_SHIFT; |
| } |
| submit_bio(bio); |
| out: |
| kfree(block->data); |
| kfree(block); |
| put_pending_block(lc); |
| return 0; |
| error: |
| free_pending_block(lc, block); |
| put_io_block(lc); |
| return -1; |
| } |
| |
| static int log_super(struct log_writes_c *lc) |
| { |
| struct log_write_super super; |
| |
| super.magic = cpu_to_le64(WRITE_LOG_MAGIC); |
| super.version = cpu_to_le64(WRITE_LOG_VERSION); |
| super.nr_entries = cpu_to_le64(lc->logged_entries); |
| super.sectorsize = cpu_to_le32(lc->sectorsize); |
| |
| if (write_metadata(lc, &super, sizeof(super), NULL, 0, |
| WRITE_LOG_SUPER_SECTOR)) { |
| DMERR("Couldn't write super"); |
| return -1; |
| } |
| |
| /* |
| * Super sector should be writen in-order, otherwise the |
| * nr_entries could be rewritten incorrectly by an old bio. |
| */ |
| wait_for_completion_io(&lc->super_done); |
| |
| return 0; |
| } |
| |
| static inline sector_t logdev_last_sector(struct log_writes_c *lc) |
| { |
| return i_size_read(lc->logdev->bdev->bd_inode) >> SECTOR_SHIFT; |
| } |
| |
| static int log_writes_kthread(void *arg) |
| { |
| struct log_writes_c *lc = (struct log_writes_c *)arg; |
| sector_t sector = 0; |
| |
| while (!kthread_should_stop()) { |
| bool super = false; |
| bool logging_enabled; |
| struct pending_block *block = NULL; |
| int ret; |
| |
| spin_lock_irq(&lc->blocks_lock); |
| if (!list_empty(&lc->logging_blocks)) { |
| block = list_first_entry(&lc->logging_blocks, |
| struct pending_block, list); |
| list_del_init(&block->list); |
| if (!lc->logging_enabled) |
| goto next; |
| |
| sector = lc->next_sector; |
| if (!(block->flags & LOG_DISCARD_FLAG)) |
| lc->next_sector += dev_to_bio_sectors(lc, block->nr_sectors); |
| lc->next_sector += dev_to_bio_sectors(lc, 1); |
| |
| /* |
| * Apparently the size of the device may not be known |
| * right away, so handle this properly. |
| */ |
| if (!lc->end_sector) |
| lc->end_sector = logdev_last_sector(lc); |
| if (lc->end_sector && |
| lc->next_sector >= lc->end_sector) { |
| DMERR("Ran out of space on the logdev"); |
| lc->logging_enabled = false; |
| goto next; |
| } |
| lc->logged_entries++; |
| atomic_inc(&lc->io_blocks); |
| |
| super = (block->flags & (LOG_FUA_FLAG | LOG_MARK_FLAG)); |
| if (super) |
| atomic_inc(&lc->io_blocks); |
| } |
| next: |
| logging_enabled = lc->logging_enabled; |
| spin_unlock_irq(&lc->blocks_lock); |
| if (block) { |
| if (logging_enabled) { |
| ret = log_one_block(lc, block, sector); |
| if (!ret && super) |
| ret = log_super(lc); |
| if (ret) { |
| spin_lock_irq(&lc->blocks_lock); |
| lc->logging_enabled = false; |
| spin_unlock_irq(&lc->blocks_lock); |
| } |
| } else |
| free_pending_block(lc, block); |
| continue; |
| } |
| |
| if (!try_to_freeze()) { |
| set_current_state(TASK_INTERRUPTIBLE); |
| if (!kthread_should_stop() && |
| list_empty(&lc->logging_blocks)) |
| schedule(); |
| __set_current_state(TASK_RUNNING); |
| } |
| } |
| return 0; |
| } |
| |
| /* |
| * Construct a log-writes mapping: |
| * log-writes <dev_path> <log_dev_path> |
| */ |
| static int log_writes_ctr(struct dm_target *ti, unsigned int argc, char **argv) |
| { |
| struct log_writes_c *lc; |
| struct dm_arg_set as; |
| const char *devname, *logdevname; |
| int ret; |
| |
| as.argc = argc; |
| as.argv = argv; |
| |
| if (argc < 2) { |
| ti->error = "Invalid argument count"; |
| return -EINVAL; |
| } |
| |
| lc = kzalloc(sizeof(struct log_writes_c), GFP_KERNEL); |
| if (!lc) { |
| ti->error = "Cannot allocate context"; |
| return -ENOMEM; |
| } |
| spin_lock_init(&lc->blocks_lock); |
| INIT_LIST_HEAD(&lc->unflushed_blocks); |
| INIT_LIST_HEAD(&lc->logging_blocks); |
| init_waitqueue_head(&lc->wait); |
| init_completion(&lc->super_done); |
| atomic_set(&lc->io_blocks, 0); |
| atomic_set(&lc->pending_blocks, 0); |
| |
| devname = dm_shift_arg(&as); |
| ret = dm_get_device(ti, devname, dm_table_get_mode(ti->table), &lc->dev); |
| if (ret) { |
| ti->error = "Device lookup failed"; |
| goto bad; |
| } |
| |
| logdevname = dm_shift_arg(&as); |
| ret = dm_get_device(ti, logdevname, dm_table_get_mode(ti->table), |
| &lc->logdev); |
| if (ret) { |
| ti->error = "Log device lookup failed"; |
| dm_put_device(ti, lc->dev); |
| goto bad; |
| } |
| |
| lc->sectorsize = bdev_logical_block_size(lc->dev->bdev); |
| lc->sectorshift = ilog2(lc->sectorsize); |
| lc->log_kthread = kthread_run(log_writes_kthread, lc, "log-write"); |
| if (IS_ERR(lc->log_kthread)) { |
| ret = PTR_ERR(lc->log_kthread); |
| ti->error = "Couldn't alloc kthread"; |
| dm_put_device(ti, lc->dev); |
| dm_put_device(ti, lc->logdev); |
| goto bad; |
| } |
| |
| /* |
| * next_sector is in 512b sectors to correspond to what bi_sector expects. |
| * The super starts at sector 0, and the next_sector is the next logical |
| * one based on the sectorsize of the device. |
| */ |
| lc->next_sector = lc->sectorsize >> SECTOR_SHIFT; |
| lc->logging_enabled = true; |
| lc->end_sector = logdev_last_sector(lc); |
| lc->device_supports_discard = true; |
| |
| ti->num_flush_bios = 1; |
| ti->flush_supported = true; |
| ti->num_discard_bios = 1; |
| ti->discards_supported = true; |
| ti->per_io_data_size = sizeof(struct per_bio_data); |
| ti->private = lc; |
| return 0; |
| |
| bad: |
| kfree(lc); |
| return ret; |
| } |
| |
| static int log_mark(struct log_writes_c *lc, char *data) |
| { |
| struct pending_block *block; |
| size_t maxsize = lc->sectorsize - sizeof(struct log_write_entry); |
| |
| block = kzalloc(sizeof(struct pending_block), GFP_KERNEL); |
| if (!block) { |
| DMERR("Error allocating pending block"); |
| return -ENOMEM; |
| } |
| |
| block->data = kstrndup(data, maxsize - 1, GFP_KERNEL); |
| if (!block->data) { |
| DMERR("Error copying mark data"); |
| kfree(block); |
| return -ENOMEM; |
| } |
| atomic_inc(&lc->pending_blocks); |
| block->datalen = strlen(block->data); |
| block->flags |= LOG_MARK_FLAG; |
| spin_lock_irq(&lc->blocks_lock); |
| list_add_tail(&block->list, &lc->logging_blocks); |
| spin_unlock_irq(&lc->blocks_lock); |
| wake_up_process(lc->log_kthread); |
| return 0; |
| } |
| |
| static void log_writes_dtr(struct dm_target *ti) |
| { |
| struct log_writes_c *lc = ti->private; |
| |
| spin_lock_irq(&lc->blocks_lock); |
| list_splice_init(&lc->unflushed_blocks, &lc->logging_blocks); |
| spin_unlock_irq(&lc->blocks_lock); |
| |
| /* |
| * This is just nice to have since it'll update the super to include the |
| * unflushed blocks, if it fails we don't really care. |
| */ |
| log_mark(lc, "dm-log-writes-end"); |
| wake_up_process(lc->log_kthread); |
| wait_event(lc->wait, !atomic_read(&lc->io_blocks) && |
| !atomic_read(&lc->pending_blocks)); |
| kthread_stop(lc->log_kthread); |
| |
| WARN_ON(!list_empty(&lc->logging_blocks)); |
| WARN_ON(!list_empty(&lc->unflushed_blocks)); |
| dm_put_device(ti, lc->dev); |
| dm_put_device(ti, lc->logdev); |
| kfree(lc); |
| } |
| |
| static void normal_map_bio(struct dm_target *ti, struct bio *bio) |
| { |
| struct log_writes_c *lc = ti->private; |
| |
| bio_set_dev(bio, lc->dev->bdev); |
| } |
| |
| static int log_writes_map(struct dm_target *ti, struct bio *bio) |
| { |
| struct log_writes_c *lc = ti->private; |
| struct per_bio_data *pb = dm_per_bio_data(bio, sizeof(struct per_bio_data)); |
| struct pending_block *block; |
| struct bvec_iter iter; |
| struct bio_vec bv; |
| size_t alloc_size; |
| int i = 0; |
| bool flush_bio = (bio->bi_opf & REQ_PREFLUSH); |
| bool fua_bio = (bio->bi_opf & REQ_FUA); |
| bool discard_bio = (bio_op(bio) == REQ_OP_DISCARD); |
| bool meta_bio = (bio->bi_opf & REQ_META); |
| |
| pb->block = NULL; |
| |
| /* Don't bother doing anything if logging has been disabled */ |
| if (!lc->logging_enabled) |
| goto map_bio; |
| |
| /* |
| * Map reads as normal. |
| */ |
| if (bio_data_dir(bio) == READ) |
| goto map_bio; |
| |
| /* No sectors and not a flush? Don't care */ |
| if (!bio_sectors(bio) && !flush_bio) |
| goto map_bio; |
| |
| /* |
| * Discards will have bi_size set but there's no actual data, so just |
| * allocate the size of the pending block. |
| */ |
| if (discard_bio) |
| alloc_size = sizeof(struct pending_block); |
| else |
| alloc_size = struct_size(block, vecs, bio_segments(bio)); |
| |
| block = kzalloc(alloc_size, GFP_NOIO); |
| if (!block) { |
| DMERR("Error allocating pending block"); |
| spin_lock_irq(&lc->blocks_lock); |
| lc->logging_enabled = false; |
| spin_unlock_irq(&lc->blocks_lock); |
| return DM_MAPIO_KILL; |
| } |
| INIT_LIST_HEAD(&block->list); |
| pb->block = block; |
| atomic_inc(&lc->pending_blocks); |
| |
| if (flush_bio) |
| block->flags |= LOG_FLUSH_FLAG; |
| if (fua_bio) |
| block->flags |= LOG_FUA_FLAG; |
| if (discard_bio) |
| block->flags |= LOG_DISCARD_FLAG; |
| if (meta_bio) |
| block->flags |= LOG_METADATA_FLAG; |
| |
| block->sector = bio_to_dev_sectors(lc, bio->bi_iter.bi_sector); |
| block->nr_sectors = bio_to_dev_sectors(lc, bio_sectors(bio)); |
| |
| /* We don't need the data, just submit */ |
| if (discard_bio) { |
| WARN_ON(flush_bio || fua_bio); |
| if (lc->device_supports_discard) |
| goto map_bio; |
| bio_endio(bio); |
| return DM_MAPIO_SUBMITTED; |
| } |
| |
| /* Flush bio, splice the unflushed blocks onto this list and submit */ |
| if (flush_bio && !bio_sectors(bio)) { |
| spin_lock_irq(&lc->blocks_lock); |
| list_splice_init(&lc->unflushed_blocks, &block->list); |
| spin_unlock_irq(&lc->blocks_lock); |
| goto map_bio; |
| } |
| |
| /* |
| * We will write this bio somewhere else way later so we need to copy |
| * the actual contents into new pages so we know the data will always be |
| * there. |
| * |
| * We do this because this could be a bio from O_DIRECT in which case we |
| * can't just hold onto the page until some later point, we have to |
| * manually copy the contents. |
| */ |
| bio_for_each_segment(bv, bio, iter) { |
| struct page *page; |
| void *src, *dst; |
| |
| page = alloc_page(GFP_NOIO); |
| if (!page) { |
| DMERR("Error allocing page"); |
| free_pending_block(lc, block); |
| spin_lock_irq(&lc->blocks_lock); |
| lc->logging_enabled = false; |
| spin_unlock_irq(&lc->blocks_lock); |
| return DM_MAPIO_KILL; |
| } |
| |
| src = kmap_atomic(bv.bv_page); |
| dst = kmap_atomic(page); |
| memcpy(dst, src + bv.bv_offset, bv.bv_len); |
| kunmap_atomic(dst); |
| kunmap_atomic(src); |
| block->vecs[i].bv_page = page; |
| block->vecs[i].bv_len = bv.bv_len; |
| block->vec_cnt++; |
| i++; |
| } |
| |
| /* Had a flush with data in it, weird */ |
| if (flush_bio) { |
| spin_lock_irq(&lc->blocks_lock); |
| list_splice_init(&lc->unflushed_blocks, &block->list); |
| spin_unlock_irq(&lc->blocks_lock); |
| } |
| map_bio: |
| normal_map_bio(ti, bio); |
| return DM_MAPIO_REMAPPED; |
| } |
| |
| static int normal_end_io(struct dm_target *ti, struct bio *bio, |
| blk_status_t *error) |
| { |
| struct log_writes_c *lc = ti->private; |
| struct per_bio_data *pb = dm_per_bio_data(bio, sizeof(struct per_bio_data)); |
| |
| if (bio_data_dir(bio) == WRITE && pb->block) { |
| struct pending_block *block = pb->block; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&lc->blocks_lock, flags); |
| if (block->flags & LOG_FLUSH_FLAG) { |
| list_splice_tail_init(&block->list, &lc->logging_blocks); |
| list_add_tail(&block->list, &lc->logging_blocks); |
| wake_up_process(lc->log_kthread); |
| } else if (block->flags & LOG_FUA_FLAG) { |
| list_add_tail(&block->list, &lc->logging_blocks); |
| wake_up_process(lc->log_kthread); |
| } else |
| list_add_tail(&block->list, &lc->unflushed_blocks); |
| spin_unlock_irqrestore(&lc->blocks_lock, flags); |
| } |
| |
| return DM_ENDIO_DONE; |
| } |
| |
| /* |
| * INFO format: <logged entries> <highest allocated sector> |
| */ |
| static void log_writes_status(struct dm_target *ti, status_type_t type, |
| unsigned status_flags, char *result, |
| unsigned maxlen) |
| { |
| unsigned sz = 0; |
| struct log_writes_c *lc = ti->private; |
| |
| switch (type) { |
| case STATUSTYPE_INFO: |
| DMEMIT("%llu %llu", lc->logged_entries, |
| (unsigned long long)lc->next_sector - 1); |
| if (!lc->logging_enabled) |
| DMEMIT(" logging_disabled"); |
| break; |
| |
| case STATUSTYPE_TABLE: |
| DMEMIT("%s %s", lc->dev->name, lc->logdev->name); |
| break; |
| |
| case STATUSTYPE_IMA: |
| *result = '\0'; |
| break; |
| } |
| } |
| |
| static int log_writes_prepare_ioctl(struct dm_target *ti, |
| struct block_device **bdev) |
| { |
| struct log_writes_c *lc = ti->private; |
| struct dm_dev *dev = lc->dev; |
| |
| *bdev = dev->bdev; |
| /* |
| * Only pass ioctls through if the device sizes match exactly. |
| */ |
| if (ti->len != i_size_read(dev->bdev->bd_inode) >> SECTOR_SHIFT) |
| return 1; |
| return 0; |
| } |
| |
| static int log_writes_iterate_devices(struct dm_target *ti, |
| iterate_devices_callout_fn fn, |
| void *data) |
| { |
| struct log_writes_c *lc = ti->private; |
| |
| return fn(ti, lc->dev, 0, ti->len, data); |
| } |
| |
| /* |
| * Messages supported: |
| * mark <mark data> - specify the marked data. |
| */ |
| static int log_writes_message(struct dm_target *ti, unsigned argc, char **argv, |
| char *result, unsigned maxlen) |
| { |
| int r = -EINVAL; |
| struct log_writes_c *lc = ti->private; |
| |
| if (argc != 2) { |
| DMWARN("Invalid log-writes message arguments, expect 2 arguments, got %d", argc); |
| return r; |
| } |
| |
| if (!strcasecmp(argv[0], "mark")) |
| r = log_mark(lc, argv[1]); |
| else |
| DMWARN("Unrecognised log writes target message received: %s", argv[0]); |
| |
| return r; |
| } |
| |
| static void log_writes_io_hints(struct dm_target *ti, struct queue_limits *limits) |
| { |
| struct log_writes_c *lc = ti->private; |
| struct request_queue *q = bdev_get_queue(lc->dev->bdev); |
| |
| if (!q || !blk_queue_discard(q)) { |
| lc->device_supports_discard = false; |
| limits->discard_granularity = lc->sectorsize; |
| limits->max_discard_sectors = (UINT_MAX >> SECTOR_SHIFT); |
| } |
| limits->logical_block_size = bdev_logical_block_size(lc->dev->bdev); |
| limits->physical_block_size = bdev_physical_block_size(lc->dev->bdev); |
| limits->io_min = limits->physical_block_size; |
| } |
| |
| #if IS_ENABLED(CONFIG_DAX_DRIVER) |
| static int log_dax(struct log_writes_c *lc, sector_t sector, size_t bytes, |
| struct iov_iter *i) |
| { |
| struct pending_block *block; |
| |
| if (!bytes) |
| return 0; |
| |
| block = kzalloc(sizeof(struct pending_block), GFP_KERNEL); |
| if (!block) { |
| DMERR("Error allocating dax pending block"); |
| return -ENOMEM; |
| } |
| |
| block->data = kzalloc(bytes, GFP_KERNEL); |
| if (!block->data) { |
| DMERR("Error allocating dax data space"); |
| kfree(block); |
| return -ENOMEM; |
| } |
| |
| /* write data provided via the iterator */ |
| if (!copy_from_iter(block->data, bytes, i)) { |
| DMERR("Error copying dax data"); |
| kfree(block->data); |
| kfree(block); |
| return -EIO; |
| } |
| |
| /* rewind the iterator so that the block driver can use it */ |
| iov_iter_revert(i, bytes); |
| |
| block->datalen = bytes; |
| block->sector = bio_to_dev_sectors(lc, sector); |
| block->nr_sectors = ALIGN(bytes, lc->sectorsize) >> lc->sectorshift; |
| |
| atomic_inc(&lc->pending_blocks); |
| spin_lock_irq(&lc->blocks_lock); |
| list_add_tail(&block->list, &lc->unflushed_blocks); |
| spin_unlock_irq(&lc->blocks_lock); |
| wake_up_process(lc->log_kthread); |
| |
| return 0; |
| } |
| |
| static long log_writes_dax_direct_access(struct dm_target *ti, pgoff_t pgoff, |
| long nr_pages, void **kaddr, pfn_t *pfn) |
| { |
| struct log_writes_c *lc = ti->private; |
| sector_t sector = pgoff * PAGE_SECTORS; |
| int ret; |
| |
| ret = bdev_dax_pgoff(lc->dev->bdev, sector, nr_pages * PAGE_SIZE, &pgoff); |
| if (ret) |
| return ret; |
| return dax_direct_access(lc->dev->dax_dev, pgoff, nr_pages, kaddr, pfn); |
| } |
| |
| static size_t log_writes_dax_copy_from_iter(struct dm_target *ti, |
| pgoff_t pgoff, void *addr, size_t bytes, |
| struct iov_iter *i) |
| { |
| struct log_writes_c *lc = ti->private; |
| sector_t sector = pgoff * PAGE_SECTORS; |
| int err; |
| |
| if (bdev_dax_pgoff(lc->dev->bdev, sector, ALIGN(bytes, PAGE_SIZE), &pgoff)) |
| return 0; |
| |
| /* Don't bother doing anything if logging has been disabled */ |
| if (!lc->logging_enabled) |
| goto dax_copy; |
| |
| err = log_dax(lc, sector, bytes, i); |
| if (err) { |
| DMWARN("Error %d logging DAX write", err); |
| return 0; |
| } |
| dax_copy: |
| return dax_copy_from_iter(lc->dev->dax_dev, pgoff, addr, bytes, i); |
| } |
| |
| static size_t log_writes_dax_copy_to_iter(struct dm_target *ti, |
| pgoff_t pgoff, void *addr, size_t bytes, |
| struct iov_iter *i) |
| { |
| struct log_writes_c *lc = ti->private; |
| sector_t sector = pgoff * PAGE_SECTORS; |
| |
| if (bdev_dax_pgoff(lc->dev->bdev, sector, ALIGN(bytes, PAGE_SIZE), &pgoff)) |
| return 0; |
| return dax_copy_to_iter(lc->dev->dax_dev, pgoff, addr, bytes, i); |
| } |
| |
| static int log_writes_dax_zero_page_range(struct dm_target *ti, pgoff_t pgoff, |
| size_t nr_pages) |
| { |
| int ret; |
| struct log_writes_c *lc = ti->private; |
| sector_t sector = pgoff * PAGE_SECTORS; |
| |
| ret = bdev_dax_pgoff(lc->dev->bdev, sector, nr_pages << PAGE_SHIFT, |
| &pgoff); |
| if (ret) |
| return ret; |
| return dax_zero_page_range(lc->dev->dax_dev, pgoff, |
| nr_pages << PAGE_SHIFT); |
| } |
| |
| #else |
| #define log_writes_dax_direct_access NULL |
| #define log_writes_dax_copy_from_iter NULL |
| #define log_writes_dax_copy_to_iter NULL |
| #define log_writes_dax_zero_page_range NULL |
| #endif |
| |
| static struct target_type log_writes_target = { |
| .name = "log-writes", |
| .version = {1, 1, 0}, |
| .module = THIS_MODULE, |
| .ctr = log_writes_ctr, |
| .dtr = log_writes_dtr, |
| .map = log_writes_map, |
| .end_io = normal_end_io, |
| .status = log_writes_status, |
| .prepare_ioctl = log_writes_prepare_ioctl, |
| .message = log_writes_message, |
| .iterate_devices = log_writes_iterate_devices, |
| .io_hints = log_writes_io_hints, |
| .direct_access = log_writes_dax_direct_access, |
| .dax_copy_from_iter = log_writes_dax_copy_from_iter, |
| .dax_copy_to_iter = log_writes_dax_copy_to_iter, |
| .dax_zero_page_range = log_writes_dax_zero_page_range, |
| }; |
| |
| static int __init dm_log_writes_init(void) |
| { |
| int r = dm_register_target(&log_writes_target); |
| |
| if (r < 0) |
| DMERR("register failed %d", r); |
| |
| return r; |
| } |
| |
| static void __exit dm_log_writes_exit(void) |
| { |
| dm_unregister_target(&log_writes_target); |
| } |
| |
| module_init(dm_log_writes_init); |
| module_exit(dm_log_writes_exit); |
| |
| MODULE_DESCRIPTION(DM_NAME " log writes target"); |
| MODULE_AUTHOR("Josef Bacik <jbacik@fb.com>"); |
| MODULE_LICENSE("GPL"); |