[mirror_ubuntu-artful-kernel.git] / arch / m68k / mm / sun3kmap.c

/*
 * linux/arch/m68k/mm/sun3kmap.c
 *
 * Copyright (C) 2002 Sam Creasey <sammy@sammy.net>
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file COPYING in the main directory of this archive
 * for more details.
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/vmalloc.h>

#include <asm/page.h>
#include <asm/pgtable.h>
#include <asm/io.h>
#include <asm/sun3mmu.h>

#undef SUN3_KMAP_DEBUG

#ifdef SUN3_KMAP_DEBUG
extern void print_pte_vaddr(unsigned long vaddr);
#endif

extern void mmu_emu_map_pmeg (int context, int vaddr);

static inline void do_page_mapin(unsigned long phys, unsigned long virt,
				 unsigned long type)
{
	unsigned long pte;
	pte_t ptep;

	ptep = pfn_pte(phys >> PAGE_SHIFT, PAGE_KERNEL);
	pte = pte_val(ptep);
	pte |= type;

	sun3_put_pte(virt, pte);

#ifdef SUN3_KMAP_DEBUG
	pr_info("mapin:");
	print_pte_vaddr(virt);
#endif

}

static inline void do_pmeg_mapin(unsigned long phys, unsigned long virt,
				 unsigned long type, int pages)
{

	if(sun3_get_segmap(virt & ~SUN3_PMEG_MASK) == SUN3_INVALID_PMEG)
		mmu_emu_map_pmeg(sun3_get_context(), virt);

	while(pages) {
		do_page_mapin(phys, virt, type);
		phys += PAGE_SIZE;
		virt += PAGE_SIZE;
		pages--;
	}
}

void __iomem *sun3_ioremap(unsigned long phys, unsigned long size,
		   unsigned long type)
{
	struct vm_struct *area;
	unsigned long offset, virt, ret;
	int pages;

	if(!size)
		return NULL;

	/* page align */
	offset = phys & (PAGE_SIZE-1);
	phys &= ~(PAGE_SIZE-1);

	size += offset;
	size = PAGE_ALIGN(size);
	if((area = get_vm_area(size, VM_IOREMAP)) == NULL)
		return NULL;

#ifdef SUN3_KMAP_DEBUG
	pr_info("ioremap: got virt %p size %lx(%lx)\n", area->addr, size,
		area->size);
#endif

	pages = size / PAGE_SIZE;
	virt = (unsigned long)area->addr;
	ret = virt + offset;

	while(pages) {
		int seg_pages;

		seg_pages = (SUN3_PMEG_SIZE - (virt & SUN3_PMEG_MASK)) / PAGE_SIZE;
		if(seg_pages > pages)
			seg_pages = pages;

		do_pmeg_mapin(phys, virt, type, seg_pages);

		pages -= seg_pages;
		phys += seg_pages * PAGE_SIZE;
		virt += seg_pages * PAGE_SIZE;
	}

	return (void __iomem *)ret;

}
EXPORT_SYMBOL(sun3_ioremap);


void __iomem *__ioremap(unsigned long phys, unsigned long size, int cache)
{

	return sun3_ioremap(phys, size, SUN3_PAGE_TYPE_IO);

}
EXPORT_SYMBOL(__ioremap);

void iounmap(void __iomem *addr)
{
	vfree((void *)(PAGE_MASK & (unsigned long)addr));
}
EXPORT_SYMBOL(iounmap);

/* sun3_map_test(addr, val) -- Reads a byte from addr, storing to val,
 * trapping the potential read fault.  Returns 0 if the access faulted,
 * 1 on success.
 *
 * This function is primarily used to check addresses on the VME bus.
 *
 * Mucking with the page fault handler seems a little hackish to me, but
 * SunOS, NetBSD, and Mach all implemented this check in such a manner,
 * so I figure we're allowed.
 */
int sun3_map_test(unsigned long addr, char *val)
{
	int ret = 0;

	__asm__ __volatile__
		(".globl _sun3_map_test_start\n"
		 "_sun3_map_test_start:\n"
		 "1: moveb (%2), (%0)\n"
		 "   moveq #1, %1\n"
		 "2:\n"
		 ".section .fixup,\"ax\"\n"
		 ".even\n"
		 "3: moveq #0, %1\n"
		 "   jmp 2b\n"
		 ".previous\n"
		 ".section __ex_table,\"a\"\n"
		 ".align 4\n"
		 ".long 1b,3b\n"
		 ".previous\n"
		 ".globl _sun3_map_test_end\n"
		 "_sun3_map_test_end:\n"
		 : "=a"(val), "=r"(ret)
		 : "a"(addr));

	return ret;
}
EXPORT_SYMBOL(sun3_map_test);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/arch/m68k/mm/sun3kmap.c
	3	*
	4	* Copyright (C) 2002 Sam Creasey <sammy@sammy.net>
	5	*
	6	* This file is subject to the terms and conditions of the GNU General Public
	7	* License. See the file COPYING in the main directory of this archive
	8	* for more details.
	9	*/
	10
