mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-27 07:20:52 +07:00
1283 lines
25 KiB
C
1283 lines
25 KiB
C
/*
|
|
* Copyright (C) 2001, 2002 Sistina Software (UK) Limited.
|
|
* Copyright (C) 2004 Red Hat, Inc. All rights reserved.
|
|
*
|
|
* This file is released under the GPL.
|
|
*/
|
|
|
|
#include "dm.h"
|
|
#include "dm-bio-list.h"
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <linux/blkpg.h>
|
|
#include <linux/bio.h>
|
|
#include <linux/buffer_head.h>
|
|
#include <linux/mempool.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/idr.h>
|
|
#include <linux/blktrace_api.h>
|
|
|
|
static const char *_name = DM_NAME;
|
|
|
|
static unsigned int major = 0;
|
|
static unsigned int _major = 0;
|
|
|
|
/*
|
|
* One of these is allocated per bio.
|
|
*/
|
|
struct dm_io {
|
|
struct mapped_device *md;
|
|
int error;
|
|
struct bio *bio;
|
|
atomic_t io_count;
|
|
unsigned long start_time;
|
|
};
|
|
|
|
/*
|
|
* One of these is allocated per target within a bio. Hopefully
|
|
* this will be simplified out one day.
|
|
*/
|
|
struct target_io {
|
|
struct dm_io *io;
|
|
struct dm_target *ti;
|
|
union map_info info;
|
|
};
|
|
|
|
union map_info *dm_get_mapinfo(struct bio *bio)
|
|
{
|
|
if (bio && bio->bi_private)
|
|
return &((struct target_io *)bio->bi_private)->info;
|
|
return NULL;
|
|
}
|
|
|
|
/*
|
|
* Bits for the md->flags field.
|
|
*/
|
|
#define DMF_BLOCK_IO 0
|
|
#define DMF_SUSPENDED 1
|
|
#define DMF_FROZEN 2
|
|
|
|
struct mapped_device {
|
|
struct rw_semaphore io_lock;
|
|
struct semaphore suspend_lock;
|
|
rwlock_t map_lock;
|
|
atomic_t holders;
|
|
|
|
unsigned long flags;
|
|
|
|
request_queue_t *queue;
|
|
struct gendisk *disk;
|
|
|
|
void *interface_ptr;
|
|
|
|
/*
|
|
* A list of ios that arrived while we were suspended.
|
|
*/
|
|
atomic_t pending;
|
|
wait_queue_head_t wait;
|
|
struct bio_list deferred;
|
|
|
|
/*
|
|
* The current mapping.
|
|
*/
|
|
struct dm_table *map;
|
|
|
|
/*
|
|
* io objects are allocated from here.
|
|
*/
|
|
mempool_t *io_pool;
|
|
mempool_t *tio_pool;
|
|
|
|
/*
|
|
* Event handling.
|
|
*/
|
|
atomic_t event_nr;
|
|
wait_queue_head_t eventq;
|
|
|
|
/*
|
|
* freeze/thaw support require holding onto a super block
|
|
*/
|
|
struct super_block *frozen_sb;
|
|
struct block_device *suspended_bdev;
|
|
};
|
|
|
|
#define MIN_IOS 256
|
|
static kmem_cache_t *_io_cache;
|
|
static kmem_cache_t *_tio_cache;
|
|
|
|
static struct bio_set *dm_set;
|
|
|
|
static int __init local_init(void)
|
|
{
|
|
int r;
|
|
|
|
dm_set = bioset_create(16, 16, 4);
|
|
if (!dm_set)
|
|
return -ENOMEM;
|
|
|
|
/* allocate a slab for the dm_ios */
|
|
_io_cache = kmem_cache_create("dm_io",
|
|
sizeof(struct dm_io), 0, 0, NULL, NULL);
|
|
if (!_io_cache)
|
|
return -ENOMEM;
|
|
|
|
/* allocate a slab for the target ios */
|
|
_tio_cache = kmem_cache_create("dm_tio", sizeof(struct target_io),
|
|
0, 0, NULL, NULL);
|
|
if (!_tio_cache) {
|
|
kmem_cache_destroy(_io_cache);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
_major = major;
|
|
r = register_blkdev(_major, _name);
|
|
if (r < 0) {
|
|
kmem_cache_destroy(_tio_cache);
|
|
kmem_cache_destroy(_io_cache);
|
|
return r;
|
|
}
|
|
|
|
if (!_major)
|
|
_major = r;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void local_exit(void)
|
|
{
|
|
kmem_cache_destroy(_tio_cache);
|
|
kmem_cache_destroy(_io_cache);
|
|
|
|
bioset_free(dm_set);
|
|
|
|
if (unregister_blkdev(_major, _name) < 0)
|
|
DMERR("devfs_unregister_blkdev failed");
|
|
|
|
_major = 0;
|
|
|
|
DMINFO("cleaned up");
|
|
}
|
|
|
|
int (*_inits[])(void) __initdata = {
|
|
local_init,
|
|
dm_target_init,
|
|
dm_linear_init,
|
|
dm_stripe_init,
|
|
dm_interface_init,
|
|
};
|
|
|
|
void (*_exits[])(void) = {
|
|
local_exit,
|
|
dm_target_exit,
|
|
dm_linear_exit,
|
|
dm_stripe_exit,
|
|
dm_interface_exit,
|
|
};
|
|
|
|
static int __init dm_init(void)
|
|
{
|
|
const int count = ARRAY_SIZE(_inits);
|
|
|
|
int r, i;
|
|
|
|
for (i = 0; i < count; i++) {
|
|
r = _inits[i]();
|
|
if (r)
|
|
goto bad;
|
|
}
|
|
|
|
return 0;
|
|
|
|
bad:
|
|
while (i--)
|
|
_exits[i]();
|
|
|
|
return r;
|
|
}
|
|
|
|
static void __exit dm_exit(void)
|
|
{
|
|
int i = ARRAY_SIZE(_exits);
|
|
|
|
while (i--)
|
|
_exits[i]();
|
|
}
|
|
|
|
/*
|
|
* Block device functions
|
|
*/
|
|
static int dm_blk_open(struct inode *inode, struct file *file)
|
|
{
|
|
struct mapped_device *md;
|
|
|
|
md = inode->i_bdev->bd_disk->private_data;
|
|
dm_get(md);
|
|
return 0;
|
|
}
|
|
|
|
static int dm_blk_close(struct inode *inode, struct file *file)
|
|
{
|
|
struct mapped_device *md;
|
|
|
|
md = inode->i_bdev->bd_disk->private_data;
|
|
dm_put(md);
|
|
return 0;
|
|
}
|
|
|
|
static inline struct dm_io *alloc_io(struct mapped_device *md)
|
|
{
|
|
return mempool_alloc(md->io_pool, GFP_NOIO);
|
|
}
|
|
|
|
static inline void free_io(struct mapped_device *md, struct dm_io *io)
|
|
{
|
|
mempool_free(io, md->io_pool);
|
|
}
|
|
|
|
static inline struct target_io *alloc_tio(struct mapped_device *md)
|
|
{
|
|
return mempool_alloc(md->tio_pool, GFP_NOIO);
|
|
}
|
|
|
|
static inline void free_tio(struct mapped_device *md, struct target_io *tio)
|
|
{
|
|
mempool_free(tio, md->tio_pool);
|
|
}
|
|
|
|
static void start_io_acct(struct dm_io *io)
|
|
{
|
|
struct mapped_device *md = io->md;
|
|
|
|
io->start_time = jiffies;
|
|
|
|
preempt_disable();
|
|
disk_round_stats(dm_disk(md));
|
|
preempt_enable();
|
|
dm_disk(md)->in_flight = atomic_inc_return(&md->pending);
|
|
}
|
|
|
|
static int end_io_acct(struct dm_io *io)
|
|
{
|
|
struct mapped_device *md = io->md;
|
|
struct bio *bio = io->bio;
|
|
unsigned long duration = jiffies - io->start_time;
|
|
int pending;
|
|
int rw = bio_data_dir(bio);
|
|
|
|
preempt_disable();
|
|
disk_round_stats(dm_disk(md));
|
|
preempt_enable();
|
|
dm_disk(md)->in_flight = pending = atomic_dec_return(&md->pending);
|
|
|
|
disk_stat_add(dm_disk(md), ticks[rw], duration);
|
|
|
|
return !pending;
|
|
}
|
|
|
|
/*
|
|
* Add the bio to the list of deferred io.
|
|
*/
|
|
static int queue_io(struct mapped_device *md, struct bio *bio)
|
|
{
|
|
down_write(&md->io_lock);
|
|
|
|
if (!test_bit(DMF_BLOCK_IO, &md->flags)) {
|
|
up_write(&md->io_lock);
|
|
return 1;
|
|
}
|
|
|
|
bio_list_add(&md->deferred, bio);
|
|
|
|
up_write(&md->io_lock);
|
|
return 0; /* deferred successfully */
|
|
}
|
|
|
|
/*
|
|
* Everyone (including functions in this file), should use this
|
|
* function to access the md->map field, and make sure they call
|
|
* dm_table_put() when finished.
|
|
*/
|
|
struct dm_table *dm_get_table(struct mapped_device *md)
|
|
{
|
|
struct dm_table *t;
|
|
|
|
read_lock(&md->map_lock);
|
|
t = md->map;
|
|
if (t)
|
|
dm_table_get(t);
|
|
read_unlock(&md->map_lock);
|
|
|
|
return t;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------
|
|
* CRUD START:
|
|
* A more elegant soln is in the works that uses the queue
|
|
* merge fn, unfortunately there are a couple of changes to
|
|
* the block layer that I want to make for this. So in the
|
|
* interests of getting something for people to use I give
|
|
* you this clearly demarcated crap.
|
|
*---------------------------------------------------------------*/
|
|
|
|
/*
|
|
* Decrements the number of outstanding ios that a bio has been
|
|
* cloned into, completing the original io if necc.
|
|
*/
|
|
static void dec_pending(struct dm_io *io, int error)
|
|
{
|
|
if (error)
|
|
io->error = error;
|
|
|
|
if (atomic_dec_and_test(&io->io_count)) {
|
|
if (end_io_acct(io))
|
|
/* nudge anyone waiting on suspend queue */
|
|
wake_up(&io->md->wait);
|
|
|
|
blk_add_trace_bio(io->md->queue, io->bio, BLK_TA_COMPLETE);
|
|
|
|
bio_endio(io->bio, io->bio->bi_size, io->error);
|
|
free_io(io->md, io);
|
|
}
|
|
}
|
|
|
|
static int clone_endio(struct bio *bio, unsigned int done, int error)
|
|
{
|
|
int r = 0;
|
|
struct target_io *tio = bio->bi_private;
|
|
struct dm_io *io = tio->io;
|
|
dm_endio_fn endio = tio->ti->type->end_io;
|
|
|
|
if (bio->bi_size)
|
|
return 1;
|
|
|
|
if (!bio_flagged(bio, BIO_UPTODATE) && !error)
|
|
error = -EIO;
|
|
|
|
if (endio) {
|
|
r = endio(tio->ti, bio, error, &tio->info);
|
|
if (r < 0)
|
|
error = r;
|
|
|
|
else if (r > 0)
|
|
/* the target wants another shot at the io */
|
|
return 1;
|
|
}
|
|
|
|
free_tio(io->md, tio);
|
|
dec_pending(io, error);
|
|
bio_put(bio);
|
|
return r;
|
|
}
|
|
|
|
static sector_t max_io_len(struct mapped_device *md,
|
|
sector_t sector, struct dm_target *ti)
|
|
{
|
|
sector_t offset = sector - ti->begin;
|
|
sector_t len = ti->len - offset;
|
|
|
|
/*
|
|
* Does the target need to split even further ?
|
|
*/
|
|
if (ti->split_io) {
|
|
sector_t boundary;
|
|
boundary = ((offset + ti->split_io) & ~(ti->split_io - 1))
|
|
- offset;
|
|
if (len > boundary)
|
|
len = boundary;
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
static void __map_bio(struct dm_target *ti, struct bio *clone,
|
|
struct target_io *tio)
|
|
{
|
|
int r;
|
|
sector_t sector;
|
|
|
|
/*
|
|
* Sanity checks.
|
|
*/
|
|
BUG_ON(!clone->bi_size);
|
|
|
|
clone->bi_end_io = clone_endio;
|
|
clone->bi_private = tio;
|
|
|
|
/*
|
|
* Map the clone. If r == 0 we don't need to do
|
|
* anything, the target has assumed ownership of
|
|
* this io.
|
|
*/
|
|
atomic_inc(&tio->io->io_count);
|
|
sector = clone->bi_sector;
|
|
r = ti->type->map(ti, clone, &tio->info);
|
|
if (r > 0) {
|
|
/* the bio has been remapped so dispatch it */
|
|
|
|
blk_add_trace_remap(bdev_get_queue(clone->bi_bdev), clone,
|
|
tio->io->bio->bi_bdev->bd_dev, sector,
|
|
clone->bi_sector);
|
|
|
|
generic_make_request(clone);
|
|
}
|
|
|
|
else if (r < 0) {
|
|
/* error the io and bail out */
|
|
struct dm_io *io = tio->io;
|
|
free_tio(tio->io->md, tio);
|
|
dec_pending(io, r);
|
|
bio_put(clone);
|
|
}
|
|
}
|
|
|
|
struct clone_info {
|
|
struct mapped_device *md;
|
|
struct dm_table *map;
|
|
struct bio *bio;
|
|
struct dm_io *io;
|
|
sector_t sector;
|
|
sector_t sector_count;
|
|
unsigned short idx;
|
|
};
|
|
|
|
static void dm_bio_destructor(struct bio *bio)
|
|
{
|
|
bio_free(bio, dm_set);
|
|
}
|
|
|
|
/*
|
|
* Creates a little bio that is just does part of a bvec.
|
|
*/
|
|
static struct bio *split_bvec(struct bio *bio, sector_t sector,
|
|
unsigned short idx, unsigned int offset,
|
|
unsigned int len)
|
|
{
|
|
struct bio *clone;
|
|
struct bio_vec *bv = bio->bi_io_vec + idx;
|
|
|
|
clone = bio_alloc_bioset(GFP_NOIO, 1, dm_set);
|
|
clone->bi_destructor = dm_bio_destructor;
|
|
*clone->bi_io_vec = *bv;
|
|
|
|
clone->bi_sector = sector;
|
|
clone->bi_bdev = bio->bi_bdev;
|
|
clone->bi_rw = bio->bi_rw;
|
|
clone->bi_vcnt = 1;
|
|
clone->bi_size = to_bytes(len);
|
|
clone->bi_io_vec->bv_offset = offset;
|
|
clone->bi_io_vec->bv_len = clone->bi_size;
|
|
|
|
return clone;
|
|
}
|
|
|
|
/*
|
|
* Creates a bio that consists of range of complete bvecs.
|
|
*/
|
|
static struct bio *clone_bio(struct bio *bio, sector_t sector,
|
|
unsigned short idx, unsigned short bv_count,
|
|
unsigned int len)
|
|
{
|
|
struct bio *clone;
|
|
|
|
clone = bio_clone(bio, GFP_NOIO);
|
|
clone->bi_sector = sector;
|
|
clone->bi_idx = idx;
|
|
clone->bi_vcnt = idx + bv_count;
|
|
clone->bi_size = to_bytes(len);
|
|
clone->bi_flags &= ~(1 << BIO_SEG_VALID);
|
|
|
|
return clone;
|
|
}
|
|
|
|
static void __clone_and_map(struct clone_info *ci)
|
|
{
|
|
struct bio *clone, *bio = ci->bio;
|
|
struct dm_target *ti = dm_table_find_target(ci->map, ci->sector);
|
|
sector_t len = 0, max = max_io_len(ci->md, ci->sector, ti);
|
|
struct target_io *tio;
|
|
|
|
/*
|
|
* Allocate a target io object.
|
|
*/
|
|
tio = alloc_tio(ci->md);
|
|
tio->io = ci->io;
|
|
tio->ti = ti;
|
|
memset(&tio->info, 0, sizeof(tio->info));
|
|
|
|
if (ci->sector_count <= max) {
|
|
/*
|
|
* Optimise for the simple case where we can do all of
|
|
* the remaining io with a single clone.
|
|
*/
|
|
clone = clone_bio(bio, ci->sector, ci->idx,
|
|
bio->bi_vcnt - ci->idx, ci->sector_count);
|
|
__map_bio(ti, clone, tio);
|
|
ci->sector_count = 0;
|
|
|
|
} else if (to_sector(bio->bi_io_vec[ci->idx].bv_len) <= max) {
|
|
/*
|
|
* There are some bvecs that don't span targets.
|
|
* Do as many of these as possible.
|
|
*/
|
|
int i;
|
|
sector_t remaining = max;
|
|
sector_t bv_len;
|
|
|
|
for (i = ci->idx; remaining && (i < bio->bi_vcnt); i++) {
|
|
bv_len = to_sector(bio->bi_io_vec[i].bv_len);
|
|
|
|
if (bv_len > remaining)
|
|
break;
|
|
|
|
remaining -= bv_len;
|
|
len += bv_len;
|
|
}
|
|
|
|
clone = clone_bio(bio, ci->sector, ci->idx, i - ci->idx, len);
|
|
__map_bio(ti, clone, tio);
|
|
|
|
ci->sector += len;
|
|
ci->sector_count -= len;
|
|
ci->idx = i;
|
|
|
|
} else {
|
|
/*
|
|
* Handle a bvec that must be split between two or more targets.
|
|
*/
|
|
struct bio_vec *bv = bio->bi_io_vec + ci->idx;
|
|
sector_t remaining = to_sector(bv->bv_len);
|
|
unsigned int offset = 0;
|
|
|
|
do {
|
|
if (offset) {
|
|
ti = dm_table_find_target(ci->map, ci->sector);
|
|
max = max_io_len(ci->md, ci->sector, ti);
|
|
|
|
tio = alloc_tio(ci->md);
|
|
tio->io = ci->io;
|
|
tio->ti = ti;
|
|
memset(&tio->info, 0, sizeof(tio->info));
|
|
}
|
|
|
|
len = min(remaining, max);
|
|
|
|
clone = split_bvec(bio, ci->sector, ci->idx,
|
|
bv->bv_offset + offset, len);
|
|
|
|
__map_bio(ti, clone, tio);
|
|
|
|
ci->sector += len;
|
|
ci->sector_count -= len;
|
|
offset += to_bytes(len);
|
|
} while (remaining -= len);
|
|
|
|
ci->idx++;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Split the bio into several clones.
|
|
*/
|
|
static void __split_bio(struct mapped_device *md, struct bio *bio)
|
|
{
|
|
struct clone_info ci;
|
|
|
|
ci.map = dm_get_table(md);
|
|
if (!ci.map) {
|
|
bio_io_error(bio, bio->bi_size);
|
|
return;
|
|
}
|
|
|
|
ci.md = md;
|
|
ci.bio = bio;
|
|
ci.io = alloc_io(md);
|
|
ci.io->error = 0;
|
|
atomic_set(&ci.io->io_count, 1);
|
|
ci.io->bio = bio;
|
|
ci.io->md = md;
|
|
ci.sector = bio->bi_sector;
|
|
ci.sector_count = bio_sectors(bio);
|
|
ci.idx = bio->bi_idx;
|
|
|
|
start_io_acct(ci.io);
|
|
while (ci.sector_count)
|
|
__clone_and_map(&ci);
|
|
|
|
/* drop the extra reference count */
|
|
dec_pending(ci.io, 0);
|
|
dm_table_put(ci.map);
|
|
}
|
|
/*-----------------------------------------------------------------
|
|
* CRUD END
|
|
*---------------------------------------------------------------*/
|
|
|
|
/*
|
|
* The request function that just remaps the bio built up by
|
|
* dm_merge_bvec.
|
|
*/
|
|
static int dm_request(request_queue_t *q, struct bio *bio)
|
|
{
|
|
int r;
|
|
int rw = bio_data_dir(bio);
|
|
struct mapped_device *md = q->queuedata;
|
|
|
|
down_read(&md->io_lock);
|
|
|
|
disk_stat_inc(dm_disk(md), ios[rw]);
|
|
disk_stat_add(dm_disk(md), sectors[rw], bio_sectors(bio));
|
|
|
|
/*
|
|
* If we're suspended we have to queue
|
|
* this io for later.
|
|
*/
|
|
while (test_bit(DMF_BLOCK_IO, &md->flags)) {
|
|
up_read(&md->io_lock);
|
|
|
|
if (bio_rw(bio) == READA) {
|
|
bio_io_error(bio, bio->bi_size);
|
|
return 0;
|
|
}
|
|
|
|
r = queue_io(md, bio);
|
|
if (r < 0) {
|
|
bio_io_error(bio, bio->bi_size);
|
|
return 0;
|
|
|
|
} else if (r == 0)
|
|
return 0; /* deferred successfully */
|
|
|
|
/*
|
|
* We're in a while loop, because someone could suspend
|
|
* before we get to the following read lock.
|
|
*/
|
|
down_read(&md->io_lock);
|
|
}
|
|
|
|
__split_bio(md, bio);
|
|
up_read(&md->io_lock);
|
|
return 0;
|
|
}
|
|
|
|
static int dm_flush_all(request_queue_t *q, struct gendisk *disk,
|
|
sector_t *error_sector)
|
|
{
|
|
struct mapped_device *md = q->queuedata;
|
|
struct dm_table *map = dm_get_table(md);
|
|
int ret = -ENXIO;
|
|
|
|
if (map) {
|
|
ret = dm_table_flush_all(map);
|
|
dm_table_put(map);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void dm_unplug_all(request_queue_t *q)
|
|
{
|
|
struct mapped_device *md = q->queuedata;
|
|
struct dm_table *map = dm_get_table(md);
|
|
|
|
if (map) {
|
|
dm_table_unplug_all(map);
|
|
dm_table_put(map);
|
|
}
|
|
}
|
|
|
|
static int dm_any_congested(void *congested_data, int bdi_bits)
|
|
{
|
|
int r;
|
|
struct mapped_device *md = (struct mapped_device *) congested_data;
|
|
struct dm_table *map = dm_get_table(md);
|
|
|
|
if (!map || test_bit(DMF_BLOCK_IO, &md->flags))
|
|
r = bdi_bits;
|
|
else
|
|
r = dm_table_any_congested(map, bdi_bits);
|
|
|
|
dm_table_put(map);
|
|
return r;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------
|
|
* An IDR is used to keep track of allocated minor numbers.
|
|
*---------------------------------------------------------------*/
|
|
static DECLARE_MUTEX(_minor_lock);
|
|
static DEFINE_IDR(_minor_idr);
|
|
|
|
static void free_minor(unsigned int minor)
|
|
{
|
|
down(&_minor_lock);
|
|
idr_remove(&_minor_idr, minor);
|
|
up(&_minor_lock);
|
|
}
|
|
|
|
/*
|
|
* See if the device with a specific minor # is free.
|
|
*/
|
|
static int specific_minor(struct mapped_device *md, unsigned int minor)
|
|
{
|
|
int r, m;
|
|
|
|
if (minor >= (1 << MINORBITS))
|
|
return -EINVAL;
|
|
|
|
down(&_minor_lock);
|
|
|
|
if (idr_find(&_minor_idr, minor)) {
|
|
r = -EBUSY;
|
|
goto out;
|
|
}
|
|
|
|
r = idr_pre_get(&_minor_idr, GFP_KERNEL);
|
|
if (!r) {
|
|
r = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
r = idr_get_new_above(&_minor_idr, md, minor, &m);
|
|
if (r) {
|
|
goto out;
|
|
}
|
|
|
|
if (m != minor) {
|
|
idr_remove(&_minor_idr, m);
|
|
r = -EBUSY;
|
|
goto out;
|
|
}
|
|
|
|
out:
|
|
up(&_minor_lock);
|
|
return r;
|
|
}
|
|
|
|
static int next_free_minor(struct mapped_device *md, unsigned int *minor)
|
|
{
|
|
int r;
|
|
unsigned int m;
|
|
|
|
down(&_minor_lock);
|
|
|
|
r = idr_pre_get(&_minor_idr, GFP_KERNEL);
|
|
if (!r) {
|
|
r = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
r = idr_get_new(&_minor_idr, md, &m);
|
|
if (r) {
|
|
goto out;
|
|
}
|
|
|
|
if (m >= (1 << MINORBITS)) {
|
|
idr_remove(&_minor_idr, m);
|
|
r = -ENOSPC;
|
|
goto out;
|
|
}
|
|
|
|
*minor = m;
|
|
|
|
out:
|
|
up(&_minor_lock);
|
|
return r;
|
|
}
|
|
|
|
static struct block_device_operations dm_blk_dops;
|
|
|
|
/*
|
|
* Allocate and initialise a blank device with a given minor.
|
|
*/
|
|
static struct mapped_device *alloc_dev(unsigned int minor, int persistent)
|
|
{
|
|
int r;
|
|
struct mapped_device *md = kmalloc(sizeof(*md), GFP_KERNEL);
|
|
|
|
if (!md) {
|
|
DMWARN("unable to allocate device, out of memory.");
|
|
return NULL;
|
|
}
|
|
|
|
/* get a minor number for the dev */
|
|
r = persistent ? specific_minor(md, minor) : next_free_minor(md, &minor);
|
|
if (r < 0)
|
|
goto bad1;
|
|
|
|
memset(md, 0, sizeof(*md));
|
|
init_rwsem(&md->io_lock);
|
|
init_MUTEX(&md->suspend_lock);
|
|
rwlock_init(&md->map_lock);
|
|
atomic_set(&md->holders, 1);
|
|
atomic_set(&md->event_nr, 0);
|
|
|
|
md->queue = blk_alloc_queue(GFP_KERNEL);
|
|
if (!md->queue)
|
|
goto bad1;
|
|
|
|
md->queue->queuedata = md;
|
|
md->queue->backing_dev_info.congested_fn = dm_any_congested;
|
|
md->queue->backing_dev_info.congested_data = md;
|
|
blk_queue_make_request(md->queue, dm_request);
|
|
blk_queue_bounce_limit(md->queue, BLK_BOUNCE_ANY);
|
|
md->queue->unplug_fn = dm_unplug_all;
|
|
md->queue->issue_flush_fn = dm_flush_all;
|
|
|
|
md->io_pool = mempool_create(MIN_IOS, mempool_alloc_slab,
|
|
mempool_free_slab, _io_cache);
|
|
if (!md->io_pool)
|
|
goto bad2;
|
|
|
|
md->tio_pool = mempool_create(MIN_IOS, mempool_alloc_slab,
|
|
mempool_free_slab, _tio_cache);
|
|
if (!md->tio_pool)
|
|
goto bad3;
|
|
|
|
md->disk = alloc_disk(1);
|
|
if (!md->disk)
|
|
goto bad4;
|
|
|
|
md->disk->major = _major;
|
|
md->disk->first_minor = minor;
|
|
md->disk->fops = &dm_blk_dops;
|
|
md->disk->queue = md->queue;
|
|
md->disk->private_data = md;
|
|
sprintf(md->disk->disk_name, "dm-%d", minor);
|
|
add_disk(md->disk);
|
|
|
|
atomic_set(&md->pending, 0);
|
|
init_waitqueue_head(&md->wait);
|
|
init_waitqueue_head(&md->eventq);
|
|
|
|
return md;
|
|
|
|
bad4:
|
|
mempool_destroy(md->tio_pool);
|
|
bad3:
|
|
mempool_destroy(md->io_pool);
|
|
bad2:
|
|
blk_cleanup_queue(md->queue);
|
|
free_minor(minor);
|
|
bad1:
|
|
kfree(md);
|
|
return NULL;
|
|
}
|
|
|
|
static void free_dev(struct mapped_device *md)
|
|
{
|
|
unsigned int minor = md->disk->first_minor;
|
|
|
|
if (md->suspended_bdev) {
|
|
thaw_bdev(md->suspended_bdev, NULL);
|
|
bdput(md->suspended_bdev);
|
|
}
|
|
mempool_destroy(md->tio_pool);
|
|
mempool_destroy(md->io_pool);
|
|
del_gendisk(md->disk);
|
|
free_minor(minor);
|
|
put_disk(md->disk);
|
|
blk_cleanup_queue(md->queue);
|
|
kfree(md);
|
|
}
|
|
|
|
/*
|
|
* Bind a table to the device.
|
|
*/
|
|
static void event_callback(void *context)
|
|
{
|
|
struct mapped_device *md = (struct mapped_device *) context;
|
|
|
|
atomic_inc(&md->event_nr);
|
|
wake_up(&md->eventq);
|
|
}
|
|
|
|
static void __set_size(struct mapped_device *md, sector_t size)
|
|
{
|
|
set_capacity(md->disk, size);
|
|
|
|
mutex_lock(&md->suspended_bdev->bd_inode->i_mutex);
|
|
i_size_write(md->suspended_bdev->bd_inode, (loff_t)size << SECTOR_SHIFT);
|
|
mutex_unlock(&md->suspended_bdev->bd_inode->i_mutex);
|
|
}
|
|
|
|
static int __bind(struct mapped_device *md, struct dm_table *t)
|
|
{
|
|
request_queue_t *q = md->queue;
|
|
sector_t size;
|
|
|
|
size = dm_table_get_size(t);
|
|
__set_size(md, size);
|
|
if (size == 0)
|
|
return 0;
|
|
|
|
dm_table_get(t);
|
|
dm_table_event_callback(t, event_callback, md);
|
|
|
|
write_lock(&md->map_lock);
|
|
md->map = t;
|
|
dm_table_set_restrictions(t, q);
|
|
write_unlock(&md->map_lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void __unbind(struct mapped_device *md)
|
|
{
|
|
struct dm_table *map = md->map;
|
|
|
|
if (!map)
|
|
return;
|
|
|
|
dm_table_event_callback(map, NULL, NULL);
|
|
write_lock(&md->map_lock);
|
|
md->map = NULL;
|
|
write_unlock(&md->map_lock);
|
|
dm_table_put(map);
|
|
}
|
|
|
|
/*
|
|
* Constructor for a new device.
|
|
*/
|
|
static int create_aux(unsigned int minor, int persistent,
|
|
struct mapped_device **result)
|
|
{
|
|
struct mapped_device *md;
|
|
|
|
md = alloc_dev(minor, persistent);
|
|
if (!md)
|
|
return -ENXIO;
|
|
|
|
*result = md;
|
|
return 0;
|
|
}
|
|
|
|
int dm_create(struct mapped_device **result)
|
|
{
|
|
return create_aux(0, 0, result);
|
|
}
|
|
|
|
int dm_create_with_minor(unsigned int minor, struct mapped_device **result)
|
|
{
|
|
return create_aux(minor, 1, result);
|
|
}
|
|
|
|
static struct mapped_device *dm_find_md(dev_t dev)
|
|
{
|
|
struct mapped_device *md;
|
|
unsigned minor = MINOR(dev);
|
|
|
|
if (MAJOR(dev) != _major || minor >= (1 << MINORBITS))
|
|
return NULL;
|
|
|
|
down(&_minor_lock);
|
|
|
|
md = idr_find(&_minor_idr, minor);
|
|
if (!md || (dm_disk(md)->first_minor != minor))
|
|
md = NULL;
|
|
|
|
up(&_minor_lock);
|
|
|
|
return md;
|
|
}
|
|
|
|
struct mapped_device *dm_get_md(dev_t dev)
|
|
{
|
|
struct mapped_device *md = dm_find_md(dev);
|
|
|
|
if (md)
|
|
dm_get(md);
|
|
|
|
return md;
|
|
}
|
|
|
|
void *dm_get_mdptr(dev_t dev)
|
|
{
|
|
struct mapped_device *md;
|
|
void *mdptr = NULL;
|
|
|
|
md = dm_find_md(dev);
|
|
if (md)
|
|
mdptr = md->interface_ptr;
|
|
return mdptr;
|
|
}
|
|
|
|
void dm_set_mdptr(struct mapped_device *md, void *ptr)
|
|
{
|
|
md->interface_ptr = ptr;
|
|
}
|
|
|
|
void dm_get(struct mapped_device *md)
|
|
{
|
|
atomic_inc(&md->holders);
|
|
}
|
|
|
|
void dm_put(struct mapped_device *md)
|
|
{
|
|
struct dm_table *map = dm_get_table(md);
|
|
|
|
if (atomic_dec_and_test(&md->holders)) {
|
|
if (!dm_suspended(md)) {
|
|
dm_table_presuspend_targets(map);
|
|
dm_table_postsuspend_targets(map);
|
|
}
|
|
__unbind(md);
|
|
free_dev(md);
|
|
}
|
|
|
|
dm_table_put(map);
|
|
}
|
|
|
|
/*
|
|
* Process the deferred bios
|
|
*/
|
|
static void __flush_deferred_io(struct mapped_device *md, struct bio *c)
|
|
{
|
|
struct bio *n;
|
|
|
|
while (c) {
|
|
n = c->bi_next;
|
|
c->bi_next = NULL;
|
|
__split_bio(md, c);
|
|
c = n;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Swap in a new table (destroying old one).
|
|
*/
|
|
int dm_swap_table(struct mapped_device *md, struct dm_table *table)
|
|
{
|
|
int r = -EINVAL;
|
|
|
|
down(&md->suspend_lock);
|
|
|
|
/* device must be suspended */
|
|
if (!dm_suspended(md))
|
|
goto out;
|
|
|
|
__unbind(md);
|
|
r = __bind(md, table);
|
|
|
|
out:
|
|
up(&md->suspend_lock);
|
|
return r;
|
|
}
|
|
|
|
/*
|
|
* Functions to lock and unlock any filesystem running on the
|
|
* device.
|
|
*/
|
|
static int lock_fs(struct mapped_device *md)
|
|
{
|
|
int r;
|
|
|
|
WARN_ON(md->frozen_sb);
|
|
|
|
md->frozen_sb = freeze_bdev(md->suspended_bdev);
|
|
if (IS_ERR(md->frozen_sb)) {
|
|
r = PTR_ERR(md->frozen_sb);
|
|
md->frozen_sb = NULL;
|
|
return r;
|
|
}
|
|
|
|
set_bit(DMF_FROZEN, &md->flags);
|
|
|
|
/* don't bdput right now, we don't want the bdev
|
|
* to go away while it is locked.
|
|
*/
|
|
return 0;
|
|
}
|
|
|
|
static void unlock_fs(struct mapped_device *md)
|
|
{
|
|
if (!test_bit(DMF_FROZEN, &md->flags))
|
|
return;
|
|
|
|
thaw_bdev(md->suspended_bdev, md->frozen_sb);
|
|
md->frozen_sb = NULL;
|
|
clear_bit(DMF_FROZEN, &md->flags);
|
|
}
|
|
|
|
/*
|
|
* We need to be able to change a mapping table under a mounted
|
|
* filesystem. For example we might want to move some data in
|
|
* the background. Before the table can be swapped with
|
|
* dm_bind_table, dm_suspend must be called to flush any in
|
|
* flight bios and ensure that any further io gets deferred.
|
|
*/
|
|
int dm_suspend(struct mapped_device *md, int do_lockfs)
|
|
{
|
|
struct dm_table *map = NULL;
|
|
DECLARE_WAITQUEUE(wait, current);
|
|
int r = -EINVAL;
|
|
|
|
down(&md->suspend_lock);
|
|
|
|
if (dm_suspended(md))
|
|
goto out;
|
|
|
|
map = dm_get_table(md);
|
|
|
|
/* This does not get reverted if there's an error later. */
|
|
dm_table_presuspend_targets(map);
|
|
|
|
md->suspended_bdev = bdget_disk(md->disk, 0);
|
|
if (!md->suspended_bdev) {
|
|
DMWARN("bdget failed in dm_suspend");
|
|
r = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
/* Flush I/O to the device. */
|
|
if (do_lockfs) {
|
|
r = lock_fs(md);
|
|
if (r)
|
|
goto out;
|
|
}
|
|
|
|
/*
|
|
* First we set the BLOCK_IO flag so no more ios will be mapped.
|
|
*/
|
|
down_write(&md->io_lock);
|
|
set_bit(DMF_BLOCK_IO, &md->flags);
|
|
|
|
add_wait_queue(&md->wait, &wait);
|
|
up_write(&md->io_lock);
|
|
|
|
/* unplug */
|
|
if (map)
|
|
dm_table_unplug_all(map);
|
|
|
|
/*
|
|
* Then we wait for the already mapped ios to
|
|
* complete.
|
|
*/
|
|
while (1) {
|
|
set_current_state(TASK_INTERRUPTIBLE);
|
|
|
|
if (!atomic_read(&md->pending) || signal_pending(current))
|
|
break;
|
|
|
|
io_schedule();
|
|
}
|
|
set_current_state(TASK_RUNNING);
|
|
|
|
down_write(&md->io_lock);
|
|
remove_wait_queue(&md->wait, &wait);
|
|
|
|
/* were we interrupted ? */
|
|
r = -EINTR;
|
|
if (atomic_read(&md->pending)) {
|
|
up_write(&md->io_lock);
|
|
unlock_fs(md);
|
|
clear_bit(DMF_BLOCK_IO, &md->flags);
|
|
goto out;
|
|
}
|
|
up_write(&md->io_lock);
|
|
|
|
dm_table_postsuspend_targets(map);
|
|
|
|
set_bit(DMF_SUSPENDED, &md->flags);
|
|
|
|
r = 0;
|
|
|
|
out:
|
|
if (r && md->suspended_bdev) {
|
|
bdput(md->suspended_bdev);
|
|
md->suspended_bdev = NULL;
|
|
}
|
|
|
|
dm_table_put(map);
|
|
up(&md->suspend_lock);
|
|
return r;
|
|
}
|
|
|
|
int dm_resume(struct mapped_device *md)
|
|
{
|
|
int r = -EINVAL;
|
|
struct bio *def;
|
|
struct dm_table *map = NULL;
|
|
|
|
down(&md->suspend_lock);
|
|
if (!dm_suspended(md))
|
|
goto out;
|
|
|
|
map = dm_get_table(md);
|
|
if (!map || !dm_table_get_size(map))
|
|
goto out;
|
|
|
|
dm_table_resume_targets(map);
|
|
|
|
down_write(&md->io_lock);
|
|
clear_bit(DMF_BLOCK_IO, &md->flags);
|
|
|
|
def = bio_list_get(&md->deferred);
|
|
__flush_deferred_io(md, def);
|
|
up_write(&md->io_lock);
|
|
|
|
unlock_fs(md);
|
|
|
|
bdput(md->suspended_bdev);
|
|
md->suspended_bdev = NULL;
|
|
|
|
clear_bit(DMF_SUSPENDED, &md->flags);
|
|
|
|
dm_table_unplug_all(map);
|
|
|
|
r = 0;
|
|
|
|
out:
|
|
dm_table_put(map);
|
|
up(&md->suspend_lock);
|
|
|
|
return r;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------
|
|
* Event notification.
|
|
*---------------------------------------------------------------*/
|
|
uint32_t dm_get_event_nr(struct mapped_device *md)
|
|
{
|
|
return atomic_read(&md->event_nr);
|
|
}
|
|
|
|
int dm_wait_event(struct mapped_device *md, int event_nr)
|
|
{
|
|
return wait_event_interruptible(md->eventq,
|
|
(event_nr != atomic_read(&md->event_nr)));
|
|
}
|
|
|
|
/*
|
|
* The gendisk is only valid as long as you have a reference
|
|
* count on 'md'.
|
|
*/
|
|
struct gendisk *dm_disk(struct mapped_device *md)
|
|
{
|
|
return md->disk;
|
|
}
|
|
|
|
int dm_suspended(struct mapped_device *md)
|
|
{
|
|
return test_bit(DMF_SUSPENDED, &md->flags);
|
|
}
|
|
|
|
static struct block_device_operations dm_blk_dops = {
|
|
.open = dm_blk_open,
|
|
.release = dm_blk_close,
|
|
.owner = THIS_MODULE
|
|
};
|
|
|
|
EXPORT_SYMBOL(dm_get_mapinfo);
|
|
|
|
/*
|
|
* module hooks
|
|
*/
|
|
module_init(dm_init);
|
|
module_exit(dm_exit);
|
|
|
|
module_param(major, uint, 0);
|
|
MODULE_PARM_DESC(major, "The major number of the device mapper");
|
|
MODULE_DESCRIPTION(DM_NAME " driver");
|
|
MODULE_AUTHOR("Joe Thornber <dm-devel@redhat.com>");
|
|
MODULE_LICENSE("GPL");
|