[net-next-2.6.git] / arch / mips / mm / tlb-r4k.c

/*
 * 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.
 *
 * Copyright (C) 1996 David S. Miller (dm@engr.sgi.com)
 * Copyright (C) 1997, 1998, 1999, 2000 Ralf Baechle ralf@gnu.org
 * Carsten Langgaard, carstenl@mips.com
 * Copyright (C) 2002 MIPS Technologies, Inc.  All rights reserved.
 */
#include <linux/init.h>
#include <linux/sched.h>
#include <linux/smp.h>
#include <linux/mm.h>
#include <linux/hugetlb.h>

#include <asm/cpu.h>
#include <asm/bootinfo.h>
#include <asm/mmu_context.h>
#include <asm/pgtable.h>
#include <asm/system.h>

extern void build_tlb_refill_handler(void);

/*
 * Make sure all entries differ.  If they're not different
 * MIPS32 will take revenge ...
 */
#define UNIQUE_ENTRYHI(idx) (CKSEG0 + ((idx) << (PAGE_SHIFT + 1)))

/* Atomicity and interruptability */
#ifdef CONFIG_MIPS_MT_SMTC

#include <asm/smtc.h>
#include <asm/mipsmtregs.h>

#define ENTER_CRITICAL(flags) \
	{ \
	unsigned int mvpflags; \
	local_irq_save(flags);\
	mvpflags = dvpe()
#define EXIT_CRITICAL(flags) \
	evpe(mvpflags); \
	local_irq_restore(flags); \
	}
#else

#define ENTER_CRITICAL(flags) local_irq_save(flags)
#define EXIT_CRITICAL(flags) local_irq_restore(flags)

#endif /* CONFIG_MIPS_MT_SMTC */

#if defined(CONFIG_CPU_LOONGSON2)
/*
 * LOONGSON2 has a 4 entry itlb which is a subset of dtlb,
 * unfortrunately, itlb is not totally transparent to software.
 */
#define FLUSH_ITLB write_c0_diag(4);

#define FLUSH_ITLB_VM(vma) { if ((vma)->vm_flags & VM_EXEC)  write_c0_diag(4); }

#else

#define FLUSH_ITLB
#define FLUSH_ITLB_VM(vma)

#endif

void local_flush_tlb_all(void)
{
	unsigned long flags;
	unsigned long old_ctx;
	int entry;

	ENTER_CRITICAL(flags);
	/* Save old context and create impossible VPN2 value */
	old_ctx = read_c0_entryhi();
	write_c0_entrylo0(0);
	write_c0_entrylo1(0);

	entry = read_c0_wired();

	/* Blast 'em all away. */
	while (entry < current_cpu_data.tlbsize) {
		/* Make sure all entries differ. */
		write_c0_entryhi(UNIQUE_ENTRYHI(entry));
		write_c0_index(entry);
		mtc0_tlbw_hazard();
		tlb_write_indexed();
		entry++;
	}
	tlbw_use_hazard();
	write_c0_entryhi(old_ctx);
	FLUSH_ITLB;
	EXIT_CRITICAL(flags);
}

/* All entries common to a mm share an asid.  To effectively flush
   these entries, we just bump the asid. */
void local_flush_tlb_mm(struct mm_struct *mm)
{
	int cpu;

	preempt_disable();

	cpu = smp_processor_id();

	if (cpu_context(cpu, mm) != 0) {
		drop_mmu_context(mm, cpu);
	}

	preempt_enable();
}

void local_flush_tlb_range(struct vm_area_struct *vma, unsigned long start,
	unsigned long end)
{
	struct mm_struct *mm = vma->vm_mm;
	int cpu = smp_processor_id();

	if (cpu_context(cpu, mm) != 0) {
		unsigned long size, flags;

		ENTER_CRITICAL(flags);
		size = (end - start + (PAGE_SIZE - 1)) >> PAGE_SHIFT;
		size = (size + 1) >> 1;
		if (size <= current_cpu_data.tlbsize/2) {
			int oldpid = read_c0_entryhi();
			int newpid = cpu_asid(cpu, mm);

			start &= (PAGE_MASK << 1);
			end += ((PAGE_SIZE << 1) - 1);
			end &= (PAGE_MASK << 1);
			while (start < end) {
				int idx;

				write_c0_entryhi(start | newpid);
				start += (PAGE_SIZE << 1);
				mtc0_tlbw_hazard();
				tlb_probe();
				tlb_probe_hazard();
				idx = read_c0_index();
				write_c0_entrylo0(0);
				write_c0_entrylo1(0);
				if (idx < 0)
					continue;
				/* Make sure all entries differ. */
				write_c0_entryhi(UNIQUE_ENTRYHI(idx));
				mtc0_tlbw_hazard();
				tlb_write_indexed();
			}
			tlbw_use_hazard();
			write_c0_entryhi(oldpid);
		} else {
			drop_mmu_context(mm, cpu);
		}
		FLUSH_ITLB;
		EXIT_CRITICAL(flags);
	}
}

