[mirror_ubuntu-jammy-kernel.git] / arch / m68k / sun3 / dvma.c

// SPDX-License-Identifier: GPL-2.0
/*
 * linux/arch/m68k/sun3/dvma.c
 *
 * Written by Sam Creasey
 *
 * Sun3 IOMMU routines used for dvma accesses.
 *
 */

#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/memblock.h>
#include <linux/list.h>
#include <asm/page.h>
#include <asm/sun3mmu.h>
#include <asm/dvma.h>


static unsigned long ptelist[120];

static unsigned long dvma_page(unsigned long kaddr, unsigned long vaddr)
{
	unsigned long pte;
	unsigned long j;
	pte_t ptep;

	j = *(volatile unsigned long *)kaddr;
	*(volatile unsigned long *)kaddr = j;

	ptep = pfn_pte(virt_to_pfn(kaddr), PAGE_KERNEL);
	pte = pte_val(ptep);
//	pr_info("dvma_remap: addr %lx -> %lx pte %08lx\n", kaddr, vaddr, pte);
	if(ptelist[(vaddr & 0xff000) >> PAGE_SHIFT] != pte) {
		sun3_put_pte(vaddr, pte);
		ptelist[(vaddr & 0xff000) >> PAGE_SHIFT] = pte;
	}

	return (vaddr + (kaddr & ~PAGE_MASK));

}

int dvma_map_iommu(unsigned long kaddr, unsigned long baddr,
			      int len)
{

	unsigned long end;
	unsigned long vaddr;

	vaddr = dvma_btov(baddr);

	end = vaddr + len;

	while(vaddr < end) {
		dvma_page(kaddr, vaddr);
		kaddr += PAGE_SIZE;
		vaddr += PAGE_SIZE;
	}

	return 0;

}

void __init sun3_dvma_init(void)
{
	memset(ptelist, 0, sizeof(ptelist));
}
Commit	Line	Data
b2441318	1	// SPDX-License-Identifier: GPL-2.0
1da177e4 LT	2	/*
	3	* linux/arch/m68k/sun3/dvma.c
	4	*
	5	* Written by Sam Creasey
	6	*
	7	* Sun3 IOMMU routines used for dvma accesses.
	8	*
	9	*/
	10
a4df02a2	11	#include <linux/init.h>
1da177e4 LT	12	#include <linux/kernel.h>
1da177e4 LT	13	#include <linux/mm.h>
57c8a661	14	#include <linux/memblock.h>
1da177e4 LT	15	#include <linux/list.h>
1da177e4 LT	16	#include <asm/page.h>
1da177e4 LT	17	#include <asm/sun3mmu.h>
	18	#include <asm/dvma.h>
	19
	20
	21	static unsigned long ptelist[120];
	22
07b81259	23	static unsigned long dvma_page(unsigned long kaddr, unsigned long vaddr)
1da177e4 LT	24	{
	25	unsigned long pte;
	26	unsigned long j;
	27	pte_t ptep;
	28
	29	j = (volatile unsigned long )kaddr;
	30	(volatile unsigned long )kaddr = j;
	31
	32	ptep = pfn_pte(virt_to_pfn(kaddr), PAGE_KERNEL);
	33	pte = pte_val(ptep);
56bbd862	34	// pr_info("dvma_remap: addr %lx -> %lx pte %08lx\n", kaddr, vaddr, pte);
1da177e4 LT	35	if(ptelist[(vaddr & 0xff000) >> PAGE_SHIFT] != pte) {
	36	sun3_put_pte(vaddr, pte);
	37	ptelist[(vaddr & 0xff000) >> PAGE_SHIFT] = pte;
	38	}
	39
	40	return (vaddr + (kaddr & ~PAGE_MASK));
	41
	42	}
	43
	44	int dvma_map_iommu(unsigned long kaddr, unsigned long baddr,
	45	int len)
	46	{
	47
	48	unsigned long end;
	49	unsigned long vaddr;
	50
	51	vaddr = dvma_btov(baddr);
	52
	53	end = vaddr + len;
	54
	55	while(vaddr < end) {
	56	dvma_page(kaddr, vaddr);
	57	kaddr += PAGE_SIZE;
	58	vaddr += PAGE_SIZE;
	59	}
	60
	61	return 0;
	62
	63	}
	64
a4df02a2	65	void __init sun3_dvma_init(void)
1da177e4	66	{
1da177e4	67	memset(ptelist, 0, sizeof(ptelist));
1da177e4	68	}