[deliverable/linux.git] / drivers / mtd / mtdpart.c

/*
 * Simple MTD partitioning layer
 *
 * (C) 2000 Nicolas Pitre <nico@cam.org>
 *
 * This code is GPL
 *
 * 	02-21-2002	Thomas Gleixner <gleixner@autronix.de>
 *			added support for read_oob, write_oob
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/list.h>
#include <linux/kmod.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/partitions.h>
#include <linux/mtd/compatmac.h>

/* Our partition linked list */
static LIST_HEAD(mtd_partitions);

/* Our partition node structure */
struct mtd_part {
	struct mtd_info mtd;
	struct mtd_info *master;
	uint64_t offset;
	int index;
	struct list_head list;
	int registered;
};

/*
 * Given a pointer to the MTD object in the mtd_part structure, we can retrieve
 * the pointer to that structure with this macro.
 */
#define PART(x)  ((struct mtd_part *)(x))


/*
 * MTD methods which simply translate the effective address and pass through
 * to the _real_ device.
 */

static int part_read(struct mtd_info *mtd, loff_t from, size_t len,
		size_t *retlen, u_char *buf)
{
	struct mtd_part *part = PART(mtd);
	struct mtd_ecc_stats stats;
	int res;

	stats = part->master->ecc_stats;

	if (from >= mtd->size)
		len = 0;
	else if (from + len > mtd->size)
		len = mtd->size - from;
	res = part->master->read(part->master, from + part->offset,
				   len, retlen, buf);
	if (unlikely(res)) {
		if (res == -EUCLEAN)
			mtd->ecc_stats.corrected += part->master->ecc_stats.corrected - stats.corrected;
		if (res == -EBADMSG)
			mtd->ecc_stats.failed += part->master->ecc_stats.failed - stats.failed;
	}
	return res;
}

static int part_point(struct mtd_info *mtd, loff_t from, size_t len,
		size_t *retlen, void **virt, resource_size_t *phys)
{
	struct mtd_part *part = PART(mtd);
	if (from >= mtd->size)
		len = 0;
	else if (from + len > mtd->size)
		len = mtd->size - from;
	return part->master->point (part->master, from + part->offset,
				    len, retlen, virt, phys);
}

static void part_unpoint(struct mtd_info *mtd, loff_t from, size_t len)
{
	struct mtd_part *part = PART(mtd);

	part->master->unpoint(part->master, from + part->offset, len);
}

static unsigned long part_get_unmapped_area(struct mtd_info *mtd,
					    unsigned long len,
					    unsigned long offset,
					    unsigned long flags)
{
	struct mtd_part *part = PART(mtd);

	offset += part->offset;
	return part->master->get_unmapped_area(part->master, len, offset,
					       flags);
}

static int part_read_oob(struct mtd_info *mtd, loff_t from,
		struct mtd_oob_ops *ops)
{
	struct mtd_part *part = PART(mtd);
	int res;

	if (from >= mtd->size)
		return -EINVAL;
	if (ops->datbuf && from + ops->len > mtd->size)
		return -EINVAL;
	res = part->master->read_oob(part->master, from + part->offset, ops);

	if (unlikely(res)) {
		if (res == -EUCLEAN)
			mtd->ecc_stats.corrected++;
		if (res == -EBADMSG)
			mtd->ecc_stats.failed++;
	}
	return res;
}

static int part_read_user_prot_reg(struct mtd_info *mtd, loff_t from,
		size_t len, size_t *retlen, u_char *buf)
{
	struct mtd_part *part = PART(mtd);
	return part->master->read_user_prot_reg(part->master, from,
					len, retlen, buf);
}

static int part_get_user_prot_info(struct mtd_info *mtd,
		struct otp_info *buf, size_t len)
{
	struct mtd_part *part = PART(mtd);
	return part->master->get_user_prot_info(part->master, buf, len);
}

static int part_read_fact_prot_reg(struct mtd_info *mtd, loff_t from,
		size_t len, size_t *retlen, u_char *buf)
{
	struct mtd_part *part = PART(mtd);
	return part->master->read_fact_prot_reg(part->master, from,
					len, retlen, buf);
}

static int part_get_fact_prot_info(struct mtd_info *mtd, struct otp_info *buf,
		size_t len)
{
	struct mtd_part *part = PART(mtd);
	return part->master->get_fact_prot_info(part->master, buf, len);
}

static int part_write(struct mtd_info *mtd, loff_t to, size_t len,
		size_t *retlen, const u_char *buf)
{
	struct mtd_part *part = PART(mtd);
	if (!(mtd->flags & MTD_WRITEABLE))
		return -EROFS;
	if (to >= mtd->size)
		len = 0;
	else if (to + len > mtd->size)
		len = mtd->size - to;
	return part->master->write(part->master, to + part->offset,
				    len, retlen, buf);
}

static int part_panic_write(struct mtd_info *mtd, loff_t to, size_t len,
		size_t *retlen, const u_char *buf)
{
	struct mtd_part *part = PART(mtd);
	if (!(mtd->flags & MTD_WRITEABLE))
		return -EROFS;
	if (to >= mtd->size)
		len = 0;
	else if (to + len > mtd->size)
		len = mtd->size - to;
	return part->master->panic_write(part->master, to + part->offset,
				    len, retlen, buf);
}

static int part_write_oob(struct mtd_info *mtd, loff_t to,
		struct mtd_oob_ops *ops)
{
	struct mtd_part *part = PART(mtd);

	if (!(mtd->flags & MTD_WRITEABLE))
		return -EROFS;

	if (to >= mtd->size)
		return -EINVAL;
	if (ops->datbuf && to + ops->len > mtd->size)
		return -EINVAL;
	return part->master->write_oob(part->master, to + part->offset, ops);
}

static int part_write_user_prot_reg(struct mtd_info *mtd, loff_t from,
		size_t len, size_t *retlen, u_char *buf)
{
	struct mtd_part *part = PART(mtd);
	return part->master->write_user_prot_reg(part->master, from,
					len, retlen, buf);
}

