|
@@ -5,6 +5,12 @@
|
|
#include <linux/gfp.h>
|
|
#include <linux/gfp.h>
|
|
#include <linux/export.h>
|
|
#include <linux/export.h>
|
|
|
|
|
|
|
|
+enum devm_ioremap_type {
|
|
|
|
+ DEVM_IOREMAP = 0,
|
|
|
|
+ DEVM_IOREMAP_NC,
|
|
|
|
+ DEVM_IOREMAP_WC,
|
|
|
|
+};
|
|
|
|
+
|
|
void devm_ioremap_release(struct device *dev, void *res)
|
|
void devm_ioremap_release(struct device *dev, void *res)
|
|
{
|
|
{
|
|
iounmap(*(void __iomem **)res);
|
|
iounmap(*(void __iomem **)res);
|
|
@@ -15,24 +21,28 @@ static int devm_ioremap_match(struct device *dev, void *res, void *match_data)
|
|
return *(void **)res == match_data;
|
|
return *(void **)res == match_data;
|
|
}
|
|
}
|
|
|
|
|
|
-/**
|
|
|
|
- * devm_ioremap - Managed ioremap()
|
|
|
|
- * @dev: Generic device to remap IO address for
|
|
|
|
- * @offset: Resource address to map
|
|
|
|
- * @size: Size of map
|
|
|
|
- *
|
|
|
|
- * Managed ioremap(). Map is automatically unmapped on driver detach.
|
|
|
|
- */
|
|
|
|
-void __iomem *devm_ioremap(struct device *dev, resource_size_t offset,
|
|
|
|
- resource_size_t size)
|
|
|
|
|
|
+static void __iomem *__devm_ioremap(struct device *dev, resource_size_t offset,
|
|
|
|
+ resource_size_t size,
|
|
|
|
+ enum devm_ioremap_type type)
|
|
{
|
|
{
|
|
- void __iomem **ptr, *addr;
|
|
|
|
|
|
+ void __iomem **ptr, *addr = NULL;
|
|
|
|
|
|
ptr = devres_alloc(devm_ioremap_release, sizeof(*ptr), GFP_KERNEL);
|
|
ptr = devres_alloc(devm_ioremap_release, sizeof(*ptr), GFP_KERNEL);
|
|
if (!ptr)
|
|
if (!ptr)
|
|
return NULL;
|
|
return NULL;
|
|
|
|
|
|
- addr = ioremap(offset, size);
|
|
|
|
|
|
+ switch (type) {
|
|
|
|
+ case DEVM_IOREMAP:
|
|
|
|
+ addr = ioremap(offset, size);
|
|
|
|
+ break;
|
|
|
|
+ case DEVM_IOREMAP_NC:
|
|
|
|
+ addr = ioremap_nocache(offset, size);
|
|
|
|
+ break;
|
|
|
|
+ case DEVM_IOREMAP_WC:
|
|
|
|
+ addr = ioremap_wc(offset, size);
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
if (addr) {
|
|
if (addr) {
|
|
*ptr = addr;
|
|
*ptr = addr;
|
|
devres_add(dev, ptr);
|
|
devres_add(dev, ptr);
|
|
@@ -41,6 +51,20 @@ void __iomem *devm_ioremap(struct device *dev, resource_size_t offset,
|
|
|
|
|
|
return addr;
|
|
return addr;
|
|
}
|
|
}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * devm_ioremap - Managed ioremap()
|
|
|
|
+ * @dev: Generic device to remap IO address for
|
|
|
|
+ * @offset: Resource address to map
|
|
|
|
+ * @size: Size of map
|
|
|
|
+ *
|
|
|
|
+ * Managed ioremap(). Map is automatically unmapped on driver detach.
|
|
|
|
+ */
|
|
|
|
+void __iomem *devm_ioremap(struct device *dev, resource_size_t offset,
|
|
|
|
+ resource_size_t size)
|
|
|
|
+{
|
|
|
|
+ return __devm_ioremap(dev, offset, size, DEVM_IOREMAP);
|
|
|
|
+}
|
|
EXPORT_SYMBOL(devm_ioremap);
|
|
EXPORT_SYMBOL(devm_ioremap);
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -55,20 +79,7 @@ EXPORT_SYMBOL(devm_ioremap);
|
|
void __iomem *devm_ioremap_nocache(struct device *dev, resource_size_t offset,
|
|
void __iomem *devm_ioremap_nocache(struct device *dev, resource_size_t offset,
|
|
resource_size_t size)
|
|
resource_size_t size)
|
|
{
|
|
{
|
|
- void __iomem **ptr, *addr;
|
|
|
|
-
|
|
|
|
- ptr = devres_alloc(devm_ioremap_release, sizeof(*ptr), GFP_KERNEL);
|
|
|
|
- if (!ptr)
|
|
|
|
- return NULL;
|
|
|
|
-
|
|
|
|
- addr = ioremap_nocache(offset, size);
|
|
|
|
- if (addr) {
|
|
|
|
- *ptr = addr;
|
|
|
|
- devres_add(dev, ptr);
|
|
|
|
- } else
|
|
|
|
- devres_free(ptr);
|
|
|
|
-
|
|
|
|
- return addr;
|
|
|
|
|
|
+ return __devm_ioremap(dev, offset, size, DEVM_IOREMAP_NC);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(devm_ioremap_nocache);
|
|
EXPORT_SYMBOL(devm_ioremap_nocache);
|
|
|
|
|
|
@@ -83,20 +94,7 @@ EXPORT_SYMBOL(devm_ioremap_nocache);
|
|
void __iomem *devm_ioremap_wc(struct device *dev, resource_size_t offset,
|
|
void __iomem *devm_ioremap_wc(struct device *dev, resource_size_t offset,
|
|
resource_size_t size)
|
|
resource_size_t size)
|
|
{
|
|
{
|
|
- void __iomem **ptr, *addr;
|
|
|
|
-
|
|
|
|
- ptr = devres_alloc(devm_ioremap_release, sizeof(*ptr), GFP_KERNEL);
|
|
|
|
- if (!ptr)
|
|
|
|
- return NULL;
|
|
|
|
-
|
|
|
|
- addr = ioremap_wc(offset, size);
|
|
|
|
- if (addr) {
|
|
|
|
- *ptr = addr;
|
|
|
|
- devres_add(dev, ptr);
|
|
|
|
- } else
|
|
|
|
- devres_free(ptr);
|
|
|
|
-
|
|
|
|
- return addr;
|
|
|
|
|
|
+ return __devm_ioremap(dev, offset, size, DEVM_IOREMAP_WC);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(devm_ioremap_wc);
|
|
EXPORT_SYMBOL(devm_ioremap_wc);
|
|
|
|
|