162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci#include <linux/dma-direct.h>
362306a36Sopenharmony_ci#include <linux/init.h>
462306a36Sopenharmony_ci#include <linux/swiotlb.h>
562306a36Sopenharmony_ci#include <boot_param.h>
662306a36Sopenharmony_ci
762306a36Sopenharmony_cidma_addr_t phys_to_dma(struct device *dev, phys_addr_t paddr)
862306a36Sopenharmony_ci{
962306a36Sopenharmony_ci	/* We extract 2bit node id (bit 44~47, only bit 44~45 used now) from
1062306a36Sopenharmony_ci	 * Loongson-3's 48bit address space and embed it into 40bit */
1162306a36Sopenharmony_ci	long nid = (paddr >> 44) & 0x3;
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci	return ((nid << 44) ^ paddr) | (nid << node_id_offset);
1462306a36Sopenharmony_ci}
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ciphys_addr_t dma_to_phys(struct device *dev, dma_addr_t daddr)
1762306a36Sopenharmony_ci{
1862306a36Sopenharmony_ci	/* We extract 2bit node id (bit 44~47, only bit 44~45 used now) from
1962306a36Sopenharmony_ci	 * Loongson-3's 48bit address space and embed it into 40bit */
2062306a36Sopenharmony_ci	long nid = (daddr >> node_id_offset) & 0x3;
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci	return ((nid << node_id_offset) ^ daddr) | (nid << 44);
2362306a36Sopenharmony_ci}
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_civoid __init plat_swiotlb_setup(void)
2662306a36Sopenharmony_ci{
2762306a36Sopenharmony_ci	swiotlb_init(true, SWIOTLB_VERBOSE);
2862306a36Sopenharmony_ci}
29