ofpart.c 1.9 KB
Newer Older
1 2 3
/*
 * Flash partitions described by the OF (or flattened) device tree
 *
D
David Woodhouse 已提交
4
 * Copyright © 2006 MontaVista Software Inc.
5 6 7
 * Author: Vitaly Wool <vwool@ru.mvista.com>
 *
 * Revised to handle newer style flash binding by:
D
David Woodhouse 已提交
8
 *   Copyright © 2007 David Gibson, IBM Corporation.
9 10 11 12 13 14 15 16 17 18 19
 *
 * 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/init.h>
#include <linux/of.h>
#include <linux/mtd/mtd.h>
20
#include <linux/slab.h>
21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46
#include <linux/mtd/partitions.h>

int __devinit of_mtd_parse_partitions(struct device *dev,
                                      struct device_node *node,
                                      struct mtd_partition **pparts)
{
	const char *partname;
	struct device_node *pp;
	int nr_parts, i;

	/* First count the subnodes */
	pp = NULL;
	nr_parts = 0;
	while ((pp = of_get_next_child(node, pp)))
		nr_parts++;

	if (nr_parts == 0)
		return 0;

	*pparts = kzalloc(nr_parts * sizeof(**pparts), GFP_KERNEL);
	if (!*pparts)
		return -ENOMEM;

	pp = NULL;
	i = 0;
	while ((pp = of_get_next_child(node, pp))) {
47
		const __be32 *reg;
48 49
		int len;

50 51
		reg = of_get_property(pp, "reg", &len);
		if (!reg) {
52 53 54 55
			nr_parts--;
			continue;
		}

56 57
		(*pparts)[i].offset = be32_to_cpu(reg[0]);
		(*pparts)[i].size = be32_to_cpu(reg[1]);
58 59 60 61 62 63 64 65 66 67 68 69

		partname = of_get_property(pp, "label", &len);
		if (!partname)
			partname = of_get_property(pp, "name", &len);
		(*pparts)[i].name = (char *)partname;

		if (of_get_property(pp, "read-only", &len))
			(*pparts)[i].mask_flags = MTD_WRITEABLE;

		i++;
	}

70 71 72 73 74 75 76 77
	if (!i) {
		of_node_put(pp);
		dev_err(dev, "No valid partition found on %s\n", node->full_name);
		kfree(*pparts);
		*pparts = NULL;
		return -EINVAL;
	}

78 79 80
	return nr_parts;
}
EXPORT_SYMBOL(of_mtd_parse_partitions);
81 82

MODULE_LICENSE("GPL");