From patchwork Fri Jun 7 03:07:18 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: John Stultz X-Patchwork-Id: 166055 Delivered-To: patches@linaro.org Received: by 2002:a92:9e1a:0:0:0:0:0 with SMTP id q26csp107706ili; Thu, 6 Jun 2019 20:07:31 -0700 (PDT) X-Received: by 2002:a17:902:121:: with SMTP id 30mr51210467plb.314.1559876851475; Thu, 06 Jun 2019 20:07:31 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1559876851; cv=none; d=google.com; s=arc-20160816; b=GFjSqzf4CVdCDb2hulgmRkomRpLzvmH4Q2f82IHq5vZegcqyF+WxEN92GI3DiyPdiY NT2PsHYV64Vkv0og8cKFehDTI9gq9BHAn5EGPofNFJ9maWWalUH6H+uavaqZR4TOkyV0 wipjNTfxssj2SdVJyZptjg1j21zEYmQqPOA1Qu8t2Db+e1iWZqcbHgBBXJegW6N1AJLn aSprN8k/YBYjUY0HwKARB1RHQWjOH3DItzA/UEFAwKgRUmJSjfD/3tuaU41vywtUSN3B NTVGWuvgh9wAMVe0TMa9brl5DiS/sHkhVCjhShoVXd+f4z+coI/ae2/TF2FM9m2QOuZV yT6A== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=references:in-reply-to:message-id:date:subject:cc:to:from :dkim-signature; bh=jkqUfkb6bwSXNnPhUgVaq/yDNSDsBfZpTr2nyhoEdqY=; b=P+ljy/SbXZXNJYPWniLXpOMJHpcQIHOLHN3ysnS/lK58OgtC9pTa0s9pUd4qCtV5fJ DaJoajGhvBrzvCatF0LEsXWFtvMmm/4NbtoGVpOT7iwwA60b6K/9ptD98YQOX02GePnV 93oqLcQM8eXBveda/24G/zpLZ3voHVIvdf60d87H7wFZ0ioE0siLBsyMdQH9sGG8+tTL IqXBFO76ePlS1LNFVThGUmubQdA35xmmPuJgvt2IisEzTHNhwLhstbJZ81cybMvGUPOg XdFWIo1xvO82LulT2ACKxDfq6yipkAlkTNmmyFhFygnsM1/xAV3SDm6W+0iaXDxifIYt zECg== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=dpARyvDH; spf=pass (google.com: domain of john.stultz@linaro.org designates 209.85.220.65 as permitted sender) smtp.mailfrom=john.stultz@linaro.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Return-Path: Received: from mail-sor-f65.google.com (mail-sor-f65.google.com. [209.85.220.65]) by mx.google.com with SMTPS id m32sor971648pld.47.2019.06.06.20.07.31 for (Google Transport Security); Thu, 06 Jun 2019 20:07:31 -0700 (PDT) Received-SPF: pass (google.com: domain of john.stultz@linaro.org designates 209.85.220.65 as permitted sender) client-ip=209.85.220.65; Authentication-Results: mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=dpARyvDH; spf=pass (google.com: domain of john.stultz@linaro.org designates 209.85.220.65 as permitted sender) smtp.mailfrom=john.stultz@linaro.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=jkqUfkb6bwSXNnPhUgVaq/yDNSDsBfZpTr2nyhoEdqY=; b=dpARyvDHLwpM85DNPxc1VTJFYxf95+w+KgX1lIPxv1mlqdkV2SoE22G3TevZNOSt0D oahD8uqCF7HgaWNfFvNzH8bL3du/rCSlduwuY6mBeywCfQQfetb80Yr+RebszMqnL7Qw Q0hXERijVj5BlP2g74mXbML6tC7M90aOxoJKLUivm1q084XZiZnM+EprJBQoSXfT9xKm ELEWjwMiXpraOvjuQFwQUVpW+nj7Sp+opMyn08SA4UYu1g2YYtnBgd72Cek/6b1wTuEJ 14uteyj+DHIjsxR+6ZGLYltH3vCKsNgJgbYvJmLMqx46LZxtlR/D18xpBKhErpLWVfQc kDhw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=jkqUfkb6bwSXNnPhUgVaq/yDNSDsBfZpTr2nyhoEdqY=; b=PxmeEsXICH4Q7kacJg9VEUG2iADdzl4ft4Ao/6zFWnnuhGB6tpcbJN5+ftMoH7VIkw MyEEXScCjq0vqQzIN1Af/qsh69fI80oNl9MegFKyQDTnD8gBEbCupmmHCmLzD33/TJ2r pH/lDTyZEthmNXTk7rSAcB33ykI/BIPX3t/y0u5ry5g6aiAURoKu/oGdtwdi6hABC2F9 0x7kQ2R0VnoJsZgKCo5YTAn4k5qnsZhXmtJJAUSOKqBA33jPMi36jQ+rWHD4mf05npLm uFv+UX9i/l78dyXiv9nLHNIM5mOjk8TXNwoeq2HmSpv/bJQxdfcTh7hU5JYtIYYSPF2e 69sQ== X-Gm-Message-State: APjAAAXW5Pg6vvGwNGf3GwEBwkh68s3XP+dQkn4B5qVj60hlRQUvV7kE coPJBIpBcGFzpL1TnfAFrbPqL8AP4geDGg== X-Google-Smtp-Source: APXvYqz4H4Nc5xu7BGXotnYms+GsRjkcVfOg0Qd04NaLgymDFVY71ror+EVXyGqPl6/CI/qxHjdj1g== X-Received: by 2002:a17:902:a513:: with SMTP id s19mr49947487plq.261.1559876850744; Thu, 06 Jun 2019 20:07:30 -0700 (PDT) Return-Path: Received: from localhost.localdomain ([2601:1c2:680:1319:692:26ff:feda:3a81]) by smtp.gmail.com with ESMTPSA id f4sm506575pfn.118.2019.06.06.20.07.28 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Thu, 06 Jun 2019 20:07:29 -0700 (PDT) From: John Stultz To: lkml Cc: John Stultz , Laura Abbott , Benjamin Gaignard , Sumit Semwal , Liam Mark , Pratik Patel , Brian Starkey , Vincent Donnefort , Sudipto Paul , "Andrew F . Davis" , Christoph Hellwig , Chenbo Feng , Alistair Strachan , dri-devel@lists.freedesktop.org Subject: [PATCH v5 4/5] dma-buf: heaps: Add CMA heap to dmabuf heaps Date: Fri, 7 Jun 2019 03:07:18 +0000 Message-Id: <20190607030719.77286-5-john.stultz@linaro.org> X-Mailer: git-send-email 2.17.1 In-Reply-To: <20190607030719.77286-1-john.stultz@linaro.org> References: <20190607030719.77286-1-john.stultz@linaro.org> This adds a CMA heap, which allows userspace to allocate a dma-buf of contiguous memory out of a CMA region. This code is an evolution of the Android ION implementation, so thanks to its original author and maintainters: Benjamin Gaignard, Laura Abbott, and others! Cc: Laura Abbott Cc: Benjamin Gaignard Cc: Sumit Semwal Cc: Liam Mark Cc: Pratik Patel Cc: Brian Starkey Cc: Vincent Donnefort Cc: Sudipto Paul Cc: Andrew F. Davis Cc: Christoph Hellwig Cc: Chenbo Feng Cc: Alistair Strachan Cc: dri-devel@lists.freedesktop.org Reviewed-by: Benjamin Gaignard Signed-off-by: John Stultz Change-Id: Ic2b0c5dfc0dbaff5245bd1c50170c64b06c73051 --- v2: * Switch allocate to return dmabuf fd * Simplify init code * Checkpatch fixups v3: * Switch to inline function for to_cma_heap() * Minor cleanups suggested by Brian * Fold in new registration style from Andrew * Folded in changes from Andrew to use simplified page list from the heap helpers v4: * Use the fd_flags when creating dmabuf fd (Suggested by Benjamin) * Use precalculated pagecount (Suggested by Andrew) --- drivers/dma-buf/heaps/Kconfig | 8 ++ drivers/dma-buf/heaps/Makefile | 1 + drivers/dma-buf/heaps/cma_heap.c | 169 +++++++++++++++++++++++++++++++ 3 files changed, 178 insertions(+) create mode 100644 drivers/dma-buf/heaps/cma_heap.c -- 2.17.1 diff --git a/drivers/dma-buf/heaps/Kconfig b/drivers/dma-buf/heaps/Kconfig index 205052744169..a5eef06c4226 100644 --- a/drivers/dma-buf/heaps/Kconfig +++ b/drivers/dma-buf/heaps/Kconfig @@ -4,3 +4,11 @@ config DMABUF_HEAPS_SYSTEM help Choose this option to enable the system dmabuf heap. The system heap is backed by pages from the buddy allocator. If in doubt, say Y. + +config DMABUF_HEAPS_CMA + bool "DMA-BUF CMA Heap" + depends on DMABUF_HEAPS && DMA_CMA + help + Choose this option to enable dma-buf CMA heap. This heap is backed + by the Contiguous Memory Allocator (CMA). If your system has these + regions, you should say Y here. diff --git a/drivers/dma-buf/heaps/Makefile b/drivers/dma-buf/heaps/Makefile index d1808eca2581..6e54cdec3da0 100644 --- a/drivers/dma-buf/heaps/Makefile +++ b/drivers/dma-buf/heaps/Makefile @@ -1,3 +1,4 @@ # SPDX-License-Identifier: GPL-2.0 obj-y += heap-helpers.o obj-$(CONFIG_DMABUF_HEAPS_SYSTEM) += system_heap.o +obj-$(CONFIG_DMABUF_HEAPS_CMA) += cma_heap.o diff --git a/drivers/dma-buf/heaps/cma_heap.c b/drivers/dma-buf/heaps/cma_heap.c new file mode 100644 index 000000000000..3d0ffbbd0a34 --- /dev/null +++ b/drivers/dma-buf/heaps/cma_heap.c @@ -0,0 +1,169 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * DMABUF CMA heap exporter + * + * Copyright (C) 2012, 2019 Linaro Ltd. + * Author: for ST-Ericsson. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "heap-helpers.h" + +struct cma_heap { + struct dma_heap *heap; + struct cma *cma; +}; + +static void cma_heap_free(struct heap_helper_buffer *buffer) +{ + struct cma_heap *cma_heap = dma_heap_get_data(buffer->heap_buffer.heap); + unsigned long nr_pages = buffer->pagecount; + struct page *pages = buffer->priv_virt; + + /* free page list */ + kfree(buffer->pages); + /* release memory */ + cma_release(cma_heap->cma, pages, nr_pages); + kfree(buffer); +} + +/* dmabuf heap CMA operations functions */ +static int cma_heap_allocate(struct dma_heap *heap, + unsigned long len, + unsigned long fd_flags, + unsigned long heap_flags) +{ + struct cma_heap *cma_heap = dma_heap_get_data(heap); + struct heap_helper_buffer *helper_buffer; + struct page *pages; + size_t size = PAGE_ALIGN(len); + unsigned long nr_pages = size >> PAGE_SHIFT; + unsigned long align = get_order(size); + DEFINE_DMA_BUF_EXPORT_INFO(exp_info); + struct dma_buf *dmabuf; + int ret = -ENOMEM; + pgoff_t pg; + + if (align > CONFIG_CMA_ALIGNMENT) + align = CONFIG_CMA_ALIGNMENT; + + helper_buffer = kzalloc(sizeof(*helper_buffer), GFP_KERNEL); + if (!helper_buffer) + return -ENOMEM; + + INIT_HEAP_HELPER_BUFFER(helper_buffer, cma_heap_free); + helper_buffer->heap_buffer.flags = heap_flags; + helper_buffer->heap_buffer.heap = heap; + helper_buffer->heap_buffer.size = len; + + pages = cma_alloc(cma_heap->cma, nr_pages, align, false); + if (!pages) + goto free_buf; + + if (PageHighMem(pages)) { + unsigned long nr_clear_pages = nr_pages; + struct page *page = pages; + + while (nr_clear_pages > 0) { + void *vaddr = kmap_atomic(page); + + memset(vaddr, 0, PAGE_SIZE); + kunmap_atomic(vaddr); + page++; + nr_clear_pages--; + } + } else { + memset(page_address(pages), 0, size); + } + + helper_buffer->pagecount = nr_pages; + helper_buffer->pages = kmalloc_array(helper_buffer->pagecount, + sizeof(*helper_buffer->pages), + GFP_KERNEL); + if (!helper_buffer->pages) { + ret = -ENOMEM; + goto free_cma; + } + + for (pg = 0; pg < helper_buffer->pagecount; pg++) { + helper_buffer->pages[pg] = &pages[pg]; + if (!helper_buffer->pages[pg]) + goto free_pages; + } + + /* create the dmabuf */ + exp_info.ops = &heap_helper_ops; + exp_info.size = len; + exp_info.flags = fd_flags; + exp_info.priv = &helper_buffer->heap_buffer; + dmabuf = dma_buf_export(&exp_info); + if (IS_ERR(dmabuf)) { + ret = PTR_ERR(dmabuf); + goto free_pages; + } + + helper_buffer->heap_buffer.dmabuf = dmabuf; + helper_buffer->priv_virt = pages; + + ret = dma_buf_fd(dmabuf, fd_flags); + if (ret < 0) { + dma_buf_put(dmabuf); + /* just return, as put will call release and that will free */ + return ret; + } + + return ret; + +free_pages: + kfree(helper_buffer->pages); +free_cma: + cma_release(cma_heap->cma, pages, nr_pages); +free_buf: + kfree(helper_buffer); + return ret; +} + +static struct dma_heap_ops cma_heap_ops = { + .allocate = cma_heap_allocate, +}; + +static int __add_cma_heap(struct cma *cma, void *data) +{ + struct cma_heap *cma_heap; + struct dma_heap_export_info exp_info; + + cma_heap = kzalloc(sizeof(*cma_heap), GFP_KERNEL); + if (!cma_heap) + return -ENOMEM; + cma_heap->cma = cma; + + exp_info.name = cma_get_name(cma); + exp_info.ops = &cma_heap_ops; + exp_info.priv = cma_heap; + + cma_heap->heap = dma_heap_add(&exp_info); + if (IS_ERR(cma_heap->heap)) { + int ret = PTR_ERR(cma_heap->heap); + + kfree(cma_heap); + return ret; + } + + return 0; +} + +static int add_cma_heaps(void) +{ + cma_for_each_area(__add_cma_heap, NULL); + return 0; +} +device_initcall(add_cma_heaps);