[net-next-2.6.git] / drivers / mtd / maps / physmap_of.c

/*
 * Flash mappings described by the OF (or flattened) device tree
 *
 * Copyright (C) 2006 MontaVista Software Inc.
 * Author: Vitaly Wool <vwool@ru.mvista.com>
 *
 * Revised to handle newer style flash binding by:
 *   Copyright (C) 2007 David Gibson, IBM Corporation.
 *
 * 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.
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/init.h>
#include <linux/device.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/map.h>
#include <linux/mtd/partitions.h>
#include <linux/mtd/concat.h>
#include <linux/of.h>
#include <linux/of_platform.h>

struct of_flash_list {
	struct mtd_info *mtd;
	struct map_info map;
	struct resource *res;
};

struct of_flash {
	struct mtd_info		*cmtd;
#ifdef CONFIG_MTD_PARTITIONS
	struct mtd_partition	*parts;
#endif
	int list_size; /* number of elements in of_flash_list */
	struct of_flash_list	list[0];
};

#ifdef CONFIG_MTD_PARTITIONS
#define OF_FLASH_PARTS(info)	((info)->parts)

static int parse_obsolete_partitions(struct of_device *dev,
				     struct of_flash *info,
				     struct device_node *dp)
{
	int i, plen, nr_parts;
	const struct {
		u32 offset, len;
	} *part;
	const char *names;

	part = of_get_property(dp, "partitions", &plen);
	if (!part)
		return 0; /* No partitions found */

	dev_warn(&dev->dev, "Device tree uses obsolete partition map binding\n");

	nr_parts = plen / sizeof(part[0]);

	info->parts = kzalloc(nr_parts * sizeof(*info->parts), GFP_KERNEL);
	if (!info->parts)
		return -ENOMEM;

	names = of_get_property(dp, "partition-names", &plen);

	for (i = 0; i < nr_parts; i++) {
		info->parts[i].offset = part->offset;
		info->parts[i].size   = part->len & ~1;
		if (part->len & 1) /* bit 0 set signifies read only partition */
			info->parts[i].mask_flags = MTD_WRITEABLE;

		if (names && (plen > 0)) {
			int len = strlen(names) + 1;

			info->parts[i].name = (char *)names;
			plen -= len;
			names += len;
		} else {
			info->parts[i].name = "unnamed";
		}

		part++;
	}

	return nr_parts;
}
#else /* MTD_PARTITIONS */
#define	OF_FLASH_PARTS(info)		(0)
#define parse_partitions(info, dev)	(0)
#endif /* MTD_PARTITIONS */

static int of_flash_remove(struct of_device *dev)
{
	struct of_flash *info;
	int i;

	info = dev_get_drvdata(&dev->dev);
	if (!info)
		return 0;
	dev_set_drvdata(&dev->dev, NULL);

#ifdef CONFIG_MTD_CONCAT
	if (info->cmtd != info->list[0].mtd) {
		del_mtd_device(info->cmtd);
		mtd_concat_destroy(info->cmtd);
	}
#endif

	if (info->cmtd) {
		if (OF_FLASH_PARTS(info)) {
			del_mtd_partitions(info->cmtd);
			kfree(OF_FLASH_PARTS(info));
		} else {
			del_mtd_device(info->cmtd);
		}
	}

	for (i = 0; i < info->list_size; i++) {
		if (info->list[i].mtd)
			map_destroy(info->list[i].mtd);

		if (info->list[i].map.virt)
			iounmap(info->list[i].map.virt);

		if (info->list[i].res) {
			release_resource(info->list[i].res);
			kfree(info->list[i].res);
		}
	}

	kfree(info);

	return 0;
}

/* Helper function to handle probing of the obsolete "direct-mapped"
 * compatible binding, which has an extra "probe-type" property
 * describing the type of flash probe necessary. */
static struct mtd_info * __devinit obsolete_probe(struct of_device *dev,
						  struct map_info *map)
{
	struct device_node *dp = dev->node;
	const char *of_probe;
	struct mtd_info *mtd;
	static const char *rom_probe_types[]
		= { "cfi_probe", "jedec_probe", "map_rom"};
	int i;

