mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-17 05:41:10 +07:00
72169755cf
Fix a bug where mtd parent device symlinks aren't shown in sysfs. While at it, make use of the default owner value set by mtdcore. Incidentally, it seems the owner field in the concatenated mtds is not actually used, so this shouldn't make much of a difference anyway. Signed-off-by: Frans Klaver <fransklaver@gmail.com> Signed-off-by: Brian Norris <computersforpeace@gmail.com>
301 lines
6.3 KiB
C
301 lines
6.3 KiB
C
/*
|
|
* Flash memory access on SA11x0 based devices
|
|
*
|
|
* (C) 2000 Nicolas Pitre <nico@fluxnic.net>
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/err.h>
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/mtd/mtd.h>
|
|
#include <linux/mtd/map.h>
|
|
#include <linux/mtd/partitions.h>
|
|
#include <linux/mtd/concat.h>
|
|
|
|
#include <mach/hardware.h>
|
|
#include <asm/sizes.h>
|
|
#include <asm/mach/flash.h>
|
|
|
|
struct sa_subdev_info {
|
|
char name[16];
|
|
struct map_info map;
|
|
struct mtd_info *mtd;
|
|
struct flash_platform_data *plat;
|
|
};
|
|
|
|
struct sa_info {
|
|
struct mtd_info *mtd;
|
|
int num_subdev;
|
|
struct sa_subdev_info subdev[0];
|
|
};
|
|
|
|
static DEFINE_SPINLOCK(sa1100_vpp_lock);
|
|
static int sa1100_vpp_refcnt;
|
|
static void sa1100_set_vpp(struct map_info *map, int on)
|
|
{
|
|
struct sa_subdev_info *subdev = container_of(map, struct sa_subdev_info, map);
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&sa1100_vpp_lock, flags);
|
|
if (on) {
|
|
if (++sa1100_vpp_refcnt == 1) /* first nested 'on' */
|
|
subdev->plat->set_vpp(1);
|
|
} else {
|
|
if (--sa1100_vpp_refcnt == 0) /* last nested 'off' */
|
|
subdev->plat->set_vpp(0);
|
|
}
|
|
spin_unlock_irqrestore(&sa1100_vpp_lock, flags);
|
|
}
|
|
|
|
static void sa1100_destroy_subdev(struct sa_subdev_info *subdev)
|
|
{
|
|
if (subdev->mtd)
|
|
map_destroy(subdev->mtd);
|
|
if (subdev->map.virt)
|
|
iounmap(subdev->map.virt);
|
|
release_mem_region(subdev->map.phys, subdev->map.size);
|
|
}
|
|
|
|
static int sa1100_probe_subdev(struct sa_subdev_info *subdev, struct resource *res)
|
|
{
|
|
unsigned long phys;
|
|
unsigned int size;
|
|
int ret;
|
|
|
|
phys = res->start;
|
|
size = res->end - phys + 1;
|
|
|
|
/*
|
|
* Retrieve the bankwidth from the MSC registers.
|
|
* We currently only implement CS0 and CS1 here.
|
|
*/
|
|
switch (phys) {
|
|
default:
|
|
printk(KERN_WARNING "SA1100 flash: unknown base address "
|
|
"0x%08lx, assuming CS0\n", phys);
|
|
|
|
case SA1100_CS0_PHYS:
|
|
subdev->map.bankwidth = (MSC0 & MSC_RBW) ? 2 : 4;
|
|
break;
|
|
|
|
case SA1100_CS1_PHYS:
|
|
subdev->map.bankwidth = ((MSC0 >> 16) & MSC_RBW) ? 2 : 4;
|
|
break;
|
|
}
|
|
|
|
if (!request_mem_region(phys, size, subdev->name)) {
|
|
ret = -EBUSY;
|
|
goto out;
|
|
}
|
|
|
|
if (subdev->plat->set_vpp)
|
|
subdev->map.set_vpp = sa1100_set_vpp;
|
|
|
|
subdev->map.phys = phys;
|
|
subdev->map.size = size;
|
|
subdev->map.virt = ioremap(phys, size);
|
|
if (!subdev->map.virt) {
|
|
ret = -ENOMEM;
|
|
goto err;
|
|
}
|
|
|
|
simple_map_init(&subdev->map);
|
|
|
|
/*
|
|
* Now let's probe for the actual flash. Do it here since
|
|
* specific machine settings might have been set above.
|
|
*/
|
|
subdev->mtd = do_map_probe(subdev->plat->map_name, &subdev->map);
|
|
if (subdev->mtd == NULL) {
|
|
ret = -ENXIO;
|
|
goto err;
|
|
}
|
|
|
|
printk(KERN_INFO "SA1100 flash: CFI device at 0x%08lx, %uMiB, %d-bit\n",
|
|
phys, (unsigned)(subdev->mtd->size >> 20),
|
|
subdev->map.bankwidth * 8);
|
|
|
|
return 0;
|
|
|
|
err:
|
|
sa1100_destroy_subdev(subdev);
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static void sa1100_destroy(struct sa_info *info, struct flash_platform_data *plat)
|
|
{
|
|
int i;
|
|
|
|
if (info->mtd) {
|
|
mtd_device_unregister(info->mtd);
|
|
if (info->mtd != info->subdev[0].mtd)
|
|
mtd_concat_destroy(info->mtd);
|
|
}
|
|
|
|
for (i = info->num_subdev - 1; i >= 0; i--)
|
|
sa1100_destroy_subdev(&info->subdev[i]);
|
|
kfree(info);
|
|
|
|
if (plat->exit)
|
|
plat->exit();
|
|
}
|
|
|
|
static struct sa_info *sa1100_setup_mtd(struct platform_device *pdev,
|
|
struct flash_platform_data *plat)
|
|
{
|
|
struct sa_info *info;
|
|
int nr, size, i, ret = 0;
|
|
|
|
/*
|
|
* Count number of devices.
|
|
*/
|
|
for (nr = 0; ; nr++)
|
|
if (!platform_get_resource(pdev, IORESOURCE_MEM, nr))
|
|
break;
|
|
|
|
if (nr == 0) {
|
|
ret = -ENODEV;
|
|
goto out;
|
|
}
|
|
|
|
size = sizeof(struct sa_info) + sizeof(struct sa_subdev_info) * nr;
|
|
|
|
/*
|
|
* Allocate the map_info structs in one go.
|
|
*/
|
|
info = kzalloc(size, GFP_KERNEL);
|
|
if (!info) {
|
|
ret = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
if (plat->init) {
|
|
ret = plat->init();
|
|
if (ret)
|
|
goto err;
|
|
}
|
|
|
|
/*
|
|
* Claim and then map the memory regions.
|
|
*/
|
|
for (i = 0; i < nr; i++) {
|
|
struct sa_subdev_info *subdev = &info->subdev[i];
|
|
struct resource *res;
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, i);
|
|
if (!res)
|
|
break;
|
|
|
|
subdev->map.name = subdev->name;
|
|
sprintf(subdev->name, "%s-%d", plat->name, i);
|
|
subdev->plat = plat;
|
|
|
|
ret = sa1100_probe_subdev(subdev, res);
|
|
if (ret)
|
|
break;
|
|
}
|
|
|
|
info->num_subdev = i;
|
|
|
|
/*
|
|
* ENXIO is special. It means we didn't find a chip when we probed.
|
|
*/
|
|
if (ret != 0 && !(ret == -ENXIO && info->num_subdev > 0))
|
|
goto err;
|
|
|
|
/*
|
|
* If we found one device, don't bother with concat support. If
|
|
* we found multiple devices, use concat if we have it available,
|
|
* otherwise fail. Either way, it'll be called "sa1100".
|
|
*/
|
|
if (info->num_subdev == 1) {
|
|
strcpy(info->subdev[0].name, plat->name);
|
|
info->mtd = info->subdev[0].mtd;
|
|
ret = 0;
|
|
} else if (info->num_subdev > 1) {
|
|
struct mtd_info *cdev[nr];
|
|
/*
|
|
* We detected multiple devices. Concatenate them together.
|
|
*/
|
|
for (i = 0; i < info->num_subdev; i++)
|
|
cdev[i] = info->subdev[i].mtd;
|
|
|
|
info->mtd = mtd_concat_create(cdev, info->num_subdev,
|
|
plat->name);
|
|
if (info->mtd == NULL)
|
|
ret = -ENXIO;
|
|
}
|
|
info->mtd->dev.parent = &pdev->dev;
|
|
|
|
if (ret == 0)
|
|
return info;
|
|
|
|
err:
|
|
sa1100_destroy(info, plat);
|
|
out:
|
|
return ERR_PTR(ret);
|
|
}
|
|
|
|
static const char * const part_probes[] = { "cmdlinepart", "RedBoot", NULL };
|
|
|
|
static int sa1100_mtd_probe(struct platform_device *pdev)
|
|
{
|
|
struct flash_platform_data *plat = dev_get_platdata(&pdev->dev);
|
|
struct sa_info *info;
|
|
int err;
|
|
|
|
if (!plat)
|
|
return -ENODEV;
|
|
|
|
info = sa1100_setup_mtd(pdev, plat);
|
|
if (IS_ERR(info)) {
|
|
err = PTR_ERR(info);
|
|
goto out;
|
|
}
|
|
|
|
/*
|
|
* Partition selection stuff.
|
|
*/
|
|
mtd_device_parse_register(info->mtd, part_probes, NULL, plat->parts,
|
|
plat->nr_parts);
|
|
|
|
platform_set_drvdata(pdev, info);
|
|
err = 0;
|
|
|
|
out:
|
|
return err;
|
|
}
|
|
|
|
static int sa1100_mtd_remove(struct platform_device *pdev)
|
|
{
|
|
struct sa_info *info = platform_get_drvdata(pdev);
|
|
struct flash_platform_data *plat = dev_get_platdata(&pdev->dev);
|
|
|
|
sa1100_destroy(info, plat);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver sa1100_mtd_driver = {
|
|
.probe = sa1100_mtd_probe,
|
|
.remove = sa1100_mtd_remove,
|
|
.driver = {
|
|
.name = "sa1100-mtd",
|
|
},
|
|
};
|
|
|
|
module_platform_driver(sa1100_mtd_driver);
|
|
|
|
MODULE_AUTHOR("Nicolas Pitre");
|
|
MODULE_DESCRIPTION("SA1100 CFI map driver");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:sa1100-mtd");
|