static int part_lock_user_prot_reg(struct mtd_info *mtd, loff_t from,
		size_t len)
{
	struct mtd_part *part = PART(mtd);
	return part->master->lock_user_prot_reg(part->master, from, len);
}

static int part_writev(struct mtd_info *mtd, const struct kvec *vecs,
		unsigned long count, loff_t to, size_t *retlen)
{
	struct mtd_part *part = PART(mtd);
	if (!(mtd->flags & MTD_WRITEABLE))
		return -EROFS;
	return part->master->writev(part->master, vecs, count,
					to + part->offset, retlen);
}

static int part_erase(struct mtd_info *mtd, struct erase_info *instr)
{
	struct mtd_part *part = PART(mtd);
	int ret;
	if (!(mtd->flags & MTD_WRITEABLE))
		return -EROFS;
	if (instr->addr >= mtd->size)
		return -EINVAL;
	instr->addr += part->offset;
	ret = part->master->erase(part->master, instr);
	if (ret) {
		if (instr->fail_addr != MTD_FAIL_ADDR_UNKNOWN)
			instr->fail_addr -= part->offset;
		instr->addr -= part->offset;
	}
	return ret;
}

void mtd_erase_callback(struct erase_info *instr)
{
	if (instr->mtd->erase == part_erase) {
		struct mtd_part *part = PART(instr->mtd);

		if (instr->fail_addr != MTD_FAIL_ADDR_UNKNOWN)
			instr->fail_addr -= part->offset;
		instr->addr -= part->offset;
	}
	if (instr->callback)
		instr->callback(instr);
}
EXPORT_SYMBOL_GPL(mtd_erase_callback);

static int part_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
{
	struct mtd_part *part = PART(mtd);
	if ((len + ofs) > mtd->size)
		return -EINVAL;
	return part->master->lock(part->master, ofs + part->offset, len);
}

static int part_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
{
	struct mtd_part *part = PART(mtd);
	if ((len + ofs) > mtd->size)
		return -EINVAL;
	return part->master->unlock(part->master, ofs + part->offset, len);
}

static void part_sync(struct mtd_info *mtd)
{
	struct mtd_part *part = PART(mtd);
	part->master->sync(part->master);
}

static int part_suspend(struct mtd_info *mtd)
{
	struct mtd_part *part = PART(mtd);
	return part->master->suspend(part->master);
}

static void part_resume(struct mtd_info *mtd)
{
	struct mtd_part *part = PART(mtd);
	part->master->resume(part->master);
}

static int part_block_isbad(struct mtd_info *mtd, loff_t ofs)
{
	struct mtd_part *part = PART(mtd);
	if (ofs >= mtd->size)
		return -EINVAL;
	ofs += part->offset;
	return part->master->block_isbad(part->master, ofs);
}

static int part_block_markbad(struct mtd_info *mtd, loff_t ofs)
{
	struct mtd_part *part = PART(mtd);
	int res;

	if (!(mtd->flags & MTD_WRITEABLE))
		return -EROFS;
	if (ofs >= mtd->size)
		return -EINVAL;
	ofs += part->offset;
	res = part->master->block_markbad(part->master, ofs);
	if (!res)
		mtd->ecc_stats.badblocks++;
	return res;
}

/*
 * This function unregisters and destroy all slave MTD objects which are
 * attached to the given master MTD object.
 */

int del_mtd_partitions(struct mtd_info *master)
{
	struct mtd_part *slave, *next;

	list_for_each_entry_safe(slave, next, &mtd_partitions, list)
		if (slave->master == master) {
			list_del(&slave->list);
			if (slave->registered)
				del_mtd_device(&slave->mtd);
			kfree(slave);
		}

	return 0;
}
EXPORT_SYMBOL(del_mtd_partitions);

