ARM: make_coherent: split adjust_pte() in two
[safe/jmp/linux-2.6] / arch / arm / mm / fault-armv.c
1 /*
2  *  linux/arch/arm/mm/fault-armv.c
3  *
4  *  Copyright (C) 1995  Linus Torvalds
5  *  Modifications for ARM processor (c) 1995-2002 Russell King
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 #include <linux/module.h>
12 #include <linux/sched.h>
13 #include <linux/kernel.h>
14 #include <linux/mm.h>
15 #include <linux/bitops.h>
16 #include <linux/vmalloc.h>
17 #include <linux/init.h>
18 #include <linux/pagemap.h>
19
20 #include <asm/bugs.h>
21 #include <asm/cacheflush.h>
22 #include <asm/cachetype.h>
23 #include <asm/pgtable.h>
24 #include <asm/tlbflush.h>
25
26 #include "mm.h"
27
28 static unsigned long shared_pte_mask = L_PTE_MT_BUFFERABLE;
29
30 /*
31  * We take the easy way out of this problem - we make the
32  * PTE uncacheable.  However, we leave the write buffer on.
33  *
34  * Note that the pte lock held when calling update_mmu_cache must also
35  * guard the pte (somewhere else in the same mm) that we modify here.
36  * Therefore those configurations which might call adjust_pte (those
37  * without CONFIG_CPU_CACHE_VIPT) cannot support split page_table_lock.
38  */
39 static int do_adjust_pte(struct vm_area_struct *vma, unsigned long address,
40         pte_t *ptep)
41 {
42         pte_t entry = *ptep;
43         int ret;
44
45         /*
46          * If this page is present, it's actually being shared.
47          */
48         ret = pte_present(entry);
49
50         /*
51          * If this page isn't present, or is already setup to
52          * fault (ie, is old), we can safely ignore any issues.
53          */
54         if (ret && (pte_val(entry) & L_PTE_MT_MASK) != shared_pte_mask) {
55                 unsigned long pfn = pte_pfn(entry);
56                 flush_cache_page(vma, address, pfn);
57                 outer_flush_range((pfn << PAGE_SHIFT),
58                                   (pfn << PAGE_SHIFT) + PAGE_SIZE);
59                 pte_val(entry) &= ~L_PTE_MT_MASK;
60                 pte_val(entry) |= shared_pte_mask;
61                 set_pte_at(vma->vm_mm, address, ptep, entry);
62                 flush_tlb_page(vma, address);
63         }
64
65         return ret;
66 }
67
68 static int adjust_pte(struct vm_area_struct *vma, unsigned long address)
69 {
70         pgd_t *pgd;
71         pmd_t *pmd;
72         pte_t *pte;
73         int ret;
74
75         pgd = pgd_offset(vma->vm_mm, address);
76         if (pgd_none(*pgd))
77                 goto no_pgd;
78         if (pgd_bad(*pgd))
79                 goto bad_pgd;
80
81         pmd = pmd_offset(pgd, address);
82         if (pmd_none(*pmd))
83                 goto no_pmd;
84         if (pmd_bad(*pmd))
85                 goto bad_pmd;
86
87         pte = pte_offset_map(pmd, address);
88
89         ret = do_adjust_pte(vma, address, pte);
90
91         pte_unmap(pte);
92
93         return ret;
94
95 bad_pgd:
96         pgd_ERROR(*pgd);
97         pgd_clear(pgd);
98 no_pgd:
99         return 0;
100
101 bad_pmd:
102         pmd_ERROR(*pmd);
103         pmd_clear(pmd);
104 no_pmd:
105         return 0;
106 }
107
108 static void
109 make_coherent(struct address_space *mapping, struct vm_area_struct *vma, unsigned long addr, unsigned long pfn)
110 {
111         struct mm_struct *mm = vma->vm_mm;
112         struct vm_area_struct *mpnt;
113         struct prio_tree_iter iter;
114         unsigned long offset;
115         pgoff_t pgoff;
116         int aliases = 0;
117
118         pgoff = vma->vm_pgoff + ((addr - vma->vm_start) >> PAGE_SHIFT);
119
120         /*
121          * If we have any shared mappings that are in the same mm
122          * space, then we need to handle them specially to maintain
123          * cache coherency.
124          */
125         flush_dcache_mmap_lock(mapping);
126         vma_prio_tree_foreach(mpnt, &iter, &mapping->i_mmap, pgoff, pgoff) {
127                 /*
128                  * If this VMA is not in our MM, we can ignore it.
129                  * Note that we intentionally mask out the VMA
130                  * that we are fixing up.
131                  */
132                 if (mpnt->vm_mm != mm || mpnt == vma)
133                         continue;
134                 if (!(mpnt->vm_flags & VM_MAYSHARE))
135                         continue;
136                 offset = (pgoff - mpnt->vm_pgoff) << PAGE_SHIFT;
137                 aliases += adjust_pte(mpnt, mpnt->vm_start + offset);
138         }
139         flush_dcache_mmap_unlock(mapping);
140         if (aliases)
141                 adjust_pte(vma, addr);
142         else
143                 flush_cache_page(vma, addr, pfn);
144 }
145
146 /*
147  * Take care of architecture specific things when placing a new PTE into
148  * a page table, or changing an existing PTE.  Basically, there are two
149  * things that we need to take care of:
150  *
151  *  1. If PG_dcache_dirty is set for the page, we need to ensure
152  *     that any cache entries for the kernels virtual memory
153  *     range are written back to the page.
154  *  2. If we have multiple shared mappings of the same space in
155  *     an object, we need to deal with the cache aliasing issues.
156  *
157  * Note that the pte lock will be held.
158  */
159 void update_mmu_cache(struct vm_area_struct *vma, unsigned long addr, pte_t pte)
160 {
161         unsigned long pfn = pte_pfn(pte);
162         struct address_space *mapping;
163         struct page *page;
164
165         if (!pfn_valid(pfn))
166                 return;
167
168         /*
169          * The zero page is never written to, so never has any dirty
170          * cache lines, and therefore never needs to be flushed.
171          */
172         page = pfn_to_page(pfn);
173         if (page == ZERO_PAGE(0))
174                 return;
175
176         mapping = page_mapping(page);
177 #ifndef CONFIG_SMP
178         if (test_and_clear_bit(PG_dcache_dirty, &page->flags))
179                 __flush_dcache_page(mapping, page);
180 #endif
181         if (mapping) {
182                 if (cache_is_vivt())
183                         make_coherent(mapping, vma, addr, pfn);
184                 else if (vma->vm_flags & VM_EXEC)
185                         __flush_icache_all();
186         }
187 }
188
189 /*
190  * Check whether the write buffer has physical address aliasing
191  * issues.  If it has, we need to avoid them for the case where
192  * we have several shared mappings of the same object in user
193  * space.
194  */
195 static int __init check_writebuffer(unsigned long *p1, unsigned long *p2)
196 {
197         register unsigned long zero = 0, one = 1, val;
198
199         local_irq_disable();
200         mb();
201         *p1 = one;
202         mb();
203         *p2 = zero;
204         mb();
205         val = *p1;
206         mb();
207         local_irq_enable();
208         return val != zero;
209 }
210
211 void __init check_writebuffer_bugs(void)
212 {
213         struct page *page;
214         const char *reason;
215         unsigned long v = 1;
216
217         printk(KERN_INFO "CPU: Testing write buffer coherency: ");
218
219         page = alloc_page(GFP_KERNEL);
220         if (page) {
221                 unsigned long *p1, *p2;
222                 pgprot_t prot = __pgprot_modify(PAGE_KERNEL,
223                                         L_PTE_MT_MASK, L_PTE_MT_BUFFERABLE);
224
225                 p1 = vmap(&page, 1, VM_IOREMAP, prot);
226                 p2 = vmap(&page, 1, VM_IOREMAP, prot);
227
228                 if (p1 && p2) {
229                         v = check_writebuffer(p1, p2);
230                         reason = "enabling work-around";
231                 } else {
232                         reason = "unable to map memory\n";
233                 }
234
235                 vunmap(p1);
236                 vunmap(p2);
237                 put_page(page);
238         } else {
239                 reason = "unable to grab page\n";
240         }
241
242         if (v) {
243                 printk("failed, %s\n", reason);
244                 shared_pte_mask = L_PTE_MT_UNCACHED;
245         } else {
246                 printk("ok\n");
247         }
248 }