Blame view

kernel/linux-rt-4.4.41/arch/xtensa/include/asm/initialize_mmu.h 4.02 KB
5113f6f70   김현기   kernel add
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
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
  /*
   * arch/xtensa/include/asm/initialize_mmu.h
   *
   * Initializes MMU:
   *
   *      For the new V3 MMU we remap the TLB from virtual == physical
   *      to the standard Linux mapping used in earlier MMU's.
   *
   *      The the MMU we also support a new configuration register that
   *      specifies how the S32C1I instruction operates with the cache
   *      controller.
   *
   * This file is subject to the terms and conditions of the GNU General
   * Public License.  See the file "COPYING" in the main directory of
   * this archive for more details.
   *
   * Copyright (C) 2008 - 2012 Tensilica, Inc.
   *
   *   Marc Gauthier <marc@tensilica.com>
   *   Pete Delaney <piet@tensilica.com>
   */
  
  #ifndef _XTENSA_INITIALIZE_MMU_H
  #define _XTENSA_INITIALIZE_MMU_H
  
  #include <asm/pgtable.h>
  #include <asm/vectors.h>
  
  #if XCHAL_HAVE_PTP_MMU
  #define CA_BYPASS	(_PAGE_CA_BYPASS | _PAGE_HW_WRITE | _PAGE_HW_EXEC)
  #define CA_WRITEBACK	(_PAGE_CA_WB     | _PAGE_HW_WRITE | _PAGE_HW_EXEC)
  #else
  #define CA_WRITEBACK	(0x4)
  #endif
  
  #ifndef XCHAL_SPANNING_WAY
  #define XCHAL_SPANNING_WAY 0
  #endif
  
  #ifdef __ASSEMBLY__
  
  #define XTENSA_HWVERSION_RC_2009_0 230000
  
  	.macro	initialize_mmu
  
  #if XCHAL_HAVE_S32C1I && (XCHAL_HW_MIN_VERSION >= XTENSA_HWVERSION_RC_2009_0)
  /*
   * We Have Atomic Operation Control (ATOMCTL) Register; Initialize it.
   * For details see Documentation/xtensa/atomctl.txt
   */
  #if XCHAL_DCACHE_IS_COHERENT
  	movi	a3, 0x25	/* For SMP/MX -- internal for writeback,
  				 * RCW otherwise
  				 */
  #else
  	movi	a3, 0x29	/* non-MX -- Most cores use Std Memory
  				 * Controlers which usually can't use RCW
  				 */
  #endif
  	wsr	a3, atomctl
  #endif  /* XCHAL_HAVE_S32C1I &&
  	 * (XCHAL_HW_MIN_VERSION >= XTENSA_HWVERSION_RC_2009_0)
  	 */
  
  #if defined(CONFIG_MMU) && XCHAL_HAVE_PTP_MMU && XCHAL_HAVE_SPANNING_WAY
  /*
   * Have MMU v3
   */
  
  #if !XCHAL_HAVE_VECBASE
  # error "MMU v3 requires reloc vectors"
  #endif
  
  	movi	a1, 0
  	_call0	1f
  	_j	2f
  
  	.align	4
  1:	movi	a2, 0x10000000
  	movi	a3, 0x18000000
  	add	a2, a2, a0
  9:	bgeu	a2, a3, 9b	/* PC is out of the expected range */
  
  	/* Step 1: invalidate mapping at 0x40000000..0x5FFFFFFF. */
  
  	movi	a2, 0x40000000 | XCHAL_SPANNING_WAY
  	idtlb	a2
  	iitlb	a2
  	isync
  
  	/* Step 2: map 0x40000000..0x47FFFFFF to paddr containing this code
  	 * and jump to the new mapping.
  	 */
  
  	srli	a3, a0, 27
  	slli	a3, a3, 27
  	addi	a3, a3, CA_BYPASS
  	addi	a7, a2, -1
  	wdtlb	a3, a7
  	witlb	a3, a7
  	isync
  
  	slli	a4, a0, 5
  	srli	a4, a4, 5
  	addi	a5, a2, -6
  	add	a4, a4, a5
  	jx	a4
  
  	/* Step 3: unmap everything other than current area.
  	 *	   Start at 0x60000000, wrap around, and end with 0x20000000
  	 */
  2:	movi	a4, 0x20000000
  	add	a5, a2, a4
  3:	idtlb	a5
  	iitlb	a5
  	add	a5, a5, a4
  	bne	a5, a2, 3b
  
  	/* Step 4: Setup MMU with the old V2 mappings. */
  	movi	a6, 0x01000000
  	wsr	a6, ITLBCFG
  	wsr	a6, DTLBCFG
  	isync
  
  	movi	a5, 0xd0000005
  	movi	a4, CA_WRITEBACK
  	wdtlb	a4, a5
  	witlb	a4, a5
  
  	movi	a5, 0xd8000005
  	movi	a4, CA_BYPASS
  	wdtlb	a4, a5
  	witlb	a4, a5
  
  	movi	a5, XCHAL_KIO_CACHED_VADDR + 6
  	movi	a4, XCHAL_KIO_DEFAULT_PADDR + CA_WRITEBACK
  	wdtlb	a4, a5
  	witlb	a4, a5
  
  	movi	a5, XCHAL_KIO_BYPASS_VADDR + 6
  	movi	a4, XCHAL_KIO_DEFAULT_PADDR + CA_BYPASS
  	wdtlb	a4, a5
  	witlb	a4, a5
  
  	isync
  
  	/* Jump to self, using MMU v2 mappings. */
  	movi	a4, 1f
  	jx	a4
  
  1:
  	/* Step 5: remove temporary mapping. */
  	idtlb	a7
  	iitlb	a7
  	isync
  
  	movi	a0, 0
  	wsr	a0, ptevaddr
  	rsync
  
  #endif /* defined(CONFIG_MMU) && XCHAL_HAVE_PTP_MMU &&
  	  XCHAL_HAVE_SPANNING_WAY */
  
  #if !defined(CONFIG_MMU) && XCHAL_HAVE_TLBS && \
  		(XCHAL_DCACHE_SIZE || XCHAL_ICACHE_SIZE)
  	/* Enable data and instruction cache in the DEFAULT_MEMORY region
  	 * if the processor has DTLB and ITLB.
  	 */
  
  	movi	a5, PLATFORM_DEFAULT_MEM_START | XCHAL_SPANNING_WAY
  	movi	a6, ~_PAGE_ATTRIB_MASK
  	movi	a7, CA_WRITEBACK
  	movi	a8, 0x20000000
  	movi	a9, PLATFORM_DEFAULT_MEM_SIZE
  	j	2f
  1:
  	sub	a9, a9, a8
  2:
  #if XCHAL_DCACHE_SIZE
  	rdtlb1	a3, a5
  	and	a3, a3, a6
  	or	a3, a3, a7
  	wdtlb	a3, a5
  #endif
  #if XCHAL_ICACHE_SIZE
  	ritlb1	a4, a5
  	and	a4, a4, a6
  	or	a4, a4, a7
  	witlb	a4, a5
  #endif
  	add	a5, a5, a8
  	bltu	a8, a9, 1b
  
  #endif
  
  	.endm
  
  #endif /*__ASSEMBLY__*/
  
  #endif /* _XTENSA_INITIALIZE_MMU_H */