Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit f04b951f authored by Christoph Hellwig's avatar Christoph Hellwig
Browse files

csky: use the generic remapping dma alloc implementation



The csky code was largely copied from arm/arm64, so switch to the
generic arm64-based implementation instead.

Signed-off-by: default avatarChristoph Hellwig <hch@lst.de>
Acked-by: default avatarGuo Ren <ren_guo@c-sky.com>
parent 576d0d55
Loading
Loading
Loading
Loading
+1 −1
Original line number Original line Diff line number Diff line
@@ -8,7 +8,7 @@ config CSKY
	select CLKSRC_MMIO
	select CLKSRC_MMIO
	select CLKSRC_OF
	select CLKSRC_OF
	select DMA_DIRECT_OPS
	select DMA_DIRECT_OPS
	select DMA_REMAP
	select DMA_DIRECT_REMAP
	select IRQ_DOMAIN
	select IRQ_DOMAIN
	select HANDLE_DOMAIN_IRQ
	select HANDLE_DOMAIN_IRQ
	select DW_APB_TIMER_OF
	select DW_APB_TIMER_OF
+2 −140
Original line number Original line Diff line number Diff line
@@ -14,73 +14,13 @@
#include <linux/version.h>
#include <linux/version.h>
#include <asm/cache.h>
#include <asm/cache.h>


static struct gen_pool *atomic_pool;
static size_t atomic_pool_size __initdata = SZ_256K;

static int __init early_coherent_pool(char *p)
{
	atomic_pool_size = memparse(p, &p);
	return 0;
}
early_param("coherent_pool", early_coherent_pool);

static int __init atomic_pool_init(void)
static int __init atomic_pool_init(void)
{
{
	struct page *page;
	return dma_atomic_pool_init(GFP_KERNEL, pgprot_noncached(PAGE_KERNEL));
	size_t size = atomic_pool_size;
	void *ptr;
	int ret;

	atomic_pool = gen_pool_create(PAGE_SHIFT, -1);
	if (!atomic_pool)
		BUG();

	page = alloc_pages(GFP_KERNEL, get_order(size));
	if (!page)
		BUG();

	ptr = dma_common_contiguous_remap(page, size, VM_ALLOC,
					  pgprot_noncached(PAGE_KERNEL),
					  __builtin_return_address(0));
	if (!ptr)
		BUG();

	ret = gen_pool_add_virt(atomic_pool, (unsigned long)ptr,
				page_to_phys(page), atomic_pool_size, -1);
	if (ret)
		BUG();

	gen_pool_set_algo(atomic_pool, gen_pool_first_fit_order_align, NULL);

	pr_info("DMA: preallocated %zu KiB pool for atomic coherent pool\n",
		atomic_pool_size / 1024);

	pr_info("DMA: vaddr: 0x%x phy: 0x%lx,\n", (unsigned int)ptr,
		page_to_phys(page));

	return 0;
}
}
postcore_initcall(atomic_pool_init);
postcore_initcall(atomic_pool_init);


static void *csky_dma_alloc_atomic(struct device *dev, size_t size,
void arch_dma_prep_coherent(struct page *page, size_t size)
				   dma_addr_t *dma_handle)
{
	unsigned long addr;

	addr = gen_pool_alloc(atomic_pool, size);
	if (addr)
		*dma_handle = gen_pool_virt_to_phys(atomic_pool, addr);

	return (void *)addr;
}

static void csky_dma_free_atomic(struct device *dev, size_t size, void *vaddr,
				 dma_addr_t dma_handle, unsigned long attrs)
{
	gen_pool_free(atomic_pool, (unsigned long)vaddr, size);
}

static void __dma_clear_buffer(struct page *page, size_t size)
{
{
	if (PageHighMem(page)) {
	if (PageHighMem(page)) {
		unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;
		unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;
@@ -107,84 +47,6 @@ static void __dma_clear_buffer(struct page *page, size_t size)
	}
	}
}
}


static void *csky_dma_alloc_nonatomic(struct device *dev, size_t size,
				      dma_addr_t *dma_handle, gfp_t gfp,
				      unsigned long attrs)
{
	void  *vaddr;
	struct page *page;
	unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;

	if (DMA_ATTR_NON_CONSISTENT & attrs) {
		pr_err("csky %s can't support DMA_ATTR_NON_CONSISTENT.\n", __func__);
		return NULL;
	}

	if (IS_ENABLED(CONFIG_DMA_CMA))
		page = dma_alloc_from_contiguous(dev, count, get_order(size),
						 gfp);
	else
		page = alloc_pages(gfp, get_order(size));

	if (!page) {
		pr_err("csky %s no more free pages.\n", __func__);
		return NULL;
	}

	*dma_handle = page_to_phys(page);

	__dma_clear_buffer(page, size);

	if (attrs & DMA_ATTR_NO_KERNEL_MAPPING)
		return page;

	vaddr = dma_common_contiguous_remap(page, PAGE_ALIGN(size), VM_USERMAP,
		pgprot_noncached(PAGE_KERNEL), __builtin_return_address(0));
	if (!vaddr)
		BUG();

	return vaddr;
}

static void csky_dma_free_nonatomic(
	struct device *dev,
	size_t size,
	void *vaddr,
	dma_addr_t dma_handle,
	unsigned long attrs
	)
{
	struct page *page = phys_to_page(dma_handle);
	unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;

	if ((unsigned int)vaddr >= VMALLOC_START)
		dma_common_free_remap(vaddr, size, VM_USERMAP);

	if (IS_ENABLED(CONFIG_DMA_CMA))
		dma_release_from_contiguous(dev, page, count);
	else
		__free_pages(page, get_order(size));
}

void *arch_dma_alloc(struct device *dev, size_t size, dma_addr_t *dma_handle,
		     gfp_t gfp, unsigned long attrs)
{
	if (gfpflags_allow_blocking(gfp))
		return csky_dma_alloc_nonatomic(dev, size, dma_handle, gfp,
						attrs);
	else
		return csky_dma_alloc_atomic(dev, size, dma_handle);
}

void arch_dma_free(struct device *dev, size_t size, void *vaddr,
		   dma_addr_t dma_handle, unsigned long attrs)
{
	if (!addr_in_gen_pool(atomic_pool, (unsigned int) vaddr, size))
		csky_dma_free_nonatomic(dev, size, vaddr, dma_handle, attrs);
	else
		csky_dma_free_atomic(dev, size, vaddr, dma_handle, attrs);
}

static inline void cache_op(phys_addr_t paddr, size_t size,
static inline void cache_op(phys_addr_t paddr, size_t size,
			    void (*fn)(unsigned long start, unsigned long end))
			    void (*fn)(unsigned long start, unsigned long end))
{
{