ronnie
2022-10-14 1504bb53e29d3d46222c0b3ea994fc494b48e153
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
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
/* tlb-flush.S: TLB flushing routines
 *
 * Copyright (C) 2004 Red Hat, Inc. All Rights Reserved.
 * Written by David Howells (dhowells@redhat.com)
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */
 
#include <linux/sys.h>
#include <linux/linkage.h>
#include <asm/page.h>
#include <asm/ptrace.h>
#include <asm/spr-regs.h>
 
.macro DEBUG ch
#    sethi.p        %hi(0xfeff9c00),gr4
#    setlo        %lo(0xfeff9c00),gr4
#    setlos        #\ch,gr5
#    stbi        gr5,@(gr4,#0)
#    membar
.endm
 
   .section    .rodata
 
   # sizes corresponding to TPXR.LMAX
   .balign        1
__tlb_lmax_sizes:
   .byte        0, 64, 0, 0
   .byte        0, 0, 0, 0
   .byte        0, 0, 0, 0
   .byte        0, 0, 0, 0
 
   .section    .text
   .balign        4
 
###############################################################################
#
# flush everything
# - void __flush_tlb_all(void)
#
###############################################################################
   .globl        __flush_tlb_all
   .type        __flush_tlb_all,@function
__flush_tlb_all:
   DEBUG        'A'
 
   # kill cached PGE value
   setlos        #0xffffffff,gr4
   movgs        gr4,scr0
   movgs        gr4,scr1
 
   # kill AMPR-cached TLB values
   movgs        gr0,iamlr1
   movgs        gr0,iampr1
   movgs        gr0,damlr1
   movgs        gr0,dampr1
 
   # find out how many lines there are
   movsg        tpxr,gr5
   sethi.p        %hi(__tlb_lmax_sizes),gr4
   srli        gr5,#TPXR_LMAX_SHIFT,gr5
   setlo.p        %lo(__tlb_lmax_sizes),gr4
   andi        gr5,#TPXR_LMAX_SMASK,gr5
   ldub        @(gr4,gr5),gr4
 
   # now, we assume that the TLB line step is page size in size
   setlos.p    #PAGE_SIZE,gr5
   setlos        #0,gr6
1:
   tlbpr        gr6,gr0,#6,#0
   subicc.p    gr4,#1,gr4,icc0
   add        gr6,gr5,gr6
   bne        icc0,#2,1b
 
   DEBUG        'B'
   bralr
 
   .size        __flush_tlb_all, .-__flush_tlb_all
 
###############################################################################
#
# flush everything to do with one context
# - void __flush_tlb_mm(unsigned long contextid [GR8])
#
###############################################################################
   .globl        __flush_tlb_mm
   .type        __flush_tlb_mm,@function
__flush_tlb_mm:
   DEBUG        'M'
 
   # kill cached PGE value
   setlos        #0xffffffff,gr4
   movgs        gr4,scr0
   movgs        gr4,scr1
 
   # specify the context we want to flush
   movgs        gr8,tplr
 
   # find out how many lines there are
   movsg        tpxr,gr5
   sethi.p        %hi(__tlb_lmax_sizes),gr4
   srli        gr5,#TPXR_LMAX_SHIFT,gr5
   setlo.p        %lo(__tlb_lmax_sizes),gr4
   andi        gr5,#TPXR_LMAX_SMASK,gr5
   ldub        @(gr4,gr5),gr4
 
   # now, we assume that the TLB line step is page size in size
   setlos.p    #PAGE_SIZE,gr5
   setlos        #0,gr6
0:
   tlbpr        gr6,gr0,#5,#0
   subicc.p    gr4,#1,gr4,icc0
   add        gr6,gr5,gr6
   bne        icc0,#2,0b
 
   DEBUG        'N'
   bralr
 
   .size        __flush_tlb_mm, .-__flush_tlb_mm
 
###############################################################################
#
# flush a range of addresses from the TLB
# - void __flush_tlb_page(unsigned long contextid [GR8],
#              unsigned long start [GR9])
#
###############################################################################
   .globl        __flush_tlb_page
   .type        __flush_tlb_page,@function
__flush_tlb_page:
   # kill cached PGE value
   setlos        #0xffffffff,gr4
   movgs        gr4,scr0
   movgs        gr4,scr1
 
   # specify the context we want to flush
   movgs        gr8,tplr
 
   # zap the matching TLB line and AMR values
   setlos        #~(PAGE_SIZE-1),gr5
   and        gr9,gr5,gr9
   tlbpr        gr9,gr0,#5,#0
 
   bralr
 
   .size        __flush_tlb_page, .-__flush_tlb_page
 
###############################################################################
#
# flush a range of addresses from the TLB
# - void __flush_tlb_range(unsigned long contextid [GR8],
#               unsigned long start [GR9],
#               unsigned long end [GR10])
#
###############################################################################
   .globl        __flush_tlb_range
   .type        __flush_tlb_range,@function
__flush_tlb_range:
   # kill cached PGE value
   setlos        #0xffffffff,gr4
   movgs        gr4,scr0
   movgs        gr4,scr1
 
   # specify the context we want to flush
   movgs        gr8,tplr
 
   # round the start down to beginning of TLB line and end up to beginning of next TLB line
   setlos.p    #~(PAGE_SIZE-1),gr5
   setlos        #PAGE_SIZE,gr6
   subi.p        gr10,#1,gr10
   and        gr9,gr5,gr9
   and        gr10,gr5,gr10
2:
   tlbpr        gr9,gr0,#5,#0
   subcc.p        gr9,gr10,gr0,icc0
   add        gr9,gr6,gr9
   bne        icc0,#0,2b        ; most likely a 1-page flush
 
   bralr
 
   .size        __flush_tlb_range, .-__flush_tlb_range