pg-sh4.c 2.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4
/*
 * arch/sh/mm/pg-sh4.c
 *
 * Copyright (C) 1999, 2000, 2002  Niibe Yutaka
5
 * Copyright (C) 2002 - 2005  Paul Mundt
L
Linus Torvalds 已提交
6 7 8 9
 *
 * Released under the terms of the GNU GPL v2.0.
 */
#include <linux/mm.h>
P
Paul Mundt 已提交
10
#include <linux/mutex.h>
L
Linus Torvalds 已提交
11 12 13
#include <asm/mmu_context.h>
#include <asm/cacheflush.h>

P
Paul Mundt 已提交
14
extern struct mutex p3map_mutex[];
L
Linus Torvalds 已提交
15

16
#define CACHE_ALIAS (current_cpu_data.dcache.alias_mask)
17

L
Linus Torvalds 已提交
18 19 20 21 22 23 24 25
/*
 * clear_user_page
 * @to: P1 address
 * @address: U0 address to be mapped
 * @page: page (virt_to_page(to))
 */
void clear_user_page(void *to, unsigned long address, struct page *page)
{
26
	__set_bit(PG_mapped, &page->flags);
L
Linus Torvalds 已提交
27 28 29 30 31
	if (((address ^ (unsigned long)to) & CACHE_ALIAS) == 0)
		clear_page(to);
	else {
		unsigned long phys_addr = PHYSADDR(to);
		unsigned long p3_addr = P3SEG + (address & CACHE_ALIAS);
32 33 34
		pgd_t *pgd = pgd_offset_k(p3_addr);
		pud_t *pud = pud_offset(pgd, p3_addr);
		pmd_t *pmd = pmd_offset(pud, p3_addr);
L
Linus Torvalds 已提交
35 36 37 38
		pte_t *pte = pte_offset_kernel(pmd, p3_addr);
		pte_t entry;
		unsigned long flags;

39
		entry = pfn_pte(phys_addr >> PAGE_SHIFT, PAGE_KERNEL);
P
Paul Mundt 已提交
40
		mutex_lock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
L
Linus Torvalds 已提交
41 42
		set_pte(pte, entry);
		local_irq_save(flags);
43
		flush_tlb_one(get_asid(), p3_addr);
L
Linus Torvalds 已提交
44 45 46 47
		local_irq_restore(flags);
		update_mmu_cache(NULL, p3_addr, entry);
		__clear_user_page((void *)p3_addr, to);
		pte_clear(&init_mm, p3_addr, pte);
P
Paul Mundt 已提交
48
		mutex_unlock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
L
Linus Torvalds 已提交
49 50 51 52 53 54 55 56 57 58
	}
}

/*
 * copy_user_page
 * @to: P1 address
 * @from: P1 address
 * @address: U0 address to be mapped
 * @page: page (virt_to_page(to))
 */
59
void copy_user_page(void *to, void *from, unsigned long address,
L
Linus Torvalds 已提交
60 61
		    struct page *page)
{
62
	__set_bit(PG_mapped, &page->flags);
L
Linus Torvalds 已提交
63 64 65 66 67
	if (((address ^ (unsigned long)to) & CACHE_ALIAS) == 0)
		copy_page(to, from);
	else {
		unsigned long phys_addr = PHYSADDR(to);
		unsigned long p3_addr = P3SEG + (address & CACHE_ALIAS);
68 69 70
		pgd_t *pgd = pgd_offset_k(p3_addr);
		pud_t *pud = pud_offset(pgd, p3_addr);
		pmd_t *pmd = pmd_offset(pud, p3_addr);
L
Linus Torvalds 已提交
71 72 73 74
		pte_t *pte = pte_offset_kernel(pmd, p3_addr);
		pte_t entry;
		unsigned long flags;

75
		entry = pfn_pte(phys_addr >> PAGE_SHIFT, PAGE_KERNEL);
P
Paul Mundt 已提交
76
		mutex_lock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
L
Linus Torvalds 已提交
77 78
		set_pte(pte, entry);
		local_irq_save(flags);
79
		flush_tlb_one(get_asid(), p3_addr);
L
Linus Torvalds 已提交
80 81 82 83
		local_irq_restore(flags);
		update_mmu_cache(NULL, p3_addr, entry);
		__copy_user_page((void *)p3_addr, from, to);
		pte_clear(&init_mm, p3_addr, pte);
P
Paul Mundt 已提交
84
		mutex_unlock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
L
Linus Torvalds 已提交
85 86
	}
}
87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106

/*
 * For SH-4, we have our own implementation for ptep_get_and_clear
 */
inline pte_t ptep_get_and_clear(struct mm_struct *mm, unsigned long addr, pte_t *ptep)
{
	pte_t pte = *ptep;

	pte_clear(mm, addr, ptep);
	if (!pte_not_present(pte)) {
		unsigned long pfn = pte_pfn(pte);
		if (pfn_valid(pfn)) {
			struct page *page = pfn_to_page(pfn);
			struct address_space *mapping = page_mapping(page);
			if (!mapping || !mapping_writably_mapped(mapping))
				__clear_bit(PG_mapped, &page->flags);
		}
	}
	return pte;
}