static struct mtd_part *add_one_partition(struct mtd_info *master,
		const struct mtd_partition *part, int partno,
		uint64_t cur_offset)
{
	struct mtd_part *slave;

	/* allocate the partition structure */
	slave = kzalloc(sizeof(*slave), GFP_KERNEL);
	if (!slave) {
		printk(KERN_ERR"memory allocation error while creating partitions for \"%s\"\n",
			master->name);
		del_mtd_partitions(master);
		return NULL;
	}
	list_add(&slave->list, &mtd_partitions);

	/* set up the MTD object for this partition */
	slave->mtd.type = master->type;
	slave->mtd.flags = master->flags & ~part->mask_flags;
	slave->mtd.size = part->size;
	slave->mtd.writesize = master->writesize;
	slave->mtd.oobsize = master->oobsize;
	slave->mtd.oobavail = master->oobavail;
	slave->mtd.subpage_sft = master->subpage_sft;

	slave->mtd.name = part->name;
	slave->mtd.owner = master->owner;
	slave->mtd.backing_dev_info = master->backing_dev_info;

	/* NOTE:  we don't arrange MTDs as a tree; it'd be error-prone
	 * to have the same data be in two different partitions.
	 */
	slave->mtd.dev.parent = master->dev.parent;

	slave->mtd.read = part_read;
	slave->mtd.write = part_write;

	if (master->panic_write)
		slave->mtd.panic_write = part_panic_write;

	if (master->point && master->unpoint) {
		slave->mtd.point = part_point;
		slave->mtd.unpoint = part_unpoint;
	}

	if (master->get_unmapped_area)
		slave->mtd.get_unmapped_area = part_get_unmapped_area;
	if (master->read_oob)
		slave->mtd.read_oob = part_read_oob;
	if (master->write_oob)
		slave->mtd.write_oob = part_write_oob;
	if (master->read_user_prot_reg)
		slave->mtd.read_user_prot_reg = part_read_user_prot_reg;
	if (master->read_fact_prot_reg)
		slave->mtd.read_fact_prot_reg = part_read_fact_prot_reg;
	if (master->write_user_prot_reg)
		slave->mtd.write_user_prot_reg = part_write_user_prot_reg;
	if (master->lock_user_prot_reg)
		slave->mtd.lock_user_prot_reg = part_lock_user_prot_reg;
	if (master->get_user_prot_info)
		slave->mtd.get_user_prot_info = part_get_user_prot_info;
	if (master->get_fact_prot_info)
		slave->mtd.get_fact_prot_info = part_get_fact_prot_info;
	if (master->sync)
		slave->mtd.sync = part_sync;
	if (!partno && master->suspend && master->resume) {
			slave->mtd.suspend = part_suspend;
			slave->mtd.resume = part_resume;
	}
	if (master->writev)
		slave->mtd.writev = part_writev;
	if (master->lock)
		slave->mtd.lock = part_lock;
	if (master->unlock)
		slave->mtd.unlock = part_unlock;
	if (master->block_isbad)
		slave->mtd.block_isbad = part_block_isbad;
	if (master->block_markbad)
		slave->mtd.block_markbad = part_block_markbad;
	slave->mtd.erase = part_erase;
	slave->master = master;
	slave->offset = part->offset;
	slave->index = partno;

	if (slave->offset == MTDPART_OFS_APPEND)
		slave->offset = cur_offset;
	if (slave->offset == MTDPART_OFS_NXTBLK) {
		slave->offset = cur_offset;
		if (mtd_mod_by_eb(cur_offset, master) != 0) {
			/* Round up to next erasesize */
			slave->offset = (mtd_div_by_eb(cur_offset, master) + 1) * master->erasesize;
			printk(KERN_NOTICE "Moving partition %d: "
			       "0x%012llx -> 0x%012llx\n", partno,
			       (unsigned long long)cur_offset, (unsigned long long)slave->offset);
		}
	}
	if (slave->mtd.size == MTDPART_SIZ_FULL)
		slave->mtd.size = master->size - slave->offset;

	printk(KERN_NOTICE "0x%012llx-0x%012llx : \"%s\"\n", (unsigned long long)slave->offset,
		(unsigned long long)(slave->offset + slave->mtd.size), slave->mtd.name);

	/* let's do some sanity checks */
	if (slave->offset >= master->size) {
		/* let's register it anyway to preserve ordering */
		slave->offset = 0;
		slave->mtd.size = 0;
		printk(KERN_ERR"mtd: partition \"%s\" is out of reach -- disabled\n",
			part->name);
		goto out_register;
	}
	if (slave->offset + slave->mtd.size > master->size) {
		slave->mtd.size = master->size - slave->offset;
		printk(KERN_WARNING"mtd: partition \"%s\" extends beyond the end of device \"%s\" -- size truncated to %#llx\n",
			part->name, master->name, (unsigned long long)slave->mtd.size);
	}
	if (master->numeraseregions > 1) {
		/* Deal with variable erase size stuff */
		int i, max = master->numeraseregions;
		u64 end = slave->offset + slave->mtd.size;
		struct mtd_erase_region_info *regions = master->eraseregions;

		/* Find the first erase regions which is part of this
		 * partition. */
		for (i = 0; i < max && regions[i].offset <= slave->offset; i++)
			;
		/* The loop searched for the region _behind_ the first one */
		i--;

		/* Pick biggest erasesize */
		for (; i < max && regions[i].offset < end; i++) {
			if (slave->mtd.erasesize < regions[i].erasesize) {
				slave->mtd.erasesize = regions[i].erasesize;
			}
		}
		BUG_ON(slave->mtd.erasesize == 0);
	} else {
		/* Single erase size */
		slave->mtd.erasesize = master->erasesize;
	}

	if ((slave->mtd.flags & MTD_WRITEABLE) &&
	    mtd_mod_by_eb(slave->offset, &slave->mtd)) {
		/* Doesn't start on a boundary of major erase size */
		/* FIXME: Let it be writable if it is on a boundary of
		 * _minor_ erase size though */
		slave->mtd.flags &= ~MTD_WRITEABLE;
		printk(KERN_WARNING"mtd: partition \"%s\" doesn't start on an erase block boundary -- force read-only\n",
			part->name);
	}
	if ((slave->mtd.flags & MTD_WRITEABLE) &&
	    mtd_mod_by_eb(slave->mtd.size, &slave->mtd)) {
		slave->mtd.flags &= ~MTD_WRITEABLE;
		printk(KERN_WARNING"mtd: partition \"%s\" doesn't end on an erase block -- force read-only\n",
			part->name);
	}

	slave->mtd.ecclayout = master->ecclayout;
	if (master->block_isbad) {
		uint64_t offs = 0;

		while (offs < slave->mtd.size) {
			if (master->block_isbad(master,
						offs + slave->offset))
				slave->mtd.ecc_stats.badblocks++;
			offs += slave->mtd.erasesize;
		}
	}

out_register:
	if (part->mtdp) {
		/* store the object pointer (caller may or may not register it*/
		*part->mtdp = &slave->mtd;
		slave->registered = 0;
	} else {
		/* register our partition */
		add_mtd_device(&slave->mtd);
		slave->registered = 1;
	}
	return slave;
}

/*
 * This function, given a master MTD object and a partition table, creates
 * and registers slave MTD objects which are bound to the master according to
 * the partition definitions.
 *
 * We don't register the master, or expect the caller to have done so,
 * for reasons of data integrity.
 */

int add_mtd_partitions(struct mtd_info *master,
		       const struct mtd_partition *parts,
		       int nbparts)
{
	struct mtd_part *slave;
	uint64_t cur_offset = 0;
	int i;

	printk(KERN_NOTICE "Creating %d MTD partitions on \"%s\":\n", nbparts, master->name);

	for (i = 0; i < nbparts; i++) {
		slave = add_one_partition(master, parts + i, i, cur_offset);
		if (!slave)
			return -ENOMEM;
		cur_offset = slave->offset + slave->mtd.size;
	}

	return 0;
}
EXPORT_SYMBOL(add_mtd_partitions);

static DEFINE_SPINLOCK(part_parser_lock);
static LIST_HEAD(part_parsers);

static struct mtd_part_parser *get_partition_parser(const char *name)
{
	struct mtd_part_parser *p, *ret = NULL;