void local_flush_tlb_kernel_range(unsigned long start, unsigned long end)
{
	unsigned long size, flags;

	ENTER_CRITICAL(flags);
	size = (end - start + (PAGE_SIZE - 1)) >> PAGE_SHIFT;
	size = (size + 1) >> 1;
	if (size <= current_cpu_data.tlbsize / 2) {
		int pid = read_c0_entryhi();

		start &= (PAGE_MASK << 1);
		end += ((PAGE_SIZE << 1) - 1);
		end &= (PAGE_MASK << 1);

		while (start < end) {
			int idx;

			write_c0_entryhi(start);
			start += (PAGE_SIZE << 1);
			mtc0_tlbw_hazard();
			tlb_probe();
			tlb_probe_hazard();
			idx = read_c0_index();
			write_c0_entrylo0(0);
			write_c0_entrylo1(0);
			if (idx < 0)
				continue;
			/* Make sure all entries differ. */
			write_c0_entryhi(UNIQUE_ENTRYHI(idx));
			mtc0_tlbw_hazard();
			tlb_write_indexed();
		}
		tlbw_use_hazard();
		write_c0_entryhi(pid);
	} else {
		local_flush_tlb_all();
	}
	FLUSH_ITLB;
	EXIT_CRITICAL(flags);
}

void local_flush_tlb_page(struct vm_area_struct *vma, unsigned long page)
{
	int cpu = smp_processor_id();

	if (cpu_context(cpu, vma->vm_mm) != 0) {
		unsigned long flags;
		int oldpid, newpid, idx;

		newpid = cpu_asid(cpu, vma->vm_mm);
		page &= (PAGE_MASK << 1);
		ENTER_CRITICAL(flags);
		oldpid = read_c0_entryhi();
		write_c0_entryhi(page | newpid);
		mtc0_tlbw_hazard();
		tlb_probe();
		tlb_probe_hazard();
		idx = read_c0_index();
		write_c0_entrylo0(0);
		write_c0_entrylo1(0);
		if (idx < 0)
			goto finish;
		/* Make sure all entries differ. */
		write_c0_entryhi(UNIQUE_ENTRYHI(idx));
		mtc0_tlbw_hazard();
		tlb_write_indexed();
		tlbw_use_hazard();

	finish:
		write_c0_entryhi(oldpid);
		FLUSH_ITLB_VM(vma);
		EXIT_CRITICAL(flags);
	}
}

/*
 * This one is only used for pages with the global bit set so we don't care
 * much about the ASID.
 */
void local_flush_tlb_one(unsigned long page)
{
	unsigned long flags;
	int oldpid, idx;

	ENTER_CRITICAL(flags);
	oldpid = read_c0_entryhi();
	page &= (PAGE_MASK << 1);
	write_c0_entryhi(page);
	mtc0_tlbw_hazard();
	tlb_probe();
	tlb_probe_hazard();
	idx = read_c0_index();
	write_c0_entrylo0(0);
	write_c0_entrylo1(0);
	if (idx >= 0) {
		/* Make sure all entries differ. */
		write_c0_entryhi(UNIQUE_ENTRYHI(idx));
		mtc0_tlbw_hazard();
		tlb_write_indexed();
		tlbw_use_hazard();
	}
	write_c0_entryhi(oldpid);
	FLUSH_ITLB;
	EXIT_CRITICAL(flags);
}

/*
 * We will need multiple versions of update_mmu_cache(), one that just
 * updates the TLB with the new pte(s), and another which also checks
 * for the R4k "end of page" hardware bug and does the needy.
 */
void __update_tlb(struct vm_area_struct * vma, unsigned long address, pte_t pte)
{
	unsigned long flags;
	pgd_t *pgdp;
	pud_t *pudp;
	pmd_t *pmdp;
	pte_t *ptep;
	int idx, pid;

	/*
	 * Handle debugger faulting in for debugee.
	 */
	if (current->active_mm != vma->vm_mm)
		return;

	ENTER_CRITICAL(flags);

	pid = read_c0_entryhi() & ASID_MASK;
	address &= (PAGE_MASK << 1);
	write_c0_entryhi(address | pid);
	pgdp = pgd_offset(vma->vm_mm, address);
	mtc0_tlbw_hazard();
	tlb_probe();
	tlb_probe_hazard();
	pudp = pud_offset(pgdp, address);
	pmdp = pmd_offset(pudp, address);
	idx = read_c0_index();
#ifdef CONFIG_HUGETLB_PAGE
	/* this could be a huge page  */
	if (pmd_huge(*pmdp)) {
		unsigned long lo;
		write_c0_pagemask(PM_HUGE_MASK);
		ptep = (pte_t *)pmdp;
		lo = pte_val(*ptep) >> 6;
		write_c0_entrylo0(lo);
		write_c0_entrylo1(lo + (HPAGE_SIZE >> 7));

		mtc0_tlbw_hazard();
		if (idx < 0)
			tlb_write_random();
		else
			tlb_write_indexed();
		write_c0_pagemask(PM_DEFAULT_MASK);
	} else
#endif
	{
		ptep = pte_offset_map(pmdp, address);

#if defined(CONFIG_64BIT_PHYS_ADDR) && defined(CONFIG_CPU_MIPS32)
		write_c0_entrylo0(ptep->pte_high);
		ptep++;
		write_c0_entrylo1(ptep->pte_high);
#else
		write_c0_entrylo0(pte_val(*ptep++) >> 6);
		write_c0_entrylo1(pte_val(*ptep) >> 6);
#endif
		mtc0_tlbw_hazard();
		if (idx < 0)
			tlb_write_random();
		else
			tlb_write_indexed();
	}
	tlbw_use_hazard();
	FLUSH_ITLB_VM(vma);
	EXIT_CRITICAL(flags);
}

