hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
/* SPDX-License-Identifier: GPL-2.0-only */
/*
 *  linux/arch/arm/mm/tlb-v7.S
 *
 *  Copyright (C) 1997-2002 Russell King
 *  Modified for ARMv7 by Catalin Marinas
 *
 *  ARM architecture version 6 TLB handling functions.
 *  These assume a split I/D TLB.
 */
#include <linux/init.h>
#include <linux/linkage.h>
#include <asm/assembler.h>
#include <asm/asm-offsets.h>
#include <asm/page.h>
#include <asm/tlbflush.h>
#include "proc-macros.S"
 
/*
 *    v7wbi_flush_user_tlb_range(start, end, vma)
 *
 *    Invalidate a range of TLB entries in the specified address space.
 *
 *    - start - start address (may not be aligned)
 *    - end   - end address (exclusive, may not be aligned)
 *    - vma   - vma_struct describing address range
 *
 *    It is assumed that:
 *    - the "Invalidate single entry" instruction will invalidate
 *      both the I and the D TLBs on Harvard-style TLBs
 */
ENTRY(v7wbi_flush_user_tlb_range)
   vma_vm_mm r3, r2            @ get vma->vm_mm
   mmid    r3, r3                @ get vm_mm->context.id
   dsb    ish
   mov    r0, r0, lsr #PAGE_SHIFT        @ align address
   mov    r1, r1, lsr #PAGE_SHIFT
   asid    r3, r3                @ mask ASID
#ifdef CONFIG_ARM_ERRATA_720789
   ALT_SMP(W(mov)    r3, #0    )
   ALT_UP(W(nop)        )
#endif
   orr    r0, r3, r0, lsl #PAGE_SHIFT    @ Create initial MVA
   mov    r1, r1, lsl #PAGE_SHIFT
1:
#ifdef CONFIG_ARM_ERRATA_720789
   ALT_SMP(mcr    p15, 0, r0, c8, c3, 3)    @ TLB invalidate U MVA all ASID (shareable)
#else
   ALT_SMP(mcr    p15, 0, r0, c8, c3, 1)    @ TLB invalidate U MVA (shareable)
#endif
   ALT_UP(mcr    p15, 0, r0, c8, c7, 1)    @ TLB invalidate U MVA
 
   add    r0, r0, #PAGE_SZ
   cmp    r0, r1
   blo    1b
   dsb    ish
   ret    lr
ENDPROC(v7wbi_flush_user_tlb_range)
 
/*
 *    v7wbi_flush_kern_tlb_range(start,end)
 *
 *    Invalidate a range of kernel TLB entries
 *
 *    - start - start address (may not be aligned)
 *    - end   - end address (exclusive, may not be aligned)
 */
ENTRY(v7wbi_flush_kern_tlb_range)
   dsb    ish
   mov    r0, r0, lsr #PAGE_SHIFT        @ align address
   mov    r1, r1, lsr #PAGE_SHIFT
   mov    r0, r0, lsl #PAGE_SHIFT
   mov    r1, r1, lsl #PAGE_SHIFT
1:
#ifdef CONFIG_ARM_ERRATA_720789
   ALT_SMP(mcr    p15, 0, r0, c8, c3, 3)    @ TLB invalidate U MVA all ASID (shareable)
#else
   ALT_SMP(mcr    p15, 0, r0, c8, c3, 1)    @ TLB invalidate U MVA (shareable)
#endif
   ALT_UP(mcr    p15, 0, r0, c8, c7, 1)    @ TLB invalidate U MVA
   add    r0, r0, #PAGE_SZ
   cmp    r0, r1
   blo    1b
   dsb    ish
   isb
   ret    lr
ENDPROC(v7wbi_flush_kern_tlb_range)
 
   __INIT
 
   /* define struct cpu_tlb_fns (see <asm/tlbflush.h> and proc-macros.S) */
   define_tlb_functions v7wbi, v7wbi_tlb_flags_up, flags_smp=v7wbi_tlb_flags_smp