323 lines
8.7 KiB
C
323 lines
8.7 KiB
C
/*
|
|
* Copyright (c) International Business Machines Corp., 2006
|
|
*
|
|
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
* Author: Artem Bityutskiy (Битюцкий Артём), Joern Engel
|
|
*/
|
|
|
|
/*
|
|
* This file includes implementation of fake MTD devices for each UBI volume.
|
|
* This sounds strange, but it is in fact quite useful to make MTD-oriented
|
|
* software (including all the legacy software) to work on top of UBI.
|
|
*
|
|
* Gluebi emulates MTD devices of "MTD_UBIVOLUME" type. Their minimal I/O unit
|
|
* size (mtd->writesize) is equivalent to the UBI minimal I/O unit. The
|
|
* eraseblock size is equivalent to the logical eraseblock size of the volume.
|
|
*/
|
|
|
|
#include <asm/div64.h>
|
|
#include "ubi.h"
|
|
|
|
/**
|
|
* gluebi_get_device - get MTD device reference.
|
|
* @mtd: the MTD device description object
|
|
*
|
|
* This function is called every time the MTD device is being opened and
|
|
* implements the MTD get_device() operation. Returns zero in case of success
|
|
* and a negative error code in case of failure.
|
|
*/
|
|
static int gluebi_get_device(struct mtd_info *mtd)
|
|
{
|
|
struct ubi_volume *vol;
|
|
|
|
vol = container_of(mtd, struct ubi_volume, gluebi_mtd);
|
|
|
|
/*
|
|
* We do not introduce locks for gluebi reference count because the
|
|
* get_device()/put_device() calls are already serialized at MTD.
|
|
*/
|
|
if (vol->gluebi_refcount > 0) {
|
|
/*
|
|
* The MTD device is already referenced and this is just one
|
|
* more reference. MTD allows many users to open the same
|
|
* volume simultaneously and do not distinguish between
|
|
* readers/writers/exclusive openers as UBI does. So we do not
|
|
* open the UBI volume again - just increase the reference
|
|
* counter and return.
|
|
*/
|
|
vol->gluebi_refcount += 1;
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* This is the first reference to this UBI volume via the MTD device
|
|
* interface. Open the corresponding volume in read-write mode.
|
|
*/
|
|
vol->gluebi_desc = ubi_open_volume(vol->ubi->ubi_num, vol->vol_id,
|
|
UBI_READWRITE);
|
|
if (IS_ERR(vol->gluebi_desc))
|
|
return PTR_ERR(vol->gluebi_desc);
|
|
vol->gluebi_refcount += 1;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* gluebi_put_device - put MTD device reference.
|
|
* @mtd: the MTD device description object
|
|
*
|
|
* This function is called every time the MTD device is being put. Returns
|
|
* zero in case of success and a negative error code in case of failure.
|
|
*/
|
|
static void gluebi_put_device(struct mtd_info *mtd)
|
|
{
|
|
struct ubi_volume *vol;
|
|
|
|
vol = container_of(mtd, struct ubi_volume, gluebi_mtd);
|
|
vol->gluebi_refcount -= 1;
|
|
ubi_assert(vol->gluebi_refcount >= 0);
|
|
if (vol->gluebi_refcount == 0)
|
|
ubi_close_volume(vol->gluebi_desc);
|
|
}
|
|
|
|
/**
|
|
* gluebi_read - read operation of emulated MTD devices.
|
|
* @mtd: MTD device description object
|
|
* @from: absolute offset from where to read
|
|
* @len: how many bytes to read
|
|
* @retlen: count of read bytes is returned here
|
|
* @buf: buffer to store the read data
|
|
*
|
|
* This function returns zero in case of success and a negative error code in
|
|
* case of failure.
|
|
*/
|
|
static int gluebi_read(struct mtd_info *mtd, loff_t from, size_t len,
|
|
size_t *retlen, unsigned char *buf)
|
|
{
|
|
int err = 0, lnum, offs, total_read;
|
|
struct ubi_volume *vol;
|
|
struct ubi_device *ubi;
|
|
uint64_t tmp = from;
|
|
|
|
dbg_msg("read %zd bytes from offset %lld", len, from);
|
|
|
|
if (len < 0 || from < 0 || from + len > mtd->size)
|
|
return -EINVAL;
|
|
|
|
vol = container_of(mtd, struct ubi_volume, gluebi_mtd);
|
|
ubi = vol->ubi;
|
|
|
|
offs = do_div(tmp, mtd->erasesize);
|
|
lnum = tmp;
|
|
|
|
total_read = len;
|
|
while (total_read) {
|
|
size_t to_read = mtd->erasesize - offs;
|
|
|
|
if (to_read > total_read)
|
|
to_read = total_read;
|
|
|
|
err = ubi_eba_read_leb(ubi, vol->vol_id, lnum, buf, offs,
|
|
to_read, 0);
|
|
if (err)
|
|
break;
|
|
|
|
lnum += 1;
|
|
offs = 0;
|
|
total_read -= to_read;
|
|
buf += to_read;
|
|
}
|
|
|
|
*retlen = len - total_read;
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* gluebi_write - write operation of emulated MTD devices.
|
|
* @mtd: MTD device description object
|
|
* @to: absolute offset where to write
|
|
* @len: how many bytes to write
|
|
* @retlen: count of written bytes is returned here
|
|
* @buf: buffer with data to write
|
|
*
|
|
* This function returns zero in case of success and a negative error code in
|
|
* case of failure.
|
|
*/
|
|
static int gluebi_write(struct mtd_info *mtd, loff_t to, size_t len,
|
|
size_t *retlen, const u_char *buf)
|
|
{
|
|
int err = 0, lnum, offs, total_written;
|
|
struct ubi_volume *vol;
|
|
struct ubi_device *ubi;
|
|
uint64_t tmp = to;
|
|
|
|
dbg_msg("write %zd bytes to offset %lld", len, to);
|
|
|
|
if (len < 0 || to < 0 || len + to > mtd->size)
|
|
return -EINVAL;
|
|
|
|
vol = container_of(mtd, struct ubi_volume, gluebi_mtd);
|
|
ubi = vol->ubi;
|
|
|
|
if (ubi->ro_mode)
|
|
return -EROFS;
|
|
|
|
offs = do_div(tmp, mtd->erasesize);
|
|
lnum = tmp;
|
|
|
|
if (len % mtd->writesize || offs % mtd->writesize)
|
|
return -EINVAL;
|
|
|
|
total_written = len;
|
|
while (total_written) {
|
|
size_t to_write = mtd->erasesize - offs;
|
|
|
|
if (to_write > total_written)
|
|
to_write = total_written;
|
|
|
|
err = ubi_eba_write_leb(ubi, vol->vol_id, lnum, buf, offs,
|
|
to_write, UBI_UNKNOWN);
|
|
if (err)
|
|
break;
|
|
|
|
lnum += 1;
|
|
offs = 0;
|
|
total_written -= to_write;
|
|
buf += to_write;
|
|
}
|
|
|
|
*retlen = len - total_written;
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* gluebi_erase - erase operation of emulated MTD devices.
|
|
* @mtd: the MTD device description object
|
|
* @instr: the erase operation description
|
|
*
|
|
* This function calls the erase callback when finishes. Returns zero in case
|
|
* of success and a negative error code in case of failure.
|
|
*/
|
|
static int gluebi_erase(struct mtd_info *mtd, struct erase_info *instr)
|
|
{
|
|
int err, i, lnum, count;
|
|
struct ubi_volume *vol;
|
|
struct ubi_device *ubi;
|
|
|
|
dbg_msg("erase %u bytes at offset %u", instr->len, instr->addr);
|
|
|
|
if (instr->addr < 0 || instr->addr > mtd->size - mtd->erasesize)
|
|
return -EINVAL;
|
|
|
|
if (instr->len < 0 || instr->addr + instr->len > mtd->size)
|
|
return -EINVAL;
|
|
|
|
if (instr->addr % mtd->writesize || instr->len % mtd->writesize)
|
|
return -EINVAL;
|
|
|
|
lnum = instr->addr / mtd->erasesize;
|
|
count = instr->len / mtd->erasesize;
|
|
|
|
vol = container_of(mtd, struct ubi_volume, gluebi_mtd);
|
|
ubi = vol->ubi;
|
|
|
|
if (ubi->ro_mode)
|
|
return -EROFS;
|
|
|
|
for (i = 0; i < count; i++) {
|
|
err = ubi_eba_unmap_leb(ubi, vol->vol_id, lnum + i);
|
|
if (err)
|
|
goto out_err;
|
|
}
|
|
|
|
/*
|
|
* MTD erase operations are synchronous, so we have to make sure the
|
|
* physical eraseblock is wiped out.
|
|
*/
|
|
err = ubi_wl_flush(ubi);
|
|
if (err)
|
|
goto out_err;
|
|
|
|
instr->state = MTD_ERASE_DONE;
|
|
mtd_erase_callback(instr);
|
|
return 0;
|
|
|
|
out_err:
|
|
instr->state = MTD_ERASE_FAILED;
|
|
instr->fail_addr = lnum * mtd->erasesize;
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* ubi_create_gluebi - initialize gluebi for an UBI volume.
|
|
* @ubi: UBI device description object
|
|
* @vol: volume description object
|
|
*
|
|
* This function is called when an UBI volume is created in order to create
|
|
* corresponding fake MTD device. Returns zero in case of success and a
|
|
* negative error code in case of failure.
|
|
*/
|
|
int ubi_create_gluebi(struct ubi_device *ubi, struct ubi_volume *vol)
|
|
{
|
|
struct mtd_info *mtd = &vol->gluebi_mtd;
|
|
|
|
mtd->name = kmemdup(vol->name, vol->name_len + 1, GFP_KERNEL);
|
|
if (!mtd->name)
|
|
return -ENOMEM;
|
|
|
|
mtd->type = MTD_UBIVOLUME;
|
|
if (!ubi->ro_mode)
|
|
mtd->flags = MTD_WRITEABLE;
|
|
mtd->writesize = ubi->min_io_size;
|
|
mtd->owner = THIS_MODULE;
|
|
mtd->size = vol->usable_leb_size * vol->reserved_pebs;
|
|
mtd->erasesize = vol->usable_leb_size;
|
|
mtd->read = gluebi_read;
|
|
mtd->write = gluebi_write;
|
|
mtd->erase = gluebi_erase;
|
|
mtd->get_device = gluebi_get_device;
|
|
mtd->put_device = gluebi_put_device;
|
|
|
|
if (add_mtd_device(mtd)) {
|
|
ubi_err("cannot not add MTD device\n");
|
|
kfree(mtd->name);
|
|
return -ENFILE;
|
|
}
|
|
|
|
dbg_msg("added mtd%d (\"%s\"), size %u, EB size %u",
|
|
mtd->index, mtd->name, mtd->size, mtd->erasesize);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ubi_destroy_gluebi - close gluebi for an UBI volume.
|
|
* @vol: volume description object
|
|
*
|
|
* This function is called when an UBI volume is removed in order to remove
|
|
* corresponding fake MTD device. Returns zero in case of success and a
|
|
* negative error code in case of failure.
|
|
*/
|
|
int ubi_destroy_gluebi(struct ubi_volume *vol)
|
|
{
|
|
int err;
|
|
struct mtd_info *mtd = &vol->gluebi_mtd;
|
|
|
|
dbg_msg("remove mtd%d", mtd->index);
|
|
err = del_mtd_device(mtd);
|
|
if (err)
|
|
return err;
|
|
kfree(mtd->name);
|
|
return 0;
|
|
}
|