|
@@ -1171,6 +1171,25 @@ core_initcall(dma_debug_do_init);
|
|
|
|
|
|
#ifdef CONFIG_ARM_DMA_USE_IOMMU
|
|
#ifdef CONFIG_ARM_DMA_USE_IOMMU
|
|
|
|
|
|
|
|
+static int __dma_info_to_prot(enum dma_data_direction dir, unsigned long attrs)
|
|
|
|
+{
|
|
|
|
+ int prot = 0;
|
|
|
|
+
|
|
|
|
+ if (attrs & DMA_ATTR_PRIVILEGED)
|
|
|
|
+ prot |= IOMMU_PRIV;
|
|
|
|
+
|
|
|
|
+ switch (dir) {
|
|
|
|
+ case DMA_BIDIRECTIONAL:
|
|
|
|
+ return prot | IOMMU_READ | IOMMU_WRITE;
|
|
|
|
+ case DMA_TO_DEVICE:
|
|
|
|
+ return prot | IOMMU_READ;
|
|
|
|
+ case DMA_FROM_DEVICE:
|
|
|
|
+ return prot | IOMMU_WRITE;
|
|
|
|
+ default:
|
|
|
|
+ return prot;
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
/* IOMMU */
|
|
/* IOMMU */
|
|
|
|
|
|
static int extend_iommu_mapping(struct dma_iommu_mapping *mapping);
|
|
static int extend_iommu_mapping(struct dma_iommu_mapping *mapping);
|
|
@@ -1394,7 +1413,8 @@ __iommu_alloc_remap(struct page **pages, size_t size, gfp_t gfp, pgprot_t prot,
|
|
* Create a mapping in device IO address space for specified pages
|
|
* Create a mapping in device IO address space for specified pages
|
|
*/
|
|
*/
|
|
static dma_addr_t
|
|
static dma_addr_t
|
|
-__iommu_create_mapping(struct device *dev, struct page **pages, size_t size)
|
|
|
|
|
|
+__iommu_create_mapping(struct device *dev, struct page **pages, size_t size,
|
|
|
|
+ unsigned long attrs)
|
|
{
|
|
{
|
|
struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);
|
|
struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);
|
|
unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;
|
|
unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;
|
|
@@ -1419,7 +1439,7 @@ __iommu_create_mapping(struct device *dev, struct page **pages, size_t size)
|
|
|
|
|
|
len = (j - i) << PAGE_SHIFT;
|
|
len = (j - i) << PAGE_SHIFT;
|
|
ret = iommu_map(mapping->domain, iova, phys, len,
|
|
ret = iommu_map(mapping->domain, iova, phys, len,
|
|
- IOMMU_READ|IOMMU_WRITE);
|
|
|
|
|
|
+ __dma_info_to_prot(DMA_BIDIRECTIONAL, attrs));
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
goto fail;
|
|
goto fail;
|
|
iova += len;
|
|
iova += len;
|
|
@@ -1476,7 +1496,8 @@ static struct page **__iommu_get_pages(void *cpu_addr, unsigned long attrs)
|
|
}
|
|
}
|
|
|
|
|
|
static void *__iommu_alloc_simple(struct device *dev, size_t size, gfp_t gfp,
|
|
static void *__iommu_alloc_simple(struct device *dev, size_t size, gfp_t gfp,
|
|
- dma_addr_t *handle, int coherent_flag)
|
|
|
|
|
|
+ dma_addr_t *handle, int coherent_flag,
|
|
|
|
+ unsigned long attrs)
|
|
{
|
|
{
|
|
struct page *page;
|
|
struct page *page;
|
|
void *addr;
|
|
void *addr;
|
|
@@ -1488,7 +1509,7 @@ static void *__iommu_alloc_simple(struct device *dev, size_t size, gfp_t gfp,
|
|
if (!addr)
|
|
if (!addr)
|
|
return NULL;
|
|
return NULL;
|
|
|
|
|
|
- *handle = __iommu_create_mapping(dev, &page, size);
|
|
|
|
|
|
+ *handle = __iommu_create_mapping(dev, &page, size, attrs);
|
|
if (*handle == DMA_ERROR_CODE)
|
|
if (*handle == DMA_ERROR_CODE)
|
|
goto err_mapping;
|
|
goto err_mapping;
|
|
|
|
|
|
@@ -1522,7 +1543,7 @@ static void *__arm_iommu_alloc_attrs(struct device *dev, size_t size,
|
|
|
|
|
|
if (coherent_flag == COHERENT || !gfpflags_allow_blocking(gfp))
|
|
if (coherent_flag == COHERENT || !gfpflags_allow_blocking(gfp))
|
|
return __iommu_alloc_simple(dev, size, gfp, handle,
|
|
return __iommu_alloc_simple(dev, size, gfp, handle,
|
|
- coherent_flag);
|
|
|
|
|
|
+ coherent_flag, attrs);
|
|
|
|
|
|
/*
|
|
/*
|
|
* Following is a work-around (a.k.a. hack) to prevent pages
|
|
* Following is a work-around (a.k.a. hack) to prevent pages
|
|
@@ -1537,7 +1558,7 @@ static void *__arm_iommu_alloc_attrs(struct device *dev, size_t size,
|
|
if (!pages)
|
|
if (!pages)
|
|
return NULL;
|
|
return NULL;
|
|
|
|
|
|
- *handle = __iommu_create_mapping(dev, pages, size);
|
|
|
|
|
|
+ *handle = __iommu_create_mapping(dev, pages, size, attrs);
|
|
if (*handle == DMA_ERROR_CODE)
|
|
if (*handle == DMA_ERROR_CODE)
|
|
goto err_buffer;
|
|
goto err_buffer;
|
|
|
|
|
|
@@ -1672,27 +1693,6 @@ static int arm_iommu_get_sgtable(struct device *dev, struct sg_table *sgt,
|
|
GFP_KERNEL);
|
|
GFP_KERNEL);
|
|
}
|
|
}
|
|
|
|
|
|
-static int __dma_direction_to_prot(enum dma_data_direction dir)
|
|
|
|
-{
|
|
|
|
- int prot;
|
|
|
|
-
|
|
|
|
- switch (dir) {
|
|
|
|
- case DMA_BIDIRECTIONAL:
|
|
|
|
- prot = IOMMU_READ | IOMMU_WRITE;
|
|
|
|
- break;
|
|
|
|
- case DMA_TO_DEVICE:
|
|
|
|
- prot = IOMMU_READ;
|
|
|
|
- break;
|
|
|
|
- case DMA_FROM_DEVICE:
|
|
|
|
- prot = IOMMU_WRITE;
|
|
|
|
- break;
|
|
|
|
- default:
|
|
|
|
- prot = 0;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- return prot;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
/*
|
|
/*
|
|
* Map a part of the scatter-gather list into contiguous io address space
|
|
* Map a part of the scatter-gather list into contiguous io address space
|
|
*/
|
|
*/
|
|
@@ -1722,7 +1722,7 @@ static int __map_sg_chunk(struct device *dev, struct scatterlist *sg,
|
|
if (!is_coherent && (attrs & DMA_ATTR_SKIP_CPU_SYNC) == 0)
|
|
if (!is_coherent && (attrs & DMA_ATTR_SKIP_CPU_SYNC) == 0)
|
|
__dma_page_cpu_to_dev(sg_page(s), s->offset, s->length, dir);
|
|
__dma_page_cpu_to_dev(sg_page(s), s->offset, s->length, dir);
|
|
|
|
|
|
- prot = __dma_direction_to_prot(dir);
|
|
|
|
|
|
+ prot = __dma_info_to_prot(dir, attrs);
|
|
|
|
|
|
ret = iommu_map(mapping->domain, iova, phys, len, prot);
|
|
ret = iommu_map(mapping->domain, iova, phys, len, prot);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
@@ -1930,7 +1930,7 @@ static dma_addr_t arm_coherent_iommu_map_page(struct device *dev, struct page *p
|
|
if (dma_addr == DMA_ERROR_CODE)
|
|
if (dma_addr == DMA_ERROR_CODE)
|
|
return dma_addr;
|
|
return dma_addr;
|
|
|
|
|
|
- prot = __dma_direction_to_prot(dir);
|
|
|
|
|
|
+ prot = __dma_info_to_prot(dir, attrs);
|
|
|
|
|
|
ret = iommu_map(mapping->domain, dma_addr, page_to_phys(page), len, prot);
|
|
ret = iommu_map(mapping->domain, dma_addr, page_to_phys(page), len, prot);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
@@ -2036,7 +2036,7 @@ static dma_addr_t arm_iommu_map_resource(struct device *dev,
|
|
if (dma_addr == DMA_ERROR_CODE)
|
|
if (dma_addr == DMA_ERROR_CODE)
|
|
return dma_addr;
|
|
return dma_addr;
|
|
|
|
|
|
- prot = __dma_direction_to_prot(dir) | IOMMU_MMIO;
|
|
|
|
|
|
+ prot = __dma_info_to_prot(dir, attrs) | IOMMU_MMIO;
|
|
|
|
|
|
ret = iommu_map(mapping->domain, dma_addr, addr, len, prot);
|
|
ret = iommu_map(mapping->domain, dma_addr, addr, len, prot);
|
|
if (ret < 0)
|
|
if (ret < 0)
|