-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
- Loading branch information
Atsushi Nemoto
authored and
David Woodhouse
committed
Mar 20, 2009
1 parent
9978b68
commit 9a79b78
Showing
4 changed files
with
216 additions
and
1 deletion.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -1,2 +1,2 @@ | ||
--- | ||
refs/heads/master: 64fb65baffa5b8f6f2eb3f628dec43c22cd1031f | ||
refs/heads/master: 610f75e74b636f933bc3e379a88a10f883b91332 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,208 @@ | ||
/* | ||
* 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 int rbtx4939_flash_suspend(struct platform_device *dev, | ||
pm_message_t state) | ||
{ | ||
struct rbtx4939_flash_info *info = platform_get_drvdata(dev); | ||
|
||
if (info->mtd->suspend) | ||
return info->mtd->suspend(info->mtd); | ||
return 0; | ||
} | ||
|
||
static int rbtx4939_flash_resume(struct platform_device *dev) | ||
{ | ||
struct rbtx4939_flash_info *info = platform_get_drvdata(dev); | ||
|
||
if (info->mtd->resume) | ||
info->mtd->resume(info->mtd); | ||
return 0; | ||
} | ||
|
||
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_suspend NULL | ||
#define rbtx4939_flash_resume NULL | ||
#define rbtx4939_flash_shutdown NULL | ||
#endif | ||
|
||
static struct platform_driver rbtx4939_flash_driver = { | ||
.probe = rbtx4939_flash_probe, | ||
.remove = rbtx4939_flash_remove, | ||
.suspend = rbtx4939_flash_suspend, | ||
.resume = rbtx4939_flash_resume, | ||
.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"); |