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) #include <linux/dma-direct.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/swiotlb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <boot_param.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) dma_addr_t phys_to_dma(struct device *dev, phys_addr_t paddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 	/* We extract 2bit node id (bit 44~47, only bit 44~45 used now) from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 	 * Loongson-3's 48bit address space and embed it into 40bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 	long nid = (paddr >> 44) & 0x3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	return ((nid << 44) ^ paddr) | (nid << node_id_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) phys_addr_t dma_to_phys(struct device *dev, dma_addr_t daddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	/* We extract 2bit node id (bit 44~47, only bit 44~45 used now) from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	 * Loongson-3's 48bit address space and embed it into 40bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	long nid = (daddr >> node_id_offset) & 0x3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	return ((nid << node_id_offset) ^ daddr) | (nid << 44);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) void __init plat_swiotlb_setup(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	swiotlb_init(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) }