Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * DMA operations that map to virtual addresses without flushing memory.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/dma-map-ops.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <linux/scatterlist.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) static void *dma_virt_alloc(struct device *dev, size_t size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 			    dma_addr_t *dma_handle, gfp_t gfp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 			    unsigned long attrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	void *ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	ret = (void *)__get_free_pages(gfp | __GFP_ZERO, get_order(size));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 		*dma_handle = (uintptr_t)ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static void dma_virt_free(struct device *dev, size_t size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 			  void *cpu_addr, dma_addr_t dma_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 			  unsigned long attrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	free_pages((unsigned long)cpu_addr, get_order(size));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static dma_addr_t dma_virt_map_page(struct device *dev, struct page *page,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 				    unsigned long offset, size_t size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 				    enum dma_data_direction dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 				    unsigned long attrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	return (uintptr_t)(page_address(page) + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) static int dma_virt_map_sg(struct device *dev, struct scatterlist *sgl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 			   int nents, enum dma_data_direction dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 			   unsigned long attrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	struct scatterlist *sg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	for_each_sg(sgl, sg, nents, i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 		BUG_ON(!sg_page(sg));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 		sg_dma_address(sg) = (uintptr_t)sg_virt(sg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 		sg_dma_len(sg) = sg->length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	return nents;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) const struct dma_map_ops dma_virt_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 	.alloc			= dma_virt_alloc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 	.free			= dma_virt_free,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	.map_page		= dma_virt_map_page,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	.map_sg			= dma_virt_map_sg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	.alloc_pages		= dma_common_alloc_pages,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	.free_pages		= dma_common_free_pages,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) EXPORT_SYMBOL(dma_virt_ops);