	spin_lock(&part_parser_lock);

	list_for_each_entry(p, &part_parsers, list)
		if (!strcmp(p->name, name) && try_module_get(p->owner)) {
			ret = p;
			break;
		}

	spin_unlock(&part_parser_lock);

	return ret;
}

int register_mtd_parser(struct mtd_part_parser *p)
{
	spin_lock(&part_parser_lock);
	list_add(&p->list, &part_parsers);
	spin_unlock(&part_parser_lock);

	return 0;
}
EXPORT_SYMBOL_GPL(register_mtd_parser);

int deregister_mtd_parser(struct mtd_part_parser *p)
{
	spin_lock(&part_parser_lock);
	list_del(&p->list);
	spin_unlock(&part_parser_lock);
	return 0;
}
EXPORT_SYMBOL_GPL(deregister_mtd_parser);

int parse_mtd_partitions(struct mtd_info *master, const char **types,
			 struct mtd_partition **pparts, unsigned long origin)
{
	struct mtd_part_parser *parser;
	int ret = 0;

	for ( ; ret <= 0 && *types; types++) {
		parser = get_partition_parser(*types);
		if (!parser && !request_module("%s", *types))
				parser = get_partition_parser(*types);
		if (!parser) {
			printk(KERN_NOTICE "%s partition parsing not available\n",
			       *types);
			continue;
		}
		ret = (*parser->parse_fn)(master, pparts, origin);
		if (ret > 0) {
			printk(KERN_NOTICE "%d %s partitions found on MTD device %s\n",
			       ret, parser->name, master->name);
		}
		put_partition_parser(parser);
	}
	return ret;
}
EXPORT_SYMBOL_GPL(parse_mtd_partitions);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Simple MTD partitioning layer
	3	*
	4	* (C) 2000 Nicolas Pitre <nico@cam.org>
	5	*
	6	* This code is GPL
	7	*
1da177e4 LT	8	* 02-21-2002 Thomas Gleixner <gleixner@autronix.de>
1da177e4 LT	9	* added support for read_oob, write_oob
97894cda	10	*/
1da177e4 LT	11
	12	#include <linux/module.h>
	13	#include <linux/types.h>
	14	#include <linux/kernel.h>
	15	#include <linux/slab.h>
	16	#include <linux/list.h>
1da177e4 LT	17	#include <linux/kmod.h>
	18	#include <linux/mtd/mtd.h>
	19	#include <linux/mtd/partitions.h>
	20	#include <linux/mtd/compatmac.h>
	21
	22	/* Our partition linked list */
	23	static LIST_HEAD(mtd_partitions);
	24
	25	/* Our partition node structure */
	26	struct mtd_part {
	27	struct mtd_info mtd;
	28	struct mtd_info *master;
69423d99	29	uint64_t offset;
1da177e4 LT	30	int index;
	31	struct list_head list;
	32	int registered;
	33	};
	34
	35	/*
	36	* Given a pointer to the MTD object in the mtd_part structure, we can retrieve
	37	* the pointer to that structure with this macro.
	38	*/
	39	#define PART(x) ((struct mtd_part *)(x))
	40
97894cda TG	41
97894cda TG	42	/*
1da177e4 LT	43	* MTD methods which simply translate the effective address and pass through
	44	* to the _real_ device.
	45	*/
	46
b33a2887 AN	47	static int part_read(struct mtd_info *mtd, loff_t from, size_t len,
b33a2887 AN	48	size_t retlen, u_char buf)
1da177e4 LT	49	{
1da177e4 LT	50	struct mtd_part *part = PART(mtd);
d8877f19	51	struct mtd_ecc_stats stats;
f1a28c02 TG	52	int res;
f1a28c02 TG	53
d8877f19 YK	54	stats = part->master->ecc_stats;
d8877f19 YK	55
1da177e4 LT	56	if (from >= mtd->size)
	57	len = 0;
	58	else if (from + len > mtd->size)
	59	len = mtd->size - from;
b33a2887	60	res = part->master->read(part->master, from + part->offset,
9223a456	61	len, retlen, buf);
f1a28c02 TG	62	if (unlikely(res)) {
f1a28c02 TG	63	if (res == -EUCLEAN)
d8877f19	64	mtd->ecc_stats.corrected += part->master->ecc_stats.corrected - stats.corrected;
f1a28c02	65	if (res == -EBADMSG)
d8877f19	66	mtd->ecc_stats.failed += part->master->ecc_stats.failed - stats.failed;
f1a28c02 TG	67	}
f1a28c02 TG	68	return res;
1da177e4 LT	69	}
1da177e4 LT	70
b33a2887 AN	71	static int part_point(struct mtd_info *mtd, loff_t from, size_t len,
b33a2887 AN	72	size_t retlen, void virt, resource_size_t phys)
1da177e4 LT	73	{
	74	struct mtd_part *part = PART(mtd);
	75	if (from >= mtd->size)
	76	len = 0;
	77	else if (from + len > mtd->size)
	78	len = mtd->size - from;
97894cda	79	return part->master->point (part->master, from + part->offset,
a98889f3	80	len, retlen, virt, phys);
1da177e4	81	}
9223a456	82
a98889f3	83	static void part_unpoint(struct mtd_info *mtd, loff_t from, size_t len)
1da177e4 LT	84	{
	85	struct mtd_part *part = PART(mtd);
	86
a98889f3	87	part->master->unpoint(part->master, from + part->offset, len);
1da177e4 LT	88	}
1da177e4 LT	89
402d3265 DH	90	static unsigned long part_get_unmapped_area(struct mtd_info *mtd,
	91	unsigned long len,
	92	unsigned long offset,
	93	unsigned long flags)
	94	{
	95	struct mtd_part *part = PART(mtd);
	96
	97	offset += part->offset;
	98	return part->master->get_unmapped_area(part->master, len, offset,
	99	flags);
	100	}
	101
