blob: 3f98d2a4f936355507e4386855e442b7fa6860ac [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * arch/sh/mm/pg-sh4.c
3 *
4 * Copyright (C) 1999, 2000, 2002 Niibe Yutaka
Paul Mundt8b395262006-09-27 14:38:02 +09005 * Copyright (C) 2002 - 2005 Paul Mundt
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 *
7 * Released under the terms of the GNU GPL v2.0.
8 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07009#include <linux/mm.h>
Paul Mundt52e27782006-11-21 11:09:41 +090010#include <linux/mutex.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070011#include <asm/mmu_context.h>
12#include <asm/cacheflush.h>
13
Paul Mundt52e27782006-11-21 11:09:41 +090014extern struct mutex p3map_mutex[];
Linus Torvalds1da177e2005-04-16 15:20:36 -070015
Paul Mundt8b395262006-09-27 14:38:02 +090016#define CACHE_ALIAS (cpu_data->dcache.alias_mask)
17
Linus Torvalds1da177e2005-04-16 15:20:36 -070018/*
19 * clear_user_page
20 * @to: P1 address
21 * @address: U0 address to be mapped
22 * @page: page (virt_to_page(to))
23 */
24void clear_user_page(void *to, unsigned long address, struct page *page)
25{
26 __set_bit(PG_mapped, &page->flags);
27 if (((address ^ (unsigned long)to) & CACHE_ALIAS) == 0)
28 clear_page(to);
29 else {
Linus Torvalds1da177e2005-04-16 15:20:36 -070030 unsigned long phys_addr = PHYSADDR(to);
31 unsigned long p3_addr = P3SEG + (address & CACHE_ALIAS);
Paul Mundt8b395262006-09-27 14:38:02 +090032 pgd_t *pgd = pgd_offset_k(p3_addr);
33 pud_t *pud = pud_offset(pgd, p3_addr);
34 pmd_t *pmd = pmd_offset(pud, p3_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -070035 pte_t *pte = pte_offset_kernel(pmd, p3_addr);
36 pte_t entry;
37 unsigned long flags;
38
Paul Mundt21440cf2006-11-20 14:30:26 +090039 entry = pfn_pte(phys_addr >> PAGE_SHIFT, PAGE_KERNEL);
Paul Mundt52e27782006-11-21 11:09:41 +090040 mutex_lock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
Linus Torvalds1da177e2005-04-16 15:20:36 -070041 set_pte(pte, entry);
42 local_irq_save(flags);
43 __flush_tlb_page(get_asid(), p3_addr);
44 local_irq_restore(flags);
45 update_mmu_cache(NULL, p3_addr, entry);
46 __clear_user_page((void *)p3_addr, to);
47 pte_clear(&init_mm, p3_addr, pte);
Paul Mundt52e27782006-11-21 11:09:41 +090048 mutex_unlock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
Linus Torvalds1da177e2005-04-16 15:20:36 -070049 }
50}
51
52/*
53 * copy_user_page
54 * @to: P1 address
55 * @from: P1 address
56 * @address: U0 address to be mapped
57 * @page: page (virt_to_page(to))
58 */
Paul Mundt8b395262006-09-27 14:38:02 +090059void copy_user_page(void *to, void *from, unsigned long address,
Linus Torvalds1da177e2005-04-16 15:20:36 -070060 struct page *page)
61{
62 __set_bit(PG_mapped, &page->flags);
63 if (((address ^ (unsigned long)to) & CACHE_ALIAS) == 0)
64 copy_page(to, from);
65 else {
Linus Torvalds1da177e2005-04-16 15:20:36 -070066 unsigned long phys_addr = PHYSADDR(to);
67 unsigned long p3_addr = P3SEG + (address & CACHE_ALIAS);
Paul Mundt8b395262006-09-27 14:38:02 +090068 pgd_t *pgd = pgd_offset_k(p3_addr);
69 pud_t *pud = pud_offset(pgd, p3_addr);
70 pmd_t *pmd = pmd_offset(pud, p3_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 pte_t *pte = pte_offset_kernel(pmd, p3_addr);
72 pte_t entry;
73 unsigned long flags;
74
Paul Mundt21440cf2006-11-20 14:30:26 +090075 entry = pfn_pte(phys_addr >> PAGE_SHIFT, PAGE_KERNEL);
Paul Mundt52e27782006-11-21 11:09:41 +090076 mutex_lock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077 set_pte(pte, entry);
78 local_irq_save(flags);
79 __flush_tlb_page(get_asid(), p3_addr);
80 local_irq_restore(flags);
81 update_mmu_cache(NULL, p3_addr, entry);
82 __copy_user_page((void *)p3_addr, from, to);
83 pte_clear(&init_mm, p3_addr, pte);
Paul Mundt52e27782006-11-21 11:09:41 +090084 mutex_unlock(&p3map_mutex[(address & CACHE_ALIAS)>>12]);
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 }
86}
87
88/*
89 * For SH-4, we have our own implementation for ptep_get_and_clear
90 */
91inline pte_t ptep_get_and_clear(struct mm_struct *mm, unsigned long addr, pte_t *ptep)
92{
93 pte_t pte = *ptep;
94
95 pte_clear(mm, addr, ptep);
96 if (!pte_not_present(pte)) {
97 unsigned long pfn = pte_pfn(pte);
98 if (pfn_valid(pfn)) {
99 struct page *page = pfn_to_page(pfn);
100 struct address_space *mapping = page_mapping(page);
101 if (!mapping || !mapping_writably_mapped(mapping))
102 __clear_bit(PG_mapped, &page->flags);
103 }
104 }
105 return pte;
106}