Linux Audio

Check our new training course

Loading...
v4.17
 
  1/*
  2 *  linux/arch/arm/mm/cache-v6.S
  3 *
  4 *  Copyright (C) 2001 Deep Blue Solutions Ltd.
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License version 2 as
  8 * published by the Free Software Foundation.
  9 *
 10 *  This is the "shell" of the ARMv6 processor support.
 11 */
 12#include <linux/linkage.h>
 13#include <linux/init.h>
 14#include <asm/assembler.h>
 15#include <asm/errno.h>
 16#include <asm/unwind.h>
 17
 18#include "proc-macros.S"
 19
 20#define HARVARD_CACHE
 21#define CACHE_LINE_SIZE		32
 22#define D_CACHE_LINE_SIZE	32
 23#define BTB_FLUSH_SIZE		8
 24
 25/*
 26 *	v6_flush_icache_all()
 27 *
 28 *	Flush the whole I-cache.
 29 *
 30 *	ARM1136 erratum 411920 - Invalidate Instruction Cache operation can fail.
 31 *	This erratum is present in 1136, 1156 and 1176. It does not affect the
 32 *	MPCore.
 33 *
 34 *	Registers:
 35 *	r0 - set to 0
 36 *	r1 - corrupted
 37 */
 38ENTRY(v6_flush_icache_all)
 39	mov	r0, #0
 40#ifdef CONFIG_ARM_ERRATA_411920
 41	mrs	r1, cpsr
 42	cpsid	ifa				@ disable interrupts
 43	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 44	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 45	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 46	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 47	msr	cpsr_cx, r1			@ restore interrupts
 48	.rept	11				@ ARM Ltd recommends at least
 49	nop					@ 11 NOPs
 50	.endr
 51#else
 52	mcr	p15, 0, r0, c7, c5, 0		@ invalidate I-cache
 53#endif
 54	ret	lr
 55ENDPROC(v6_flush_icache_all)
 56
 57/*
 58 *	v6_flush_cache_all()
 59 *
 60 *	Flush the entire cache.
 61 *
 62 *	It is assumed that:
 63 */
 64ENTRY(v6_flush_kern_cache_all)
 65	mov	r0, #0
 66#ifdef HARVARD_CACHE
 67	mcr	p15, 0, r0, c7, c14, 0		@ D cache clean+invalidate
 68#ifndef CONFIG_ARM_ERRATA_411920
 69	mcr	p15, 0, r0, c7, c5, 0		@ I+BTB cache invalidate
 70#else
 71	b	v6_flush_icache_all
 72#endif
 73#else
 74	mcr	p15, 0, r0, c7, c15, 0		@ Cache clean+invalidate
 75#endif
 76	ret	lr
 77
 78/*
 79 *	v6_flush_cache_all()
 80 *
 81 *	Flush all TLB entries in a particular address space
 82 *
 83 *	- mm    - mm_struct describing address space
 84 */
 85ENTRY(v6_flush_user_cache_all)
 86	/*FALLTHROUGH*/
 87
 88/*
 89 *	v6_flush_cache_range(start, end, flags)
 90 *
 91 *	Flush a range of TLB entries in the specified address space.
 92 *
 93 *	- start - start address (may not be aligned)
 94 *	- end   - end address (exclusive, may not be aligned)
 95 *	- flags	- vm_area_struct flags describing address space
 96 *
 97 *	It is assumed that:
 98 *	- we have a VIPT cache.
 99 */
