1
2
3
4
5
6
7
8
9
10
11#include <linux/mm.h>
12#include <linux/hugetlb.h>
13#include <asm/pgtable.h>
14#include <asm/pgalloc.h>
15#include <asm/cacheflush.h>
16#include <asm/machdep.h>
17
18extern long hpte_insert_repeating(unsigned long hash, unsigned long vpn,
19 unsigned long pa, unsigned long rlags,
20 unsigned long vflags, int psize, int ssize);
21
22int __hash_page_huge(unsigned long ea, unsigned long access, unsigned long vsid,
23 pte_t *ptep, unsigned long trap, unsigned long flags,
24 int ssize, unsigned int shift, unsigned int mmu_psize)
25{
26 real_pte_t rpte;
27 unsigned long vpn;
28 unsigned long old_pte, new_pte;
29 unsigned long rflags, pa, sz;
30 long slot, offset;
31
32 BUG_ON(shift != mmu_psize_defs[mmu_psize].shift);
33
34
35 vpn = hpt_vpn(ea, vsid, ssize);
36
37
38
39
40
41
42
43
44
45
46
47
48
49 do {
50 old_pte = pte_val(*ptep);
51
52 if (unlikely(old_pte & H_PAGE_BUSY))
53 return 0;
54
55 if (unlikely(!check_pte_access(access, old_pte)))
56 return 1;
57
58
59
60 new_pte = old_pte | H_PAGE_BUSY | _PAGE_ACCESSED;
61 if (access & _PAGE_WRITE)
62 new_pte |= _PAGE_DIRTY;
63 } while(!pte_xchg(ptep, __pte(old_pte), __pte(new_pte)));
64
65 rflags = htab_convert_pte_flags(new_pte);
66 if (unlikely(mmu_psize == MMU_PAGE_16G))
67 offset = PTRS_PER_PUD;
68 else
69 offset = PTRS_PER_PMD;
70 rpte = __real_pte(__pte(old_pte), ptep, offset);
71
72 sz = ((1UL) << shift);
73 if (!cpu_has_feature(CPU_FTR_COHERENT_ICACHE))
74
75
76 rflags = hash_page_do_lazy_icache(rflags, __pte(old_pte), trap);
77
78
79 if (unlikely(old_pte & H_PAGE_HASHPTE)) {
80
81 unsigned long gslot;
82
83 gslot = pte_get_hash_gslot(vpn, shift, ssize, rpte, 0);
84 if (mmu_hash_ops.hpte_updatepp(gslot, rflags, vpn, mmu_psize,
85 mmu_psize, ssize, flags) == -1)
86 old_pte &= ~_PAGE_HPTEFLAGS;
87 }
88
89 if (likely(!(old_pte & H_PAGE_HASHPTE))) {
90 unsigned long hash = hpt_hash(vpn, shift, ssize);
91
92 pa = pte_pfn(__pte(old_pte)) << PAGE_SHIFT;
93
94
95 new_pte = (new_pte & ~_PAGE_HPTEFLAGS) | H_PAGE_HASHPTE;
96
97 slot = hpte_insert_repeating(hash, vpn, pa, rflags, 0,
98 mmu_psize, ssize);
99
100
101
102
103
104 if (unlikely(slot == -2)) {
105 *ptep = __pte(old_pte);
106 hash_failure_debug(ea, access, vsid, trap, ssize,
107 mmu_psize, mmu_psize, old_pte);
108 return -1;
109 }
110
111 new_pte |= pte_set_hidx(ptep, rpte, 0, slot, offset);
112 }
113
114
115
116
117 *ptep = __pte(new_pte & ~H_PAGE_BUSY);
118 return 0;
119}
120