[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / sparc64 / mm / tsb.c

/* arch/sparc64/mm/tsb.c
 *
 * Copyright (C) 2006 David S. Miller <davem@davemloft.net>
 */

#include <linux/kernel.h>
#include <asm/system.h>
#include <asm/page.h>
#include <asm/tlbflush.h>
#include <asm/tlb.h>
#include <asm/mmu_context.h>
#include <asm/pgtable.h>
#include <asm/tsb.h>
#include <asm/oplib.h>

extern struct tsb swapper_tsb[KERNEL_TSB_NENTRIES];

static inline unsigned long tsb_hash(unsigned long vaddr, unsigned long hash_shift, unsigned long nentries)
{
	vaddr >>= hash_shift;
	return vaddr & (nentries - 1);
}

static inline int tag_compare(unsigned long tag, unsigned long vaddr)
{
	return (tag == (vaddr >> 22));
}

/* TSB flushes need only occur on the processor initiating the address
 * space modification, not on each cpu the address space has run on.
 * Only the TLB flush needs that treatment.
 */

void flush_tsb_kernel_range(unsigned long start, unsigned long end)
{
	unsigned long v;

	for (v = start; v < end; v += PAGE_SIZE) {
		unsigned long hash = tsb_hash(v, PAGE_SHIFT,
					      KERNEL_TSB_NENTRIES);
		struct tsb *ent = &swapper_tsb[hash];

		if (tag_compare(ent->tag, v)) {
			ent->tag = (1UL << TSB_TAG_INVALID_BIT);
			membar_storeload_storestore();
		}
	}
}

static void __flush_tsb_one(struct mmu_gather *mp, unsigned long hash_shift, unsigned long tsb, unsigned long nentries)
{
	unsigned long i;

	for (i = 0; i < mp->tlb_nr; i++) {
		unsigned long v = mp->vaddrs[i];
		unsigned long tag, ent, hash;

		v &= ~0x1UL;

		hash = tsb_hash(v, hash_shift, nentries);
		ent = tsb + (hash * sizeof(struct tsb));
		tag = (v >> 22UL);

		tsb_flush(ent, tag);
	}
}

void flush_tsb_user(struct mmu_gather *mp)
{
	struct mm_struct *mm = mp->mm;
	unsigned long nentries, base, flags;

	spin_lock_irqsave(&mm->context.lock, flags);

	base = (unsigned long) mm->context.tsb_block[MM_TSB_BASE].tsb;
	nentries = mm->context.tsb_block[MM_TSB_BASE].tsb_nentries;
	if (tlb_type == cheetah_plus || tlb_type == hypervisor)
		base = __pa(base);
	__flush_tsb_one(mp, PAGE_SHIFT, base, nentries);

#ifdef CONFIG_HUGETLB_PAGE
	if (mm->context.tsb_block[MM_TSB_HUGE].tsb) {
		base = (unsigned long) mm->context.tsb_block[MM_TSB_HUGE].tsb;
		nentries = mm->context.tsb_block[MM_TSB_HUGE].tsb_nentries;
		if (tlb_type == cheetah_plus || tlb_type == hypervisor)
			base = __pa(base);
		__flush_tsb_one(mp, HPAGE_SHIFT, base, nentries);
	}
#endif
	spin_unlock_irqrestore(&mm->context.lock, flags);
}

#if defined(CONFIG_SPARC64_PAGE_SIZE_8KB)
#define HV_PGSZ_IDX_BASE	HV_PGSZ_IDX_8K
#define HV_PGSZ_MASK_BASE	HV_PGSZ_MASK_8K
#elif defined(CONFIG_SPARC64_PAGE_SIZE_64KB)
#define HV_PGSZ_IDX_BASE	HV_PGSZ_IDX_64K
#define HV_PGSZ_MASK_BASE	HV_PGSZ_MASK_64K
#elif defined(CONFIG_SPARC64_PAGE_SIZE_512KB)
#define HV_PGSZ_IDX_BASE	HV_PGSZ_IDX_512K
#define HV_PGSZ_MASK_BASE	HV_PGSZ_MASK_512K
#elif defined(CONFIG_SPARC64_PAGE_SIZE_4MB)
#define HV_PGSZ_IDX_BASE	HV_PGSZ_IDX_4MB
#define HV_PGSZ_MASK_BASE	HV_PGSZ_MASK_4MB
#else
#error Broken base page size setting...
#endif

#ifdef CONFIG_HUGETLB_PAGE
#if defined(CONFIG_HUGETLB_PAGE_SIZE_64K)
#define HV_PGSZ_IDX_HUGE	HV_PGSZ_IDX_64K
#define HV_PGSZ_MASK_HUGE	HV_PGSZ_MASK_64K
#elif defined(CONFIG_HUGETLB_PAGE_SIZE_512K)
#define HV_PGSZ_IDX_HUGE	HV_PGSZ_IDX_512K
#define HV_PGSZ_MASK_HUGE	HV_PGSZ_MASK_512K
#elif defined(CONFIG_HUGETLB_PAGE_SIZE_4MB)
#define HV_PGSZ_IDX_HUGE	HV_PGSZ_IDX_4MB
#define HV_PGSZ_MASK_HUGE	HV_PGSZ_MASK_4MB
#else
#error Broken huge page size setting...
#endif
#endif

static void setup_tsb_params(struct mm_struct *mm, unsigned long tsb_idx, unsigned long tsb_bytes)
{
	unsigned long tsb_reg, base, tsb_paddr;
	unsigned long page_sz, tte;

	mm->context.tsb_block[tsb_idx].tsb_nentries =
		tsb_bytes / sizeof(struct tsb);

	base = TSBMAP_BASE;
	tte = pgprot_val(PAGE_KERNEL_LOCKED);
	tsb_paddr = __pa(mm->context.tsb_block[tsb_idx].tsb);
	BUG_ON(tsb_paddr & (tsb_bytes - 1UL));

	/* Use the smallest page size that can map the whole TSB
	 * in one TLB entry.
	 */
	switch (tsb_bytes) {
	case 8192 << 0:
		tsb_reg = 0x0UL;
#ifdef DCACHE_ALIASING_POSSIBLE
		base += (tsb_paddr & 8192);
#endif
		page_sz = 8192;
		break;

	case 8192 << 1:
		tsb_reg = 0x1UL;
		page_sz = 64 * 1024;
		break;

	case 8192 << 2:
		tsb_reg = 0x2UL;
		page_sz = 64 * 1024;
		break;

	case 8192 << 3:
		tsb_reg = 0x3UL;
		page_sz = 64 * 1024;
		break;

	case 8192 << 4:
		tsb_reg = 0x4UL;
		page_sz = 512 * 1024;
		break;

	case 8192 << 5:
		tsb_reg = 0x5UL;
		page_sz = 512 * 1024;
		break;

	case 8192 << 6:
		tsb_reg = 0x6UL;
		page_sz = 512 * 1024;
		break;

	case 8192 << 7:
		tsb_reg = 0x7UL;
		page_sz = 4 * 1024 * 1024;
		break;

	default:
		BUG();
	};
	tte |= pte_sz_bits(page_sz);

	if (tlb_type == cheetah_plus || tlb_type == hypervisor) {
		/* Physical mapping, no locked TLB entry for TSB.  */
		tsb_reg |= tsb_paddr;

		mm->context.tsb_block[tsb_idx].tsb_reg_val = tsb_reg;
		mm->context.tsb_block[tsb_idx].tsb_map_vaddr = 0;
		mm->context.tsb_block[tsb_idx].tsb_map_pte = 0;
	} else {
		tsb_reg |= base;
		tsb_reg |= (tsb_paddr & (page_sz - 1UL));
		tte |= (tsb_paddr & ~(page_sz - 1UL));

		mm->context.tsb_block[tsb_idx].tsb_reg_val = tsb_reg;
		mm->context.tsb_block[tsb_idx].tsb_map_vaddr = base;
		mm->context.tsb_block[tsb_idx].tsb_map_pte = tte;
	}

	/* Setup the Hypervisor TSB descriptor.  */
	if (tlb_type == hypervisor) {
		struct hv_tsb_descr *hp = &mm->context.tsb_descr[tsb_idx];

		switch (tsb_idx) {
		case MM_TSB_BASE:
			hp->pgsz_idx = HV_PGSZ_IDX_BASE;
			break;
#ifdef CONFIG_HUGETLB_PAGE
		case MM_TSB_HUGE:
			hp->pgsz_idx = HV_PGSZ_IDX_HUGE;
			break;
#endif
		default:
			BUG();
		};
		hp->assoc = 1;
		hp->num_ttes = tsb_bytes / 16;
		hp->ctx_idx = 0;
		switch (tsb_idx) {
		case MM_TSB_BASE:
			hp->pgsz_mask = HV_PGSZ_MASK_BASE;
			break;
#ifdef CONFIG_HUGETLB_PAGE
		case MM_TSB_HUGE:
			hp->pgsz_mask = HV_PGSZ_MASK_HUGE;
			break;
#endif
		default:
			BUG();
		};
		hp->tsb_base = tsb_paddr;
		hp->resv = 0;
	}
}

static struct kmem_cache *tsb_caches[8] __read_mostly;

static const char *tsb_cache_names[8] = {
	"tsb_8KB",
	"tsb_16KB",
	"tsb_32KB",
	"tsb_64KB",
	"tsb_128KB",
	"tsb_256KB",
	"tsb_512KB",
	"tsb_1MB",
};

void __init pgtable_cache_init(void)
{
	unsigned long i;

	for (i = 0; i < 8; i++) {
		unsigned long size = 8192 << i;
		const char *name = tsb_cache_names[i];

		tsb_caches[i] = kmem_cache_create(name,
						  size, size,
						  0,
						  NULL, NULL);
		if (!tsb_caches[i]) {
			prom_printf("Could not create %s cache\n", name);
			prom_halt();
		}
	}
}

/* When the RSS of an address space exceeds tsb_rss_limit for a TSB,
 * do_sparc64_fault() invokes this routine to try and grow it.
 *
 * When we reach the maximum TSB size supported, we stick ~0UL into
 * tsb_rss_limit for that TSB so the grow checks in do_sparc64_fault()
 * will not trigger any longer.
 *
 * The TSB can be anywhere from 8K to 1MB in size, in increasing powers
 * of two.  The TSB must be aligned to it's size, so f.e. a 512K TSB
 * must be 512K aligned.  It also must be physically contiguous, so we
 * cannot use vmalloc().
 *
 * The idea here is to grow the TSB when the RSS of the process approaches
 * the number of entries that the current TSB can hold at once.  Currently,
 * we trigger when the RSS hits 3/4 of the TSB capacity.
 */
void tsb_grow(struct mm_struct *mm, unsigned long tsb_index, unsigned long rss)
{
	unsigned long max_tsb_size = 1 * 1024 * 1024;
	unsigned long new_size, old_size, flags;
	struct tsb *old_tsb, *new_tsb;
	unsigned long new_cache_index, old_cache_index;
	unsigned long new_rss_limit;
	gfp_t gfp_flags;

	if (max_tsb_size > (PAGE_SIZE << MAX_ORDER))
		max_tsb_size = (PAGE_SIZE << MAX_ORDER);

	new_cache_index = 0;
	for (new_size = 8192; new_size < max_tsb_size; new_size <<= 1UL) {
		unsigned long n_entries = new_size / sizeof(struct tsb);

		n_entries = (n_entries * 3) / 4;
		if (n_entries > rss)
			break;

		new_cache_index++;
	}

	if (new_size == max_tsb_size)
		new_rss_limit = ~0UL;
	else
		new_rss_limit = ((new_size / sizeof(struct tsb)) * 3) / 4;

retry_tsb_alloc:
	gfp_flags = GFP_KERNEL;
	if (new_size > (PAGE_SIZE * 2))
		gfp_flags = __GFP_NOWARN | __GFP_NORETRY;

	new_tsb = kmem_cache_alloc(tsb_caches[new_cache_index], gfp_flags);
	if (unlikely(!new_tsb)) {
		/* Not being able to fork due to a high-order TSB
		 * allocation failure is very bad behavior.  Just back
		 * down to a 0-order allocation and force no TSB
		 * growing for this address space.
		 */
		if (mm->context.tsb_block[tsb_index].tsb == NULL &&
		    new_cache_index > 0) {
			new_cache_index = 0;
			new_size = 8192;
			new_rss_limit = ~0UL;
			goto retry_tsb_alloc;
		}

		/* If we failed on a TSB grow, we are under serious
		 * memory pressure so don't try to grow any more.
		 */
		if (mm->context.tsb_block[tsb_index].tsb != NULL)
			mm->context.tsb_block[tsb_index].tsb_rss_limit = ~0UL;
		return;
	}

	/* Mark all tags as invalid.  */
	tsb_init(new_tsb, new_size);

	/* Ok, we are about to commit the changes.  If we are
	 * growing an existing TSB the locking is very tricky,
	 * so WATCH OUT!
	 *
	 * We have to hold mm->context.lock while committing to the
	 * new TSB, this synchronizes us with processors in
	 * flush_tsb_user() and switch_mm() for this address space.
	 *
	 * But even with that lock held, processors run asynchronously
	 * accessing the old TSB via TLB miss handling.  This is OK
	 * because those actions are just propagating state from the
	 * Linux page tables into the TSB, page table mappings are not
	 * being changed.  If a real fault occurs, the processor will
	 * synchronize with us when it hits flush_tsb_user(), this is
	 * also true for the case where vmscan is modifying the page
	 * tables.  The only thing we need to be careful with is to
	 * skip any locked TSB entries during copy_tsb().
	 *
	 * When we finish committing to the new TSB, we have to drop
	 * the lock and ask all other cpus running this address space
	 * to run tsb_context_switch() to see the new TSB table.
	 */
	spin_lock_irqsave(&mm->context.lock, flags);

	old_tsb = mm->context.tsb_block[tsb_index].tsb;
	old_cache_index =
		(mm->context.tsb_block[tsb_index].tsb_reg_val & 0x7UL);
	old_size = (mm->context.tsb_block[tsb_index].tsb_nentries *
		    sizeof(struct tsb));


	/* Handle multiple threads trying to grow the TSB at the same time.
	 * One will get in here first, and bump the size and the RSS limit.
	 * The others will get in here next and hit this check.
	 */
	if (unlikely(old_tsb &&
		     (rss < mm->context.tsb_block[tsb_index].tsb_rss_limit))) {
		spin_unlock_irqrestore(&mm->context.lock, flags);

		kmem_cache_free(tsb_caches[new_cache_index], new_tsb);
		return;
	}

	mm->context.tsb_block[tsb_index].tsb_rss_limit = new_rss_limit;

	if (old_tsb) {
		extern void copy_tsb(unsigned long old_tsb_base,
				     unsigned long old_tsb_size,
				     unsigned long new_tsb_base,
				     unsigned long new_tsb_size);
		unsigned long old_tsb_base = (unsigned long) old_tsb;
		unsigned long new_tsb_base = (unsigned long) new_tsb;

		if (tlb_type == cheetah_plus || tlb_type == hypervisor) {
			old_tsb_base = __pa(old_tsb_base);
			new_tsb_base = __pa(new_tsb_base);
		}
		copy_tsb(old_tsb_base, old_size, new_tsb_base, new_size);
	}

	mm->context.tsb_block[tsb_index].tsb = new_tsb;
	setup_tsb_params(mm, tsb_index, new_size);

	spin_unlock_irqrestore(&mm->context.lock, flags);

	/* If old_tsb is NULL, we're being invoked for the first time
	 * from init_new_context().
	 */
	if (old_tsb) {
		/* Reload it on the local cpu.  */
		tsb_context_switch(mm);

		/* Now force other processors to do the same.  */
		smp_tsb_sync(mm);

		/* Now it is safe to free the old tsb.  */
		kmem_cache_free(tsb_caches[old_cache_index], old_tsb);
	}
}

int init_new_context(struct task_struct *tsk, struct mm_struct *mm)
{
#ifdef CONFIG_HUGETLB_PAGE
	unsigned long huge_pte_count;
#endif
	unsigned int i;

	spin_lock_init(&mm->context.lock);

	mm->context.sparc64_ctx_val = 0UL;

#ifdef CONFIG_HUGETLB_PAGE
	/* We reset it to zero because the fork() page copying
	 * will re-increment the counters as the parent PTEs are
	 * copied into the child address space.
	 */
	huge_pte_count = mm->context.huge_pte_count;
	mm->context.huge_pte_count = 0;
#endif

	/* copy_mm() copies over the parent's mm_struct before calling
	 * us, so we need to zero out the TSB pointer or else tsb_grow()
	 * will be confused and think there is an older TSB to free up.
	 */
	for (i = 0; i < MM_NUM_TSBS; i++)
		mm->context.tsb_block[i].tsb = NULL;

	/* If this is fork, inherit the parent's TSB size.  We would
	 * grow it to that size on the first page fault anyways.
	 */
	tsb_grow(mm, MM_TSB_BASE, get_mm_rss(mm));

#ifdef CONFIG_HUGETLB_PAGE
	if (unlikely(huge_pte_count))
		tsb_grow(mm, MM_TSB_HUGE, huge_pte_count);
#endif

	if (unlikely(!mm->context.tsb_block[MM_TSB_BASE].tsb))
		return -ENOMEM;

	return 0;
}

static void tsb_destroy_one(struct tsb_config *tp)
{
	unsigned long cache_index;

	if (!tp->tsb)
		return;
	cache_index = tp->tsb_reg_val & 0x7UL;
	kmem_cache_free(tsb_caches[cache_index], tp->tsb);
	tp->tsb = NULL;
	tp->tsb_reg_val = 0UL;
}

void destroy_context(struct mm_struct *mm)
{
	unsigned long flags, i;

	for (i = 0; i < MM_NUM_TSBS; i++)
		tsb_destroy_one(&mm->context.tsb_block[i]);

	spin_lock_irqsave(&ctx_alloc_lock, flags);

	if (CTX_VALID(mm->context)) {
		unsigned long nr = CTX_NRBITS(mm->context);
		mmu_context_bmap[nr>>6] &= ~(1UL << (nr & 63));
	}

	spin_unlock_irqrestore(&ctx_alloc_lock, flags);
}
Commit	Line	Data
74bf4312 DM	1	/* arch/sparc64/mm/tsb.c
	2	*
	3	* Copyright (C) 2006 David S. Miller <davem@davemloft.net>
	4	*/
	5
	6	#include <linux/kernel.h>
	7	#include <asm/system.h>
	8	#include <asm/page.h>
	9	#include <asm/tlbflush.h>
	10	#include <asm/tlb.h>
09f94287	11	#include <asm/mmu_context.h>
98c5584c	12	#include <asm/pgtable.h>
bd40791e	13	#include <asm/tsb.h>
9b4006dc	14	#include <asm/oplib.h>
74bf4312	15
74bf4312 DM	16	extern struct tsb swapper_tsb[KERNEL_TSB_NENTRIES];
74bf4312 DM	17
dcc1e8dd	18	static inline unsigned long tsb_hash(unsigned long vaddr, unsigned long hash_shift, unsigned long nentries)
74bf4312	19	{
dcc1e8dd	20	vaddr >>= hash_shift;
98c5584c	21	return vaddr & (nentries - 1);
74bf4312 DM	22	}
74bf4312 DM	23
8b234274	24	static inline int tag_compare(unsigned long tag, unsigned long vaddr)
74bf4312	25	{
8b234274	26	return (tag == (vaddr >> 22));
74bf4312 DM	27	}
	28
	29	/* TSB flushes need only occur on the processor initiating the address
	30	* space modification, not on each cpu the address space has run on.
	31	* Only the TLB flush needs that treatment.
	32	*/
	33
	34	void flush_tsb_kernel_range(unsigned long start, unsigned long end)
	35	{
	36	unsigned long v;
	37
	38	for (v = start; v < end; v += PAGE_SIZE) {
dcc1e8dd DM	39	unsigned long hash = tsb_hash(v, PAGE_SHIFT,
dcc1e8dd DM	40	KERNEL_TSB_NENTRIES);
98c5584c	41	struct tsb *ent = &swapper_tsb[hash];
74bf4312	42
8b234274 DM	43	if (tag_compare(ent->tag, v)) {
8b234274 DM	44	ent->tag = (1UL << TSB_TAG_INVALID_BIT);
74bf4312 DM	45	membar_storeload_storestore();
	46	}
	47	}
	48	}
	49
dcc1e8dd	50	static void __flush_tsb_one(struct mmu_gather *mp, unsigned long hash_shift, unsigned long tsb, unsigned long nentries)
74bf4312	51	{
dcc1e8dd	52	unsigned long i;
7a1ac526	53
74bf4312 DM	54	for (i = 0; i < mp->tlb_nr; i++) {
74bf4312 DM	55	unsigned long v = mp->vaddrs[i];
517af332	56	unsigned long tag, ent, hash;
74bf4312 DM	57
	58	v &= ~0x1UL;
	59
dcc1e8dd DM	60	hash = tsb_hash(v, hash_shift, nentries);
dcc1e8dd DM	61	ent = tsb + (hash * sizeof(struct tsb));
8b234274	62	tag = (v >> 22UL);
517af332 DM	63
517af332 DM	64	tsb_flush(ent, tag);
74bf4312	65	}
dcc1e8dd DM	66	}
	67
	68	void flush_tsb_user(struct mmu_gather *mp)
	69	{
	70	struct mm_struct *mm = mp->mm;
	71	unsigned long nentries, base, flags;
	72
	73	spin_lock_irqsave(&mm->context.lock, flags);
7a1ac526	74
dcc1e8dd DM	75	base = (unsigned long) mm->context.tsb_block[MM_TSB_BASE].tsb;
	76	nentries = mm->context.tsb_block[MM_TSB_BASE].tsb_nentries;
	77	if (tlb_type == cheetah_plus \|\| tlb_type == hypervisor)
	78	base = __pa(base);
	79	__flush_tsb_one(mp, PAGE_SHIFT, base, nentries);
	80
	81	#ifdef CONFIG_HUGETLB_PAGE
	82	if (mm->context.tsb_block[MM_TSB_HUGE].tsb) {
	83	base = (unsigned long) mm->context.tsb_block[MM_TSB_HUGE].tsb;
	84	nentries = mm->context.tsb_block[MM_TSB_HUGE].tsb_nentries;
	85	if (tlb_type == cheetah_plus \|\| tlb_type == hypervisor)
	86	base = __pa(base);
	87	__flush_tsb_one(mp, HPAGE_SHIFT, base, nentries);
	88	}
	89	#endif
7a1ac526	90	spin_unlock_irqrestore(&mm->context.lock, flags);
74bf4312	91	}
09f94287	92
dcc1e8dd DM	93	#if defined(CONFIG_SPARC64_PAGE_SIZE_8KB)
	94	#define HV_PGSZ_IDX_BASE HV_PGSZ_IDX_8K
	95	#define HV_PGSZ_MASK_BASE HV_PGSZ_MASK_8K
	96	#elif defined(CONFIG_SPARC64_PAGE_SIZE_64KB)
	97	#define HV_PGSZ_IDX_BASE HV_PGSZ_IDX_64K
	98	#define HV_PGSZ_MASK_BASE HV_PGSZ_MASK_64K
	99	#elif defined(CONFIG_SPARC64_PAGE_SIZE_512KB)
	100	#define HV_PGSZ_IDX_BASE HV_PGSZ_IDX_512K
	101	#define HV_PGSZ_MASK_BASE HV_PGSZ_MASK_512K
	102	#elif defined(CONFIG_SPARC64_PAGE_SIZE_4MB)
	103	#define HV_PGSZ_IDX_BASE HV_PGSZ_IDX_4MB
	104	#define HV_PGSZ_MASK_BASE HV_PGSZ_MASK_4MB
	105	#else
	106	#error Broken base page size setting...
	107	#endif
	108
	109	#ifdef CONFIG_HUGETLB_PAGE
	110	#if defined(CONFIG_HUGETLB_PAGE_SIZE_64K)
	111	#define HV_PGSZ_IDX_HUGE HV_PGSZ_IDX_64K
	112	#define HV_PGSZ_MASK_HUGE HV_PGSZ_MASK_64K
	113	#elif defined(CONFIG_HUGETLB_PAGE_SIZE_512K)
	114	#define HV_PGSZ_IDX_HUGE HV_PGSZ_IDX_512K
	115	#define HV_PGSZ_MASK_HUGE HV_PGSZ_MASK_512K
	116	#elif defined(CONFIG_HUGETLB_PAGE_SIZE_4MB)
	117	#define HV_PGSZ_IDX_HUGE HV_PGSZ_IDX_4MB
	118	#define HV_PGSZ_MASK_HUGE HV_PGSZ_MASK_4MB
	119	#else
	120	#error Broken huge page size setting...
	121	#endif
	122	#endif
	123
	124	static void setup_tsb_params(struct mm_struct *mm, unsigned long tsb_idx, unsigned long tsb_bytes)
98c5584c DM	125	{
	126	unsigned long tsb_reg, base, tsb_paddr;
	127	unsigned long page_sz, tte;
	128
dcc1e8dd DM	129	mm->context.tsb_block[tsb_idx].tsb_nentries =
dcc1e8dd DM	130	tsb_bytes / sizeof(struct tsb);
98c5584c DM	131
98c5584c DM	132	base = TSBMAP_BASE;
c4bce90e	133	tte = pgprot_val(PAGE_KERNEL_LOCKED);
dcc1e8dd	134	tsb_paddr = __pa(mm->context.tsb_block[tsb_idx].tsb);
517af332	135	BUG_ON(tsb_paddr & (tsb_bytes - 1UL));
98c5584c DM	136
	137	/* Use the smallest page size that can map the whole TSB
	138	* in one TLB entry.
	139	*/
	140	switch (tsb_bytes) {
	141	case 8192 << 0:
	142	tsb_reg = 0x0UL;
	143	#ifdef DCACHE_ALIASING_POSSIBLE
	144	base += (tsb_paddr & 8192);
	145	#endif
98c5584c DM	146	page_sz = 8192;
	147	break;
	148
	149	case 8192 << 1:
	150	tsb_reg = 0x1UL;
98c5584c DM	151	page_sz = 64 * 1024;
	152	break;
	153
	154	case 8192 << 2:
	155	tsb_reg = 0x2UL;
98c5584c DM	156	page_sz = 64 * 1024;
	157	break;
	158
	159	case 8192 << 3:
	160	tsb_reg = 0x3UL;
98c5584c DM	161	page_sz = 64 * 1024;
	162	break;
	163
	164	case 8192 << 4:
	165	tsb_reg = 0x4UL;
98c5584c DM	166	page_sz = 512 * 1024;
	167	break;
	168
	169	case 8192 << 5:
	170	tsb_reg = 0x5UL;
98c5584c DM	171	page_sz = 512 * 1024;
	172	break;
	173
	174	case 8192 << 6:
	175	tsb_reg = 0x6UL;
98c5584c DM	176	page_sz = 512 * 1024;
	177	break;
	178
	179	case 8192 << 7:
	180	tsb_reg = 0x7UL;
98c5584c DM	181	page_sz = 4 * 1024 * 1024;
98c5584c DM	182	break;
bd40791e DM	183
	184	default:
	185	BUG();
98c5584c	186	};
c4bce90e	187	tte \|= pte_sz_bits(page_sz);
98c5584c	188
618e9ed9	189	if (tlb_type == cheetah_plus \|\| tlb_type == hypervisor) {
517af332 DM	190	/* Physical mapping, no locked TLB entry for TSB. */
	191	tsb_reg \|= tsb_paddr;
	192
dcc1e8dd DM	193	mm->context.tsb_block[tsb_idx].tsb_reg_val = tsb_reg;
	194	mm->context.tsb_block[tsb_idx].tsb_map_vaddr = 0;
	195	mm->context.tsb_block[tsb_idx].tsb_map_pte = 0;
517af332 DM	196	} else {
	197	tsb_reg \|= base;
	198	tsb_reg \|= (tsb_paddr & (page_sz - 1UL));
	199	tte \|= (tsb_paddr & ~(page_sz - 1UL));
	200
dcc1e8dd DM	201	mm->context.tsb_block[tsb_idx].tsb_reg_val = tsb_reg;
	202	mm->context.tsb_block[tsb_idx].tsb_map_vaddr = base;
	203	mm->context.tsb_block[tsb_idx].tsb_map_pte = tte;
517af332	204	}
98c5584c	205
618e9ed9 DM	206	/* Setup the Hypervisor TSB descriptor. */
618e9ed9 DM	207	if (tlb_type == hypervisor) {
dcc1e8dd	208	struct hv_tsb_descr *hp = &mm->context.tsb_descr[tsb_idx];
618e9ed9	209
dcc1e8dd DM	210	switch (tsb_idx) {
	211	case MM_TSB_BASE:
	212	hp->pgsz_idx = HV_PGSZ_IDX_BASE;
618e9ed9	213	break;
dcc1e8dd DM	214	#ifdef CONFIG_HUGETLB_PAGE
	215	case MM_TSB_HUGE:
	216	hp->pgsz_idx = HV_PGSZ_IDX_HUGE;
618e9ed9	217	break;
dcc1e8dd DM	218	#endif
	219	default:
	220	BUG();
618e9ed9 DM	221	};
	222	hp->assoc = 1;
	223	hp->num_ttes = tsb_bytes / 16;
	224	hp->ctx_idx = 0;
dcc1e8dd DM	225	switch (tsb_idx) {
	226	case MM_TSB_BASE:
	227	hp->pgsz_mask = HV_PGSZ_MASK_BASE;
618e9ed9	228	break;
dcc1e8dd DM	229	#ifdef CONFIG_HUGETLB_PAGE
	230	case MM_TSB_HUGE:
	231	hp->pgsz_mask = HV_PGSZ_MASK_HUGE;
618e9ed9	232	break;
dcc1e8dd DM	233	#endif
	234	default:
	235	BUG();
618e9ed9 DM	236	};
	237	hp->tsb_base = tsb_paddr;
	238	hp->resv = 0;
	239	}
98c5584c DM	240	}
98c5584c DM	241
e18b890b	242	static struct kmem_cache *tsb_caches[8] __read_mostly;
9b4006dc DM	243
	244	static const char *tsb_cache_names[8] = {
	245	"tsb_8KB",
	246	"tsb_16KB",
	247	"tsb_32KB",
	248	"tsb_64KB",
	249	"tsb_128KB",
	250	"tsb_256KB",
	251	"tsb_512KB",
	252	"tsb_1MB",
	253	};
	254
3a2cba99	255	void __init pgtable_cache_init(void)
9b4006dc DM	256	{
	257	unsigned long i;
	258
	259	for (i = 0; i < 8; i++) {
	260	unsigned long size = 8192 << i;
	261	const char *name = tsb_cache_names[i];
	262
	263	tsb_caches[i] = kmem_cache_create(name,
	264	size, size,
f0f3980b	265	0,
9b4006dc DM	266	NULL, NULL);
	267	if (!tsb_caches[i]) {
	268	prom_printf("Could not create %s cache\n", name);
	269	prom_halt();
	270	}
	271	}
	272	}
	273
dcc1e8dd DM	274	/* When the RSS of an address space exceeds tsb_rss_limit for a TSB,
dcc1e8dd DM	275	* do_sparc64_fault() invokes this routine to try and grow it.
7a1ac526	276	*
bd40791e	277	* When we reach the maximum TSB size supported, we stick ~0UL into
dcc1e8dd	278	* tsb_rss_limit for that TSB so the grow checks in do_sparc64_fault()
bd40791e DM	279	* will not trigger any longer.
	280	*
	281	* The TSB can be anywhere from 8K to 1MB in size, in increasing powers
	282	* of two. The TSB must be aligned to it's size, so f.e. a 512K TSB
b52439c2 DM	283	* must be 512K aligned. It also must be physically contiguous, so we
b52439c2 DM	284	* cannot use vmalloc().
bd40791e DM	285	*
	286	* The idea here is to grow the TSB when the RSS of the process approaches
	287	* the number of entries that the current TSB can hold at once. Currently,
	288	* we trigger when the RSS hits 3/4 of the TSB capacity.
	289	*/
dcc1e8dd	290	void tsb_grow(struct mm_struct *mm, unsigned long tsb_index, unsigned long rss)
bd40791e DM	291	{
bd40791e DM	292	unsigned long max_tsb_size = 1 * 1024 * 1024;
9b4006dc	293	unsigned long new_size, old_size, flags;
7a1ac526	294	struct tsb old_tsb, new_tsb;
9b4006dc DM	295	unsigned long new_cache_index, old_cache_index;
9b4006dc DM	296	unsigned long new_rss_limit;
b52439c2	297	gfp_t gfp_flags;
bd40791e DM	298
	299	if (max_tsb_size > (PAGE_SIZE << MAX_ORDER))
	300	max_tsb_size = (PAGE_SIZE << MAX_ORDER);
	301
9b4006dc DM	302	new_cache_index = 0;
	303	for (new_size = 8192; new_size < max_tsb_size; new_size <<= 1UL) {
	304	unsigned long n_entries = new_size / sizeof(struct tsb);
bd40791e DM	305
	306	n_entries = (n_entries * 3) / 4;
	307	if (n_entries > rss)
	308	break;
9b4006dc DM	309
9b4006dc DM	310	new_cache_index++;
bd40791e DM	311	}
bd40791e DM	312
9b4006dc	313	if (new_size == max_tsb_size)
b52439c2 DM	314	new_rss_limit = ~0UL;
b52439c2 DM	315	else
9b4006dc	316	new_rss_limit = ((new_size / sizeof(struct tsb)) * 3) / 4;
b52439c2	317
9b4006dc	318	retry_tsb_alloc:
b52439c2	319	gfp_flags = GFP_KERNEL;
9b4006dc	320	if (new_size > (PAGE_SIZE * 2))
b52439c2 DM	321	gfp_flags = __GFP_NOWARN \| __GFP_NORETRY;
b52439c2 DM	322
9b4006dc DM	323	new_tsb = kmem_cache_alloc(tsb_caches[new_cache_index], gfp_flags);
9b4006dc DM	324	if (unlikely(!new_tsb)) {
b52439c2 DM	325	/* Not being able to fork due to a high-order TSB
	326	* allocation failure is very bad behavior. Just back
	327	* down to a 0-order allocation and force no TSB
	328	* growing for this address space.
	329	*/
dcc1e8dd DM	330	if (mm->context.tsb_block[tsb_index].tsb == NULL &&
dcc1e8dd DM	331	new_cache_index > 0) {
9b4006dc DM	332	new_cache_index = 0;
9b4006dc DM	333	new_size = 8192;
b52439c2	334	new_rss_limit = ~0UL;
9b4006dc	335	goto retry_tsb_alloc;
b52439c2 DM	336	}
	337
	338	/* If we failed on a TSB grow, we are under serious
	339	* memory pressure so don't try to grow any more.
	340	*/
dcc1e8dd DM	341	if (mm->context.tsb_block[tsb_index].tsb != NULL)
dcc1e8dd DM	342	mm->context.tsb_block[tsb_index].tsb_rss_limit = ~0UL;
bd40791e	343	return;
b52439c2	344	}
bd40791e	345
8b234274	346	/* Mark all tags as invalid. */
bb8646d8	347	tsb_init(new_tsb, new_size);
7a1ac526 DM	348
	349	/* Ok, we are about to commit the changes. If we are
	350	* growing an existing TSB the locking is very tricky,
	351	* so WATCH OUT!
	352	*
	353	* We have to hold mm->context.lock while committing to the
	354	* new TSB, this synchronizes us with processors in
	355	* flush_tsb_user() and switch_mm() for this address space.
	356	*
	357	* But even with that lock held, processors run asynchronously
	358	* accessing the old TSB via TLB miss handling. This is OK
	359	* because those actions are just propagating state from the
	360	* Linux page tables into the TSB, page table mappings are not
	361	* being changed. If a real fault occurs, the processor will
	362	* synchronize with us when it hits flush_tsb_user(), this is
	363	* also true for the case where vmscan is modifying the page
	364	* tables. The only thing we need to be careful with is to
	365	* skip any locked TSB entries during copy_tsb().
	366	*
	367	* When we finish committing to the new TSB, we have to drop
	368	* the lock and ask all other cpus running this address space
	369	* to run tsb_context_switch() to see the new TSB table.
	370	*/
	371	spin_lock_irqsave(&mm->context.lock, flags);
	372
dcc1e8dd DM	373	old_tsb = mm->context.tsb_block[tsb_index].tsb;
	374	old_cache_index =
	375	(mm->context.tsb_block[tsb_index].tsb_reg_val & 0x7UL);
	376	old_size = (mm->context.tsb_block[tsb_index].tsb_nentries *
	377	sizeof(struct tsb));
7a1ac526	378
9b4006dc	379
7a1ac526 DM	380	/* Handle multiple threads trying to grow the TSB at the same time.
	381	* One will get in here first, and bump the size and the RSS limit.
	382	* The others will get in here next and hit this check.
	383	*/
dcc1e8dd DM	384	if (unlikely(old_tsb &&
dcc1e8dd DM	385	(rss < mm->context.tsb_block[tsb_index].tsb_rss_limit))) {
7a1ac526 DM	386	spin_unlock_irqrestore(&mm->context.lock, flags);
7a1ac526 DM	387
9b4006dc	388	kmem_cache_free(tsb_caches[new_cache_index], new_tsb);
7a1ac526 DM	389	return;
7a1ac526 DM	390	}
8b234274	391
dcc1e8dd	392	mm->context.tsb_block[tsb_index].tsb_rss_limit = new_rss_limit;
bd40791e	393
7a1ac526 DM	394	if (old_tsb) {
	395	extern void copy_tsb(unsigned long old_tsb_base,
	396	unsigned long old_tsb_size,
	397	unsigned long new_tsb_base,
	398	unsigned long new_tsb_size);
	399	unsigned long old_tsb_base = (unsigned long) old_tsb;
	400	unsigned long new_tsb_base = (unsigned long) new_tsb;
	401
	402	if (tlb_type == cheetah_plus \|\| tlb_type == hypervisor) {
	403	old_tsb_base = __pa(old_tsb_base);
	404	new_tsb_base = __pa(new_tsb_base);
	405	}
9b4006dc	406	copy_tsb(old_tsb_base, old_size, new_tsb_base, new_size);
7a1ac526	407	}
bd40791e	408
dcc1e8dd DM	409	mm->context.tsb_block[tsb_index].tsb = new_tsb;
dcc1e8dd DM	410	setup_tsb_params(mm, tsb_index, new_size);
bd40791e	411
7a1ac526 DM	412	spin_unlock_irqrestore(&mm->context.lock, flags);
7a1ac526 DM	413
bd40791e DM	414	/* If old_tsb is NULL, we're being invoked for the first time
	415	* from init_new_context().
	416	*/
	417	if (old_tsb) {
7a1ac526	418	/* Reload it on the local cpu. */
bd40791e DM	419	tsb_context_switch(mm);
bd40791e DM	420
7a1ac526 DM	421	/* Now force other processors to do the same. */
	422	smp_tsb_sync(mm);
	423
	424	/* Now it is safe to free the old tsb. */
9b4006dc	425	kmem_cache_free(tsb_caches[old_cache_index], old_tsb);
bd40791e DM	426	}
	427	}
	428
09f94287 DM	429	int init_new_context(struct task_struct tsk, struct mm_struct mm)
09f94287 DM	430	{
dcc1e8dd DM	431	#ifdef CONFIG_HUGETLB_PAGE
	432	unsigned long huge_pte_count;
	433	#endif
	434	unsigned int i;
	435
a77754b4	436	spin_lock_init(&mm->context.lock);
09f94287 DM	437
09f94287 DM	438	mm->context.sparc64_ctx_val = 0UL;
09f94287	439
dcc1e8dd DM	440	#ifdef CONFIG_HUGETLB_PAGE
	441	/* We reset it to zero because the fork() page copying
	442	* will re-increment the counters as the parent PTEs are
	443	* copied into the child address space.
	444	*/
	445	huge_pte_count = mm->context.huge_pte_count;
	446	mm->context.huge_pte_count = 0;
	447	#endif
	448
bd40791e DM	449	/* copy_mm() copies over the parent's mm_struct before calling
	450	* us, so we need to zero out the TSB pointer or else tsb_grow()
	451	* will be confused and think there is an older TSB to free up.
	452	*/
dcc1e8dd DM	453	for (i = 0; i < MM_NUM_TSBS; i++)
dcc1e8dd DM	454	mm->context.tsb_block[i].tsb = NULL;
7a1ac526 DM	455
	456	/* If this is fork, inherit the parent's TSB size. We would
	457	* grow it to that size on the first page fault anyways.
	458	*/
dcc1e8dd	459	tsb_grow(mm, MM_TSB_BASE, get_mm_rss(mm));
bd40791e	460
dcc1e8dd DM	461	#ifdef CONFIG_HUGETLB_PAGE
	462	if (unlikely(huge_pte_count))
	463	tsb_grow(mm, MM_TSB_HUGE, huge_pte_count);
	464	#endif
	465
	466	if (unlikely(!mm->context.tsb_block[MM_TSB_BASE].tsb))
bd40791e	467	return -ENOMEM;
09f94287 DM	468
	469	return 0;
	470	}
	471
dcc1e8dd	472	static void tsb_destroy_one(struct tsb_config *tp)
09f94287	473	{
dcc1e8dd	474	unsigned long cache_index;
bd40791e	475
dcc1e8dd DM	476	if (!tp->tsb)
	477	return;
	478	cache_index = tp->tsb_reg_val & 0x7UL;
	479	kmem_cache_free(tsb_caches[cache_index], tp->tsb);
	480	tp->tsb = NULL;
	481	tp->tsb_reg_val = 0UL;
	482	}
98c5584c	483
dcc1e8dd DM	484	void destroy_context(struct mm_struct *mm)
	485	{
	486	unsigned long flags, i;
	487
	488	for (i = 0; i < MM_NUM_TSBS; i++)
	489	tsb_destroy_one(&mm->context.tsb_block[i]);
09f94287	490
77b838fa	491	spin_lock_irqsave(&ctx_alloc_lock, flags);
09f94287 DM	492
	493	if (CTX_VALID(mm->context)) {
	494	unsigned long nr = CTX_NRBITS(mm->context);
	495	mmu_context_bmap[nr>>6] &= ~(1UL << (nr & 63));
	496	}
	497
77b838fa	498	spin_unlock_irqrestore(&ctx_alloc_lock, flags);
09f94287	499	}