8593fbc6	102	static int part_read_oob(struct mtd_info *mtd, loff_t from,
b33a2887	103	struct mtd_oob_ops *ops)
1da177e4 LT	104	{
1da177e4 LT	105	struct mtd_part *part = PART(mtd);
f1a28c02	106	int res;
8593fbc6	107
1da177e4	108	if (from >= mtd->size)
8593fbc6	109	return -EINVAL;
7014568b	110	if (ops->datbuf && from + ops->len > mtd->size)
8593fbc6	111	return -EINVAL;
f1a28c02 TG	112	res = part->master->read_oob(part->master, from + part->offset, ops);
	113
	114	if (unlikely(res)) {
	115	if (res == -EUCLEAN)
	116	mtd->ecc_stats.corrected++;
	117	if (res == -EBADMSG)
	118	mtd->ecc_stats.failed++;
	119	}
	120	return res;
1da177e4 LT	121	}
1da177e4 LT	122
b33a2887 AN	123	static int part_read_user_prot_reg(struct mtd_info *mtd, loff_t from,
b33a2887 AN	124	size_t len, size_t retlen, u_char buf)
1da177e4 LT	125	{
1da177e4 LT	126	struct mtd_part *part = PART(mtd);
b33a2887	127	return part->master->read_user_prot_reg(part->master, from,
1da177e4 LT	128	len, retlen, buf);
	129	}
	130
b33a2887 AN	131	static int part_get_user_prot_info(struct mtd_info *mtd,
b33a2887 AN	132	struct otp_info *buf, size_t len)
f77814dd NP	133	{
f77814dd NP	134	struct mtd_part *part = PART(mtd);
b33a2887	135	return part->master->get_user_prot_info(part->master, buf, len);
f77814dd NP	136	}
f77814dd NP	137
b33a2887 AN	138	static int part_read_fact_prot_reg(struct mtd_info *mtd, loff_t from,
b33a2887 AN	139	size_t len, size_t retlen, u_char buf)
1da177e4 LT	140	{
1da177e4 LT	141	struct mtd_part *part = PART(mtd);
b33a2887	142	return part->master->read_fact_prot_reg(part->master, from,
1da177e4 LT	143	len, retlen, buf);
	144	}
	145
b33a2887 AN	146	static int part_get_fact_prot_info(struct mtd_info mtd, struct otp_info buf,
b33a2887 AN	147	size_t len)
f77814dd NP	148	{
f77814dd NP	149	struct mtd_part *part = PART(mtd);
b33a2887	150	return part->master->get_fact_prot_info(part->master, buf, len);
f77814dd NP	151	}
f77814dd NP	152
b33a2887 AN	153	static int part_write(struct mtd_info *mtd, loff_t to, size_t len,
b33a2887 AN	154	size_t retlen, const u_char buf)
1da177e4 LT	155	{
	156	struct mtd_part *part = PART(mtd);
	157	if (!(mtd->flags & MTD_WRITEABLE))
	158	return -EROFS;
	159	if (to >= mtd->size)
	160	len = 0;
	161	else if (to + len > mtd->size)
	162	len = mtd->size - to;
b33a2887	163	return part->master->write(part->master, to + part->offset,
9223a456	164	len, retlen, buf);
1da177e4 LT	165	}
1da177e4 LT	166
b33a2887 AN	167	static int part_panic_write(struct mtd_info *mtd, loff_t to, size_t len,
b33a2887 AN	168	size_t retlen, const u_char buf)
388bbb09 RP	169	{
	170	struct mtd_part *part = PART(mtd);
	171	if (!(mtd->flags & MTD_WRITEABLE))
	172	return -EROFS;
	173	if (to >= mtd->size)
	174	len = 0;
	175	else if (to + len > mtd->size)
	176	len = mtd->size - to;
b33a2887	177	return part->master->panic_write(part->master, to + part->offset,
388bbb09 RP	178	len, retlen, buf);
	179	}
	180
8593fbc6	181	static int part_write_oob(struct mtd_info *mtd, loff_t to,
b33a2887	182	struct mtd_oob_ops *ops)
1da177e4 LT	183	{
1da177e4 LT	184	struct mtd_part *part = PART(mtd);
8593fbc6	185
1da177e4 LT	186	if (!(mtd->flags & MTD_WRITEABLE))
1da177e4 LT	187	return -EROFS;
8593fbc6	188
1da177e4	189	if (to >= mtd->size)
8593fbc6	190	return -EINVAL;
7014568b	191	if (ops->datbuf && to + ops->len > mtd->size)
8593fbc6 TG	192	return -EINVAL;
8593fbc6 TG	193	return part->master->write_oob(part->master, to + part->offset, ops);
1da177e4 LT	194	}
1da177e4 LT	195
b33a2887 AN	196	static int part_write_user_prot_reg(struct mtd_info *mtd, loff_t from,
b33a2887 AN	197	size_t len, size_t retlen, u_char buf)
1da177e4 LT	198	{
1da177e4 LT	199	struct mtd_part *part = PART(mtd);
b33a2887	200	return part->master->write_user_prot_reg(part->master, from,
1da177e4 LT	201	len, retlen, buf);
	202	}
	203
