Now that we have introduced ECC-related flags for the dma-heaps buffer
allocations, let's honour these flags depending on the memory setup.

Signed-off-by: Maxime Ripard <[email protected]>
---
 drivers/dma-buf/heaps/system_heap.c | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/drivers/dma-buf/heaps/system_heap.c 
b/drivers/dma-buf/heaps/system_heap.c
index 8b5e6344eea4..dd7c8b6f9cf6 100644
--- a/drivers/dma-buf/heaps/system_heap.c
+++ b/drivers/dma-buf/heaps/system_heap.c
@@ -18,13 +18,15 @@
 #include <linux/mm.h>
 #include <linux/module.h>
 #include <linux/scatterlist.h>
 #include <linux/slab.h>
 #include <linux/vmalloc.h>
+#include <linux/of.h>
 
 struct system_heap {
        struct dma_heap *heap;
+       bool ecc_enabled;
 };
 
 struct system_heap_buffer {
        struct dma_heap *heap;
        struct list_head attachments;
@@ -336,10 +338,11 @@ static struct page *alloc_largest_available(unsigned long 
size,
 static struct dma_buf *system_heap_allocate(struct dma_heap *heap,
                                            unsigned long len,
                                            unsigned long fd_flags,
                                            unsigned long heap_flags)
 {
+       struct system_heap *sys_heap = dma_heap_get_drvdata(heap);
        struct system_heap_buffer *buffer;
        DEFINE_DMA_BUF_EXPORT_INFO(exp_info);
        unsigned long size_remaining = len;
        unsigned int max_order = orders[0];
        struct dma_buf *dmabuf;
@@ -347,10 +350,16 @@ static struct dma_buf *system_heap_allocate(struct 
dma_heap *heap,
        struct scatterlist *sg;
        struct list_head pages;
        struct page *page, *tmp_page;
        int i, ret = -ENOMEM;
 
+       if (!sys_heap->ecc_enabled && (heap_flags & 
DMA_HEAP_FLAG_ECC_PROTECTED))
+               return ERR_PTR(-EINVAL);
+
+       if (sys_heap->ecc_enabled && (heap_flags & 
DMA_HEAP_FLAG_ECC_UNPROTECTED))
+               return ERR_PTR(-EINVAL);
+
        buffer = kzalloc(sizeof(*buffer), GFP_KERNEL);
        if (!buffer)
                return ERR_PTR(-ENOMEM);
 
        INIT_LIST_HEAD(&buffer->attachments);
@@ -430,10 +439,13 @@ static int system_heap_create(void)
 
        sys_heap = kzalloc(sizeof(*sys_heap), GFP_KERNEL);
        if (!sys_heap)
                return -ENOMEM;
 
+       if (of_memory_get_ecc_correction_bits() > 0)
+               sys_heap->ecc_enabled = true;
+
        exp_info.name = "system";
        exp_info.ops = &system_heap_ops;
        exp_info.priv = sys_heap;
 
        sys_heap->heap = dma_heap_add(&exp_info);

-- 
2.44.0

Reply via email to