|
@@ -2,6 +2,7 @@
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/delay.h>
|
|
|
|
+#include <linux/ioport.h>
|
|
#include <linux/mtd/mtd.h>
|
|
#include <linux/mtd/mtd.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/bcma/bcma.h>
|
|
#include <linux/bcma/bcma.h>
|
|
@@ -109,8 +110,7 @@ static int bcm47xxsflash_read(struct mtd_info *mtd, loff_t from, size_t len,
|
|
if ((from + len) > mtd->size)
|
|
if ((from + len) > mtd->size)
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
|
|
|
|
- memcpy_fromio(buf, (void __iomem *)KSEG0ADDR(b47s->window + from),
|
|
|
|
- len);
|
|
|
|
|
|
+ memcpy_fromio(buf, b47s->window + from, len);
|
|
*retlen = len;
|
|
*retlen = len;
|
|
|
|
|
|
return len;
|
|
return len;
|
|
@@ -275,15 +275,33 @@ static void bcm47xxsflash_bcma_cc_write(struct bcm47xxsflash *b47s, u16 offset,
|
|
|
|
|
|
static int bcm47xxsflash_bcma_probe(struct platform_device *pdev)
|
|
static int bcm47xxsflash_bcma_probe(struct platform_device *pdev)
|
|
{
|
|
{
|
|
- struct bcma_sflash *sflash = dev_get_platdata(&pdev->dev);
|
|
|
|
|
|
+ struct device *dev = &pdev->dev;
|
|
|
|
+ struct bcma_sflash *sflash = dev_get_platdata(dev);
|
|
struct bcm47xxsflash *b47s;
|
|
struct bcm47xxsflash *b47s;
|
|
|
|
+ struct resource *res;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
- b47s = devm_kzalloc(&pdev->dev, sizeof(*b47s), GFP_KERNEL);
|
|
|
|
|
|
+ b47s = devm_kzalloc(dev, sizeof(*b47s), GFP_KERNEL);
|
|
if (!b47s)
|
|
if (!b47s)
|
|
return -ENOMEM;
|
|
return -ENOMEM;
|
|
sflash->priv = b47s;
|
|
sflash->priv = b47s;
|
|
|
|
|
|
|
|
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
|
+ if (!res) {
|
|
|
|
+ dev_err(dev, "invalid resource\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+ if (!devm_request_mem_region(dev, res->start, resource_size(res),
|
|
|
|
+ res->name)) {
|
|
|
|
+ dev_err(dev, "can't request region for resource %pR\n", res);
|
|
|
|
+ return -EBUSY;
|
|
|
|
+ }
|
|
|
|
+ b47s->window = ioremap_cache(res->start, resource_size(res));
|
|
|
|
+ if (!b47s->window) {
|
|
|
|
+ dev_err(dev, "ioremap failed for resource %pR\n", res);
|
|
|
|
+ return -ENOMEM;
|
|
|
|
+ }
|
|
|
|
+
|
|
b47s->bcma_cc = container_of(sflash, struct bcma_drv_cc, sflash);
|
|
b47s->bcma_cc = container_of(sflash, struct bcma_drv_cc, sflash);
|
|
b47s->cc_read = bcm47xxsflash_bcma_cc_read;
|
|
b47s->cc_read = bcm47xxsflash_bcma_cc_read;
|
|
b47s->cc_write = bcm47xxsflash_bcma_cc_write;
|
|
b47s->cc_write = bcm47xxsflash_bcma_cc_write;
|
|
@@ -297,7 +315,6 @@ static int bcm47xxsflash_bcma_probe(struct platform_device *pdev)
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
- b47s->window = sflash->window;
|
|
|
|
b47s->blocksize = sflash->blocksize;
|
|
b47s->blocksize = sflash->blocksize;
|
|
b47s->numblocks = sflash->numblocks;
|
|
b47s->numblocks = sflash->numblocks;
|
|
b47s->size = sflash->size;
|
|
b47s->size = sflash->size;
|
|
@@ -306,6 +323,7 @@ static int bcm47xxsflash_bcma_probe(struct platform_device *pdev)
|
|
err = mtd_device_parse_register(&b47s->mtd, probes, NULL, NULL, 0);
|
|
err = mtd_device_parse_register(&b47s->mtd, probes, NULL, NULL, 0);
|
|
if (err) {
|
|
if (err) {
|
|
pr_err("Failed to register MTD device: %d\n", err);
|
|
pr_err("Failed to register MTD device: %d\n", err);
|
|
|
|
+ iounmap(b47s->window);
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -321,6 +339,7 @@ static int bcm47xxsflash_bcma_remove(struct platform_device *pdev)
|
|
struct bcm47xxsflash *b47s = sflash->priv;
|
|
struct bcm47xxsflash *b47s = sflash->priv;
|
|
|
|
|
|
mtd_device_unregister(&b47s->mtd);
|
|
mtd_device_unregister(&b47s->mtd);
|
|
|
|
+ iounmap(b47s->window);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|