2e811488	11	#include <linux/module.h>
1da177e4 LT	12	#include <linux/types.h>
	13	#include <linux/kernel.h>
	14	#include <linux/mm.h>
	15	#include <linux/vmalloc.h>
	16
	17	#include <asm/page.h>
	18	#include <asm/pgtable.h>
	19	#include <asm/io.h>
	20	#include <asm/sun3mmu.h>
	21
	22	#undef SUN3_KMAP_DEBUG
	23
	24	#ifdef SUN3_KMAP_DEBUG
	25	extern void print_pte_vaddr(unsigned long vaddr);
	26	#endif
	27
	28	extern void mmu_emu_map_pmeg (int context, int vaddr);
	29
	30	static inline void do_page_mapin(unsigned long phys, unsigned long virt,
	31	unsigned long type)
	32	{
	33	unsigned long pte;
	34	pte_t ptep;
	35
	36	ptep = pfn_pte(phys >> PAGE_SHIFT, PAGE_KERNEL);
	37	pte = pte_val(ptep);
	38	pte \|= type;
	39
	40	sun3_put_pte(virt, pte);
	41
	42	#ifdef SUN3_KMAP_DEBUG
05b70ff6	43	pr_info("mapin:");
1da177e4 LT	44	print_pte_vaddr(virt);
	45	#endif
	46
	47	}
	48
	49	static inline void do_pmeg_mapin(unsigned long phys, unsigned long virt,
	50	unsigned long type, int pages)
	51	{
	52
	53	if(sun3_get_segmap(virt & ~SUN3_PMEG_MASK) == SUN3_INVALID_PMEG)
	54	mmu_emu_map_pmeg(sun3_get_context(), virt);
	55
	56	while(pages) {
	57	do_page_mapin(phys, virt, type);
	58	phys += PAGE_SIZE;
	59	virt += PAGE_SIZE;
	60	pages--;
	61	}
	62	}
	63
437111ca	64	void __iomem *sun3_ioremap(unsigned long phys, unsigned long size,
1da177e4 LT	65	unsigned long type)
	66	{
	67	struct vm_struct *area;
	68	unsigned long offset, virt, ret;
	69	int pages;
	70
	71	if(!size)
	72	return NULL;
	73
	74	/* page align */
	75	offset = phys & (PAGE_SIZE-1);
	76	phys &= ~(PAGE_SIZE-1);
	77
	78	size += offset;
	79	size = PAGE_ALIGN(size);
	80	if((area = get_vm_area(size, VM_IOREMAP)) == NULL)
	81	return NULL;
	82
	83	#ifdef SUN3_KMAP_DEBUG
05b70ff6 GU	84	pr_info("ioremap: got virt %p size %lx(%lx)\n", area->addr, size,
05b70ff6 GU	85	area->size);
1da177e4 LT	86	#endif
	87
	88	pages = size / PAGE_SIZE;
	89	virt = (unsigned long)area->addr;
	90	ret = virt + offset;
	91
	92	while(pages) {
	93	int seg_pages;
	94
	95	seg_pages = (SUN3_PMEG_SIZE - (virt & SUN3_PMEG_MASK)) / PAGE_SIZE;
	96	if(seg_pages > pages)
	97	seg_pages = pages;
	98
	99	do_pmeg_mapin(phys, virt, type, seg_pages);
	100
	101	pages -= seg_pages;
	102	phys += seg_pages * PAGE_SIZE;
	103	virt += seg_pages * PAGE_SIZE;
	104	}
	105
437111ca	106	return (void __iomem *)ret;
1da177e4 LT	107
1da177e4 LT	108	}
88f8bb78	109	EXPORT_SYMBOL(sun3_ioremap);
1da177e4 LT	110
1da177e4 LT	111
437111ca	112	void __iomem *__ioremap(unsigned long phys, unsigned long size, int cache)
1da177e4 LT	113	{
	114
	115	return sun3_ioremap(phys, size, SUN3_PAGE_TYPE_IO);
	116
	117	}
2e811488	118	EXPORT_SYMBOL(__ioremap);
1da177e4	119
437111ca	120	void iounmap(void __iomem *addr)
1da177e4 LT	121	{
	122	vfree((void *)(PAGE_MASK & (unsigned long)addr));
	123	}
2e811488	124	EXPORT_SYMBOL(iounmap);
1da177e4 LT	125
	126	/* sun3_map_test(addr, val) -- Reads a byte from addr, storing to val,
	127	* trapping the potential read fault. Returns 0 if the access faulted,
	128	* 1 on success.
	129	*
	130	* This function is primarily used to check addresses on the VME bus.
	131	*
	132	* Mucking with the page fault handler seems a little hackish to me, but
	133	* SunOS, NetBSD, and Mach all implemented this check in such a manner,
	134	* so I figure we're allowed.
	135	*/
	136	int sun3_map_test(unsigned long addr, char *val)
	137	{
	138	int ret = 0;
	139
	140	__asm__ __volatile__
	141	(".globl _sun3_map_test_start\n"
	142	"_sun3_map_test_start:\n"
	143	"1: moveb (%2), (%0)\n"
	144	" moveq #1, %1\n"
	145	"2:\n"
	146	".section .fixup,\"ax\"\n"
	147	".even\n"
	148	"3: moveq #0, %1\n"
	149	" jmp 2b\n"
	150	".previous\n"
	151	".section __ex_table,\"a\"\n"
	152	".align 4\n"
	153	".long 1b,3b\n"
	154	".previous\n"
	155	".globl _sun3_map_test_end\n"
	156	"_sun3_map_test_end:\n"
	157	: "=a"(val), "=r"(ret)
	158	: "a"(addr));
	159
	160	return ret;
	161	}
88f8bb78	162	EXPORT_SYMBOL(sun3_map_test);