|
@@ -37,7 +37,7 @@ static inline dma_addr_t dma_get_device_base(struct device *dev,
|
|
|
return mem->device_base;
|
|
|
}
|
|
|
|
|
|
-static bool dma_init_coherent_memory(
|
|
|
+static int dma_init_coherent_memory(
|
|
|
phys_addr_t phys_addr, dma_addr_t device_addr, size_t size, int flags,
|
|
|
struct dma_coherent_mem **mem)
|
|
|
{
|
|
@@ -45,25 +45,28 @@ static bool dma_init_coherent_memory(
|
|
|
void __iomem *mem_base = NULL;
|
|
|
int pages = size >> PAGE_SHIFT;
|
|
|
int bitmap_size = BITS_TO_LONGS(pages) * sizeof(long);
|
|
|
+ int ret;
|
|
|
|
|
|
- if ((flags & (DMA_MEMORY_MAP | DMA_MEMORY_IO)) == 0)
|
|
|
- goto out;
|
|
|
- if (!size)
|
|
|
+ if (!size) {
|
|
|
+ ret = -EINVAL;
|
|
|
goto out;
|
|
|
+ }
|
|
|
|
|
|
- if (flags & DMA_MEMORY_MAP)
|
|
|
- mem_base = memremap(phys_addr, size, MEMREMAP_WC);
|
|
|
- else
|
|
|
- mem_base = ioremap(phys_addr, size);
|
|
|
- if (!mem_base)
|
|
|
+ mem_base = memremap(phys_addr, size, MEMREMAP_WC);
|
|
|
+ if (!mem_base) {
|
|
|
+ ret = -EINVAL;
|
|
|
goto out;
|
|
|
-
|
|
|
+ }
|
|
|
dma_mem = kzalloc(sizeof(struct dma_coherent_mem), GFP_KERNEL);
|
|
|
- if (!dma_mem)
|
|
|
+ if (!dma_mem) {
|
|
|
+ ret = -ENOMEM;
|
|
|
goto out;
|
|
|
+ }
|
|
|
dma_mem->bitmap = kzalloc(bitmap_size, GFP_KERNEL);
|
|
|
- if (!dma_mem->bitmap)
|
|
|
+ if (!dma_mem->bitmap) {
|
|
|
+ ret = -ENOMEM;
|
|
|
goto out;
|
|
|
+ }
|
|
|
|
|
|
dma_mem->virt_base = mem_base;
|
|
|
dma_mem->device_base = device_addr;
|
|
@@ -73,17 +76,13 @@ static bool dma_init_coherent_memory(
|
|
|
spin_lock_init(&dma_mem->spinlock);
|
|
|
|
|
|
*mem = dma_mem;
|
|
|
- return true;
|
|
|
+ return 0;
|
|
|
|
|
|
out:
|
|
|
kfree(dma_mem);
|
|
|
- if (mem_base) {
|
|
|
- if (flags & DMA_MEMORY_MAP)
|
|
|
- memunmap(mem_base);
|
|
|
- else
|
|
|
- iounmap(mem_base);
|
|
|
- }
|
|
|
- return false;
|
|
|
+ if (mem_base)
|
|
|
+ memunmap(mem_base);
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
static void dma_release_coherent_memory(struct dma_coherent_mem *mem)
|
|
@@ -91,10 +90,7 @@ static void dma_release_coherent_memory(struct dma_coherent_mem *mem)
|
|
|
if (!mem)
|
|
|
return;
|
|
|
|
|
|
- if (mem->flags & DMA_MEMORY_MAP)
|
|
|
- memunmap(mem->virt_base);
|
|
|
- else
|
|
|
- iounmap(mem->virt_base);
|
|
|
+ memunmap(mem->virt_base);
|
|
|
kfree(mem->bitmap);
|
|
|
kfree(mem);
|
|
|
}
|
|
@@ -109,8 +105,6 @@ static int dma_assign_coherent_memory(struct device *dev,
|
|
|
return -EBUSY;
|
|
|
|
|
|
dev->dma_mem = mem;
|
|
|
- /* FIXME: this routine just ignores DMA_MEMORY_INCLUDES_CHILDREN */
|
|
|
-
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -118,16 +112,16 @@ int dma_declare_coherent_memory(struct device *dev, phys_addr_t phys_addr,
|
|
|
dma_addr_t device_addr, size_t size, int flags)
|
|
|
{
|
|
|
struct dma_coherent_mem *mem;
|
|
|
+ int ret;
|
|
|
|
|
|
- if (!dma_init_coherent_memory(phys_addr, device_addr, size, flags,
|
|
|
- &mem))
|
|
|
- return 0;
|
|
|
-
|
|
|
- if (dma_assign_coherent_memory(dev, mem) == 0)
|
|
|
- return flags & DMA_MEMORY_MAP ? DMA_MEMORY_MAP : DMA_MEMORY_IO;
|
|
|
+ ret = dma_init_coherent_memory(phys_addr, device_addr, size, flags, &mem);
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
|
|
|
- dma_release_coherent_memory(mem);
|
|
|
- return 0;
|
|
|
+ ret = dma_assign_coherent_memory(dev, mem);
|
|
|
+ if (ret)
|
|
|
+ dma_release_coherent_memory(mem);
|
|
|
+ return ret;
|
|
|
}
|
|
|
EXPORT_SYMBOL(dma_declare_coherent_memory);
|
|
|
|
|
@@ -171,7 +165,6 @@ static void *__dma_alloc_from_coherent(struct dma_coherent_mem *mem,
|
|
|
int order = get_order(size);
|
|
|
unsigned long flags;
|
|
|
int pageno;
|
|
|
- int dma_memory_map;
|
|
|
void *ret;
|
|
|
|
|
|
spin_lock_irqsave(&mem->spinlock, flags);
|
|
@@ -188,15 +181,9 @@ static void *__dma_alloc_from_coherent(struct dma_coherent_mem *mem,
|
|
|
*/
|
|
|
*dma_handle = mem->device_base + (pageno << PAGE_SHIFT);
|
|
|
ret = mem->virt_base + (pageno << PAGE_SHIFT);
|
|
|
- dma_memory_map = (mem->flags & DMA_MEMORY_MAP);
|
|
|
spin_unlock_irqrestore(&mem->spinlock, flags);
|
|
|
- if (dma_memory_map)
|
|
|
- memset(ret, 0, size);
|
|
|
- else
|
|
|
- memset_io(ret, 0, size);
|
|
|
-
|
|
|
+ memset(ret, 0, size);
|
|
|
return ret;
|
|
|
-
|
|
|
err:
|
|
|
spin_unlock_irqrestore(&mem->spinlock, flags);
|
|
|
return NULL;
|
|
@@ -359,14 +346,18 @@ static struct reserved_mem *dma_reserved_default_memory __initdata;
|
|
|
static int rmem_dma_device_init(struct reserved_mem *rmem, struct device *dev)
|
|
|
{
|
|
|
struct dma_coherent_mem *mem = rmem->priv;
|
|
|
+ int ret;
|
|
|
|
|
|
- if (!mem &&
|
|
|
- !dma_init_coherent_memory(rmem->base, rmem->base, rmem->size,
|
|
|
- DMA_MEMORY_MAP | DMA_MEMORY_EXCLUSIVE,
|
|
|
- &mem)) {
|
|
|
+ if (!mem)
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ ret = dma_init_coherent_memory(rmem->base, rmem->base, rmem->size,
|
|
|
+ DMA_MEMORY_EXCLUSIVE, &mem);
|
|
|
+
|
|
|
+ if (ret) {
|
|
|
pr_err("Reserved memory: failed to init DMA memory pool at %pa, size %ld MiB\n",
|
|
|
&rmem->base, (unsigned long)rmem->size / SZ_1M);
|
|
|
- return -ENODEV;
|
|
|
+ return ret;
|
|
|
}
|
|
|
mem->use_dev_dma_pfn_offset = true;
|
|
|
rmem->priv = mem;
|