2 * Low level TLB handling.
4 * Copyright (C) 2000-2003, Axis Communications AB.
6 * Authors: Bjorn Wesen <bjornw@axis.com>
7 * Tobias Anderberg <tobiasa@axis.com>, CRISv32 port.
11 #include <asm/mmu_context.h>
12 #include <asm/arch/hwregs/asm/mmu_defs_asm.h>
13 #include <asm/arch/hwregs/supp_reg.h>
15 #define UPDATE_TLB_SEL_IDX(val) \
17 unsigned long tlb_sel; \
19 tlb_sel = REG_FIELD(mmu, rw_mm_tlb_sel, idx, val); \
20 SUPP_REG_WR(RW_MM_TLB_SEL, tlb_sel); \
23 #define UPDATE_TLB_HILO(tlb_hi, tlb_lo) \
25 SUPP_REG_WR(RW_MM_TLB_HI, tlb_hi); \
26 SUPP_REG_WR(RW_MM_TLB_LO, tlb_lo); \
30 * The TLB can host up to 256 different mm contexts at the same time. The running
31 * context is found in the PID register. Each TLB entry contains a page_id that
32 * has to match the PID register to give a hit. page_id_map keeps track of which
33 * mm's is assigned to which page_id's, making sure it's known when to
34 * invalidate TLB entries.
36 * The last page_id is never running, it is used as an invalid page_id so that
37 * it's possible to make TLB entries that will nerver match.
39 * Note; the flushes needs to be atomic otherwise an interrupt hander that uses
40 * vmalloc'ed memory might cause a TLB load in the middle of a flush.
43 /* Flush all TLB entries. */
50 unsigned long mmu_tlb_hi;
51 unsigned long mmu_tlb_sel;
54 * Mask with 0xf so similar TLB entries aren't written in the same 4-way
57 local_save_flags(flags);
60 for (mmu = 1; mmu <= 2; mmu++) {
61 SUPP_BANK_SEL(mmu); /* Select the MMU */
62 for (i = 0; i < NUM_TLB_ENTRIES; i++) {
63 /* Store invalid entry */
64 mmu_tlb_sel = REG_FIELD(mmu, rw_mm_tlb_sel, idx, i);
66 mmu_tlb_hi = (REG_FIELD(mmu, rw_mm_tlb_hi, pid, INVALID_PAGEID)
67 | REG_FIELD(mmu, rw_mm_tlb_hi, vpn, i & 0xf));
69 SUPP_REG_WR(RW_MM_TLB_SEL, mmu_tlb_sel);
70 SUPP_REG_WR(RW_MM_TLB_HI, mmu_tlb_hi);
71 SUPP_REG_WR(RW_MM_TLB_LO, 0);
75 local_irq_restore(flags);
78 /* Flush an entire user address space. */
80 __flush_tlb_mm(struct mm_struct *mm)
85 unsigned long page_id;
87 unsigned long mmu_tlb_hi;
89 page_id = mm->context.page_id;
91 if (page_id == NO_CONTEXT)
94 /* Mark the TLB entries that match the page_id as invalid. */
95 local_save_flags(flags);
98 for (mmu = 1; mmu <= 2; mmu++) {
100 for (i = 0; i < NUM_TLB_ENTRIES; i++) {
101 UPDATE_TLB_SEL_IDX(i);
103 /* Get the page_id */
104 SUPP_REG_RD(RW_MM_TLB_HI, tlb_hi);
106 /* Check if the page_id match. */
107 if ((tlb_hi & 0xff) == page_id) {
108 mmu_tlb_hi = (REG_FIELD(mmu, rw_mm_tlb_hi, pid,
110 | REG_FIELD(mmu, rw_mm_tlb_hi, vpn,
113 UPDATE_TLB_HILO(mmu_tlb_hi, 0);
118 local_irq_restore(flags);
121 /* Invalidate a single page. */
123 __flush_tlb_page(struct vm_area_struct *vma, unsigned long addr)
127 unsigned long page_id;
129 unsigned long tlb_hi;
130 unsigned long mmu_tlb_hi;
132 page_id = vma->vm_mm->context.page_id;
134 if (page_id == NO_CONTEXT)
140 * Invalidate those TLB entries that match both the mm context and the
141 * requested virtual address.
143 local_save_flags(flags);
146 for (mmu = 1; mmu <= 2; mmu++) {
148 for (i = 0; i < NUM_TLB_ENTRIES; i++) {
149 UPDATE_TLB_SEL_IDX(i);
150 SUPP_REG_RD(RW_MM_TLB_HI, tlb_hi);
152 /* Check if page_id and address matches */
153 if (((tlb_hi & 0xff) == page_id) &&
154 ((tlb_hi & PAGE_MASK) == addr)) {
155 mmu_tlb_hi = REG_FIELD(mmu, rw_mm_tlb_hi, pid,
156 INVALID_PAGEID) | addr;
158 UPDATE_TLB_HILO(mmu_tlb_hi, 0);
163 local_irq_restore(flags);
167 * Initialize the context related info for a new mm_struct
172 init_new_context(struct task_struct *tsk, struct mm_struct *mm)
174 mm->context.page_id = NO_CONTEXT;
178 static DEFINE_SPINLOCK(mmu_context_lock);
180 /* Called in schedule() just before actually doing the switch_to. */
182 switch_mm(struct mm_struct *prev, struct mm_struct *next,
183 struct task_struct *tsk)
185 int cpu = smp_processor_id();
187 /* Make sure there is a MMU context. */
188 spin_lock(&mmu_context_lock);
189 get_mmu_context(next);
190 cpu_set(cpu, next->cpu_vm_mask);
191 spin_unlock(&mmu_context_lock);
194 * Remember the pgd for the fault handlers. Keep a seperate copy of it
195 * because current and active_mm might be invalid at points where
196 * there's still a need to derefer the pgd.
198 per_cpu(current_pgd, cpu) = next->pgd;
200 /* Switch context in the MMU. */
201 if (tsk && tsk->thread_info)
203 SPEC_REG_WR(SPEC_REG_PID, next->context.page_id | tsk->thread_info->tls);
207 SPEC_REG_WR(SPEC_REG_PID, next->context.page_id);