1// SPDX-License-Identifier: GPL-2.0
 2// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
 3
 4#include <linux/cache.h>
 5#include <linux/dma-map-ops.h>
 
 
 6#include <linux/genalloc.h>
 7#include <linux/highmem.h>
 8#include <linux/io.h>
 9#include <linux/mm.h>
10#include <linux/scatterlist.h>
11#include <linux/types.h>
 
12#include <asm/cache.h>
13
14static inline void cache_op(phys_addr_t paddr, size_t size,
15			    void (*fn)(unsigned long start, unsigned long end))
16{
17	struct page *page    = phys_to_page(paddr);
18	void *start          = __va(page_to_phys(page));
19	unsigned long offset = offset_in_page(paddr);
20	size_t left          = size;
21
22	do {
23		size_t len = left;
24
25		if (offset + len > PAGE_SIZE)
26			len = PAGE_SIZE - offset;
27
28		if (PageHighMem(page)) {
29			start = kmap_atomic(page);
30
31			fn((unsigned long)start + offset,
32					(unsigned long)start + offset + len);
33
34			kunmap_atomic(start);
35		} else {
36			fn((unsigned long)start + offset,
37					(unsigned long)start + offset + len);
38		}
39		offset = 0;
40
41		page++;
42		start += PAGE_SIZE;
43		left -= len;
44	} while (left);
45}
46
47static void dma_wbinv_set_zero_range(unsigned long start, unsigned long end)
48{
49	memset((void *)start, 0, end - start);
50	dma_wbinv_range(start, end);
51}
52
53void arch_dma_prep_coherent(struct page *page, size_t size)
54{
55	cache_op(page_to_phys(page), size, dma_wbinv_set_zero_range);
56}
57
58void arch_sync_dma_for_device(phys_addr_t paddr, size_t size,
59		enum dma_data_direction dir)
60{
61	switch (dir) {
62	case DMA_TO_DEVICE:
63		cache_op(paddr, size, dma_wb_range);
64		break;
65	case DMA_FROM_DEVICE:
66	case DMA_BIDIRECTIONAL:
67		cache_op(paddr, size, dma_wbinv_range);
68		break;
69	default:
70		BUG();
71	}
72}
73
74void arch_sync_dma_for_cpu(phys_addr_t paddr, size_t size,
75		enum dma_data_direction dir)
76{
77	switch (dir) {
78	case DMA_TO_DEVICE:
79		return;
80	case DMA_FROM_DEVICE:
81	case DMA_BIDIRECTIONAL:
82		cache_op(paddr, size, dma_inv_range);
83		break;
84	default:
85		BUG();
86	}
87}

 1// SPDX-License-Identifier: GPL-2.0
 2// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
 3
 4#include <linux/cache.h>
 5#include <linux/dma-mapping.h>
 6#include <linux/dma-contiguous.h>
 7#include <linux/dma-noncoherent.h>
 8#include <linux/genalloc.h>
 9#include <linux/highmem.h>
10#include <linux/io.h>
11#include <linux/mm.h>
12#include <linux/scatterlist.h>
13#include <linux/types.h>
14#include <linux/version.h>
15#include <asm/cache.h>
16
17static inline void cache_op(phys_addr_t paddr, size_t size,
18			    void (*fn)(unsigned long start, unsigned long end))
19{
20	struct page *page    = phys_to_page(paddr);
21	void *start          = __va(page_to_phys(page));
22	unsigned long offset = offset_in_page(paddr);
23	size_t left          = size;
24
25	do {
26		size_t len = left;
27
28		if (offset + len > PAGE_SIZE)
29			len = PAGE_SIZE - offset;
30
31		if (PageHighMem(page)) {
32			start = kmap_atomic(page);
33
34			fn((unsigned long)start + offset,
35					(unsigned long)start + offset + len);
36
37			kunmap_atomic(start);
38		} else {
39			fn((unsigned long)start + offset,
40					(unsigned long)start + offset + len);
41		}
42		offset = 0;
43
44		page++;
45		start += PAGE_SIZE;
46		left -= len;
47	} while (left);
48}
49
50static void dma_wbinv_set_zero_range(unsigned long start, unsigned long end)
51{
52	memset((void *)start, 0, end - start);
53	dma_wbinv_range(start, end);
54}
55
56void arch_dma_prep_coherent(struct page *page, size_t size)
57{
58	cache_op(page_to_phys(page), size, dma_wbinv_set_zero_range);
59}
60
61void arch_sync_dma_for_device(phys_addr_t paddr, size_t size,
62		enum dma_data_direction dir)
63{
64	switch (dir) {
65	case DMA_TO_DEVICE:
66		cache_op(paddr, size, dma_wb_range);
67		break;
68	case DMA_FROM_DEVICE:
69	case DMA_BIDIRECTIONAL:
70		cache_op(paddr, size, dma_wbinv_range);
71		break;
72	default:
73		BUG();
74	}
75}
76
77void arch_sync_dma_for_cpu(phys_addr_t paddr, size_t size,
78		enum dma_data_direction dir)
79{
80	switch (dir) {
81	case DMA_TO_DEVICE:
82		return;
83	case DMA_FROM_DEVICE:
84	case DMA_BIDIRECTIONAL:
85		cache_op(paddr, size, dma_inv_range);
86		break;
87	default:
88		BUG();
89	}
90}