1
2
3
4
5
6
7
8
9
10
11
12
13#include <asm/tlb.h>
14#include <asm/mmu_context.h>
15#include <asm/arch/svinto.h>
16
17#define D(x)
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35void
36flush_tlb_all(void)
37{
38 int i;
39 unsigned long flags;
40
41
42
43
44
45 local_irq_save(flags);
46 for(i = 0; i < NUM_TLB_ENTRIES; i++) {
47 *R_TLB_SELECT = ( IO_FIELD(R_TLB_SELECT, index, i) );
48 *R_TLB_HI = ( IO_FIELD(R_TLB_HI, page_id, INVALID_PAGEID ) |
49 IO_FIELD(R_TLB_HI, vpn, i & 0xf ) );
50
51 *R_TLB_LO = ( IO_STATE(R_TLB_LO, global,no ) |
52 IO_STATE(R_TLB_LO, valid, no ) |
53 IO_STATE(R_TLB_LO, kernel,no ) |
54 IO_STATE(R_TLB_LO, we, no ) |
55 IO_FIELD(R_TLB_LO, pfn, 0 ) );
56 }
57 local_irq_restore(flags);
58 D(printk("tlb: flushed all\n"));
59}
60
61
62
63void
64flush_tlb_mm(struct mm_struct *mm)
65{
66 int i;
67 int page_id = mm->context.page_id;
68 unsigned long flags;
69
70 D(printk("tlb: flush mm context %d (%p)\n", page_id, mm));
71
72 if(page_id == NO_CONTEXT)
73 return;
74
75
76
77
78
79
80 local_irq_save(flags);
81 for(i = 0; i < NUM_TLB_ENTRIES; i++) {
82 *R_TLB_SELECT = IO_FIELD(R_TLB_SELECT, index, i);
83 if (IO_EXTRACT(R_TLB_HI, page_id, *R_TLB_HI) == page_id) {
84 *R_TLB_HI = ( IO_FIELD(R_TLB_HI, page_id, INVALID_PAGEID ) |
85 IO_FIELD(R_TLB_HI, vpn, i & 0xf ) );
86
87 *R_TLB_LO = ( IO_STATE(R_TLB_LO, global,no ) |
88 IO_STATE(R_TLB_LO, valid, no ) |
89 IO_STATE(R_TLB_LO, kernel,no ) |
90 IO_STATE(R_TLB_LO, we, no ) |
91 IO_FIELD(R_TLB_LO, pfn, 0 ) );
92 }
93 }
94 local_irq_restore(flags);
95}
96
97
98
99void
100flush_tlb_page(struct vm_area_struct *vma,
101 unsigned long addr)
102{
103 struct mm_struct *mm = vma->vm_mm;
104 int page_id = mm->context.page_id;
105 int i;
106 unsigned long flags;
107
108 D(printk("tlb: flush page %p in context %d (%p)\n", addr, page_id, mm));
109
110 if(page_id == NO_CONTEXT)
111 return;
112
113 addr &= PAGE_MASK;
114
115
116
117
118
119 local_irq_save(flags);
120 for(i = 0; i < NUM_TLB_ENTRIES; i++) {
121 unsigned long tlb_hi;
122 *R_TLB_SELECT = IO_FIELD(R_TLB_SELECT, index, i);
123 tlb_hi = *R_TLB_HI;
124 if (IO_EXTRACT(R_TLB_HI, page_id, tlb_hi) == page_id &&
125 (tlb_hi & PAGE_MASK) == addr) {
126 *R_TLB_HI = IO_FIELD(R_TLB_HI, page_id, INVALID_PAGEID ) |
127 addr;
128
129 *R_TLB_LO = ( IO_STATE(R_TLB_LO, global,no ) |
130 IO_STATE(R_TLB_LO, valid, no ) |
131 IO_STATE(R_TLB_LO, kernel,no ) |
132 IO_STATE(R_TLB_LO, we, no ) |
133 IO_FIELD(R_TLB_LO, pfn, 0 ) );
134 }
135 }
136 local_irq_restore(flags);
137}
138
139
140
141#if 0
142void
143dump_tlb_all(void)
144{
145 int i;
146 unsigned long flags;
147
148 printk("TLB dump. LO is: pfn | reserved | global | valid | kernel | we |\n");
149
150 local_save_flags(flags);
151 local_irq_disable();
152 for(i = 0; i < NUM_TLB_ENTRIES; i++) {
153 *R_TLB_SELECT = ( IO_FIELD(R_TLB_SELECT, index, i) );
154 printk("Entry %d: HI 0x%08lx, LO 0x%08lx\n",
155 i, *R_TLB_HI, *R_TLB_LO);
156 }
157 local_irq_restore(flags);
158}
159#endif
160
161
162
163
164
165
166int
167init_new_context(struct task_struct *tsk, struct mm_struct *mm)
168{
169 mm->context.page_id = NO_CONTEXT;
170 return 0;
171}
172
173
174
175void
176switch_mm(struct mm_struct *prev, struct mm_struct *next,
177 struct task_struct *tsk)
178{
179
180
181 get_mmu_context(next);
182
183
184
185
186
187
188
189
190 per_cpu(current_pgd, smp_processor_id()) = next->pgd;
191
192
193
194 D(printk("switching mmu_context to %d (%p)\n", next->context, next));
195
196 *R_MMU_CONTEXT = IO_FIELD(R_MMU_CONTEXT, page_id, next->context.page_id);
197}
198
199