18c2ecf20Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
28c2ecf20Sopenharmony_ci#ifndef __M68K_MMU_CONTEXT_H
38c2ecf20Sopenharmony_ci#define __M68K_MMU_CONTEXT_H
48c2ecf20Sopenharmony_ci
58c2ecf20Sopenharmony_ci#include <asm-generic/mm_hooks.h>
68c2ecf20Sopenharmony_ci#include <linux/mm_types.h>
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_cistatic inline void enter_lazy_tlb(struct mm_struct *mm, struct task_struct *tsk)
98c2ecf20Sopenharmony_ci{
108c2ecf20Sopenharmony_ci}
118c2ecf20Sopenharmony_ci
128c2ecf20Sopenharmony_ci#ifdef CONFIG_MMU
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#if defined(CONFIG_COLDFIRE)
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci#include <asm/atomic.h>
178c2ecf20Sopenharmony_ci#include <asm/bitops.h>
188c2ecf20Sopenharmony_ci#include <asm/mcfmmu.h>
198c2ecf20Sopenharmony_ci#include <asm/mmu.h>
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci#define NO_CONTEXT		256
228c2ecf20Sopenharmony_ci#define LAST_CONTEXT		255
238c2ecf20Sopenharmony_ci#define FIRST_CONTEXT		1
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ciextern unsigned long context_map[];
268c2ecf20Sopenharmony_ciextern mm_context_t next_mmu_context;
278c2ecf20Sopenharmony_ci
288c2ecf20Sopenharmony_ciextern atomic_t nr_free_contexts;
298c2ecf20Sopenharmony_ciextern struct mm_struct *context_mm[LAST_CONTEXT+1];
308c2ecf20Sopenharmony_ciextern void steal_context(void);
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_cistatic inline void get_mmu_context(struct mm_struct *mm)
338c2ecf20Sopenharmony_ci{
348c2ecf20Sopenharmony_ci	mm_context_t ctx;
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_ci	if (mm->context != NO_CONTEXT)
378c2ecf20Sopenharmony_ci		return;
388c2ecf20Sopenharmony_ci	while (atomic_dec_and_test_lt(&nr_free_contexts)) {
398c2ecf20Sopenharmony_ci		atomic_inc(&nr_free_contexts);
408c2ecf20Sopenharmony_ci		steal_context();
418c2ecf20Sopenharmony_ci	}
428c2ecf20Sopenharmony_ci	ctx = next_mmu_context;
438c2ecf20Sopenharmony_ci	while (test_and_set_bit(ctx, context_map)) {
448c2ecf20Sopenharmony_ci		ctx = find_next_zero_bit(context_map, LAST_CONTEXT+1, ctx);
458c2ecf20Sopenharmony_ci		if (ctx > LAST_CONTEXT)
468c2ecf20Sopenharmony_ci			ctx = 0;
478c2ecf20Sopenharmony_ci	}
488c2ecf20Sopenharmony_ci	next_mmu_context = (ctx + 1) & LAST_CONTEXT;
498c2ecf20Sopenharmony_ci	mm->context = ctx;
508c2ecf20Sopenharmony_ci	context_mm[ctx] = mm;
518c2ecf20Sopenharmony_ci}
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_ci/*
548c2ecf20Sopenharmony_ci * Set up the context for a new address space.
558c2ecf20Sopenharmony_ci */
568c2ecf20Sopenharmony_ci#define init_new_context(tsk, mm)	(((mm)->context = NO_CONTEXT), 0)
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_ci/*
598c2ecf20Sopenharmony_ci * We're finished using the context for an address space.
608c2ecf20Sopenharmony_ci */
618c2ecf20Sopenharmony_cistatic inline void destroy_context(struct mm_struct *mm)
628c2ecf20Sopenharmony_ci{
638c2ecf20Sopenharmony_ci	if (mm->context != NO_CONTEXT) {
648c2ecf20Sopenharmony_ci		clear_bit(mm->context, context_map);
658c2ecf20Sopenharmony_ci		mm->context = NO_CONTEXT;
668c2ecf20Sopenharmony_ci		atomic_inc(&nr_free_contexts);
678c2ecf20Sopenharmony_ci	}
688c2ecf20Sopenharmony_ci}
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_cistatic inline void set_context(mm_context_t context, pgd_t *pgd)
718c2ecf20Sopenharmony_ci{
728c2ecf20Sopenharmony_ci	__asm__ __volatile__ ("movec %0,%%asid" : : "d" (context));
738c2ecf20Sopenharmony_ci}
748c2ecf20Sopenharmony_ci
758c2ecf20Sopenharmony_cistatic inline void switch_mm(struct mm_struct *prev, struct mm_struct *next,
768c2ecf20Sopenharmony_ci	struct task_struct *tsk)
778c2ecf20Sopenharmony_ci{
788c2ecf20Sopenharmony_ci	get_mmu_context(tsk->mm);
798c2ecf20Sopenharmony_ci	set_context(tsk->mm->context, next->pgd);
808c2ecf20Sopenharmony_ci}
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ci/*
838c2ecf20Sopenharmony_ci * After we have set current->mm to a new value, this activates
848c2ecf20Sopenharmony_ci * the context for the new mm so we see the new mappings.
858c2ecf20Sopenharmony_ci */
868c2ecf20Sopenharmony_cistatic inline void activate_mm(struct mm_struct *active_mm,
878c2ecf20Sopenharmony_ci	struct mm_struct *mm)
888c2ecf20Sopenharmony_ci{
898c2ecf20Sopenharmony_ci	get_mmu_context(mm);
908c2ecf20Sopenharmony_ci	set_context(mm->context, mm->pgd);
918c2ecf20Sopenharmony_ci}
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci#define deactivate_mm(tsk, mm) do { } while (0)
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci#define prepare_arch_switch(next) load_ksp_mmu(next)
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_cistatic inline void load_ksp_mmu(struct task_struct *task)
988c2ecf20Sopenharmony_ci{
998c2ecf20Sopenharmony_ci	unsigned long flags;
1008c2ecf20Sopenharmony_ci	struct mm_struct *mm;
1018c2ecf20Sopenharmony_ci	int asid;
1028c2ecf20Sopenharmony_ci	pgd_t *pgd;
1038c2ecf20Sopenharmony_ci	p4d_t *p4d;
1048c2ecf20Sopenharmony_ci	pud_t *pud;
1058c2ecf20Sopenharmony_ci	pmd_t *pmd;
1068c2ecf20Sopenharmony_ci	pte_t *pte;
1078c2ecf20Sopenharmony_ci	unsigned long mmuar;
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci	local_irq_save(flags);
1108c2ecf20Sopenharmony_ci	mmuar = task->thread.ksp;
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci	/* Search for a valid TLB entry, if one is found, don't remap */
1138c2ecf20Sopenharmony_ci	mmu_write(MMUAR, mmuar);
1148c2ecf20Sopenharmony_ci	mmu_write(MMUOR, MMUOR_STLB | MMUOR_ADR);
1158c2ecf20Sopenharmony_ci	if (mmu_read(MMUSR) & MMUSR_HIT)
1168c2ecf20Sopenharmony_ci		goto end;
1178c2ecf20Sopenharmony_ci
1188c2ecf20Sopenharmony_ci	if (mmuar >= PAGE_OFFSET) {
1198c2ecf20Sopenharmony_ci		mm = &init_mm;
1208c2ecf20Sopenharmony_ci	} else {
1218c2ecf20Sopenharmony_ci		pr_info("load_ksp_mmu: non-kernel mm found: 0x%p\n", task->mm);
1228c2ecf20Sopenharmony_ci		mm = task->mm;
1238c2ecf20Sopenharmony_ci	}
1248c2ecf20Sopenharmony_ci
1258c2ecf20Sopenharmony_ci	if (!mm)
1268c2ecf20Sopenharmony_ci		goto bug;
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_ci	pgd = pgd_offset(mm, mmuar);
1298c2ecf20Sopenharmony_ci	if (pgd_none(*pgd))
1308c2ecf20Sopenharmony_ci		goto bug;
1318c2ecf20Sopenharmony_ci
1328c2ecf20Sopenharmony_ci	p4d = p4d_offset(pgd, mmuar);
1338c2ecf20Sopenharmony_ci	if (p4d_none(*p4d))
1348c2ecf20Sopenharmony_ci		goto bug;
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci	pud = pud_offset(p4d, mmuar);
1378c2ecf20Sopenharmony_ci	if (pud_none(*pud))
1388c2ecf20Sopenharmony_ci		goto bug;
1398c2ecf20Sopenharmony_ci
1408c2ecf20Sopenharmony_ci	pmd = pmd_offset(pud, mmuar);
1418c2ecf20Sopenharmony_ci	if (pmd_none(*pmd))
1428c2ecf20Sopenharmony_ci		goto bug;
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci	pte = (mmuar >= PAGE_OFFSET) ? pte_offset_kernel(pmd, mmuar)
1458c2ecf20Sopenharmony_ci				     : pte_offset_map(pmd, mmuar);
1468c2ecf20Sopenharmony_ci	if (pte_none(*pte) || !pte_present(*pte))
1478c2ecf20Sopenharmony_ci		goto bug;
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_ci	set_pte(pte, pte_mkyoung(*pte));
1508c2ecf20Sopenharmony_ci	asid = mm->context & 0xff;
1518c2ecf20Sopenharmony_ci	if (!pte_dirty(*pte) && mmuar <= PAGE_OFFSET)
1528c2ecf20Sopenharmony_ci		set_pte(pte, pte_wrprotect(*pte));
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_ci	mmu_write(MMUTR, (mmuar & PAGE_MASK) | (asid << MMUTR_IDN) |
1558c2ecf20Sopenharmony_ci		(((int)(pte->pte) & (int)CF_PAGE_MMUTR_MASK)
1568c2ecf20Sopenharmony_ci		>> CF_PAGE_MMUTR_SHIFT) | MMUTR_V);
1578c2ecf20Sopenharmony_ci
1588c2ecf20Sopenharmony_ci	mmu_write(MMUDR, (pte_val(*pte) & PAGE_MASK) |
1598c2ecf20Sopenharmony_ci		((pte->pte) & CF_PAGE_MMUDR_MASK) | MMUDR_SZ_8KB | MMUDR_X);
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci	mmu_write(MMUOR, MMUOR_ACC | MMUOR_UAA);
1628c2ecf20Sopenharmony_ci
1638c2ecf20Sopenharmony_ci	goto end;
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_cibug:
1668c2ecf20Sopenharmony_ci	pr_info("ksp load failed: mm=0x%p ksp=0x08%lx\n", mm, mmuar);
1678c2ecf20Sopenharmony_ciend:
1688c2ecf20Sopenharmony_ci	local_irq_restore(flags);
1698c2ecf20Sopenharmony_ci}
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_ci#elif defined(CONFIG_SUN3)
1728c2ecf20Sopenharmony_ci#include <asm/sun3mmu.h>
1738c2ecf20Sopenharmony_ci#include <linux/sched.h>
1748c2ecf20Sopenharmony_ci
1758c2ecf20Sopenharmony_ciextern unsigned long get_free_context(struct mm_struct *mm);
1768c2ecf20Sopenharmony_ciextern void clear_context(unsigned long context);
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_ci/* set the context for a new task to unmapped */
1798c2ecf20Sopenharmony_cistatic inline int init_new_context(struct task_struct *tsk,
1808c2ecf20Sopenharmony_ci				   struct mm_struct *mm)
1818c2ecf20Sopenharmony_ci{
1828c2ecf20Sopenharmony_ci	mm->context = SUN3_INVALID_CONTEXT;
1838c2ecf20Sopenharmony_ci	return 0;
1848c2ecf20Sopenharmony_ci}
1858c2ecf20Sopenharmony_ci
1868c2ecf20Sopenharmony_ci/* find the context given to this process, and if it hasn't already
1878c2ecf20Sopenharmony_ci   got one, go get one for it. */
1888c2ecf20Sopenharmony_cistatic inline void get_mmu_context(struct mm_struct *mm)
1898c2ecf20Sopenharmony_ci{
1908c2ecf20Sopenharmony_ci	if (mm->context == SUN3_INVALID_CONTEXT)
1918c2ecf20Sopenharmony_ci		mm->context = get_free_context(mm);
1928c2ecf20Sopenharmony_ci}
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_ci/* flush context if allocated... */
1958c2ecf20Sopenharmony_cistatic inline void destroy_context(struct mm_struct *mm)
1968c2ecf20Sopenharmony_ci{
1978c2ecf20Sopenharmony_ci	if (mm->context != SUN3_INVALID_CONTEXT)
1988c2ecf20Sopenharmony_ci		clear_context(mm->context);
1998c2ecf20Sopenharmony_ci}
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_cistatic inline void activate_context(struct mm_struct *mm)
2028c2ecf20Sopenharmony_ci{
2038c2ecf20Sopenharmony_ci	get_mmu_context(mm);
2048c2ecf20Sopenharmony_ci	sun3_put_context(mm->context);
2058c2ecf20Sopenharmony_ci}
2068c2ecf20Sopenharmony_ci
2078c2ecf20Sopenharmony_cistatic inline void switch_mm(struct mm_struct *prev, struct mm_struct *next,
2088c2ecf20Sopenharmony_ci			     struct task_struct *tsk)
2098c2ecf20Sopenharmony_ci{
2108c2ecf20Sopenharmony_ci	activate_context(tsk->mm);
2118c2ecf20Sopenharmony_ci}
2128c2ecf20Sopenharmony_ci
2138c2ecf20Sopenharmony_ci#define deactivate_mm(tsk, mm)	do { } while (0)
2148c2ecf20Sopenharmony_ci
2158c2ecf20Sopenharmony_cistatic inline void activate_mm(struct mm_struct *prev_mm,
2168c2ecf20Sopenharmony_ci			       struct mm_struct *next_mm)
2178c2ecf20Sopenharmony_ci{
2188c2ecf20Sopenharmony_ci	activate_context(next_mm);
2198c2ecf20Sopenharmony_ci}
2208c2ecf20Sopenharmony_ci
2218c2ecf20Sopenharmony_ci#else
2228c2ecf20Sopenharmony_ci
2238c2ecf20Sopenharmony_ci#include <asm/setup.h>
2248c2ecf20Sopenharmony_ci#include <asm/page.h>
2258c2ecf20Sopenharmony_ci#include <asm/cacheflush.h>
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_cistatic inline int init_new_context(struct task_struct *tsk,
2288c2ecf20Sopenharmony_ci				   struct mm_struct *mm)
2298c2ecf20Sopenharmony_ci{
2308c2ecf20Sopenharmony_ci	mm->context = virt_to_phys(mm->pgd);
2318c2ecf20Sopenharmony_ci	return 0;
2328c2ecf20Sopenharmony_ci}
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci#define destroy_context(mm)		do { } while(0)
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_cistatic inline void switch_mm_0230(struct mm_struct *mm)
2378c2ecf20Sopenharmony_ci{
2388c2ecf20Sopenharmony_ci	unsigned long crp[2] = {
2398c2ecf20Sopenharmony_ci		0x80000000 | _PAGE_TABLE, mm->context
2408c2ecf20Sopenharmony_ci	};
2418c2ecf20Sopenharmony_ci	unsigned long tmp;
2428c2ecf20Sopenharmony_ci
2438c2ecf20Sopenharmony_ci	asm volatile (".chip 68030");
2448c2ecf20Sopenharmony_ci
2458c2ecf20Sopenharmony_ci	/* flush MC68030/MC68020 caches (they are virtually addressed) */
2468c2ecf20Sopenharmony_ci	asm volatile (
2478c2ecf20Sopenharmony_ci		"movec %%cacr,%0;"
2488c2ecf20Sopenharmony_ci		"orw %1,%0; "
2498c2ecf20Sopenharmony_ci		"movec %0,%%cacr"
2508c2ecf20Sopenharmony_ci		: "=d" (tmp) : "di" (FLUSH_I_AND_D));
2518c2ecf20Sopenharmony_ci
2528c2ecf20Sopenharmony_ci	/* Switch the root pointer. For a 030-only kernel,
2538c2ecf20Sopenharmony_ci	 * avoid flushing the whole ATC, we only need to
2548c2ecf20Sopenharmony_ci	 * flush the user entries. The 68851 does this by
2558c2ecf20Sopenharmony_ci	 * itself. Avoid a runtime check here.
2568c2ecf20Sopenharmony_ci	 */
2578c2ecf20Sopenharmony_ci	asm volatile (
2588c2ecf20Sopenharmony_ci#ifdef CPU_M68030_ONLY
2598c2ecf20Sopenharmony_ci		"pmovefd %0,%%crp; "
2608c2ecf20Sopenharmony_ci		"pflush #0,#4"
2618c2ecf20Sopenharmony_ci#else
2628c2ecf20Sopenharmony_ci		"pmove %0,%%crp"
2638c2ecf20Sopenharmony_ci#endif
2648c2ecf20Sopenharmony_ci		: : "m" (crp[0]));
2658c2ecf20Sopenharmony_ci
2668c2ecf20Sopenharmony_ci	asm volatile (".chip 68k");
2678c2ecf20Sopenharmony_ci}
2688c2ecf20Sopenharmony_ci
2698c2ecf20Sopenharmony_cistatic inline void switch_mm_0460(struct mm_struct *mm)
2708c2ecf20Sopenharmony_ci{
2718c2ecf20Sopenharmony_ci	asm volatile (".chip 68040");
2728c2ecf20Sopenharmony_ci
2738c2ecf20Sopenharmony_ci	/* flush address translation cache (user entries) */
2748c2ecf20Sopenharmony_ci	asm volatile ("pflushan");
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_ci	/* switch the root pointer */
2778c2ecf20Sopenharmony_ci	asm volatile ("movec %0,%%urp" : : "r" (mm->context));
2788c2ecf20Sopenharmony_ci
2798c2ecf20Sopenharmony_ci	if (CPU_IS_060) {
2808c2ecf20Sopenharmony_ci		unsigned long tmp;
2818c2ecf20Sopenharmony_ci
2828c2ecf20Sopenharmony_ci		/* clear user entries in the branch cache */
2838c2ecf20Sopenharmony_ci		asm volatile (
2848c2ecf20Sopenharmony_ci			"movec %%cacr,%0; "
2858c2ecf20Sopenharmony_ci		        "orl %1,%0; "
2868c2ecf20Sopenharmony_ci		        "movec %0,%%cacr"
2878c2ecf20Sopenharmony_ci			: "=d" (tmp): "di" (0x00200000));
2888c2ecf20Sopenharmony_ci	}
2898c2ecf20Sopenharmony_ci
2908c2ecf20Sopenharmony_ci	asm volatile (".chip 68k");
2918c2ecf20Sopenharmony_ci}
2928c2ecf20Sopenharmony_ci
2938c2ecf20Sopenharmony_cistatic inline void switch_mm(struct mm_struct *prev, struct mm_struct *next, struct task_struct *tsk)
2948c2ecf20Sopenharmony_ci{
2958c2ecf20Sopenharmony_ci	if (prev != next) {
2968c2ecf20Sopenharmony_ci		if (CPU_IS_020_OR_030)
2978c2ecf20Sopenharmony_ci			switch_mm_0230(next);
2988c2ecf20Sopenharmony_ci		else
2998c2ecf20Sopenharmony_ci			switch_mm_0460(next);
3008c2ecf20Sopenharmony_ci	}
3018c2ecf20Sopenharmony_ci}
3028c2ecf20Sopenharmony_ci
3038c2ecf20Sopenharmony_ci#define deactivate_mm(tsk,mm)	do { } while (0)
3048c2ecf20Sopenharmony_ci
3058c2ecf20Sopenharmony_cistatic inline void activate_mm(struct mm_struct *prev_mm,
3068c2ecf20Sopenharmony_ci			       struct mm_struct *next_mm)
3078c2ecf20Sopenharmony_ci{
3088c2ecf20Sopenharmony_ci	next_mm->context = virt_to_phys(next_mm->pgd);
3098c2ecf20Sopenharmony_ci
3108c2ecf20Sopenharmony_ci	if (CPU_IS_020_OR_030)
3118c2ecf20Sopenharmony_ci		switch_mm_0230(next_mm);
3128c2ecf20Sopenharmony_ci	else
3138c2ecf20Sopenharmony_ci		switch_mm_0460(next_mm);
3148c2ecf20Sopenharmony_ci}
3158c2ecf20Sopenharmony_ci
3168c2ecf20Sopenharmony_ci#endif
3178c2ecf20Sopenharmony_ci
3188c2ecf20Sopenharmony_ci#else /* !CONFIG_MMU */
3198c2ecf20Sopenharmony_ci
3208c2ecf20Sopenharmony_cistatic inline int init_new_context(struct task_struct *tsk, struct mm_struct *mm)
3218c2ecf20Sopenharmony_ci{
3228c2ecf20Sopenharmony_ci	return 0;
3238c2ecf20Sopenharmony_ci}
3248c2ecf20Sopenharmony_ci
3258c2ecf20Sopenharmony_ci
3268c2ecf20Sopenharmony_cistatic inline void switch_mm(struct mm_struct *prev, struct mm_struct *next, struct task_struct *tsk)
3278c2ecf20Sopenharmony_ci{
3288c2ecf20Sopenharmony_ci}
3298c2ecf20Sopenharmony_ci
3308c2ecf20Sopenharmony_ci#define destroy_context(mm)	do { } while (0)
3318c2ecf20Sopenharmony_ci#define deactivate_mm(tsk,mm)	do { } while (0)
3328c2ecf20Sopenharmony_ci
3338c2ecf20Sopenharmony_cistatic inline void activate_mm(struct mm_struct *prev_mm, struct mm_struct *next_mm)
3348c2ecf20Sopenharmony_ci{
3358c2ecf20Sopenharmony_ci}
3368c2ecf20Sopenharmony_ci
3378c2ecf20Sopenharmony_ci#endif /* CONFIG_MMU */
3388c2ecf20Sopenharmony_ci#endif /* __M68K_MMU_CONTEXT_H */
339