b33a2887 AN	204	static int part_lock_user_prot_reg(struct mtd_info *mtd, loff_t from,
b33a2887 AN	205	size_t len)
f77814dd NP	206	{
f77814dd NP	207	struct mtd_part *part = PART(mtd);
b33a2887	208	return part->master->lock_user_prot_reg(part->master, from, len);
f77814dd NP	209	}
f77814dd NP	210
b33a2887 AN	211	static int part_writev(struct mtd_info mtd, const struct kvec vecs,
b33a2887 AN	212	unsigned long count, loff_t to, size_t *retlen)
1da177e4 LT	213	{
	214	struct mtd_part *part = PART(mtd);
	215	if (!(mtd->flags & MTD_WRITEABLE))
	216	return -EROFS;
b33a2887	217	return part->master->writev(part->master, vecs, count,
1da177e4	218	to + part->offset, retlen);
1da177e4 LT	219	}
1da177e4 LT	220
b33a2887	221	static int part_erase(struct mtd_info mtd, struct erase_info instr)
1da177e4 LT	222	{
	223	struct mtd_part *part = PART(mtd);
	224	int ret;
	225	if (!(mtd->flags & MTD_WRITEABLE))
	226	return -EROFS;
	227	if (instr->addr >= mtd->size)
	228	return -EINVAL;
	229	instr->addr += part->offset;
	230	ret = part->master->erase(part->master, instr);
74641d75	231	if (ret) {
bb0eb217	232	if (instr->fail_addr != MTD_FAIL_ADDR_UNKNOWN)
74641d75 AH	233	instr->fail_addr -= part->offset;
	234	instr->addr -= part->offset;
	235	}
1da177e4 LT	236	return ret;
	237	}
	238
	239	void mtd_erase_callback(struct erase_info *instr)
	240	{
	241	if (instr->mtd->erase == part_erase) {
	242	struct mtd_part *part = PART(instr->mtd);
	243
bb0eb217	244	if (instr->fail_addr != MTD_FAIL_ADDR_UNKNOWN)
1da177e4 LT	245	instr->fail_addr -= part->offset;
	246	instr->addr -= part->offset;
	247	}
	248	if (instr->callback)
	249	instr->callback(instr);
	250	}
	251	EXPORT_SYMBOL_GPL(mtd_erase_callback);
	252
69423d99	253	static int part_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
1da177e4 LT	254	{
1da177e4 LT	255	struct mtd_part *part = PART(mtd);
97894cda	256	if ((len + ofs) > mtd->size)
1da177e4 LT	257	return -EINVAL;
	258	return part->master->lock(part->master, ofs + part->offset, len);
	259	}
	260
69423d99	261	static int part_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
1da177e4 LT	262	{
1da177e4 LT	263	struct mtd_part *part = PART(mtd);
97894cda	264	if ((len + ofs) > mtd->size)
1da177e4 LT	265	return -EINVAL;
	266	return part->master->unlock(part->master, ofs + part->offset, len);
	267	}
	268
	269	static void part_sync(struct mtd_info *mtd)
	270	{
	271	struct mtd_part *part = PART(mtd);
	272	part->master->sync(part->master);
	273	}
	274
	275	static int part_suspend(struct mtd_info *mtd)
	276	{
	277	struct mtd_part *part = PART(mtd);
	278	return part->master->suspend(part->master);
	279	}
	280
	281	static void part_resume(struct mtd_info *mtd)
	282	{
	283	struct mtd_part *part = PART(mtd);
	284	part->master->resume(part->master);
	285	}
	286
b33a2887	287	static int part_block_isbad(struct mtd_info *mtd, loff_t ofs)
1da177e4 LT	288	{
	289	struct mtd_part *part = PART(mtd);
	290	if (ofs >= mtd->size)
	291	return -EINVAL;
	292	ofs += part->offset;
	293	return part->master->block_isbad(part->master, ofs);
	294	}
	295
b33a2887	296	static int part_block_markbad(struct mtd_info *mtd, loff_t ofs)
1da177e4 LT	297	{
1da177e4 LT	298	struct mtd_part *part = PART(mtd);
f1a28c02 TG	299	int res;
f1a28c02 TG	300
1da177e4 LT	301	if (!(mtd->flags & MTD_WRITEABLE))
	302	return -EROFS;
	303	if (ofs >= mtd->size)
	304	return -EINVAL;
	305	ofs += part->offset;
f1a28c02 TG	306	res = part->master->block_markbad(part->master, ofs);
	307	if (!res)
	308	mtd->ecc_stats.badblocks++;
	309	return res;
1da177e4 LT	310	}
1da177e4 LT	311
97894cda TG	312	/*
97894cda TG	313	* This function unregisters and destroy all slave MTD objects which are
1da177e4 LT	314	* attached to the given master MTD object.
	315	*/
	316
	317	int del_mtd_partitions(struct mtd_info *master)
	318	{
71a928c0	319	struct mtd_part slave, next;
1da177e4	320
71a928c0	321	list_for_each_entry_safe(slave, next, &mtd_partitions, list)
1da177e4	322	if (slave->master == master) {
71a928c0	323	list_del(&slave->list);
b33a2887	324	if (slave->registered)
1da177e4 LT	325	del_mtd_device(&slave->mtd);
1da177e4 LT	326	kfree(slave);
1da177e4	327	}
1da177e4 LT	328
	329	return 0;
	330	}
