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