123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147 |
- /*
- * Copyright (c) 2017 Cadence Design Systems Inc.
- *
- * Permission is hereby granted, free of charge, to any person obtaining
- * a copy of this software and associated documentation files (the
- * "Software"), to deal in the Software without restriction, including
- * without limitation the rights to use, copy, modify, merge, publish,
- * distribute, sublicense, and/or sell copies of the Software, and to
- * permit persons to whom the Software is furnished to do so, subject to
- * the following conditions:
- *
- * The above copyright notice and this permission notice shall be included
- * in all copies or substantial portions of the Software.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
- * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
- * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
- * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
- * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
- * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
- *
- * Alternatively you can use and distribute this file under the terms of
- * the GNU General Public License version 2 or later.
- */
- #include <linux/version.h>
- #if LINUX_VERSION_CODE < KERNEL_VERSION(4, 16, 0)
- #include <linux/dma-mapping.h>
- #else
- #include <linux/dma-direct.h>
- #endif
- #include <linux/kernel.h>
- #include <linux/slab.h>
- #include "xrp_cma_alloc.h"
- struct xrp_cma_allocation {
- struct xrp_allocation allocation;
- void *kvaddr;
- };
- struct xrp_cma_pool {
- struct xrp_allocation_pool pool;
- struct device *dev;
- };
- static long xrp_cma_alloc(struct xrp_allocation_pool *allocation_pool,
- u32 size, u32 align, struct xrp_allocation **alloc)
- {
- struct xrp_cma_pool *pool = container_of(allocation_pool,
- struct xrp_cma_pool, pool);
- struct xrp_cma_allocation *new_cma;
- struct xrp_allocation *new;
- dma_addr_t dma_addr;
- void *kvaddr;
- size = ALIGN(size, PAGE_SIZE);
- new_cma = kzalloc(sizeof(struct xrp_cma_allocation), GFP_KERNEL);
- if (!new_cma)
- return -ENOMEM;
- new = &new_cma->allocation;
- #if LINUX_VERSION_CODE < KERNEL_VERSION(4,8,0)
- {
- DEFINE_DMA_ATTRS(attrs);
- dma_set_attr(DMA_ATTR_NO_KERNEL_MAPPING, &attrs);
- kvaddr = dma_alloc_attrs(pool->dev, size, &dma_addr,
- GFP_KERNEL, &attrs);
- }
- #else
- kvaddr = dma_alloc_attrs(pool->dev, size, &dma_addr, GFP_KERNEL,
- DMA_ATTR_NO_KERNEL_MAPPING);
- #endif
- if (!kvaddr) {
- kfree(new_cma);
- return -ENOMEM;
- }
- new->pool = allocation_pool;
- new->start = dma_to_phys(pool->dev, dma_addr);
- new->size = size;
- atomic_set(&new->ref, 0);
- xrp_allocation_get(new);
- new_cma->kvaddr = kvaddr;
- *alloc = new;
- return 0;
- }
- static void xrp_cma_free(struct xrp_allocation *xrp_allocation)
- {
- struct xrp_cma_pool *pool = container_of(xrp_allocation->pool,
- struct xrp_cma_pool, pool);
- struct xrp_cma_allocation *a = container_of(xrp_allocation,
- struct xrp_cma_allocation,
- allocation);
- #if LINUX_VERSION_CODE < KERNEL_VERSION(4,8,0)
- DEFINE_DMA_ATTRS(attrs);
- dma_set_attr(DMA_ATTR_NO_KERNEL_MAPPING, &attrs);
- dma_free_attrs(pool->dev, xrp_allocation->size,
- a->kvaddr,
- phys_to_dma(pool->dev, xrp_allocation->start),
- &attrs);
- #else
- dma_free_attrs(pool->dev, xrp_allocation->size,
- a->kvaddr,
- phys_to_dma(pool->dev, xrp_allocation->start),
- DMA_ATTR_NO_KERNEL_MAPPING);
- #endif
- kfree(a);
- }
- static void xrp_cma_free_pool(struct xrp_allocation_pool *allocation_pool)
- {
- struct xrp_cma_pool *pool = container_of(allocation_pool,
- struct xrp_cma_pool, pool);
- kfree(pool);
- }
- static phys_addr_t xrp_cma_offset(const struct xrp_allocation *allocation)
- {
- return allocation->start;
- }
- static const struct xrp_allocation_ops xrp_cma_pool_ops = {
- .alloc = xrp_cma_alloc,
- .free = xrp_cma_free,
- .free_pool = xrp_cma_free_pool,
- .offset = xrp_cma_offset,
- };
- long xrp_init_cma_pool(struct xrp_allocation_pool **ppool, struct device *dev)
- {
- struct xrp_cma_pool *pool = kmalloc(sizeof(*pool), GFP_KERNEL);
- if (!pool)
- return -ENOMEM;
- pool->pool.ops = &xrp_cma_pool_ops;
- pool->dev = dev;
- *ppool = &pool->pool;
- return 0;
- }
|