#if 0
static void r4k_update_mmu_cache_hwbug(struct vm_area_struct * vma,
				       unsigned long address, pte_t pte)
{
	unsigned long flags;
	unsigned int asid;
	pgd_t *pgdp;
	pmd_t *pmdp;
	pte_t *ptep;
	int idx;

	ENTER_CRITICAL(flags);
	address &= (PAGE_MASK << 1);
	asid = read_c0_entryhi() & ASID_MASK;
	write_c0_entryhi(address | asid);
	pgdp = pgd_offset(vma->vm_mm, address);
	mtc0_tlbw_hazard();
	tlb_probe();
	tlb_probe_hazard();
	pmdp = pmd_offset(pgdp, address);
	idx = read_c0_index();
	ptep = pte_offset_map(pmdp, address);
	write_c0_entrylo0(pte_val(*ptep++) >> 6);
	write_c0_entrylo1(pte_val(*ptep) >> 6);
	mtc0_tlbw_hazard();
	if (idx < 0)
		tlb_write_random();
	else
		tlb_write_indexed();
	tlbw_use_hazard();
	EXIT_CRITICAL(flags);
}
#endif

void __init add_wired_entry(unsigned long entrylo0, unsigned long entrylo1,
	unsigned long entryhi, unsigned long pagemask)
{
	unsigned long flags;
	unsigned long wired;
	unsigned long old_pagemask;
	unsigned long old_ctx;

	ENTER_CRITICAL(flags);
	/* Save old context and create impossible VPN2 value */
	old_ctx = read_c0_entryhi();
	old_pagemask = read_c0_pagemask();
	wired = read_c0_wired();
	write_c0_wired(wired + 1);
	write_c0_index(wired);
	tlbw_use_hazard();	/* What is the hazard here? */
	write_c0_pagemask(pagemask);
	write_c0_entryhi(entryhi);
	write_c0_entrylo0(entrylo0);
	write_c0_entrylo1(entrylo1);
	mtc0_tlbw_hazard();
	tlb_write_indexed();
	tlbw_use_hazard();

	write_c0_entryhi(old_ctx);
	tlbw_use_hazard();	/* What is the hazard here? */
	write_c0_pagemask(old_pagemask);
	local_flush_tlb_all();
	EXIT_CRITICAL(flags);
}

/*
 * Used for loading TLB entries before trap_init() has started, when we
 * don't actually want to add a wired entry which remains throughout the
 * lifetime of the system
 */

static int temp_tlb_entry __cpuinitdata;

__init int add_temporary_entry(unsigned long entrylo0, unsigned long entrylo1,
			       unsigned long entryhi, unsigned long pagemask)
{
	int ret = 0;
	unsigned long flags;
	unsigned long wired;
	unsigned long old_pagemask;
	unsigned long old_ctx;

	ENTER_CRITICAL(flags);
	/* Save old context and create impossible VPN2 value */
	old_ctx = read_c0_entryhi();
	old_pagemask = read_c0_pagemask();
	wired = read_c0_wired();
	if (--temp_tlb_entry < wired) {
		printk(KERN_WARNING
		       "No TLB space left for add_temporary_entry\n");
		ret = -ENOSPC;
		goto out;
	}

	write_c0_index(temp_tlb_entry);
	write_c0_pagemask(pagemask);
	write_c0_entryhi(entryhi);
	write_c0_entrylo0(entrylo0);
	write_c0_entrylo1(entrylo1);
	mtc0_tlbw_hazard();
	tlb_write_indexed();
	tlbw_use_hazard();

	write_c0_entryhi(old_ctx);
	write_c0_pagemask(old_pagemask);
out:
	EXIT_CRITICAL(flags);
	return ret;
}