	dev_warn(&dev->dev, "Device tree uses obsolete \"direct-mapped\" "
		 "flash binding\n");

	of_probe = of_get_property(dp, "probe-type", NULL);
	if (!of_probe) {
		for (i = 0; i < ARRAY_SIZE(rom_probe_types); i++) {
			mtd = do_map_probe(rom_probe_types[i], map);
			if (mtd)
				return mtd;
		}
		return NULL;
	} else if (strcmp(of_probe, "CFI") == 0) {
		return do_map_probe("cfi_probe", map);
	} else if (strcmp(of_probe, "JEDEC") == 0) {
		return do_map_probe("jedec_probe", map);
	} else {
		if (strcmp(of_probe, "ROM") != 0)
			dev_warn(&dev->dev, "obsolete_probe: don't know probe "
				 "type '%s', mapping as rom\n", of_probe);
		return do_map_probe("mtd_rom", map);
	}
}

static int __devinit of_flash_probe(struct of_device *dev,
				    const struct of_device_id *match)
{
#ifdef CONFIG_MTD_PARTITIONS
	static const char *part_probe_types[]
		= { "cmdlinepart", "RedBoot", NULL };
#endif
	struct device_node *dp = dev->node;
	struct resource res;
	struct of_flash *info;
	const char *probe_type = match->data;
	const u32 *width;
	int err;
	int i;
	int count;
	const u32 *p;
	int reg_tuple_size;
	struct mtd_info **mtd_list = NULL;
	resource_size_t res_size;

	reg_tuple_size = (of_n_addr_cells(dp) + of_n_size_cells(dp)) * sizeof(u32);

	/*
	 * Get number of "reg" tuples. Scan for MTD devices on area's
	 * described by each "reg" region. This makes it possible (including
	 * the concat support) to support the Intel P30 48F4400 chips which
	 * consists internally of 2 non-identical NOR chips on one die.
	 */
	p = of_get_property(dp, "reg", &count);
	if (count % reg_tuple_size != 0) {
		dev_err(&dev->dev, "Malformed reg property on %s\n",
				dev->node->full_name);
		err = -EINVAL;
		goto err_flash_remove;
	}
	count /= reg_tuple_size;

	err = -ENOMEM;
	info = kzalloc(sizeof(struct of_flash) +
		       sizeof(struct of_flash_list) * count, GFP_KERNEL);
	if (!info)
		goto err_flash_remove;

	dev_set_drvdata(&dev->dev, info);

	mtd_list = kzalloc(sizeof(struct mtd_info) * count, GFP_KERNEL);
	if (!mtd_list)
		goto err_flash_remove;

	for (i = 0; i < count; i++) {
		err = -ENXIO;
		if (of_address_to_resource(dp, i, &res)) {
			dev_err(&dev->dev, "Can't get IO address from device"
				" tree\n");
			goto err_out;
		}

		dev_dbg(&dev->dev, "of_flash device: %.8llx-%.8llx\n",
			(unsigned long long)res.start,
			(unsigned long long)res.end);

		err = -EBUSY;
		res_size = resource_size(&res);
		info->list[i].res = request_mem_region(res.start, res_size,
						       dev_name(&dev->dev));
		if (!info->list[i].res)
			goto err_out;

		err = -ENXIO;
		width = of_get_property(dp, "bank-width", NULL);
		if (!width) {
			dev_err(&dev->dev, "Can't get bank width from device"
				" tree\n");
			goto err_out;
		}

		info->list[i].map.name = dev_name(&dev->dev);
		info->list[i].map.phys = res.start;
		info->list[i].map.size = res_size;
		info->list[i].map.bankwidth = *width;

		err = -ENOMEM;
		info->list[i].map.virt = ioremap(info->list[i].map.phys,
						 info->list[i].map.size);
		if (!info->list[i].map.virt) {
			dev_err(&dev->dev, "Failed to ioremap() flash"
				" region\n");
			goto err_out;
		}

		simple_map_init(&info->list[i].map);

		if (probe_type) {
			info->list[i].mtd = do_map_probe(probe_type,
							 &info->list[i].map);
		} else {
			info->list[i].mtd = obsolete_probe(dev,
							   &info->list[i].map);
		}
		mtd_list[i] = info->list[i].mtd;

		err = -ENXIO;
		if (!info->list[i].mtd) {
			dev_err(&dev->dev, "do_map_probe() failed\n");
			goto err_out;
		} else {
			info->list_size++;
		}
		info->list[i].mtd->owner = THIS_MODULE;
		info->list[i].mtd->dev.parent = &dev->dev;
	}

	err = 0;
	if (info->list_size == 1) {
		info->cmtd = info->list[0].mtd;
	} else if (info->list_size > 1) {
		/*
		 * We detected multiple devices. Concatenate them together.
		 */
#ifdef CONFIG_MTD_CONCAT
		info->cmtd = mtd_concat_create(mtd_list, info->list_size,
					       dev_name(&dev->dev));
		if (info->cmtd == NULL)
			err = -ENXIO;
#else
		printk(KERN_ERR "physmap_of: multiple devices "
		       "found but MTD concat support disabled.\n");
		err = -ENXIO;
#endif
	}
	if (err)
		goto err_out;

#ifdef CONFIG_MTD_PARTITIONS
	/* First look for RedBoot table or partitions on the command
	 * line, these take precedence over device tree information */
	err = parse_mtd_partitions(info->cmtd, part_probe_types,
				   &info->parts, 0);
	if (err < 0)
		return err;

#ifdef CONFIG_MTD_OF_PARTS
	if (err == 0) {
		err = of_mtd_parse_partitions(&dev->dev, dp, &info->parts);
		if (err < 0)
			return err;
	}
#endif

	if (err == 0) {
		err = parse_obsolete_partitions(dev, info, dp);
		if (err < 0)
			return err;
	}

	if (err > 0)
		add_mtd_partitions(info->cmtd, info->parts, err);
	else
#endif
		add_mtd_device(info->cmtd);

	kfree(mtd_list);

	return 0;

err_out:
	kfree(mtd_list);
err_flash_remove:
	of_flash_remove(dev);

	return err;
}