100ENTRY(v6_flush_user_cache_range)
101	ret	lr
102
103/*
104 *	v6_coherent_kern_range(start,end)
105 *
106 *	Ensure that the I and D caches are coherent within specified
107 *	region.  This is typically used when code has been written to
108 *	a memory region, and will be executed.
109 *
110 *	- start   - virtual start address of region
111 *	- end     - virtual end address of region
112 *
113 *	It is assumed that:
114 *	- the Icache does not read data from the write buffer
115 */
116ENTRY(v6_coherent_kern_range)
117	/* FALLTHROUGH */
118
119/*
120 *	v6_coherent_user_range(start,end)
121 *
122 *	Ensure that the I and D caches are coherent within specified
123 *	region.  This is typically used when code has been written to
124 *	a memory region, and will be executed.
125 *
126 *	- start   - virtual start address of region
127 *	- end     - virtual end address of region
128 *
129 *	It is assumed that:
130 *	- the Icache does not read data from the write buffer
131 */
132ENTRY(v6_coherent_user_range)
133 UNWIND(.fnstart		)
134#ifdef HARVARD_CACHE
135	bic	r0, r0, #CACHE_LINE_SIZE - 1
1361:
137 USER(	mcr	p15, 0, r0, c7, c10, 1	)	@ clean D line
138	add	r0, r0, #CACHE_LINE_SIZE
139	cmp	r0, r1
140	blo	1b
141#endif
142	mov	r0, #0
143#ifdef HARVARD_CACHE
144	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
145#ifndef CONFIG_ARM_ERRATA_411920
146	mcr	p15, 0, r0, c7, c5, 0		@ I+BTB cache invalidate
147#else
148	b	v6_flush_icache_all
149#endif
150#else
151	mcr	p15, 0, r0, c7, c5, 6		@ invalidate BTB
152#endif
153	ret	lr
154
155/*
156 * Fault handling for the cache operation above. If the virtual address in r0
157 * isn't mapped, fail with -EFAULT.
158 */
1599001:
160	mov	r0, #-EFAULT
161	ret	lr
162 UNWIND(.fnend		)
163ENDPROC(v6_coherent_user_range)
164ENDPROC(v6_coherent_kern_range)
165
166/*
167 *	v6_flush_kern_dcache_area(void *addr, size_t size)
168 *
169 *	Ensure that the data held in the page kaddr is written back
170 *	to the page in question.
171 *
172 *	- addr	- kernel address
173 *	- size	- region size
174 */
175ENTRY(v6_flush_kern_dcache_area)
176	add	r1, r0, r1
177	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
1781:
179#ifdef HARVARD_CACHE
180	mcr	p15, 0, r0, c7, c14, 1		@ clean & invalidate D line
181#else
182	mcr	p15, 0, r0, c7, c15, 1		@ clean & invalidate unified line
183#endif	
184	add	r0, r0, #D_CACHE_LINE_SIZE
185	cmp	r0, r1
186	blo	1b
187#ifdef HARVARD_CACHE
188	mov	r0, #0
189	mcr	p15, 0, r0, c7, c10, 4
190#endif
191	ret	lr
192
193
194/*
195 *	v6_dma_inv_range(start,end)
196 *
197 *	Invalidate the data cache within the specified region; we will
198 *	be performing a DMA operation in this region and we want to
199 *	purge old data in the cache.
200 *
201 *	- start   - virtual start address of region
202 *	- end     - virtual end address of region
203 */
204v6_dma_inv_range:
205#ifdef CONFIG_DMA_CACHE_RWFO
206	ldrb	r2, [r0]			@ read for ownership
207	strb	r2, [r0]			@ write for ownership
208#endif
209	tst	r0, #D_CACHE_LINE_SIZE - 1
210	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
211#ifdef HARVARD_CACHE
212	mcrne	p15, 0, r0, c7, c10, 1		@ clean D line
213#else
214	mcrne	p15, 0, r0, c7, c11, 1		@ clean unified line
215#endif
216	tst	r1, #D_CACHE_LINE_SIZE - 1
217#ifdef CONFIG_DMA_CACHE_RWFO
218	ldrneb	r2, [r1, #-1]			@ read for ownership
219	strneb	r2, [r1, #-1]			@ write for ownership
220#endif
221	bic	r1, r1, #D_CACHE_LINE_SIZE - 1
222#ifdef HARVARD_CACHE
223	mcrne	p15, 0, r1, c7, c14, 1		@ clean & invalidate D line
224#else
225	mcrne	p15, 0, r1, c7, c15, 1		@ clean & invalidate unified line
226#endif
2271:
228#ifdef HARVARD_CACHE
229	mcr	p15, 0, r0, c7, c6, 1		@ invalidate D line
230#else
231	mcr	p15, 0, r0, c7, c7, 1		@ invalidate unified line
232#endif
233	add	r0, r0, #D_CACHE_LINE_SIZE
234	cmp	r0, r1
235#ifdef CONFIG_DMA_CACHE_RWFO
236	ldrlo	r2, [r0]			@ read for ownership
237	strlo	r2, [r0]			@ write for ownership
238#endif
239	blo	1b
240	mov	r0, #0
241	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
242	ret	lr
243
244/*
245 *	v6_dma_clean_range(start,end)
246 *	- start   - virtual start address of region
247 *	- end     - virtual end address of region
248 */
249v6_dma_clean_range:
250	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
2511:
252#ifdef CONFIG_DMA_CACHE_RWFO
253	ldr	r2, [r0]			@ read for ownership
254#endif
255#ifdef HARVARD_CACHE
256	mcr	p15, 0, r0, c7, c10, 1		@ clean D line
257#else
258	mcr	p15, 0, r0, c7, c11, 1		@ clean unified line
259#endif
260	add	r0, r0, #D_CACHE_LINE_SIZE
261	cmp	r0, r1
262	blo	1b
263	mov	r0, #0
264	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
265	ret	lr
266
267/*
268 *	v6_dma_flush_range(start,end)
269 *	- start   - virtual start address of region
270 *	- end     - virtual end address of region
271 */
272ENTRY(v6_dma_flush_range)
273#ifdef CONFIG_DMA_CACHE_RWFO
274	ldrb	r2, [r0]		@ read for ownership
275	strb	r2, [r0]		@ write for ownership
276#endif
277	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
2781:
279#ifdef HARVARD_CACHE
280	mcr	p15, 0, r0, c7, c14, 1		@ clean & invalidate D line
281#else
282	mcr	p15, 0, r0, c7, c15, 1		@ clean & invalidate line
283#endif
284	add	r0, r0, #D_CACHE_LINE_SIZE
285	cmp	r0, r1
286#ifdef CONFIG_DMA_CACHE_RWFO
287	ldrlob	r2, [r0]			@ read for ownership
288	strlob	r2, [r0]			@ write for ownership
289#endif
290	blo	1b
291	mov	r0, #0
292	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
293	ret	lr
294
295/*
296 *	dma_map_area(start, size, dir)
297 *	- start	- kernel virtual start address
298 *	- size	- size of region
299 *	- dir	- DMA direction
300 */
301ENTRY(v6_dma_map_area)
302	add	r1, r1, r0
303	teq	r2, #DMA_FROM_DEVICE
304	beq	v6_dma_inv_range
305#ifndef CONFIG_DMA_CACHE_RWFO
306	b	v6_dma_clean_range
307#else
308	teq	r2, #DMA_TO_DEVICE
309	beq	v6_dma_clean_range
310	b	v6_dma_flush_range
311#endif
312ENDPROC(v6_dma_map_area)
313
314/*
315 *	dma_unmap_area(start, size, dir)
316 *	- start	- kernel virtual start address
317 *	- size	- size of region
318 *	- dir	- DMA direction
319 */
320ENTRY(v6_dma_unmap_area)
321#ifndef CONFIG_DMA_CACHE_RWFO
322	add	r1, r1, r0
323	teq	r2, #DMA_TO_DEVICE
324	bne	v6_dma_inv_range
325#endif
326	ret	lr
327ENDPROC(v6_dma_unmap_area)
328
329	.globl	v6_flush_kern_cache_louis
330	.equ	v6_flush_kern_cache_louis, v6_flush_kern_cache_all
331
332	__INITDATA
333
334	@ define struct cpu_cache_fns (see <asm/cacheflush.h> and proc-macros.S)
335	define_cache_functions v6
v5.14.15
  1/* SPDX-License-Identifier: GPL-2.0-only */
  2/*
  3 *  linux/arch/arm/mm/cache-v6.S
  4 *
  5 *  Copyright (C) 2001 Deep Blue Solutions Ltd.
  6 *
 
 
 
 
  7 *  This is the "shell" of the ARMv6 processor support.
  8 */
  9#include <linux/linkage.h>
 10#include <linux/init.h>
 11#include <asm/assembler.h>
 12#include <asm/errno.h>
 13#include <asm/unwind.h>
 14
 15#include "proc-macros.S"
 16
 17#define HARVARD_CACHE
 18#define CACHE_LINE_SIZE		32
 19#define D_CACHE_LINE_SIZE	32
 20#define BTB_FLUSH_SIZE		8
 21
 22/*
 23 *	v6_flush_icache_all()
 24 *
 25 *	Flush the whole I-cache.
 26 *
 27 *	ARM1136 erratum 411920 - Invalidate Instruction Cache operation can fail.
 28 *	This erratum is present in 1136, 1156 and 1176. It does not affect the
 29 *	MPCore.
 30 *
 31 *	Registers:
 32 *	r0 - set to 0
 33 *	r1 - corrupted
 34 */
 35ENTRY(v6_flush_icache_all)
 36	mov	r0, #0
 37#ifdef CONFIG_ARM_ERRATA_411920
 38	mrs	r1, cpsr
 39	cpsid	ifa				@ disable interrupts
 40	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 41	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 42	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 43	mcr	p15, 0, r0, c7, c5, 0		@ invalidate entire I-cache
 44	msr	cpsr_cx, r1			@ restore interrupts
 45	.rept	11				@ ARM Ltd recommends at least
 46	nop					@ 11 NOPs
 47	.endr
 48#else
 49	mcr	p15, 0, r0, c7, c5, 0		@ invalidate I-cache
 50#endif
 51	ret	lr
 52ENDPROC(v6_flush_icache_all)
 53
 54/*
 55 *	v6_flush_cache_all()
 56 *
 57 *	Flush the entire cache.
 58 *
 59 *	It is assumed that:
 60 */
 61ENTRY(v6_flush_kern_cache_all)
 62	mov	r0, #0
 63#ifdef HARVARD_CACHE
 64	mcr	p15, 0, r0, c7, c14, 0		@ D cache clean+invalidate
 65#ifndef CONFIG_ARM_ERRATA_411920
 66	mcr	p15, 0, r0, c7, c5, 0		@ I+BTB cache invalidate
 67#else
 68	b	v6_flush_icache_all
 69#endif
 70#else
 71	mcr	p15, 0, r0, c7, c15, 0		@ Cache clean+invalidate
 72#endif
 73	ret	lr
 74
 75/*
 76 *	v6_flush_cache_all()
 77 *
 78 *	Flush all TLB entries in a particular address space
 79 *
 80 *	- mm    - mm_struct describing address space
 81 */
 82ENTRY(v6_flush_user_cache_all)
 83	/*FALLTHROUGH*/
 84
 85/*
 86 *	v6_flush_cache_range(start, end, flags)
 87 *
 88 *	Flush a range of TLB entries in the specified address space.
 89 *
 90 *	- start - start address (may not be aligned)
 91 *	- end   - end address (exclusive, may not be aligned)
 92 *	- flags	- vm_area_struct flags describing address space
 93 *
 94 *	It is assumed that:
 95 *	- we have a VIPT cache.
 96 */
 97ENTRY(v6_flush_user_cache_range)
 98	ret	lr
 99
100/*
101 *	v6_coherent_kern_range(start,end)
102 *
103 *	Ensure that the I and D caches are coherent within specified
104 *	region.  This is typically used when code has been written to
105 *	a memory region, and will be executed.
106 *
107 *	- start   - virtual start address of region
108 *	- end     - virtual end address of region
109 *
110 *	It is assumed that:
111 *	- the Icache does not read data from the write buffer
112 */
113ENTRY(v6_coherent_kern_range)
114	/* FALLTHROUGH */
115
116/*
117 *	v6_coherent_user_range(start,end)
118 *
119 *	Ensure that the I and D caches are coherent within specified
120 *	region.  This is typically used when code has been written to
121 *	a memory region, and will be executed.
122 *
123 *	- start   - virtual start address of region
124 *	- end     - virtual end address of region
125 *
126 *	It is assumed that:
127 *	- the Icache does not read data from the write buffer
128 */
129ENTRY(v6_coherent_user_range)
130 UNWIND(.fnstart		)
131#ifdef HARVARD_CACHE
132	bic	r0, r0, #CACHE_LINE_SIZE - 1
1331:
134 USER(	mcr	p15, 0, r0, c7, c10, 1	)	@ clean D line
135	add	r0, r0, #CACHE_LINE_SIZE
136	cmp	r0, r1
137	blo	1b
138#endif
139	mov	r0, #0
140#ifdef HARVARD_CACHE
141	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
142#ifndef CONFIG_ARM_ERRATA_411920
143	mcr	p15, 0, r0, c7, c5, 0		@ I+BTB cache invalidate
144#else
145	b	v6_flush_icache_all
146#endif
147#else
148	mcr	p15, 0, r0, c7, c5, 6		@ invalidate BTB
149#endif
150	ret	lr
151
152/*
153 * Fault handling for the cache operation above. If the virtual address in r0
154 * isn't mapped, fail with -EFAULT.
155 */
1569001:
157	mov	r0, #-EFAULT
158	ret	lr
159 UNWIND(.fnend		)
160ENDPROC(v6_coherent_user_range)
161ENDPROC(v6_coherent_kern_range)
162
163/*
164 *	v6_flush_kern_dcache_area(void *addr, size_t size)
165 *
166 *	Ensure that the data held in the page kaddr is written back
167 *	to the page in question.
168 *
169 *	- addr	- kernel address
170 *	- size	- region size
171 */
172ENTRY(v6_flush_kern_dcache_area)
173	add	r1, r0, r1
174	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
1751:
176#ifdef HARVARD_CACHE
177	mcr	p15, 0, r0, c7, c14, 1		@ clean & invalidate D line
178#else
179	mcr	p15, 0, r0, c7, c15, 1		@ clean & invalidate unified line
180#endif	
181	add	r0, r0, #D_CACHE_LINE_SIZE
182	cmp	r0, r1
183	blo	1b
184#ifdef HARVARD_CACHE
185	mov	r0, #0
186	mcr	p15, 0, r0, c7, c10, 4
187#endif
188	ret	lr
189
190
191/*
192 *	v6_dma_inv_range(start,end)
193 *
194 *	Invalidate the data cache within the specified region; we will
195 *	be performing a DMA operation in this region and we want to
196 *	purge old data in the cache.
197 *
198 *	- start   - virtual start address of region
199 *	- end     - virtual end address of region
200 */
201v6_dma_inv_range:
202#ifdef CONFIG_DMA_CACHE_RWFO
203	ldrb	r2, [r0]			@ read for ownership
204	strb	r2, [r0]			@ write for ownership
205#endif
206	tst	r0, #D_CACHE_LINE_SIZE - 1
207	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
208#ifdef HARVARD_CACHE
209	mcrne	p15, 0, r0, c7, c10, 1		@ clean D line
210#else
211	mcrne	p15, 0, r0, c7, c11, 1		@ clean unified line
212#endif
213	tst	r1, #D_CACHE_LINE_SIZE - 1
214#ifdef CONFIG_DMA_CACHE_RWFO
215	ldrbne	r2, [r1, #-1]			@ read for ownership
216	strbne	r2, [r1, #-1]			@ write for ownership
217#endif
218	bic	r1, r1, #D_CACHE_LINE_SIZE - 1
219#ifdef HARVARD_CACHE
220	mcrne	p15, 0, r1, c7, c14, 1		@ clean & invalidate D line
221#else
222	mcrne	p15, 0, r1, c7, c15, 1		@ clean & invalidate unified line
223#endif
2241:
225#ifdef HARVARD_CACHE
226	mcr	p15, 0, r0, c7, c6, 1		@ invalidate D line
227#else
228	mcr	p15, 0, r0, c7, c7, 1		@ invalidate unified line
229#endif
230	add	r0, r0, #D_CACHE_LINE_SIZE
231	cmp	r0, r1
232#ifdef CONFIG_DMA_CACHE_RWFO
233	ldrlo	r2, [r0]			@ read for ownership
234	strlo	r2, [r0]			@ write for ownership
235#endif
236	blo	1b
237	mov	r0, #0
238	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
239	ret	lr
240
241/*
242 *	v6_dma_clean_range(start,end)
243 *	- start   - virtual start address of region
244 *	- end     - virtual end address of region
245 */
246v6_dma_clean_range:
247	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
2481:
249#ifdef CONFIG_DMA_CACHE_RWFO
250	ldr	r2, [r0]			@ read for ownership
251#endif
252#ifdef HARVARD_CACHE
253	mcr	p15, 0, r0, c7, c10, 1		@ clean D line
254#else
255	mcr	p15, 0, r0, c7, c11, 1		@ clean unified line
256#endif
257	add	r0, r0, #D_CACHE_LINE_SIZE
258	cmp	r0, r1
259	blo	1b
260	mov	r0, #0
261	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
262	ret	lr
263
264/*
265 *	v6_dma_flush_range(start,end)
266 *	- start   - virtual start address of region
267 *	- end     - virtual end address of region
268 */
269ENTRY(v6_dma_flush_range)
270#ifdef CONFIG_DMA_CACHE_RWFO
271	ldrb	r2, [r0]		@ read for ownership
272	strb	r2, [r0]		@ write for ownership
273#endif
274	bic	r0, r0, #D_CACHE_LINE_SIZE - 1
2751:
276#ifdef HARVARD_CACHE
277	mcr	p15, 0, r0, c7, c14, 1		@ clean & invalidate D line
278#else
279	mcr	p15, 0, r0, c7, c15, 1		@ clean & invalidate line
280#endif
281	add	r0, r0, #D_CACHE_LINE_SIZE
282	cmp	r0, r1
283#ifdef CONFIG_DMA_CACHE_RWFO
284	ldrblo	r2, [r0]			@ read for ownership
285	strblo	r2, [r0]			@ write for ownership
286#endif
287	blo	1b
288	mov	r0, #0
289	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
290	ret	lr
291
292/*
293 *	dma_map_area(start, size, dir)
294 *	- start	- kernel virtual start address
295 *	- size	- size of region
296 *	- dir	- DMA direction
297 */
298ENTRY(v6_dma_map_area)
299	add	r1, r1, r0
300	teq	r2, #DMA_FROM_DEVICE
301	beq	v6_dma_inv_range
302#ifndef CONFIG_DMA_CACHE_RWFO
303	b	v6_dma_clean_range
304#else
305	teq	r2, #DMA_TO_DEVICE
306	beq	v6_dma_clean_range
307	b	v6_dma_flush_range
308#endif
309ENDPROC(v6_dma_map_area)
310
311/*
312 *	dma_unmap_area(start, size, dir)
313 *	- start	- kernel virtual start address
314 *	- size	- size of region
315 *	- dir	- DMA direction
316 */
317ENTRY(v6_dma_unmap_area)
318#ifndef CONFIG_DMA_CACHE_RWFO
319	add	r1, r1, r0
320	teq	r2, #DMA_TO_DEVICE
321	bne	v6_dma_inv_range
322#endif
323	ret	lr
324ENDPROC(v6_dma_unmap_area)
325
326	.globl	v6_flush_kern_cache_louis
327	.equ	v6_flush_kern_cache_louis, v6_flush_kern_cache_all
328
329	__INITDATA
330
331	@ define struct cpu_cache_fns (see <asm/cacheflush.h> and proc-macros.S)
332	define_cache_functions v6