b33a2887	331	EXPORT_SYMBOL(del_mtd_partitions);
1da177e4	332
7788ba71 AN	333	static struct mtd_part add_one_partition(struct mtd_info master,
7788ba71 AN	334	const struct mtd_partition *part, int partno,
69423d99	335	uint64_t cur_offset)
7788ba71 AN	336	{
	337	struct mtd_part *slave;
	338
	339	/* allocate the partition structure */
b33a2887	340	slave = kzalloc(sizeof(*slave), GFP_KERNEL);
7788ba71	341	if (!slave) {
b33a2887	342	printk(KERN_ERR"memory allocation error while creating partitions for \"%s\"\n",
7788ba71 AN	343	master->name);
	344	del_mtd_partitions(master);
	345	return NULL;
	346	}
	347	list_add(&slave->list, &mtd_partitions);
	348
	349	/* set up the MTD object for this partition */
	350	slave->mtd.type = master->type;
	351	slave->mtd.flags = master->flags & ~part->mask_flags;
	352	slave->mtd.size = part->size;
	353	slave->mtd.writesize = master->writesize;
	354	slave->mtd.oobsize = master->oobsize;
	355	slave->mtd.oobavail = master->oobavail;
	356	slave->mtd.subpage_sft = master->subpage_sft;
	357
	358	slave->mtd.name = part->name;
	359	slave->mtd.owner = master->owner;
402d3265	360	slave->mtd.backing_dev_info = master->backing_dev_info;
7788ba71	361
1f24b5a8 DB	362	/* NOTE: we don't arrange MTDs as a tree; it'd be error-prone
	363	* to have the same data be in two different partitions.
	364	*/
	365	slave->mtd.dev.parent = master->dev.parent;
	366
7788ba71 AN	367	slave->mtd.read = part_read;
	368	slave->mtd.write = part_write;
	369
	370	if (master->panic_write)
	371	slave->mtd.panic_write = part_panic_write;
	372
b33a2887	373	if (master->point && master->unpoint) {
7788ba71 AN	374	slave->mtd.point = part_point;
	375	slave->mtd.unpoint = part_unpoint;
	376	}
	377
402d3265 DH	378	if (master->get_unmapped_area)
402d3265 DH	379	slave->mtd.get_unmapped_area = part_get_unmapped_area;
7788ba71 AN	380	if (master->read_oob)
	381	slave->mtd.read_oob = part_read_oob;
	382	if (master->write_oob)
	383	slave->mtd.write_oob = part_write_oob;
b33a2887	384	if (master->read_user_prot_reg)
7788ba71	385	slave->mtd.read_user_prot_reg = part_read_user_prot_reg;
b33a2887	386	if (master->read_fact_prot_reg)
7788ba71	387	slave->mtd.read_fact_prot_reg = part_read_fact_prot_reg;
b33a2887	388	if (master->write_user_prot_reg)
7788ba71	389	slave->mtd.write_user_prot_reg = part_write_user_prot_reg;
b33a2887	390	if (master->lock_user_prot_reg)
7788ba71	391	slave->mtd.lock_user_prot_reg = part_lock_user_prot_reg;
b33a2887	392	if (master->get_user_prot_info)
7788ba71	393	slave->mtd.get_user_prot_info = part_get_user_prot_info;
b33a2887	394	if (master->get_fact_prot_info)
7788ba71 AN	395	slave->mtd.get_fact_prot_info = part_get_fact_prot_info;
	396	if (master->sync)
	397	slave->mtd.sync = part_sync;
	398	if (!partno && master->suspend && master->resume) {
	399	slave->mtd.suspend = part_suspend;
	400	slave->mtd.resume = part_resume;
	401	}
	402	if (master->writev)
	403	slave->mtd.writev = part_writev;
	404	if (master->lock)
	405	slave->mtd.lock = part_lock;
	406	if (master->unlock)
	407	slave->mtd.unlock = part_unlock;
	408	if (master->block_isbad)
	409	slave->mtd.block_isbad = part_block_isbad;
	410	if (master->block_markbad)
	411	slave->mtd.block_markbad = part_block_markbad;
	412	slave->mtd.erase = part_erase;
	413	slave->master = master;
	414	slave->offset = part->offset;
	415	slave->index = partno;
	416
	417	if (slave->offset == MTDPART_OFS_APPEND)
	418	slave->offset = cur_offset;
	419	if (slave->offset == MTDPART_OFS_NXTBLK) {
	420	slave->offset = cur_offset;
69423d99	421	if (mtd_mod_by_eb(cur_offset, master) != 0) {
7788ba71	422	/* Round up to next erasesize */
69423d99	423	slave->offset = (mtd_div_by_eb(cur_offset, master) + 1) * master->erasesize;
7788ba71	424	printk(KERN_NOTICE "Moving partition %d: "
69423d99 AH	425	"0x%012llx -> 0x%012llx\n", partno,
69423d99 AH	426	(unsigned long long)cur_offset, (unsigned long long)slave->offset);
7788ba71 AN	427	}
	428	}
	429	if (slave->mtd.size == MTDPART_SIZ_FULL)
	430	slave->mtd.size = master->size - slave->offset;
	431
69423d99 AH	432	printk(KERN_NOTICE "0x%012llx-0x%012llx : \"%s\"\n", (unsigned long long)slave->offset,
69423d99 AH	433	(unsigned long long)(slave->offset + slave->mtd.size), slave->mtd.name);
7788ba71 AN	434
	435	/* let's do some sanity checks */
	436	if (slave->offset >= master->size) {
f636ffb4	437	/* let's register it anyway to preserve ordering */
7788ba71 AN	438	slave->offset = 0;
7788ba71 AN	439	slave->mtd.size = 0;
b33a2887	440	printk(KERN_ERR"mtd: partition \"%s\" is out of reach -- disabled\n",
7788ba71	441	part->name);
f636ffb4	442	goto out_register;
7788ba71 AN	443	}
	444	if (slave->offset + slave->mtd.size > master->size) {
	445	slave->mtd.size = master->size - slave->offset;
69423d99 AH	446	printk(KERN_WARNING"mtd: partition \"%s\" extends beyond the end of device \"%s\" -- size truncated to %#llx\n",
69423d99 AH	447	part->name, master->name, (unsigned long long)slave->mtd.size);
7788ba71	448	}
b33a2887	449	if (master->numeraseregions > 1) {
7788ba71	450	/* Deal with variable erase size stuff */
6910c136	451	int i, max = master->numeraseregions;
69423d99	452	u64 end = slave->offset + slave->mtd.size;
7788ba71 AN	453	struct mtd_erase_region_info *regions = master->eraseregions;
7788ba71 AN	454
6910c136 AN	455	/* Find the first erase regions which is part of this
	456	* partition. */
	457	for (i = 0; i < max && regions[i].offset <= slave->offset; i++)
7788ba71	458	;
6910c136 AN	459	/* The loop searched for the region _behind_ the first one */
6910c136 AN	460	i--;
7788ba71	461
6910c136 AN	462	/* Pick biggest erasesize */
6910c136 AN	463	for (; i < max && regions[i].offset < end; i++) {
7788ba71 AN	464	if (slave->mtd.erasesize < regions[i].erasesize) {
	465	slave->mtd.erasesize = regions[i].erasesize;
	466	}
	467	}
6910c136	468	BUG_ON(slave->mtd.erasesize == 0);
7788ba71 AN	469	} else {
	470	/* Single erase size */
	471	slave->mtd.erasesize = master->erasesize;
	472	}
	473
	474	if ((slave->mtd.flags & MTD_WRITEABLE) &&
69423d99	475	mtd_mod_by_eb(slave->offset, &slave->mtd)) {
7788ba71	476	/* Doesn't start on a boundary of major erase size */
b33a2887 AN	477	/* FIXME: Let it be writable if it is on a boundary of
b33a2887 AN	478	* _minor_ erase size though */
7788ba71	479	slave->mtd.flags &= ~MTD_WRITEABLE;
b33a2887	480	printk(KERN_WARNING"mtd: partition \"%s\" doesn't start on an erase block boundary -- force read-only\n",
7788ba71 AN	481	part->name);
	482	}
	483	if ((slave->mtd.flags & MTD_WRITEABLE) &&
69423d99	484	mtd_mod_by_eb(slave->mtd.size, &slave->mtd)) {
7788ba71	485	slave->mtd.flags &= ~MTD_WRITEABLE;
b33a2887	486	printk(KERN_WARNING"mtd: partition \"%s\" doesn't end on an erase block -- force read-only\n",
7788ba71 AN	487	part->name);
	488	}
	489
	490	slave->mtd.ecclayout = master->ecclayout;
	491	if (master->block_isbad) {
69423d99	492	uint64_t offs = 0;
7788ba71	493
b33a2887	494	while (offs < slave->mtd.size) {
7788ba71 AN	495	if (master->block_isbad(master,
	496	offs + slave->offset))
	497	slave->mtd.ecc_stats.badblocks++;
	498	offs += slave->mtd.erasesize;
	499	}
	500	}
	501
f636ffb4	502	out_register:
b33a2887 AN	503	if (part->mtdp) {
b33a2887 AN	504	/* store the object pointer (caller may or may not register it*/
7788ba71 AN	505	*part->mtdp = &slave->mtd;
	506	slave->registered = 0;
	507	} else {
	508	/* register our partition */
	509	add_mtd_device(&slave->mtd);
	510	slave->registered = 1;
	511	}
	512	return slave;
	513	}
	514
