xref: /openbmc/linux/arch/arm/include/asm/assembler.h (revision e23feb16)
1 /*
2  *  arch/arm/include/asm/assembler.h
3  *
4  *  Copyright (C) 1996-2000 Russell King
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 file contains arm architecture specific defines
11  *  for the different processors.
12  *
13  *  Do not include any C declarations in this file - it is included by
14  *  assembler source.
15  */
16 #ifndef __ASM_ASSEMBLER_H__
17 #define __ASM_ASSEMBLER_H__
18 
19 #ifndef __ASSEMBLY__
20 #error "Only include this from assembly code"
21 #endif
22 
23 #include <asm/ptrace.h>
24 #include <asm/domain.h>
25 #include <asm/opcodes-virt.h>
26 
27 #define IOMEM(x)	(x)
28 
29 /*
30  * Endian independent macros for shifting bytes within registers.
31  */
32 #ifndef __ARMEB__
33 #define pull            lsr
34 #define push            lsl
35 #define get_byte_0      lsl #0
36 #define get_byte_1	lsr #8
37 #define get_byte_2	lsr #16
38 #define get_byte_3	lsr #24
39 #define put_byte_0      lsl #0
40 #define put_byte_1	lsl #8
41 #define put_byte_2	lsl #16
42 #define put_byte_3	lsl #24
43 #else
44 #define pull            lsl
45 #define push            lsr
46 #define get_byte_0	lsr #24
47 #define get_byte_1	lsr #16
48 #define get_byte_2	lsr #8
49 #define get_byte_3      lsl #0
50 #define put_byte_0	lsl #24
51 #define put_byte_1	lsl #16
52 #define put_byte_2	lsl #8
53 #define put_byte_3      lsl #0
54 #endif
55 
56 /*
57  * Data preload for architectures that support it
58  */
59 #if __LINUX_ARM_ARCH__ >= 5
60 #define PLD(code...)	code
61 #else
62 #define PLD(code...)
63 #endif
64 
65 /*
66  * This can be used to enable code to cacheline align the destination
67  * pointer when bulk writing to memory.  Experiments on StrongARM and
68  * XScale didn't show this a worthwhile thing to do when the cache is not
69  * set to write-allocate (this would need further testing on XScale when WA
70  * is used).
71  *
72  * On Feroceon there is much to gain however, regardless of cache mode.
73  */
74 #ifdef CONFIG_CPU_FEROCEON
75 #define CALGN(code...) code
76 #else
77 #define CALGN(code...)
78 #endif
79 
80 /*
81  * Enable and disable interrupts
82  */
83 #if __LINUX_ARM_ARCH__ >= 6
84 	.macro	disable_irq_notrace
85 	cpsid	i
86 	.endm
87 
88 	.macro	enable_irq_notrace
89 	cpsie	i
90 	.endm
91 #else
92 	.macro	disable_irq_notrace
93 	msr	cpsr_c, #PSR_I_BIT | SVC_MODE
94 	.endm
95 
96 	.macro	enable_irq_notrace
97 	msr	cpsr_c, #SVC_MODE
98 	.endm
99 #endif
100 
101 	.macro asm_trace_hardirqs_off
102 #if defined(CONFIG_TRACE_IRQFLAGS)
103 	stmdb   sp!, {r0-r3, ip, lr}
104 	bl	trace_hardirqs_off
105 	ldmia	sp!, {r0-r3, ip, lr}
106 #endif
107 	.endm
108 
109 	.macro asm_trace_hardirqs_on_cond, cond
110 #if defined(CONFIG_TRACE_IRQFLAGS)
111 	/*
112 	 * actually the registers should be pushed and pop'd conditionally, but
113 	 * after bl the flags are certainly clobbered
114 	 */
115 	stmdb   sp!, {r0-r3, ip, lr}
116 	bl\cond	trace_hardirqs_on
117 	ldmia	sp!, {r0-r3, ip, lr}
118 #endif
119 	.endm
120 
121 	.macro asm_trace_hardirqs_on
122 	asm_trace_hardirqs_on_cond al
123 	.endm
124 
125 	.macro disable_irq
126 	disable_irq_notrace
127 	asm_trace_hardirqs_off
128 	.endm
129 
130 	.macro enable_irq
131 	asm_trace_hardirqs_on
132 	enable_irq_notrace
133 	.endm
134 /*
135  * Save the current IRQ state and disable IRQs.  Note that this macro
136  * assumes FIQs are enabled, and that the processor is in SVC mode.
137  */
138 	.macro	save_and_disable_irqs, oldcpsr
139 #ifdef CONFIG_CPU_V7M
140 	mrs	\oldcpsr, primask
141 #else
142 	mrs	\oldcpsr, cpsr
143 #endif
144 	disable_irq
145 	.endm
146 
147 	.macro	save_and_disable_irqs_notrace, oldcpsr
148 	mrs	\oldcpsr, cpsr
149 	disable_irq_notrace
150 	.endm
151 
152 /*
153  * Restore interrupt state previously stored in a register.  We don't
154  * guarantee that this will preserve the flags.
155  */
156 	.macro	restore_irqs_notrace, oldcpsr
157 #ifdef CONFIG_CPU_V7M
158 	msr	primask, \oldcpsr
159 #else
160 	msr	cpsr_c, \oldcpsr
161 #endif
162 	.endm
163 
164 	.macro restore_irqs, oldcpsr
165 	tst	\oldcpsr, #PSR_I_BIT
166 	asm_trace_hardirqs_on_cond eq
167 	restore_irqs_notrace \oldcpsr
168 	.endm
169 
170 #define USER(x...)				\
171 9999:	x;					\
172 	.pushsection __ex_table,"a";		\
173 	.align	3;				\
174 	.long	9999b,9001f;			\
175 	.popsection
176 
177 #ifdef CONFIG_SMP
178 #define ALT_SMP(instr...)					\
179 9998:	instr
180 /*
181  * Note: if you get assembler errors from ALT_UP() when building with
182  * CONFIG_THUMB2_KERNEL, you almost certainly need to use
183  * ALT_SMP( W(instr) ... )
184  */
185 #define ALT_UP(instr...)					\
186 	.pushsection ".alt.smp.init", "a"			;\
187 	.long	9998b						;\
188 9997:	instr							;\
189 	.if . - 9997b != 4					;\
190 		.error "ALT_UP() content must assemble to exactly 4 bytes";\
191 	.endif							;\
192 	.popsection
193 #define ALT_UP_B(label)					\
194 	.equ	up_b_offset, label - 9998b			;\
195 	.pushsection ".alt.smp.init", "a"			;\
196 	.long	9998b						;\
197 	W(b)	. + up_b_offset					;\
198 	.popsection
199 #else
200 #define ALT_SMP(instr...)
201 #define ALT_UP(instr...) instr
202 #define ALT_UP_B(label) b label
203 #endif
204 
205 /*
206  * Instruction barrier
207  */
208 	.macro	instr_sync
209 #if __LINUX_ARM_ARCH__ >= 7
210 	isb
211 #elif __LINUX_ARM_ARCH__ == 6
212 	mcr	p15, 0, r0, c7, c5, 4
213 #endif
214 	.endm
215 
216 /*
217  * SMP data memory barrier
218  */
219 	.macro	smp_dmb mode
220 #ifdef CONFIG_SMP
221 #if __LINUX_ARM_ARCH__ >= 7
222 	.ifeqs "\mode","arm"
223 	ALT_SMP(dmb	ish)
224 	.else
225 	ALT_SMP(W(dmb)	ish)
226 	.endif
227 #elif __LINUX_ARM_ARCH__ == 6
228 	ALT_SMP(mcr	p15, 0, r0, c7, c10, 5)	@ dmb
229 #else
230 #error Incompatible SMP platform
231 #endif
232 	.ifeqs "\mode","arm"
233 	ALT_UP(nop)
234 	.else
235 	ALT_UP(W(nop))
236 	.endif
237 #endif
238 	.endm
239 
240 #if defined(CONFIG_CPU_V7M)
241 	/*
242 	 * setmode is used to assert to be in svc mode during boot. For v7-M
243 	 * this is done in __v7m_setup, so setmode can be empty here.
244 	 */
245 	.macro	setmode, mode, reg
246 	.endm
247 #elif defined(CONFIG_THUMB2_KERNEL)
248 	.macro	setmode, mode, reg
249 	mov	\reg, #\mode
250 	msr	cpsr_c, \reg
251 	.endm
252 #else
253 	.macro	setmode, mode, reg
254 	msr	cpsr_c, #\mode
255 	.endm
256 #endif
257 
258 /*
259  * Helper macro to enter SVC mode cleanly and mask interrupts. reg is
260  * a scratch register for the macro to overwrite.
261  *
262  * This macro is intended for forcing the CPU into SVC mode at boot time.
263  * you cannot return to the original mode.
264  */
265 .macro safe_svcmode_maskall reg:req
266 #if __LINUX_ARM_ARCH__ >= 6
267 	mrs	\reg , cpsr
268 	eor	\reg, \reg, #HYP_MODE
269 	tst	\reg, #MODE_MASK
270 	bic	\reg , \reg , #MODE_MASK
271 	orr	\reg , \reg , #PSR_I_BIT | PSR_F_BIT | SVC_MODE
272 THUMB(	orr	\reg , \reg , #PSR_T_BIT	)
273 	bne	1f
274 	orr	\reg, \reg, #PSR_A_BIT
275 	adr	lr, BSYM(2f)
276 	msr	spsr_cxsf, \reg
277 	__MSR_ELR_HYP(14)
278 	__ERET
279 1:	msr	cpsr_c, \reg
280 2:
281 #else
282 /*
283  * workaround for possibly broken pre-v6 hardware
284  * (akita, Sharp Zaurus C-1000, PXA270-based)
285  */
286 	setmode	PSR_F_BIT | PSR_I_BIT | SVC_MODE, \reg
287 #endif
288 .endm
289 
290 /*
291  * STRT/LDRT access macros with ARM and Thumb-2 variants
292  */
293 #ifdef CONFIG_THUMB2_KERNEL
294 
295 	.macro	usraccoff, instr, reg, ptr, inc, off, cond, abort, t=TUSER()
296 9999:
297 	.if	\inc == 1
298 	\instr\cond\()b\()\t\().w \reg, [\ptr, #\off]
299 	.elseif	\inc == 4
300 	\instr\cond\()\t\().w \reg, [\ptr, #\off]
301 	.else
302 	.error	"Unsupported inc macro argument"
303 	.endif
304 
305 	.pushsection __ex_table,"a"
306 	.align	3
307 	.long	9999b, \abort
308 	.popsection
309 	.endm
310 
311 	.macro	usracc, instr, reg, ptr, inc, cond, rept, abort
312 	@ explicit IT instruction needed because of the label
313 	@ introduced by the USER macro
314 	.ifnc	\cond,al
315 	.if	\rept == 1
316 	itt	\cond
317 	.elseif	\rept == 2
318 	ittt	\cond
319 	.else
320 	.error	"Unsupported rept macro argument"
321 	.endif
322 	.endif
323 
324 	@ Slightly optimised to avoid incrementing the pointer twice
325 	usraccoff \instr, \reg, \ptr, \inc, 0, \cond, \abort
326 	.if	\rept == 2
327 	usraccoff \instr, \reg, \ptr, \inc, \inc, \cond, \abort
328 	.endif
329 
330 	add\cond \ptr, #\rept * \inc
331 	.endm
332 
333 #else	/* !CONFIG_THUMB2_KERNEL */
334 
335 	.macro	usracc, instr, reg, ptr, inc, cond, rept, abort, t=TUSER()
336 	.rept	\rept
337 9999:
338 	.if	\inc == 1
339 	\instr\cond\()b\()\t \reg, [\ptr], #\inc
340 	.elseif	\inc == 4
341 	\instr\cond\()\t \reg, [\ptr], #\inc
342 	.else
343 	.error	"Unsupported inc macro argument"
344 	.endif
345 
346 	.pushsection __ex_table,"a"
347 	.align	3
348 	.long	9999b, \abort
349 	.popsection
350 	.endr
351 	.endm
352 
353 #endif	/* CONFIG_THUMB2_KERNEL */
354 
355 	.macro	strusr, reg, ptr, inc, cond=al, rept=1, abort=9001f
356 	usracc	str, \reg, \ptr, \inc, \cond, \rept, \abort
357 	.endm
358 
359 	.macro	ldrusr, reg, ptr, inc, cond=al, rept=1, abort=9001f
360 	usracc	ldr, \reg, \ptr, \inc, \cond, \rept, \abort
361 	.endm
362 
363 /* Utility macro for declaring string literals */
364 	.macro	string name:req, string
365 	.type \name , #object
366 \name:
367 	.asciz "\string"
368 	.size \name , . - \name
369 	.endm
370 
371 	.macro check_uaccess, addr:req, size:req, limit:req, tmp:req, bad:req
372 #ifndef CONFIG_CPU_USE_DOMAINS
373 	adds	\tmp, \addr, #\size - 1
374 	sbcccs	\tmp, \tmp, \limit
375 	bcs	\bad
376 #endif
377 	.endm
378 
379 #endif /* __ASM_ASSEMBLER_H__ */
380