72 lines
		
	
	
		
			1.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			72 lines
		
	
	
		
			1.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * linux/arch/m68k/sun3/dvma.c
 | |
|  *
 | |
|  * Written by Sam Creasey
 | |
|  *
 | |
|  * Sun3 IOMMU routines used for dvma accesses.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/mm.h>
 | |
| #include <linux/bootmem.h>
 | |
| #include <linux/list.h>
 | |
| #include <asm/page.h>
 | |
| #include <asm/pgtable.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);
 | |
| //		printk("dvma_remap: addr %lx -> %lx pte %08lx len %x\n",
 | |
| //		       kaddr, vaddr, pte, len);
 | |
| 	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 sun3_dvma_init(void)
 | |
| {
 | |
| 
 | |
| 	memset(ptelist, 0, sizeof(ptelist));
 | |
| 
 | |
| 
 | |
| }
 |