1da177e4 LT	515	/*
	516	* This function, given a master MTD object and a partition table, creates
	517	* and registers slave MTD objects which are bound to the master according to
	518	* the partition definitions.
1f24b5a8 DB	519	*
	520	* We don't register the master, or expect the caller to have done so,
	521	* for reasons of data integrity.
1da177e4 LT	522	*/
1da177e4 LT	523
97894cda	524	int add_mtd_partitions(struct mtd_info *master,
1da177e4 LT	525	const struct mtd_partition *parts,
	526	int nbparts)
	527	{
	528	struct mtd_part *slave;
69423d99	529	uint64_t cur_offset = 0;
1da177e4 LT	530	int i;
1da177e4 LT	531
b33a2887	532	printk(KERN_NOTICE "Creating %d MTD partitions on \"%s\":\n", nbparts, master->name);
1da177e4 LT	533
1da177e4 LT	534	for (i = 0; i < nbparts; i++) {
7788ba71 AN	535	slave = add_one_partition(master, parts + i, i, cur_offset);
7788ba71 AN	536	if (!slave)
1da177e4	537	return -ENOMEM;
1da177e4	538	cur_offset = slave->offset + slave->mtd.size;
1da177e4 LT	539	}
	540
	541	return 0;
	542	}
1da177e4	543	EXPORT_SYMBOL(add_mtd_partitions);
1da177e4 LT	544
	545	static DEFINE_SPINLOCK(part_parser_lock);
	546	static LIST_HEAD(part_parsers);
	547
	548	static struct mtd_part_parser get_partition_parser(const char name)
	549	{
71a928c0	550	struct mtd_part_parser p, ret = NULL;
1da177e4	551
71a928c0	552	spin_lock(&part_parser_lock);
1da177e4	553
71a928c0	554	list_for_each_entry(p, &part_parsers, list)
1da177e4 LT	555	if (!strcmp(p->name, name) && try_module_get(p->owner)) {
	556	ret = p;
	557	break;
	558	}
71a928c0	559
1da177e4 LT	560	spin_unlock(&part_parser_lock);
	561
	562	return ret;
	563	}
	564
	565	int register_mtd_parser(struct mtd_part_parser *p)
	566	{
	567	spin_lock(&part_parser_lock);
	568	list_add(&p->list, &part_parsers);
	569	spin_unlock(&part_parser_lock);
	570
	571	return 0;
	572	}
b33a2887	573	EXPORT_SYMBOL_GPL(register_mtd_parser);
1da177e4 LT	574
	575	int deregister_mtd_parser(struct mtd_part_parser *p)
	576	{
	577	spin_lock(&part_parser_lock);
	578	list_del(&p->list);
	579	spin_unlock(&part_parser_lock);
	580	return 0;
	581	}
b33a2887	582	EXPORT_SYMBOL_GPL(deregister_mtd_parser);
1da177e4	583
97894cda	584	int parse_mtd_partitions(struct mtd_info master, const char *types,
1da177e4 LT	585	struct mtd_partition **pparts, unsigned long origin)
	586	{
	587	struct mtd_part_parser *parser;
	588	int ret = 0;
97894cda	589
1da177e4 LT	590	for ( ; ret <= 0 && *types; types++) {
1da177e4 LT	591	parser = get_partition_parser(*types);
1da177e4 LT	592	if (!parser && !request_module("%s", *types))
1da177e4 LT	593	parser = get_partition_parser(*types);
1da177e4 LT	594	if (!parser) {
	595	printk(KERN_NOTICE "%s partition parsing not available\n",
	596	*types);
	597	continue;
	598	}
	599	ret = (*parser->parse_fn)(master, pparts, origin);
	600	if (ret > 0) {
97894cda	601	printk(KERN_NOTICE "%d %s partitions found on MTD device %s\n",
1da177e4 LT	602	ret, parser->name, master->name);
	603	}
	604	put_partition_parser(parser);
	605	}
	606	return ret;
	607	}
1da177e4	608	EXPORT_SYMBOL_GPL(parse_mtd_partitions);