2009-11-21 03:13:39 +08:00
|
|
|
/*
|
|
|
|
* fs/logfs/dev_mtd.c - Device access methods for MTD
|
|
|
|
*
|
|
|
|
* As should be obvious for Linux kernel code, license is GPLv2
|
|
|
|
*
|
|
|
|
* Copyright (c) 2005-2008 Joern Engel <joern@logfs.org>
|
|
|
|
*/
|
|
|
|
#include "logfs.h"
|
|
|
|
#include <linux/completion.h>
|
|
|
|
#include <linux/mount.h>
|
|
|
|
#include <linux/sched.h>
|
2010-05-08 01:38:40 +08:00
|
|
|
#include <linux/slab.h>
|
2009-11-21 03:13:39 +08:00
|
|
|
|
|
|
|
#define PAGE_OFS(ofs) ((ofs) & (PAGE_SIZE-1))
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int logfs_mtd_read(struct super_block *sb, loff_t ofs, size_t len,
|
|
|
|
void *buf)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct mtd_info *mtd = logfs_super(sb)->s_mtd;
|
|
|
|
size_t retlen;
|
|
|
|
int ret;
|
|
|
|
|
2011-12-23 23:30:16 +08:00
|
|
|
ret = mtd_read(mtd, ofs, len, &retlen, buf);
|
2009-11-21 03:13:39 +08:00
|
|
|
BUG_ON(ret == -EINVAL);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
/* Not sure if we should loop instead. */
|
|
|
|
if (retlen != len)
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int loffs_mtd_write(struct super_block *sb, loff_t ofs, size_t len,
|
|
|
|
void *buf)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
struct mtd_info *mtd = super->s_mtd;
|
|
|
|
size_t retlen;
|
|
|
|
loff_t page_start, page_end;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (super->s_flags & LOGFS_SB_FLAG_RO)
|
|
|
|
return -EROFS;
|
|
|
|
|
|
|
|
BUG_ON((ofs >= mtd->size) || (len > mtd->size - ofs));
|
|
|
|
BUG_ON(ofs != (ofs >> super->s_writeshift) << super->s_writeshift);
|
|
|
|
BUG_ON(len > PAGE_CACHE_SIZE);
|
|
|
|
page_start = ofs & PAGE_CACHE_MASK;
|
|
|
|
page_end = PAGE_CACHE_ALIGN(ofs + len) - 1;
|
2011-12-23 23:35:41 +08:00
|
|
|
ret = mtd_write(mtd, ofs, len, &retlen, buf);
|
2009-11-21 03:13:39 +08:00
|
|
|
if (ret || (retlen != len))
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* For as long as I can remember (since about 2001) mtd->erase has been an
|
|
|
|
* asynchronous interface lacking the first driver to actually use the
|
|
|
|
* asynchronous properties. So just to prevent the first implementor of such
|
|
|
|
* a thing from breaking logfs in 2350, we do the usual pointless dance to
|
|
|
|
* declare a completion variable and wait for completion before returning
|
2011-12-23 21:44:14 +08:00
|
|
|
* from logfs_mtd_erase(). What an exercise in futility!
|
2009-11-21 03:13:39 +08:00
|
|
|
*/
|
|
|
|
static void logfs_erase_callback(struct erase_info *ei)
|
|
|
|
{
|
|
|
|
complete((struct completion *)ei->priv);
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int logfs_mtd_erase_mapping(struct super_block *sb, loff_t ofs,
|
|
|
|
size_t len)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
struct address_space *mapping = super->s_mapping_inode->i_mapping;
|
|
|
|
struct page *page;
|
|
|
|
pgoff_t index = ofs >> PAGE_SHIFT;
|
|
|
|
|
|
|
|
for (index = ofs >> PAGE_SHIFT; index < (ofs + len) >> PAGE_SHIFT; index++) {
|
|
|
|
page = find_get_page(mapping, index);
|
|
|
|
if (!page)
|
|
|
|
continue;
|
|
|
|
memset(page_address(page), 0xFF, PAGE_SIZE);
|
|
|
|
page_cache_release(page);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int logfs_mtd_erase(struct super_block *sb, loff_t ofs, size_t len,
|
2010-03-05 04:30:58 +08:00
|
|
|
int ensure_write)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct mtd_info *mtd = logfs_super(sb)->s_mtd;
|
|
|
|
struct erase_info ei;
|
|
|
|
DECLARE_COMPLETION_ONSTACK(complete);
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
BUG_ON(len % mtd->erasesize);
|
|
|
|
if (logfs_super(sb)->s_flags & LOGFS_SB_FLAG_RO)
|
|
|
|
return -EROFS;
|
|
|
|
|
|
|
|
memset(&ei, 0, sizeof(ei));
|
|
|
|
ei.mtd = mtd;
|
|
|
|
ei.addr = ofs;
|
|
|
|
ei.len = len;
|
|
|
|
ei.callback = logfs_erase_callback;
|
|
|
|
ei.priv = (long)&complete;
|
2011-12-23 21:25:39 +08:00
|
|
|
ret = mtd_erase(mtd, &ei);
|
2009-11-21 03:13:39 +08:00
|
|
|
if (ret)
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
wait_for_completion(&complete);
|
|
|
|
if (ei.state != MTD_ERASE_DONE)
|
|
|
|
return -EIO;
|
2011-12-23 21:44:14 +08:00
|
|
|
return logfs_mtd_erase_mapping(sb, ofs, len);
|
2009-11-21 03:13:39 +08:00
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static void logfs_mtd_sync(struct super_block *sb)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct mtd_info *mtd = logfs_super(sb)->s_mtd;
|
|
|
|
|
2011-12-30 22:35:35 +08:00
|
|
|
mtd_sync(mtd);
|
2009-11-21 03:13:39 +08:00
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int logfs_mtd_readpage(void *_sb, struct page *page)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct super_block *sb = _sb;
|
|
|
|
int err;
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
err = logfs_mtd_read(sb, page->index << PAGE_SHIFT, PAGE_SIZE,
|
2009-11-21 03:13:39 +08:00
|
|
|
page_address(page));
|
2010-05-08 01:38:40 +08:00
|
|
|
if (err == -EUCLEAN || err == -EBADMSG) {
|
|
|
|
/* -EBADMSG happens regularly on power failures */
|
2009-11-21 03:13:39 +08:00
|
|
|
err = 0;
|
|
|
|
/* FIXME: force GC this segment */
|
|
|
|
}
|
|
|
|
if (err) {
|
|
|
|
ClearPageUptodate(page);
|
|
|
|
SetPageError(page);
|
|
|
|
} else {
|
|
|
|
SetPageUptodate(page);
|
|
|
|
ClearPageError(page);
|
|
|
|
}
|
|
|
|
unlock_page(page);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static struct page *logfs_mtd_find_first_sb(struct super_block *sb, u64 *ofs)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
struct address_space *mapping = super->s_mapping_inode->i_mapping;
|
2011-12-23 21:44:14 +08:00
|
|
|
filler_t *filler = logfs_mtd_readpage;
|
2009-11-21 03:13:39 +08:00
|
|
|
struct mtd_info *mtd = super->s_mtd;
|
|
|
|
|
|
|
|
*ofs = 0;
|
2011-12-24 01:35:30 +08:00
|
|
|
while (mtd_block_isbad(mtd, *ofs)) {
|
2009-11-21 03:13:39 +08:00
|
|
|
*ofs += mtd->erasesize;
|
|
|
|
if (*ofs >= mtd->size)
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
BUG_ON(*ofs & ~PAGE_MASK);
|
|
|
|
return read_cache_page(mapping, *ofs >> PAGE_SHIFT, filler, sb);
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static struct page *logfs_mtd_find_last_sb(struct super_block *sb, u64 *ofs)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
struct address_space *mapping = super->s_mapping_inode->i_mapping;
|
2011-12-23 21:44:14 +08:00
|
|
|
filler_t *filler = logfs_mtd_readpage;
|
2009-11-21 03:13:39 +08:00
|
|
|
struct mtd_info *mtd = super->s_mtd;
|
|
|
|
|
|
|
|
*ofs = mtd->size - mtd->erasesize;
|
2011-12-24 01:35:30 +08:00
|
|
|
while (mtd_block_isbad(mtd, *ofs)) {
|
2009-11-21 03:13:39 +08:00
|
|
|
*ofs -= mtd->erasesize;
|
|
|
|
if (*ofs <= 0)
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
*ofs = *ofs + mtd->erasesize - 0x1000;
|
|
|
|
BUG_ON(*ofs & ~PAGE_MASK);
|
|
|
|
return read_cache_page(mapping, *ofs >> PAGE_SHIFT, filler, sb);
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int __logfs_mtd_writeseg(struct super_block *sb, u64 ofs, pgoff_t index,
|
2009-11-21 03:13:39 +08:00
|
|
|
size_t nr_pages)
|
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
struct address_space *mapping = super->s_mapping_inode->i_mapping;
|
|
|
|
struct page *page;
|
|
|
|
int i, err;
|
|
|
|
|
|
|
|
for (i = 0; i < nr_pages; i++) {
|
|
|
|
page = find_lock_page(mapping, index + i);
|
|
|
|
BUG_ON(!page);
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
err = loffs_mtd_write(sb, page->index << PAGE_SHIFT, PAGE_SIZE,
|
|
|
|
page_address(page));
|
2009-11-21 03:13:39 +08:00
|
|
|
unlock_page(page);
|
|
|
|
page_cache_release(page);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static void logfs_mtd_writeseg(struct super_block *sb, u64 ofs, size_t len)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
int head;
|
|
|
|
|
|
|
|
if (super->s_flags & LOGFS_SB_FLAG_RO)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (len == 0) {
|
|
|
|
/* This can happen when the object fit perfectly into a
|
|
|
|
* segment, the segment gets written per sync and subsequently
|
|
|
|
* closed.
|
|
|
|
*/
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
head = ofs & (PAGE_SIZE - 1);
|
|
|
|
if (head) {
|
|
|
|
ofs -= head;
|
|
|
|
len += head;
|
|
|
|
}
|
|
|
|
len = PAGE_ALIGN(len);
|
2011-12-23 21:44:14 +08:00
|
|
|
__logfs_mtd_writeseg(sb, ofs, ofs >> PAGE_SHIFT, len >> PAGE_SHIFT);
|
2009-11-21 03:13:39 +08:00
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static void logfs_mtd_put_device(struct logfs_super *s)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
2010-07-26 16:06:00 +08:00
|
|
|
put_mtd_device(s->s_mtd);
|
2009-11-21 03:13:39 +08:00
|
|
|
}
|
|
|
|
|
2011-12-23 21:44:14 +08:00
|
|
|
static int logfs_mtd_can_write_buf(struct super_block *sb, u64 ofs)
|
2010-05-08 01:38:40 +08:00
|
|
|
{
|
|
|
|
struct logfs_super *super = logfs_super(sb);
|
|
|
|
void *buf;
|
|
|
|
int err;
|
|
|
|
|
|
|
|
buf = kmalloc(super->s_writesize, GFP_KERNEL);
|
|
|
|
if (!buf)
|
|
|
|
return -ENOMEM;
|
2011-12-23 21:44:14 +08:00
|
|
|
err = logfs_mtd_read(sb, ofs, super->s_writesize, buf);
|
2010-05-08 01:38:40 +08:00
|
|
|
if (err)
|
|
|
|
goto out;
|
|
|
|
if (memchr_inv(buf, 0xff, super->s_writesize))
|
|
|
|
err = -EIO;
|
|
|
|
kfree(buf);
|
|
|
|
out:
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2009-11-21 03:13:39 +08:00
|
|
|
static const struct logfs_device_ops mtd_devops = {
|
2011-12-23 21:44:14 +08:00
|
|
|
.find_first_sb = logfs_mtd_find_first_sb,
|
|
|
|
.find_last_sb = logfs_mtd_find_last_sb,
|
|
|
|
.readpage = logfs_mtd_readpage,
|
|
|
|
.writeseg = logfs_mtd_writeseg,
|
|
|
|
.erase = logfs_mtd_erase,
|
|
|
|
.can_write_buf = logfs_mtd_can_write_buf,
|
|
|
|
.sync = logfs_mtd_sync,
|
|
|
|
.put_device = logfs_mtd_put_device,
|
2009-11-21 03:13:39 +08:00
|
|
|
};
|
|
|
|
|
2010-07-26 15:53:30 +08:00
|
|
|
int logfs_get_sb_mtd(struct logfs_super *s, int mtdnr)
|
2009-11-21 03:13:39 +08:00
|
|
|
{
|
2010-07-26 15:33:39 +08:00
|
|
|
struct mtd_info *mtd = get_mtd_device(NULL, mtdnr);
|
2010-07-26 15:53:30 +08:00
|
|
|
if (IS_ERR(mtd))
|
2010-05-07 16:59:06 +08:00
|
|
|
return PTR_ERR(mtd);
|
2010-07-26 15:33:39 +08:00
|
|
|
|
|
|
|
s->s_bdev = NULL;
|
|
|
|
s->s_mtd = mtd;
|
|
|
|
s->s_devops = &mtd_devops;
|
2010-07-26 15:53:30 +08:00
|
|
|
return 0;
|
2009-11-21 03:13:39 +08:00
|
|
|
}
|