ccd93854d4
Now the MTD core will do this for us, we don't need to hook it up from the board drivers. Shame we can't do shutdown from the class too... Signed-off-by: David Woodhouse <David.Woodhouse@intel.com>
185 lines
4.2 KiB
C
185 lines
4.2 KiB
C
/*
|
|
* rbtx4939-flash (based on physmap.c)
|
|
*
|
|
* This is a simplified physmap driver with map_init callback function.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* Copyright (C) 2009 Atsushi Nemoto <anemo@mba.ocn.ne.jp>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mtd/mtd.h>
|
|
#include <linux/mtd/map.h>
|
|
#include <linux/mtd/partitions.h>
|
|
#include <asm/txx9/rbtx4939.h>
|
|
|
|
struct rbtx4939_flash_info {
|
|
struct mtd_info *mtd;
|
|
struct map_info map;
|
|
#ifdef CONFIG_MTD_PARTITIONS
|
|
int nr_parts;
|
|
struct mtd_partition *parts;
|
|
#endif
|
|
};
|
|
|
|
static int rbtx4939_flash_remove(struct platform_device *dev)
|
|
{
|
|
struct rbtx4939_flash_info *info;
|
|
|
|
info = platform_get_drvdata(dev);
|
|
if (!info)
|
|
return 0;
|
|
platform_set_drvdata(dev, NULL);
|
|
|
|
if (info->mtd) {
|
|
#ifdef CONFIG_MTD_PARTITIONS
|
|
struct rbtx4939_flash_data *pdata = dev->dev.platform_data;
|
|
|
|
if (info->nr_parts) {
|
|
del_mtd_partitions(info->mtd);
|
|
kfree(info->parts);
|
|
} else if (pdata->nr_parts)
|
|
del_mtd_partitions(info->mtd);
|
|
else
|
|
del_mtd_device(info->mtd);
|
|
#else
|
|
del_mtd_device(info->mtd);
|
|
#endif
|
|
map_destroy(info->mtd);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static const char *rom_probe_types[] = { "cfi_probe", "jedec_probe", NULL };
|
|
#ifdef CONFIG_MTD_PARTITIONS
|
|
static const char *part_probe_types[] = { "cmdlinepart", NULL };
|
|
#endif
|
|
|
|
static int rbtx4939_flash_probe(struct platform_device *dev)
|
|
{
|
|
struct rbtx4939_flash_data *pdata;
|
|
struct rbtx4939_flash_info *info;
|
|
struct resource *res;
|
|
const char **probe_type;
|
|
int err = 0;
|
|
unsigned long size;
|
|
|
|
pdata = dev->dev.platform_data;
|
|
if (!pdata)
|
|
return -ENODEV;
|
|
|
|
res = platform_get_resource(dev, IORESOURCE_MEM, 0);
|
|
if (!res)
|
|
return -ENODEV;
|
|
info = devm_kzalloc(&dev->dev, sizeof(struct rbtx4939_flash_info),
|
|
GFP_KERNEL);
|
|
if (!info)
|
|
return -ENOMEM;
|
|
|
|
platform_set_drvdata(dev, info);
|
|
|
|
size = resource_size(res);
|
|
pr_notice("rbtx4939 platform flash device: %pR\n", res);
|
|
|
|
if (!devm_request_mem_region(&dev->dev, res->start, size,
|
|
dev_name(&dev->dev)))
|
|
return -EBUSY;
|
|
|
|
info->map.name = dev_name(&dev->dev);
|
|
info->map.phys = res->start;
|
|
info->map.size = size;
|
|
info->map.bankwidth = pdata->width;
|
|
|
|
info->map.virt = devm_ioremap(&dev->dev, info->map.phys, size);
|
|
if (!info->map.virt)
|
|
return -EBUSY;
|
|
|
|
if (pdata->map_init)
|
|
(*pdata->map_init)(&info->map);
|
|
else
|
|
simple_map_init(&info->map);
|
|
|
|
probe_type = rom_probe_types;
|
|
for (; !info->mtd && *probe_type; probe_type++)
|
|
info->mtd = do_map_probe(*probe_type, &info->map);
|
|
if (!info->mtd) {
|
|
dev_err(&dev->dev, "map_probe failed\n");
|
|
err = -ENXIO;
|
|
goto err_out;
|
|
}
|
|
info->mtd->owner = THIS_MODULE;
|
|
if (err)
|
|
goto err_out;
|
|
|
|
#ifdef CONFIG_MTD_PARTITIONS
|
|
err = parse_mtd_partitions(info->mtd, part_probe_types,
|
|
&info->parts, 0);
|
|
if (err > 0) {
|
|
add_mtd_partitions(info->mtd, info->parts, err);
|
|
info->nr_parts = err;
|
|
return 0;
|
|
}
|
|
|
|
if (pdata->nr_parts) {
|
|
pr_notice("Using rbtx4939 partition information\n");
|
|
add_mtd_partitions(info->mtd, pdata->parts, pdata->nr_parts);
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
add_mtd_device(info->mtd);
|
|
return 0;
|
|
|
|
err_out:
|
|
rbtx4939_flash_remove(dev);
|
|
return err;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static void rbtx4939_flash_shutdown(struct platform_device *dev)
|
|
{
|
|
struct rbtx4939_flash_info *info = platform_get_drvdata(dev);
|
|
|
|
if (info->mtd->suspend && info->mtd->resume)
|
|
if (info->mtd->suspend(info->mtd) == 0)
|
|
info->mtd->resume(info->mtd);
|
|
}
|
|
#else
|
|
#define rbtx4939_flash_shutdown NULL
|
|
#endif
|
|
|
|
static struct platform_driver rbtx4939_flash_driver = {
|
|
.probe = rbtx4939_flash_probe,
|
|
.remove = rbtx4939_flash_remove,
|
|
.shutdown = rbtx4939_flash_shutdown,
|
|
.driver = {
|
|
.name = "rbtx4939-flash",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
};
|
|
|
|
static int __init rbtx4939_flash_init(void)
|
|
{
|
|
return platform_driver_register(&rbtx4939_flash_driver);
|
|
}
|
|
|
|
static void __exit rbtx4939_flash_exit(void)
|
|
{
|
|
platform_driver_unregister(&rbtx4939_flash_driver);
|
|
}
|
|
|
|
module_init(rbtx4939_flash_init);
|
|
module_exit(rbtx4939_flash_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("RBTX4939 MTD map driver");
|
|
MODULE_ALIAS("platform:rbtx4939-flash");
|