[PATCH 1/3 v3] mtd: physmap_of: Add multiple regions and concatenation support
Grant Likely
grant.likely at secretlab.ca
Thu Apr 16 23:26:53 EST 2009
On Thu, Apr 16, 2009 at 6:10 AM, Stefan Roese <sr at denx.de> wrote:
> This patch adds support to handle multiple non-identical chips in one
> flash device tree node. It also adds concat support to physmap_of. This
> makes it possible to support e.g. the Intel P30 48F4400 chips which
> internally consists of 2 non-identical NOR chips on one die. Additionally
> partitions now can span over multiple chips.
>
> To describe such a chip's, multiple "reg" tuples are now supported in one
> flash device tree node. Here an dts example:
>
> flash at f0000000,0 {
> #address-cells = <1>;
> #size-cells = <1>;
> compatible = "cfi-flash";
> reg = <0 0x00000000 0x02000000
> 0 0x02000000 0x02000000>;
> bank-width = <2>;
> partition at 0 {
> label = "test-part1";
> reg = <0 0x04000000>;
> };
> };
>
> Signed-off-by: Stefan Roese <sr at denx.de>
> Reviewd-by: Grant Likely <grant.likely at secretlab.ca>
Yup, still looks good to me. What boards has this been tested on?
g.
> ---
> Changes in ver3:
> - s/4/sizeof(u32)
>
> Changes in ver2 (as suggested by Grant Likely):
> - Removed MAX_RESOURCES introduced in ver1. Now we don't have a hard limit
> for "reg" tuples anymore.
> - Used of_n_addr_cells() and of_n_size_cells() to determine size of each tuple.
>
> drivers/mtd/maps/physmap_of.c | 199 +++++++++++++++++++++++++++++------------
> 1 files changed, 143 insertions(+), 56 deletions(-)
>
> diff --git a/drivers/mtd/maps/physmap_of.c b/drivers/mtd/maps/physmap_of.c
> index c83a60f..39d357b 100644
> --- a/drivers/mtd/maps/physmap_of.c
> +++ b/drivers/mtd/maps/physmap_of.c
> @@ -20,16 +20,23 @@
> #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 *mtd;
> - struct map_info map;
> - struct resource *res;
> + 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
> @@ -88,30 +95,44 @@ static int parse_obsolete_partitions(struct of_device *dev,
> 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);
>
> - if (info->mtd) {
> +#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->mtd);
> + del_mtd_partitions(info->cmtd);
> kfree(OF_FLASH_PARTS(info));
> } else {
> - del_mtd_device(info->mtd);
> + del_mtd_device(info->cmtd);
> }
> - map_destroy(info->mtd);
> }
>
> - if (info->map.virt)
> - iounmap(info->map.virt);
> + for (i = 0; i < info->list_size; i++) {
> + if (info->list[i].mtd)
> + map_destroy(info->list[i].mtd);
>
> - if (info->res) {
> - release_resource(info->res);
> - kfree(info->res);
> + 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;
> }
>
> @@ -164,68 +185,130 @@ static int __devinit of_flash_probe(struct of_device *dev,
> const char *probe_type = match->data;
> const u32 *width;
> int err;
> -
> - err = -ENXIO;
> - if (of_address_to_resource(dp, 0, &res)) {
> - dev_err(&dev->dev, "Can't get IO address from device tree\n");
> + int i;
> + int count;
> + const u32 *p;
> + int reg_tuple_size;
> + struct mtd_info **mtd_list = NULL;
> +
> + 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_out;
> }
> -
> - dev_dbg(&dev->dev, "of_flash device: %.8llx-%.8llx\n",
> - (unsigned long long)res.start, (unsigned long long)res.end);
> + count /= reg_tuple_size;
>
> err = -ENOMEM;
> - info = kzalloc(sizeof(*info), GFP_KERNEL);
> + info = kzalloc(sizeof(struct of_flash) +
> + sizeof(struct of_flash_list) * count, GFP_KERNEL);
> + if (!info)
> + goto err_out;
> +
> + mtd_list = kzalloc(sizeof(struct mtd_info) * count, GFP_KERNEL);
> if (!info)
> goto err_out;
>
> dev_set_drvdata(&dev->dev, info);
>
> - err = -EBUSY;
> - info->res = request_mem_region(res.start, res.end - res.start + 1,
> - dev_name(&dev->dev));
> - if (!info->res)
> - goto err_out;
> + 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;
> + }
>
> - 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;
> - }
> + dev_dbg(&dev->dev, "of_flash device: %.8llx-%.8llx\n",
> + (unsigned long long)res.start,
> + (unsigned long long)res.end);
> +
> + err = -EBUSY;
> + info->list[i].res = request_mem_region(res.start, res.end -
> + res.start + 1,
> + 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->map.name = dev_name(&dev->dev);
> - info->map.phys = res.start;
> - info->map.size = res.end - res.start + 1;
> - info->map.bankwidth = *width;
> + info->list[i].map.name = dev_name(&dev->dev);
> + info->list[i].map.phys = res.start;
> + info->list[i].map.size = res.end - res.start + 1;
> + 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;
> + }
>
> - err = -ENOMEM;
> - info->map.virt = ioremap(info->map.phys, info->map.size);
> - if (!info->map.virt) {
> - dev_err(&dev->dev, "Failed to ioremap() flash region\n");
> - goto err_out;
> - }
> + simple_map_init(&info->list[i].map);
>
> - simple_map_init(&info->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;
>
> - if (probe_type)
> - info->mtd = do_map_probe(probe_type, &info->map);
> - else
> - info->mtd = obsolete_probe(dev, &info->map);
> + 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 = -ENXIO;
> - if (!info->mtd) {
> - dev_err(&dev->dev, "do_map_probe() failed\n");
> - goto err_out;
> + 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
> }
> - info->mtd->owner = THIS_MODULE;
> - info->mtd->dev.parent = &dev->dev;
> + 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->mtd, part_probe_types,
> - &info->parts, 0);
> + err = parse_mtd_partitions(info->cmtd, part_probe_types,
> + &info->parts, 0);
> if (err < 0)
> return err;
>
> @@ -244,15 +327,19 @@ static int __devinit of_flash_probe(struct of_device *dev,
> }
>
> if (err > 0)
> - add_mtd_partitions(info->mtd, info->parts, err);
> + add_mtd_partitions(info->cmtd, info->parts, err);
> else
> #endif
> - add_mtd_device(info->mtd);
> + add_mtd_device(info->cmtd);
> +
> + kfree(mtd_list);
>
> return 0;
>
> err_out:
> + kfree(mtd_list);
> of_flash_remove(dev);
> +
> return err;
> }
>
> --
> 1.6.2.3
>
>
--
Grant Likely, B.Sc., P.Eng.
Secret Lab Technologies Ltd.
More information about the devicetree-discuss
mailing list