static void __cpuinit probe_tlb(unsigned long config)
{
	struct cpuinfo_mips *c = &current_cpu_data;
	unsigned int reg;

	/*
	 * If this isn't a MIPS32 / MIPS64 compliant CPU.  Config 1 register
	 * is not supported, we assume R4k style.  Cpu probing already figured
	 * out the number of tlb entries.
	 */
	if ((c->processor_id & 0xff0000) == PRID_COMP_LEGACY)
		return;
#ifdef CONFIG_MIPS_MT_SMTC
	/*
	 * If TLB is shared in SMTC system, total size already
	 * has been calculated and written into cpu_data tlbsize
	 */
	if((smtc_status & SMTC_TLB_SHARED) == SMTC_TLB_SHARED)
		return;
#endif /* CONFIG_MIPS_MT_SMTC */

	reg = read_c0_config1();
	if (!((config >> 7) & 3))
		panic("No TLB present");

	c->tlbsize = ((reg >> 25) & 0x3f) + 1;
}

static int __cpuinitdata ntlb;
static int __init set_ntlb(char *str)
{
	get_option(&str, &ntlb);
	return 1;
}

__setup("ntlb=", set_ntlb);

void __cpuinit tlb_init(void)
{
	unsigned int config = read_c0_config();

	/*
	 * You should never change this register:
	 *   - On R4600 1.7 the tlbp never hits for pages smaller than
	 *     the value in the c0_pagemask register.
	 *   - The entire mm handling assumes the c0_pagemask register to
	 *     be set to fixed-size pages.
	 */
	probe_tlb(config);
	write_c0_pagemask(PM_DEFAULT_MASK);
	write_c0_wired(0);
	if (current_cpu_type() == CPU_R10000 ||
	    current_cpu_type() == CPU_R12000 ||
	    current_cpu_type() == CPU_R14000)
		write_c0_framemask(0);
	temp_tlb_entry = current_cpu_data.tlbsize - 1;

        /* From this point on the ARC firmware is dead.  */
	local_flush_tlb_all();

	/* Did I tell you that ARC SUCKS?  */

	if (ntlb) {
		if (ntlb > 1 && ntlb <= current_cpu_data.tlbsize) {
			int wired = current_cpu_data.tlbsize - ntlb;
			write_c0_wired(wired);
			write_c0_index(wired-1);
			printk("Restricting TLB to %d entries\n", ntlb);
		} else
			printk("Ignoring invalid argument ntlb=%d\n", ntlb);
	}

	build_tlb_refill_handler();
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* This file is subject to the terms and conditions of the GNU General Public
	3	* License. See the file "COPYING" in the main directory of this archive
	4	* for more details.
	5	*
	6	* Copyright (C) 1996 David S. Miller (dm@engr.sgi.com)
	7	* Copyright (C) 1997, 1998, 1999, 2000 Ralf Baechle ralf@gnu.org
	8	* Carsten Langgaard, carstenl@mips.com
	9	* Copyright (C) 2002 MIPS Technologies, Inc. All rights reserved.
	10	*/
1da177e4 LT	11	#include <linux/init.h>
1da177e4 LT	12	#include <linux/sched.h>
631330f5	13	#include <linux/smp.h>
1da177e4	14	#include <linux/mm.h>
fd062c84	15	#include <linux/hugetlb.h>
1da177e4 LT	16
	17	#include <asm/cpu.h>
	18	#include <asm/bootinfo.h>
	19	#include <asm/mmu_context.h>
	20	#include <asm/pgtable.h>
	21	#include <asm/system.h>
	22
	23	extern void build_tlb_refill_handler(void);
	24
172546bf TS	25	/*
	26	* Make sure all entries differ. If they're not different
	27	* MIPS32 will take revenge ...
	28	*/
	29	#define UNIQUE_ENTRYHI(idx) (CKSEG0 + ((idx) << (PAGE_SHIFT + 1)))
	30
41c594ab RB	31	/* Atomicity and interruptability */
	32	#ifdef CONFIG_MIPS_MT_SMTC
	33
	34	#include <asm/smtc.h>
	35	#include <asm/mipsmtregs.h>
	36
	37	#define ENTER_CRITICAL(flags) \
	38	{ \
	39	unsigned int mvpflags; \
	40	local_irq_save(flags);\
	41	mvpflags = dvpe()
	42	#define EXIT_CRITICAL(flags) \
	43	evpe(mvpflags); \
	44	local_irq_restore(flags); \
	45	}
	46	#else
	47
	48	#define ENTER_CRITICAL(flags) local_irq_save(flags)
	49	#define EXIT_CRITICAL(flags) local_irq_restore(flags)
	50
	51	#endif /* CONFIG_MIPS_MT_SMTC */
	52
2a21c730 FZ	53	#if defined(CONFIG_CPU_LOONGSON2)
	54	/*
	55	* LOONGSON2 has a 4 entry itlb which is a subset of dtlb,
	56	* unfortrunately, itlb is not totally transparent to software.
	57	*/
	58	#define FLUSH_ITLB write_c0_diag(4);
	59
	60	#define FLUSH_ITLB_VM(vma) { if ((vma)->vm_flags & VM_EXEC) write_c0_diag(4); }
	61
	62	#else
	63
	64	#define FLUSH_ITLB
	65	#define FLUSH_ITLB_VM(vma)
	66
	67	#endif
	68
1da177e4 LT	69	void local_flush_tlb_all(void)
	70	{
	71	unsigned long flags;
	72	unsigned long old_ctx;
	73	int entry;
	74
41c594ab	75	ENTER_CRITICAL(flags);
1da177e4 LT	76	/* Save old context and create impossible VPN2 value */
	77	old_ctx = read_c0_entryhi();
	78	write_c0_entrylo0(0);
	79	write_c0_entrylo1(0);
	80
	81	entry = read_c0_wired();
	82
	83	/* Blast 'em all away. */
	84	while (entry < current_cpu_data.tlbsize) {
172546bf TS	85	/* Make sure all entries differ. */
172546bf TS	86	write_c0_entryhi(UNIQUE_ENTRYHI(entry));
1da177e4 LT	87	write_c0_index(entry);
	88	mtc0_tlbw_hazard();
	89	tlb_write_indexed();
	90	entry++;
	91	}
	92	tlbw_use_hazard();
	93	write_c0_entryhi(old_ctx);
2a21c730	94	FLUSH_ITLB;
41c594ab	95	EXIT_CRITICAL(flags);
1da177e4 LT	96	}
1da177e4 LT	97
172546bf TS	98	/* All entries common to a mm share an asid. To effectively flush
172546bf TS	99	these entries, we just bump the asid. */
1da177e4 LT	100	void local_flush_tlb_mm(struct mm_struct *mm)
1da177e4 LT	101	{
172546bf TS	102	int cpu;
	103
	104	preempt_disable();
1da177e4	105
172546bf TS	106	cpu = smp_processor_id();
	107
	108	if (cpu_context(cpu, mm) != 0) {
	109	drop_mmu_context(mm, cpu);
	110	}
	111
	112	preempt_enable();
1da177e4 LT	113	}
	114
	115	void local_flush_tlb_range(struct vm_area_struct *vma, unsigned long start,
	116	unsigned long end)
	117	{
	118	struct mm_struct *mm = vma->vm_mm;
	119	int cpu = smp_processor_id();
	120
	121	if (cpu_context(cpu, mm) != 0) {
a5e696e5	122	unsigned long size, flags;
1da177e4	123
41c594ab	124	ENTER_CRITICAL(flags);
1da177e4 LT	125	size = (end - start + (PAGE_SIZE - 1)) >> PAGE_SHIFT;
	126	size = (size + 1) >> 1;
	127	if (size <= current_cpu_data.tlbsize/2) {
	128	int oldpid = read_c0_entryhi();
	129	int newpid = cpu_asid(cpu, mm);
	130
	131	start &= (PAGE_MASK << 1);
	132	end += ((PAGE_SIZE << 1) - 1);
	133	end &= (PAGE_MASK << 1);
	134	while (start < end) {
	135	int idx;
	136
	137	write_c0_entryhi(start \| newpid);
	138	start += (PAGE_SIZE << 1);
	139	mtc0_tlbw_hazard();
	140	tlb_probe();
432bef2a	141	tlb_probe_hazard();
1da177e4 LT	142	idx = read_c0_index();
	143	write_c0_entrylo0(0);
	144	write_c0_entrylo1(0);
	145	if (idx < 0)
	146	continue;
	147	/* Make sure all entries differ. */
172546bf	148	write_c0_entryhi(UNIQUE_ENTRYHI(idx));
1da177e4 LT	149	mtc0_tlbw_hazard();
	150	tlb_write_indexed();
	151	}
	152	tlbw_use_hazard();
	153	write_c0_entryhi(oldpid);
	154	} else {
	155	drop_mmu_context(mm, cpu);
	156	}
2a21c730	157	FLUSH_ITLB;
41c594ab	158	EXIT_CRITICAL(flags);
1da177e4 LT	159	}
	160	}
	161
	162	void local_flush_tlb_kernel_range(unsigned long start, unsigned long end)
	163	{
a5e696e5	164	unsigned long size, flags;
1da177e4	165
41c594ab	166	ENTER_CRITICAL(flags);
1da177e4 LT	167	size = (end - start + (PAGE_SIZE - 1)) >> PAGE_SHIFT;
	168	size = (size + 1) >> 1;
	169	if (size <= current_cpu_data.tlbsize / 2) {
	170	int pid = read_c0_entryhi();
	171
	172	start &= (PAGE_MASK << 1);
	173	end += ((PAGE_SIZE << 1) - 1);
	174	end &= (PAGE_MASK << 1);
	175
	176	while (start < end) {
	177	int idx;
	178
	179	write_c0_entryhi(start);
	180	start += (PAGE_SIZE << 1);
	181	mtc0_tlbw_hazard();
	182	tlb_probe();
432bef2a	183	tlb_probe_hazard();
1da177e4 LT	184	idx = read_c0_index();
	185	write_c0_entrylo0(0);
	186	write_c0_entrylo1(0);
	187	if (idx < 0)
	188	continue;
	189	/* Make sure all entries differ. */
172546bf	190	write_c0_entryhi(UNIQUE_ENTRYHI(idx));
1da177e4 LT	191	mtc0_tlbw_hazard();
	192	tlb_write_indexed();
	193	}
	194	tlbw_use_hazard();
	195	write_c0_entryhi(pid);
	196	} else {
	197	local_flush_tlb_all();
	198	}
2a21c730	199	FLUSH_ITLB;
41c594ab	200	EXIT_CRITICAL(flags);
1da177e4 LT	201	}
	202
	203	void local_flush_tlb_page(struct vm_area_struct *vma, unsigned long page)
	204	{
	205	int cpu = smp_processor_id();
	206
	207	if (cpu_context(cpu, vma->vm_mm) != 0) {
	208	unsigned long flags;
	209	int oldpid, newpid, idx;
	210
	211	newpid = cpu_asid(cpu, vma->vm_mm);
	212	page &= (PAGE_MASK << 1);
41c594ab	213	ENTER_CRITICAL(flags);
1da177e4 LT	214	oldpid = read_c0_entryhi();
	215	write_c0_entryhi(page \| newpid);
	216	mtc0_tlbw_hazard();
	217	tlb_probe();
432bef2a	218	tlb_probe_hazard();
1da177e4 LT	219	idx = read_c0_index();
	220	write_c0_entrylo0(0);
	221	write_c0_entrylo1(0);
	222	if (idx < 0)
	223	goto finish;
	224	/* Make sure all entries differ. */
172546bf	225	write_c0_entryhi(UNIQUE_ENTRYHI(idx));
1da177e4 LT	226	mtc0_tlbw_hazard();
	227	tlb_write_indexed();
	228	tlbw_use_hazard();
	229
	230	finish:
	231	write_c0_entryhi(oldpid);
2a21c730	232	FLUSH_ITLB_VM(vma);
41c594ab	233	EXIT_CRITICAL(flags);
1da177e4 LT	234	}
	235	}
	236
	237	/*
	238	* This one is only used for pages with the global bit set so we don't care
	239	* much about the ASID.
	240	*/
	241	void local_flush_tlb_one(unsigned long page)
	242	{
	243	unsigned long flags;
	244	int oldpid, idx;
	245
41c594ab	246	ENTER_CRITICAL(flags);
1da177e4	247	oldpid = read_c0_entryhi();
172546bf	248	page &= (PAGE_MASK << 1);
1da177e4 LT	249	write_c0_entryhi(page);
	250	mtc0_tlbw_hazard();
	251	tlb_probe();
432bef2a	252	tlb_probe_hazard();
1da177e4 LT	253	idx = read_c0_index();
	254	write_c0_entrylo0(0);
	255	write_c0_entrylo1(0);
	256	if (idx >= 0) {
	257	/* Make sure all entries differ. */
172546bf	258	write_c0_entryhi(UNIQUE_ENTRYHI(idx));
1da177e4 LT	259	mtc0_tlbw_hazard();
	260	tlb_write_indexed();
	261	tlbw_use_hazard();
	262	}
	263	write_c0_entryhi(oldpid);
2a21c730	264	FLUSH_ITLB;
41c594ab	265	EXIT_CRITICAL(flags);
1da177e4 LT	266	}
	267
	268	/*
	269	* We will need multiple versions of update_mmu_cache(), one that just
	270	* updates the TLB with the new pte(s), and another which also checks
	271	* for the R4k "end of page" hardware bug and does the needy.
	272	*/
	273	void __update_tlb(struct vm_area_struct * vma, unsigned long address, pte_t pte)
	274	{
	275	unsigned long flags;
	276	pgd_t *pgdp;
c6e8b587	277	pud_t *pudp;
1da177e4 LT	278	pmd_t *pmdp;
	279	pte_t *ptep;
	280	int idx, pid;
	281
	282	/*
	283	* Handle debugger faulting in for debugee.
	284	*/
	285	if (current->active_mm != vma->vm_mm)
	286	return;
	287
41c594ab	288	ENTER_CRITICAL(flags);
172546bf TS	289
172546bf TS	290	pid = read_c0_entryhi() & ASID_MASK;
1da177e4 LT	291	address &= (PAGE_MASK << 1);
	292	write_c0_entryhi(address \| pid);
	293	pgdp = pgd_offset(vma->vm_mm, address);
	294	mtc0_tlbw_hazard();
	295	tlb_probe();
432bef2a	296	tlb_probe_hazard();
c6e8b587 RB	297	pudp = pud_offset(pgdp, address);
c6e8b587 RB	298	pmdp = pmd_offset(pudp, address);
1da177e4	299	idx = read_c0_index();
fd062c84 DD	300	#ifdef CONFIG_HUGETLB_PAGE
	301	/* this could be a huge page */
	302	if (pmd_huge(*pmdp)) {
	303	unsigned long lo;
	304	write_c0_pagemask(PM_HUGE_MASK);
	305	ptep = (pte_t *)pmdp;
	306	lo = pte_val(*ptep) >> 6;
	307	write_c0_entrylo0(lo);
	308	write_c0_entrylo1(lo + (HPAGE_SIZE >> 7));
	309
	310	mtc0_tlbw_hazard();
	311	if (idx < 0)
	312	tlb_write_random();
	313	else
	314	tlb_write_indexed();
	315	write_c0_pagemask(PM_DEFAULT_MASK);
	316	} else
	317	#endif
	318	{
	319	ptep = pte_offset_map(pmdp, address);
1da177e4	320
962f480e	321	#if defined(CONFIG_64BIT_PHYS_ADDR) && defined(CONFIG_CPU_MIPS32)
fd062c84 DD	322	write_c0_entrylo0(ptep->pte_high);
	323	ptep++;
	324	write_c0_entrylo1(ptep->pte_high);
1da177e4	325	#else
fd062c84 DD	326	write_c0_entrylo0(pte_val(*ptep++) >> 6);
fd062c84 DD	327	write_c0_entrylo1(pte_val(*ptep) >> 6);
1da177e4	328	#endif
fd062c84 DD	329	mtc0_tlbw_hazard();
	330	if (idx < 0)
	331	tlb_write_random();
	332	else
	333	tlb_write_indexed();
	334	}
1da177e4	335	tlbw_use_hazard();
2a21c730	336	FLUSH_ITLB_VM(vma);
41c594ab	337	EXIT_CRITICAL(flags);
1da177e4 LT	338	}
	339
	340	#if 0
	341	static void r4k_update_mmu_cache_hwbug(struct vm_area_struct * vma,
	342	unsigned long address, pte_t pte)
	343	{
	344	unsigned long flags;
	345	unsigned int asid;
	346	pgd_t *pgdp;
	347	pmd_t *pmdp;
	348	pte_t *ptep;
	349	int idx;
	350
41c594ab	351	ENTER_CRITICAL(flags);
1da177e4 LT	352	address &= (PAGE_MASK << 1);
	353	asid = read_c0_entryhi() & ASID_MASK;
	354	write_c0_entryhi(address \| asid);
	355	pgdp = pgd_offset(vma->vm_mm, address);
	356	mtc0_tlbw_hazard();
	357	tlb_probe();
432bef2a	358	tlb_probe_hazard();
1da177e4 LT	359	pmdp = pmd_offset(pgdp, address);
	360	idx = read_c0_index();
	361	ptep = pte_offset_map(pmdp, address);
	362	write_c0_entrylo0(pte_val(*ptep++) >> 6);
	363	write_c0_entrylo1(pte_val(*ptep) >> 6);
	364	mtc0_tlbw_hazard();
	365	if (idx < 0)
	366	tlb_write_random();
	367	else
	368	tlb_write_indexed();
	369	tlbw_use_hazard();
41c594ab	370	EXIT_CRITICAL(flags);
1da177e4 LT	371	}
	372	#endif
	373
	374	void __init add_wired_entry(unsigned long entrylo0, unsigned long entrylo1,
	375	unsigned long entryhi, unsigned long pagemask)
	376	{
	377	unsigned long flags;
	378	unsigned long wired;
	379	unsigned long old_pagemask;
	380	unsigned long old_ctx;
	381
41c594ab	382	ENTER_CRITICAL(flags);
1da177e4 LT	383	/* Save old context and create impossible VPN2 value */
	384	old_ctx = read_c0_entryhi();
	385	old_pagemask = read_c0_pagemask();
	386	wired = read_c0_wired();
	387	write_c0_wired(wired + 1);
	388	write_c0_index(wired);
432bef2a	389	tlbw_use_hazard(); /* What is the hazard here? */
1da177e4 LT	390	write_c0_pagemask(pagemask);
	391	write_c0_entryhi(entryhi);
	392	write_c0_entrylo0(entrylo0);
	393	write_c0_entrylo1(entrylo1);
	394	mtc0_tlbw_hazard();
	395	tlb_write_indexed();
	396	tlbw_use_hazard();
	397
	398	write_c0_entryhi(old_ctx);
432bef2a	399	tlbw_use_hazard(); /* What is the hazard here? */
1da177e4 LT	400	write_c0_pagemask(old_pagemask);
1da177e4 LT	401	local_flush_tlb_all();
41c594ab	402	EXIT_CRITICAL(flags);
1da177e4 LT	403	}
	404
	405	/*
	406	* Used for loading TLB entries before trap_init() has started, when we
	407	* don't actually want to add a wired entry which remains throughout the
	408	* lifetime of the system
	409	*/
	410
234fcd14	411	static int temp_tlb_entry __cpuinitdata;
1da177e4 LT	412
	413	__init int add_temporary_entry(unsigned long entrylo0, unsigned long entrylo1,
	414	unsigned long entryhi, unsigned long pagemask)
	415	{
	416	int ret = 0;
	417	unsigned long flags;
	418	unsigned long wired;
	419	unsigned long old_pagemask;
	420	unsigned long old_ctx;
	421
41c594ab	422	ENTER_CRITICAL(flags);
1da177e4 LT	423	/* Save old context and create impossible VPN2 value */
	424	old_ctx = read_c0_entryhi();
	425	old_pagemask = read_c0_pagemask();
	426	wired = read_c0_wired();
	427	if (--temp_tlb_entry < wired) {
30442991 MR	428	printk(KERN_WARNING
30442991 MR	429	"No TLB space left for add_temporary_entry\n");
1da177e4 LT	430	ret = -ENOSPC;
	431	goto out;
	432	}
	433
	434	write_c0_index(temp_tlb_entry);
	435	write_c0_pagemask(pagemask);
	436	write_c0_entryhi(entryhi);
	437	write_c0_entrylo0(entrylo0);
	438	write_c0_entrylo1(entrylo1);
	439	mtc0_tlbw_hazard();
	440	tlb_write_indexed();
	441	tlbw_use_hazard();
	442
	443	write_c0_entryhi(old_ctx);
	444	write_c0_pagemask(old_pagemask);
	445	out:
41c594ab	446	EXIT_CRITICAL(flags);
1da177e4 LT	447	return ret;
	448	}
	449
234fcd14	450	static void __cpuinit probe_tlb(unsigned long config)
1da177e4 LT	451	{
	452	struct cpuinfo_mips *c = &current_cpu_data;
	453	unsigned int reg;
	454
	455	/*
	456	* If this isn't a MIPS32 / MIPS64 compliant CPU. Config 1 register
	457	* is not supported, we assume R4k style. Cpu probing already figured
	458	* out the number of tlb entries.
	459	*/
30442991	460	if ((c->processor_id & 0xff0000) == PRID_COMP_LEGACY)
1da177e4	461	return;
41c594ab RB	462	#ifdef CONFIG_MIPS_MT_SMTC
	463	/*
	464	* If TLB is shared in SMTC system, total size already
	465	* has been calculated and written into cpu_data tlbsize
	466	*/
	467	if((smtc_status & SMTC_TLB_SHARED) == SMTC_TLB_SHARED)
	468	return;
	469	#endif /* CONFIG_MIPS_MT_SMTC */
1da177e4 LT	470
	471	reg = read_c0_config1();
	472	if (!((config >> 7) & 3))
	473	panic("No TLB present");
	474
	475	c->tlbsize = ((reg >> 25) & 0x3f) + 1;
	476	}
	477
982f6ffe	478	static int __cpuinitdata ntlb;
41c594ab RB	479	static int __init set_ntlb(char *str)
	480	{
	481	get_option(&str, &ntlb);
	482	return 1;
	483	}
	484
	485	__setup("ntlb=", set_ntlb);
	486
234fcd14	487	void __cpuinit tlb_init(void)
1da177e4 LT	488	{
	489	unsigned int config = read_c0_config();
	490
	491	/*
	492	* You should never change this register:
	493	* - On R4600 1.7 the tlbp never hits for pages smaller than
	494	* the value in the c0_pagemask register.
	495	* - The entire mm handling assumes the c0_pagemask register to
a7c2996e	496	* be set to fixed-size pages.
1da177e4 LT	497	*/
	498	probe_tlb(config);
	499	write_c0_pagemask(PM_DEFAULT_MASK);
	500	write_c0_wired(0);
cde15b59 RB	501	if (current_cpu_type() == CPU_R10000 \|\|
	502	current_cpu_type() == CPU_R12000 \|\|
	503	current_cpu_type() == CPU_R14000)
	504	write_c0_framemask(0);
1da177e4	505	temp_tlb_entry = current_cpu_data.tlbsize - 1;
c6281edb TS	506
c6281edb TS	507	/* From this point on the ARC firmware is dead. */
1da177e4 LT	508	local_flush_tlb_all();
1da177e4 LT	509
c6281edb TS	510	/* Did I tell you that ARC SUCKS? */
c6281edb TS	511
41c594ab RB	512	if (ntlb) {
	513	if (ntlb > 1 && ntlb <= current_cpu_data.tlbsize) {
	514	int wired = current_cpu_data.tlbsize - ntlb;
	515	write_c0_wired(wired);
	516	write_c0_index(wired-1);
49a89efb	517	printk("Restricting TLB to %d entries\n", ntlb);
41c594ab RB	518	} else
	519	printk("Ignoring invalid argument ntlb=%d\n", ntlb);
	520	}
	521
1da177e4 LT	522	build_tlb_refill_handler();
1da177e4 LT	523	}