Release 4.14 drivers/mtd/mtdblock.c

/*
 * Direct MTD block device access
 *
 * Copyright © 1999-2010 David Woodhouse <dwmw2@infradead.org>
 * Copyright © 2000-2003 Nicolas Pitre <nico@fluxnic.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */

#include <linux/fs.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/types.h>
#include <linux/vmalloc.h>

#include <linux/mtd/mtd.h>
#include <linux/mtd/blktrans.h>
#include <linux/mutex.h>
#include <linux/major.h>



struct mtdblk_dev {
	
struct mtd_blktrans_dev mbd;
	
int count;
	
struct mutex cache_mutex;
	
unsigned char *cache_data;
	
unsigned long cache_offset;
	
unsigned int cache_size;
	



enum { STATE_EMPTY, STATE_CLEAN, STATE_DIRTY } cache_state;
};

/*
 * Cache stuff...
 *
 * Since typical flash erasable sectors are much larger than what Linux's
 * buffer cache can handle, we must implement read-modify-write on flash
 * sectors for each block write requests.  To avoid over-erasing flash sectors
 * and to speed things up, we locally cache a whole flash sector while it is
 * being written to until a different sector is required.
 */



static void erase_callback(struct erase_info *done)
{
	wait_queue_head_t *wait_q = (wait_queue_head_t *)done->priv;
	wake_up(wait_q);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
28
100.00%
2
100.00%
Total
28
100.00%
2
100.00%



static int erase_write (struct mtd_info *mtd, unsigned long pos,
			int len, const char *buf)
{
	struct erase_info erase;
	DECLARE_WAITQUEUE(wait, current);
	wait_queue_head_t wait_q;
	size_t retlen;
	int ret;

	/*
         * First, let's erase the flash block.
         */

	init_waitqueue_head(&wait_q);
	erase.mtd = mtd;
	erase.callback = erase_callback;
	erase.addr = pos;
	erase.len = len;
	erase.priv = (u_long)&wait_q;

	set_current_state(TASK_INTERRUPTIBLE);
	add_wait_queue(&wait_q, &wait);

	ret = mtd_erase(mtd, &erase);
	if (ret) {
		set_current_state(TASK_RUNNING);
		remove_wait_queue(&wait_q, &wait);
		printk (KERN_WARNING "mtdblock: erase of region [0x%lx, 0x%x] "
				     "on \"%s\" failed\n",
			pos, len, mtd->name);
		return ret;
	}

	schedule();  /* Wait for erase to finish. */
	remove_wait_queue(&wait_q, &wait);

	/*
         * Next, write the data to flash.
         */

	ret = mtd_write(mtd, pos, len, &retlen, buf);
	if (ret)
		return ret;
	if (retlen != len)
		return -EIO;
	return 0;
}


Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
193
98.47%
2
40.00%
Artem B. Bityutskiy
2
1.02%
2
40.00%
Matthias Kaehlcke
1
0.51%
1
20.00%
Total
196
100.00%
5
100.00%



static int write_cached_data (struct mtdblk_dev *mtdblk)
{
	struct mtd_info *mtd = mtdblk->mbd.mtd;
	int ret;

	if (mtdblk->cache_state != STATE_DIRTY)
		return 0;

	pr_debug("mtdblock: writing cached data for \"%s\" "
			"at 0x%lx, size 0x%x\n", mtd->name,
			mtdblk->cache_offset, mtdblk->cache_size);

	ret = erase_write (mtd, mtdblk->cache_offset,
			   mtdblk->cache_size, mtdblk->cache_data);
	if (ret)
		return ret;

	/*
         * Here we could arguably set the cache state to STATE_CLEAN.
         * However this could lead to inconsistency since we will not
         * be notified if this content is altered on the flash by other
         * means.  Let's declare it empty and leave buffering tasks to
         * the buffer cache instead.
         */
	mtdblk->cache_state = STATE_EMPTY;
	return 0;
}


Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
86
95.56%
1
25.00%
Ben Hutchings
2
2.22%
1
25.00%
Brian Norris
1
1.11%
1
25.00%
Lucas De Marchi
1
1.11%
1
25.00%
Total
90
100.00%
4
100.00%



static int do_cached_write (struct mtdblk_dev *mtdblk, unsigned long pos,
			    int len, const char *buf)
{
	struct mtd_info *mtd = mtdblk->mbd.mtd;
	unsigned int sect_size = mtdblk->cache_size;
	size_t retlen;
	int ret;

	pr_debug("mtdblock: write on \"%s\" at 0x%lx, size 0x%x\n",
		mtd->name, pos, len);

	if (!sect_size)
		return mtd_write(mtd, pos, len, &retlen, buf);

	while (len > 0) {
		unsigned long sect_start = (pos/sect_size)*sect_size;
		unsigned int offset = pos - sect_start;
		unsigned int size = sect_size - offset;
		if( size > len )
			size = len;

		if (size == sect_size) {
			/*
                         * We are covering a whole sector.  Thus there is no
                         * need to bother with the cache while it may still be
                         * useful for other partial writes.
                         */
			ret = erase_write (mtd, pos, size, buf);
			if (ret)
				return ret;
		} else {
			/* Partial sector: need to use the cache */

			if (mtdblk->cache_state == STATE_DIRTY &&
			    mtdblk->cache_offset != sect_start) {
				ret = write_cached_data(mtdblk);
				if (ret)
					return ret;
			}

			if (mtdblk->cache_state == STATE_EMPTY ||
			    mtdblk->cache_offset != sect_start) {
				/* fill the cache with the current sector */
				mtdblk->cache_state = STATE_EMPTY;
				ret = mtd_read(mtd, sect_start, sect_size,
					       &retlen, mtdblk->cache_data);
				if (ret)
					return ret;
				if (retlen != sect_size)
					return -EIO;

				mtdblk->cache_offset = sect_start;
				mtdblk->cache_size = sect_size;
				mtdblk->cache_state = STATE_CLEAN;
			}

			/* write data to our local cache */
			memcpy (mtdblk->cache_data + offset, buf, size);
			mtdblk->cache_state = STATE_DIRTY;
		}

		buf += size;
		pos += size;
		len -= size;
	}

	return 0;
}


Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
274
91.03%
1
14.29%
Linus Torvalds
21
6.98%
1
14.29%
Ben Hutchings
2
0.66%
1
14.29%
Artem B. Bityutskiy
2
0.66%
2
28.57%
Brian Norris
1
0.33%
1
14.29%
Thomas Gleixner
1
0.33%
1
14.29%
Total
301
100.00%
7
100.00%



static int do_cached_read (struct mtdblk_dev *mtdblk, unsigned long pos,
			   int len, char *buf)
{
	struct mtd_info *mtd = mtdblk->mbd.mtd;
	unsigned int sect_size = mtdblk->cache_size;
	size_t retlen;
	int ret;

	pr_debug("mtdblock: read on \"%s\" at 0x%lx, size 0x%x\n",
			mtd->name, pos, len);

	if (!sect_size)
		return mtd_read(mtd, pos, len, &retlen, buf);

	while (len > 0) {
		unsigned long sect_start = (pos/sect_size)*sect_size;
		unsigned int offset = pos - sect_start;
		unsigned int size = sect_size - offset;
		if (size > len)
			size = len;

		/*
                 * Check if the requested data is already cached
                 * Read the requested amount of data from our internal cache if it
                 * contains what we want, otherwise we read the data directly
                 * from flash.
                 */
		if (mtdblk->cache_state != STATE_EMPTY &&
		    mtdblk->cache_offset == sect_start) {
			memcpy (buf, mtdblk->cache_data + offset, size);
		} else {
			ret = mtd_read(mtd, pos, size, &retlen, buf);
			if (ret)
				return ret;
			if (retlen != size)
				return -EIO;
		}

		buf += size;
		pos += size;
		len -= size;
	}

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
181
87.44%
1
20.00%
Linus Torvalds
21
10.14%
1
20.00%
Artem B. Bityutskiy
2
0.97%
1
20.00%
Ben Hutchings
2
0.97%
1
20.00%
Brian Norris
1
0.48%
1
20.00%
Total
207
100.00%
5
100.00%



static int mtdblock_readsect(struct mtd_blktrans_dev *dev,
			      unsigned long block, char *buf)
{
	struct mtdblk_dev *mtdblk = container_of(dev, struct mtdblk_dev, mbd);
	return do_cached_read(mtdblk, block<<9, 512, buf);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
David Woodhouse
40
83.33%
1
50.00%
Ben Hutchings
8
16.67%
1
50.00%
Total
48
100.00%
2
100.00%



static int mtdblock_writesect(struct mtd_blktrans_dev *dev,
			      unsigned long block, char *buf)
{
	struct mtdblk_dev *mtdblk = container_of(dev, struct mtdblk_dev, mbd);
	if (unlikely(!mtdblk->cache_data && mtdblk->cache_size)) {
		mtdblk->cache_data = vmalloc(mtdblk->mbd.mtd->erasesize);
		if (!mtdblk->cache_data)
			return -EINTR;
		/* -EINTR is not really correct, but it is the best match
                 * documented in man 2 write for all cases.  We could also
                 * return -EAGAIN sometimes, but why bother?
                 */
	}
	return do_cached_write(mtdblk, block<<9, 512, buf);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
David Woodhouse
78
85.71%
3
60.00%
Ben Hutchings
10
10.99%
1
20.00%
Al Viro
3
3.30%
1
20.00%
Total
91
100.00%
5
100.00%



static int mtdblock_open(struct mtd_blktrans_dev *mbd)
{
	struct mtdblk_dev *mtdblk = container_of(mbd, struct mtdblk_dev, mbd);

	pr_debug("mtdblock_open\n");

	if (mtdblk->count) {
		mtdblk->count++;
		return 0;
	}

	/* OK, it's not open. Create cache info for it */
	mtdblk->count = 1;
	mutex_init(&mtdblk->cache_mutex);
	mtdblk->cache_state = STATE_EMPTY;
	if (!(mbd->mtd->flags & MTD_NO_ERASE) && mbd->mtd->erasesize) {
		mtdblk->cache_size = mbd->mtd->erasesize;
		mtdblk->cache_data = NULL;
	}

	pr_debug("ok\n");

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
66
58.41%
2
20.00%
Ben Hutchings
14
12.39%
1
10.00%
Linus Torvalds
12
10.62%
1
10.00%
David Woodhouse
10
8.85%
2
20.00%
Jörn Engel
6
5.31%
1
10.00%
Brian Norris
2
1.77%
1
10.00%
Ingo Molnar
2
1.77%
1
10.00%
Al Viro
1
0.88%
1
10.00%
Total
113
100.00%
10
100.00%



static void mtdblock_release(struct mtd_blktrans_dev *mbd)
{
	struct mtdblk_dev *mtdblk = container_of(mbd, struct mtdblk_dev, mbd);

	pr_debug("mtdblock_release\n");

	mutex_lock(&mtdblk->cache_mutex);
	write_cached_data(mtdblk);
	mutex_unlock(&mtdblk->cache_mutex);

	if (!--mtdblk->count) {
		/*
                 * It was the last usage. Free the cache, but only sync if
                 * opened for writing.
                 */
		if (mbd->file_mode & FMODE_WRITE)
			mtd_sync(mbd->mtd);
		vfree(mtdblk->cache_data);
	}

	pr_debug("ok\n");
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
59
65.56%
2
20.00%
Ben Hutchings
10
11.11%
1
10.00%
Alexander Stein
9
10.00%
1
10.00%
Ingo Molnar
4
4.44%
1
10.00%
David Woodhouse
4
4.44%
2
20.00%
Brian Norris
2
2.22%
1
10.00%
Artem B. Bityutskiy
1
1.11%
1
10.00%
Al Viro
1
1.11%
1
10.00%
Total
90
100.00%
10
100.00%



static int mtdblock_flush(struct mtd_blktrans_dev *dev)
{
	struct mtdblk_dev *mtdblk = container_of(dev, struct mtdblk_dev, mbd);

	mutex_lock(&mtdblk->cache_mutex);
	write_cached_data(mtdblk);
	mutex_unlock(&mtdblk->cache_mutex);
	mtd_sync(dev->mtd);
	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
27
47.37%
2
22.22%
David Woodhouse
11
19.30%
2
22.22%
Ben Hutchings
9
15.79%
1
11.11%
Ingo Molnar
4
7.02%
1
11.11%
Al Viro
3
5.26%
1
11.11%
Jens Axboe
2
3.51%
1
11.11%
Artem B. Bityutskiy
1
1.75%
1
11.11%
Total
57
100.00%
9
100.00%



static void mtdblock_add_mtd(struct mtd_blktrans_ops *tr, struct mtd_info *mtd)
{
	struct mtdblk_dev *dev = kzalloc(sizeof(*dev), GFP_KERNEL);

	if (!dev)
		return;

	dev->mbd.mtd = mtd;
	dev->mbd.devnum = mtd->index;

	dev->mbd.size = mtd->size >> 9;
	dev->mbd.tr = tr;

	if (!(mtd->flags & MTD_WRITEABLE))
		dev->mbd.readonly = 1;

	if (add_mtd_blktrans_dev(&dev->mbd))
		kfree(dev);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
David Woodhouse
44
40.00%
1
12.50%
Al Viro
28
25.45%
2
25.00%
Linus Torvalds (pre-git)
15
13.64%
1
12.50%
Ben Hutchings
14
12.73%
1
12.50%
Maxim Levitsky
7
6.36%
1
12.50%
Christoph Hellwig
1
0.91%
1
12.50%
Burman Yan
1
0.91%
1
12.50%
Total
110
100.00%
8
100.00%



static void mtdblock_remove_dev(struct mtd_blktrans_dev *dev)
{
	del_mtd_blktrans_dev(dev);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
7
43.75%
1
33.33%
David Woodhouse
5
31.25%
1
33.33%
Al Viro
4
25.00%
1
33.33%
Total
16
100.00%
3
100.00%


static struct mtd_blktrans_ops mtdblock_tr = {
	.name		= "mtdblock",
	.major		= MTD_BLOCK_MAJOR,
	.part_bits	= 0,
	.blksize 	= 512,
	.open		= mtdblock_open,
	.flush		= mtdblock_flush,
	.release	= mtdblock_release,
	.readsect	= mtdblock_readsect,
	.writesect	= mtdblock_writesect,
	.add_mtd	= mtdblock_add_mtd,
	.remove_dev	= mtdblock_remove_dev,
	.owner		= THIS_MODULE,
};



static int __init init_mtdblock(void)
{
	return register_mtd_blktrans(&mtdblock_tr);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
12
75.00%
2
40.00%
David Woodhouse
3
18.75%
2
40.00%
Al Viro
1
6.25%
1
20.00%
Total
16
100.00%
5
100.00%



static void __exit cleanup_mtdblock(void)
{
	deregister_mtd_blktrans(&mtdblock_tr);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
12
80.00%
2
50.00%
David Woodhouse
2
13.33%
1
25.00%
Al Viro
1
6.67%
1
25.00%
Total
15
100.00%
4
100.00%


module_init(init_mtdblock);

module_exit(cleanup_mtdblock);


MODULE_LICENSE("GPL");
MODULE_AUTHOR("Nicolas Pitre <nico@fluxnic.net> et al.");
MODULE_DESCRIPTION("Caching read/erase/writeback block device emulation access to MTD devices");
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Linus Torvalds (pre-git)
1018
65.80%
2
5.41%
David Woodhouse
260
16.81%
5
13.51%
Ben Hutchings
73
4.72%
1
2.70%
Linus Torvalds
70
4.52%
1
2.70%
Al Viro
46
2.97%
6
16.22%
Ingo Molnar
15
0.97%
1
2.70%
Alexander Stein
9
0.58%
1
2.70%
Thomas Gleixner
8
0.52%
2
5.41%
Artem B. Bityutskiy
8
0.52%
4
10.81%
Maxim Levitsky
7
0.45%
1
2.70%
Brian Norris
7
0.45%
1
2.70%
Jörn Engel
6
0.39%
1
2.70%
Richard Purdie
5
0.32%
1
2.70%
Ezequiel García
4
0.26%
2
5.41%
Dave Jones
2
0.13%
1
2.70%
Tim Schmielau
2
0.13%
1
2.70%
Jens Axboe
2
0.13%
1
2.70%
Nico Pitre
1
0.06%
1
2.70%
Matthias Kaehlcke
1
0.06%
1
2.70%
Burman Yan
1
0.06%
1
2.70%
Christoph Hellwig
1
0.06%
1
2.70%
Lucas De Marchi
1
0.06%
1
2.70%
Total
1547
100.00%
37
100.00%
Directory: drivers/mtd

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.