static struct of_device_id of_flash_match[] = {
	{
		.compatible	= "cfi-flash",
		.data		= (void *)"cfi_probe",
	},
	{
		/* FIXME: JEDEC chips can't be safely and reliably
		 * probed, although the mtd code gets it right in
		 * practice most of the time.  We should use the
		 * vendor and device ids specified by the binding to
		 * bypass the heuristic probe code, but the mtd layer
		 * provides, at present, no interface for doing so
		 * :(. */
		.compatible	= "jedec-flash",
		.data		= (void *)"jedec_probe",
	},
	{
		.compatible     = "mtd-ram",
		.data           = (void *)"map_ram",
	},
	{
		.type		= "rom",
		.compatible	= "direct-mapped"
	},
	{ },
};
MODULE_DEVICE_TABLE(of, of_flash_match);

static struct of_platform_driver of_flash_driver = {
	.name		= "of-flash",
	.match_table	= of_flash_match,
	.probe		= of_flash_probe,
	.remove		= of_flash_remove,
};

static int __init of_flash_init(void)
{
	return of_register_platform_driver(&of_flash_driver);
}

static void __exit of_flash_exit(void)
{
	of_unregister_platform_driver(&of_flash_driver);
}

module_init(of_flash_init);
module_exit(of_flash_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Vitaly Wool <vwool@ru.mvista.com>");
MODULE_DESCRIPTION("Device tree based MTD map driver");
Commit	Line	Data
a2c2fe4b	1	/*
c4d5e375	2	* Flash mappings described by the OF (or flattened) device tree
a2c2fe4b VW	3	*
	4	* Copyright (C) 2006 MontaVista Software Inc.
	5	* Author: Vitaly Wool <vwool@ru.mvista.com>
	6	*
2099172d DG	7	* Revised to handle newer style flash binding by:
	8	* Copyright (C) 2007 David Gibson, IBM Corporation.
	9	*
a2c2fe4b VW	10	* This program is free software; you can redistribute it and/or modify it
	11	* under the terms of the GNU General Public License as published by the
	12	* Free Software Foundation; either version 2 of the License, or (at your
	13	* option) any later version.
	14	*/
	15
	16	#include <linux/module.h>
	17	#include <linux/types.h>
a2c2fe4b	18	#include <linux/init.h>
a2c2fe4b VW	19	#include <linux/device.h>
	20	#include <linux/mtd/mtd.h>
	21	#include <linux/mtd/map.h>
	22	#include <linux/mtd/partitions.h>
143070e7	23	#include <linux/mtd/concat.h>
c4d5e375 DG	24	#include <linux/of.h>
c4d5e375 DG	25	#include <linux/of_platform.h>
a2c2fe4b	26
143070e7 SR	27	struct of_flash_list {
	28	struct mtd_info *mtd;
	29	struct map_info map;
	30	struct resource *res;
	31	};
	32
c4d5e375	33	struct of_flash {
143070e7	34	struct mtd_info *cmtd;
a2c2fe4b	35	#ifdef CONFIG_MTD_PARTITIONS
a2c2fe4b VW	36	struct mtd_partition *parts;
a2c2fe4b VW	37	#endif
143070e7 SR	38	int list_size; /* number of elements in of_flash_list */
143070e7 SR	39	struct of_flash_list list[0];
a2c2fe4b VW	40	};
a2c2fe4b VW	41
a2c2fe4b	42	#ifdef CONFIG_MTD_PARTITIONS
c4d5e375	43	#define OF_FLASH_PARTS(info) ((info)->parts)
a2c2fe4b	44
2099172d	45	static int parse_obsolete_partitions(struct of_device *dev,
c4d5e375	46	struct of_flash *info,
2099172d	47	struct device_node *dp)
a2c2fe4b	48	{
2099172d DG	49	int i, plen, nr_parts;
	50	const struct {
	51	u32 offset, len;
	52	} *part;
	53	const char *names;
a2c2fe4b	54
2099172d DG	55	part = of_get_property(dp, "partitions", &plen);
2099172d DG	56	if (!part)
c4d5e375	57	return 0; /* No partitions found */
a2c2fe4b	58
2099172d DG	59	dev_warn(&dev->dev, "Device tree uses obsolete partition map binding\n");
	60
	61	nr_parts = plen / sizeof(part[0]);
	62
c4d5e375 DG	63	info->parts = kzalloc(nr_parts * sizeof(*info->parts), GFP_KERNEL);
c4d5e375 DG	64	if (!info->parts)
2099172d	65	return -ENOMEM;
a2c2fe4b	66
2099172d	67	names = of_get_property(dp, "partition-names", &plen);
a2c2fe4b	68
2099172d DG	69	for (i = 0; i < nr_parts; i++) {
	70	info->parts[i].offset = part->offset;
	71	info->parts[i].size = part->len & ~1;
	72	if (part->len & 1) /* bit 0 set signifies read only partition */
	73	info->parts[i].mask_flags = MTD_WRITEABLE;
a2c2fe4b	74
2099172d DG	75	if (names && (plen > 0)) {
2099172d DG	76	int len = strlen(names) + 1;
a2c2fe4b	77
2099172d	78	info->parts[i].name = (char *)names;
a2c2fe4b	79	plen -= len;
2099172d DG	80	names += len;
	81	} else {
	82	info->parts[i].name = "unnamed";
	83	}
	84
	85	part++;
a2c2fe4b	86	}
2099172d DG	87
2099172d DG	88	return nr_parts;
a2c2fe4b	89	}
2099172d	90	#else /* MTD_PARTITIONS */
c4d5e375 DG	91	#define OF_FLASH_PARTS(info) (0)
c4d5e375 DG	92	#define parse_partitions(info, dev) (0)
2099172d	93	#endif /* MTD_PARTITIONS */
a2c2fe4b	94
c4d5e375	95	static int of_flash_remove(struct of_device *dev)
a2c2fe4b	96	{
c4d5e375	97	struct of_flash *info;
143070e7	98	int i;
a2c2fe4b VW	99
a2c2fe4b VW	100	info = dev_get_drvdata(&dev->dev);
c4d5e375	101	if (!info)
a2c2fe4b VW	102	return 0;
	103	dev_set_drvdata(&dev->dev, NULL);
	104
143070e7 SR	105	#ifdef CONFIG_MTD_CONCAT
	106	if (info->cmtd != info->list[0].mtd) {
	107	del_mtd_device(info->cmtd);
	108	mtd_concat_destroy(info->cmtd);
	109	}
	110	#endif
	111
	112	if (info->cmtd) {
c4d5e375	113	if (OF_FLASH_PARTS(info)) {
143070e7	114	del_mtd_partitions(info->cmtd);
c4d5e375	115	kfree(OF_FLASH_PARTS(info));
a2c2fe4b	116	} else {
143070e7	117	del_mtd_device(info->cmtd);
a2c2fe4b	118	}
a2c2fe4b VW	119	}
a2c2fe4b VW	120
143070e7 SR	121	for (i = 0; i < info->list_size; i++) {
	122	if (info->list[i].mtd)
	123	map_destroy(info->list[i].mtd);
a2c2fe4b	124
143070e7 SR	125	if (info->list[i].map.virt)
	126	iounmap(info->list[i].map.virt);
	127
	128	if (info->list[i].res) {
	129	release_resource(info->list[i].res);
	130	kfree(info->list[i].res);
	131	}
a2c2fe4b VW	132	}
a2c2fe4b VW	133
143070e7 SR	134	kfree(info);
143070e7 SR	135
a2c2fe4b VW	136	return 0;
	137	}
	138
2099172d DG	139	/* Helper function to handle probing of the obsolete "direct-mapped"
	140	* compatible binding, which has an extra "probe-type" property
	141	* describing the type of flash probe necessary. */
	142	static struct mtd_info * __devinit obsolete_probe(struct of_device *dev,
	143	struct map_info *map)
a2c2fe4b VW	144	{
a2c2fe4b VW	145	struct device_node *dp = dev->node;
a2c2fe4b	146	const char *of_probe;
2099172d DG	147	struct mtd_info *mtd;
	148	static const char *rom_probe_types[]
	149	= { "cfi_probe", "jedec_probe", "map_rom"};
	150	int i;
	151
	152	dev_warn(&dev->dev, "Device tree uses obsolete \"direct-mapped\" "
	153	"flash binding\n");
	154
	155	of_probe = of_get_property(dp, "probe-type", NULL);
	156	if (!of_probe) {
	157	for (i = 0; i < ARRAY_SIZE(rom_probe_types); i++) {
	158	mtd = do_map_probe(rom_probe_types[i], map);
	159	if (mtd)
	160	return mtd;
	161	}
	162	return NULL;
	163	} else if (strcmp(of_probe, "CFI") == 0) {
	164	return do_map_probe("cfi_probe", map);
	165	} else if (strcmp(of_probe, "JEDEC") == 0) {
	166	return do_map_probe("jedec_probe", map);
	167	} else {
	168	if (strcmp(of_probe, "ROM") != 0)
c4d5e375 DG	169	dev_warn(&dev->dev, "obsolete_probe: don't know probe "
c4d5e375 DG	170	"type '%s', mapping as rom\n", of_probe);
2099172d DG	171	return do_map_probe("mtd_rom", map);
	172	}
	173	}
	174
c4d5e375 DG	175	static int __devinit of_flash_probe(struct of_device *dev,
c4d5e375 DG	176	const struct of_device_id *match)
a2c2fe4b	177	{
9a310d21 SW	178	#ifdef CONFIG_MTD_PARTITIONS
	179	static const char *part_probe_types[]
	180	= { "cmdlinepart", "RedBoot", NULL };
	181	#endif
a2c2fe4b VW	182	struct device_node *dp = dev->node;
a2c2fe4b VW	183	struct resource res;
c4d5e375 DG	184	struct of_flash *info;
c4d5e375 DG	185	const char *probe_type = match->data;
a2c2fe4b VW	186	const u32 *width;
a2c2fe4b VW	187	int err;
143070e7 SR	188	int i;
	189	int count;
	190	const u32 *p;
	191	int reg_tuple_size;
	192	struct mtd_info **mtd_list = NULL;
2763c508	193	resource_size_t res_size;
143070e7 SR	194
	195	reg_tuple_size = (of_n_addr_cells(dp) + of_n_size_cells(dp)) * sizeof(u32);
	196
	197	/*
	198	* Get number of "reg" tuples. Scan for MTD devices on area's
	199	* described by each "reg" region. This makes it possible (including
	200	* the concat support) to support the Intel P30 48F4400 chips which
	201	* consists internally of 2 non-identical NOR chips on one die.
	202	*/
	203	p = of_get_property(dp, "reg", &count);
	204	if (count % reg_tuple_size != 0) {
	205	dev_err(&dev->dev, "Malformed reg property on %s\n",
	206	dev->node->full_name);
	207	err = -EINVAL;
ad4fbc79	208	goto err_flash_remove;
a2c2fe4b	209	}
143070e7	210	count /= reg_tuple_size;
a2c2fe4b	211
c4d5e375	212	err = -ENOMEM;
143070e7 SR	213	info = kzalloc(sizeof(struct of_flash) +
	214	sizeof(struct of_flash_list) * count, GFP_KERNEL);
	215	if (!info)
ad4fbc79	216	goto err_flash_remove;
a2c2fe4b VW	217
	218	dev_set_drvdata(&dev->dev, info);
	219
ad4fbc79	220	mtd_list = kzalloc(sizeof(struct mtd_info) * count, GFP_KERNEL);
	221	if (!mtd_list)
	222	goto err_flash_remove;
	223
143070e7 SR	224	for (i = 0; i < count; i++) {
	225	err = -ENXIO;
	226	if (of_address_to_resource(dp, i, &res)) {
	227	dev_err(&dev->dev, "Can't get IO address from device"
	228	" tree\n");
	229	goto err_out;
	230	}
a2c2fe4b	231
143070e7 SR	232	dev_dbg(&dev->dev, "of_flash device: %.8llx-%.8llx\n",
	233	(unsigned long long)res.start,
	234	(unsigned long long)res.end);
	235
	236	err = -EBUSY;
2763c508 WS	237	res_size = resource_size(&res);
2763c508 WS	238	info->list[i].res = request_mem_region(res.start, res_size,
143070e7 SR	239	dev_name(&dev->dev));
	240	if (!info->list[i].res)
	241	goto err_out;
	242
	243	err = -ENXIO;
	244	width = of_get_property(dp, "bank-width", NULL);
	245	if (!width) {
	246	dev_err(&dev->dev, "Can't get bank width from device"
	247	" tree\n");
	248	goto err_out;
	249	}
a2c2fe4b	250
143070e7 SR	251	info->list[i].map.name = dev_name(&dev->dev);
143070e7 SR	252	info->list[i].map.phys = res.start;
2763c508	253	info->list[i].map.size = res_size;
143070e7 SR	254	info->list[i].map.bankwidth = *width;
	255
	256	err = -ENOMEM;
	257	info->list[i].map.virt = ioremap(info->list[i].map.phys,
	258	info->list[i].map.size);
	259	if (!info->list[i].map.virt) {
	260	dev_err(&dev->dev, "Failed to ioremap() flash"
	261	" region\n");
	262	goto err_out;
	263	}
a2c2fe4b	264
143070e7	265	simple_map_init(&info->list[i].map);
a2c2fe4b	266
143070e7 SR	267	if (probe_type) {
	268	info->list[i].mtd = do_map_probe(probe_type,
	269	&info->list[i].map);
	270	} else {
	271	info->list[i].mtd = obsolete_probe(dev,
	272	&info->list[i].map);
	273	}
	274	mtd_list[i] = info->list[i].mtd;
a2c2fe4b	275
143070e7 SR	276	err = -ENXIO;
	277	if (!info->list[i].mtd) {
	278	dev_err(&dev->dev, "do_map_probe() failed\n");
	279	goto err_out;
	280	} else {
	281	info->list_size++;
	282	}
	283	info->list[i].mtd->owner = THIS_MODULE;
	284	info->list[i].mtd->dev.parent = &dev->dev;
	285	}
2099172d	286
143070e7 SR	287	err = 0;
	288	if (info->list_size == 1) {
	289	info->cmtd = info->list[0].mtd;
	290	} else if (info->list_size > 1) {
	291	/*
	292	* We detected multiple devices. Concatenate them together.
	293	*/
	294	#ifdef CONFIG_MTD_CONCAT
	295	info->cmtd = mtd_concat_create(mtd_list, info->list_size,
	296	dev_name(&dev->dev));
	297	if (info->cmtd == NULL)
	298	err = -ENXIO;
	299	#else
	300	printk(KERN_ERR "physmap_of: multiple devices "
	301	"found but MTD concat support disabled.\n");
	302	err = -ENXIO;
	303	#endif
a2c2fe4b	304	}
143070e7 SR	305	if (err)
143070e7 SR	306	goto err_out;
a2c2fe4b	307
9a310d21 SW	308	#ifdef CONFIG_MTD_PARTITIONS
	309	/* First look for RedBoot table or partitions on the command
	310	* line, these take precedence over device tree information */
143070e7 SR	311	err = parse_mtd_partitions(info->cmtd, part_probe_types,
143070e7 SR	312	&info->parts, 0);
c4d5e375	313	if (err < 0)
9a310d21 SW	314	return err;
	315
	316	#ifdef CONFIG_MTD_OF_PARTS
	317	if (err == 0) {
69fd3a8d	318	err = of_mtd_parse_partitions(&dev->dev, dp, &info->parts);
9a310d21 SW	319	if (err < 0)
	320	return err;
	321	}
	322	#endif
	323
	324	if (err == 0) {
	325	err = parse_obsolete_partitions(dev, info, dp);
	326	if (err < 0)
	327	return err;
	328	}
a2c2fe4b	329
c4d5e375	330	if (err > 0)
143070e7	331	add_mtd_partitions(info->cmtd, info->parts, err);
c4d5e375	332	else
9a310d21	333	#endif
143070e7 SR	334	add_mtd_device(info->cmtd);
	335
	336	kfree(mtd_list);
a2c2fe4b	337
a2c2fe4b VW	338	return 0;
	339
	340	err_out:
143070e7	341	kfree(mtd_list);
ad4fbc79	342	err_flash_remove:
c4d5e375	343	of_flash_remove(dev);
143070e7	344
a2c2fe4b	345	return err;
a2c2fe4b VW	346	}
a2c2fe4b VW	347
c4d5e375	348	static struct of_device_id of_flash_match[] = {
2099172d DG	349	{
	350	.compatible = "cfi-flash",
	351	.data = (void *)"cfi_probe",
	352	},
	353	{
	354	/* FIXME: JEDEC chips can't be safely and reliably
	355	* probed, although the mtd code gets it right in
	356	* practice most of the time. We should use the
	357	* vendor and device ids specified by the binding to
	358	* bypass the heuristic probe code, but the mtd layer
	359	* provides, at present, no interface for doing so
	360	* :(. */
	361	.compatible = "jedec-flash",
	362	.data = (void *)"jedec_probe",
	363	},
fc28c39f WS	364	{
	365	.compatible = "mtd-ram",
	366	.data = (void *)"map_ram",
	367	},
a2c2fe4b VW	368	{
	369	.type = "rom",
	370	.compatible = "direct-mapped"
	371	},
	372	{ },
	373	};
c4d5e375	374	MODULE_DEVICE_TABLE(of, of_flash_match);
a2c2fe4b	375
c4d5e375 DG	376	static struct of_platform_driver of_flash_driver = {
	377	.name = "of-flash",
	378	.match_table = of_flash_match,
	379	.probe = of_flash_probe,
	380	.remove = of_flash_remove,
a2c2fe4b VW	381	};
a2c2fe4b VW	382
c4d5e375	383	static int __init of_flash_init(void)
a2c2fe4b	384	{
c4d5e375	385	return of_register_platform_driver(&of_flash_driver);
a2c2fe4b VW	386	}
a2c2fe4b VW	387
c4d5e375	388	static void __exit of_flash_exit(void)
a2c2fe4b	389	{
c4d5e375	390	of_unregister_platform_driver(&of_flash_driver);
a2c2fe4b VW	391	}
a2c2fe4b VW	392
c4d5e375 DG	393	module_init(of_flash_init);
c4d5e375 DG	394	module_exit(of_flash_exit);
a2c2fe4b VW	395
	396	MODULE_LICENSE("GPL");
	397	MODULE_AUTHOR("Vitaly Wool <vwool@ru.mvista.com>");
c4d5e375	398	MODULE_DESCRIPTION("Device tree based MTD map driver");