initial commit
[freebsd-arm:freebsd-arm.git] / arm / include / asmacros.h
1 /*      $NetBSD: frame.h,v 1.6 2003/10/05 19:44:58 matt Exp $   */
2
3 /*-
4  * Copyright (c) 1994-1997 Mark Brinicombe.
5  * Copyright (c) 1994 Brini.
6  * All rights reserved.
7  *
8  * This code is derived from software written for Brini by Mark Brinicombe
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  * 3. All advertising materials mentioning features or use of this software
19  *    must display the following acknowledgement:
20  *      This product includes software developed by Brini.
21  * 4. The name of the company nor the name of the author may be used to
22  *    endorse or promote products derived from this software without specific
23  *    prior written permission.
24  *
25  * THIS SOFTWARE IS PROVIDED BY BRINI ``AS IS'' AND ANY EXPRESS OR IMPLIED
26  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
27  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
28  * IN NO EVENT SHALL BRINI OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
29  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
30  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
31  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
33  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
34  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35  * SUCH DAMAGE.
36  *
37  * $FreeBSD$
38  */
39
40 #ifndef _MACHINE_ASMACROS_H_
41 #define _MACHINE_ASMACROS_H_
42
43 #ifdef _KERNEL
44
45 #ifdef LOCORE
46
47 /*
48  * ASM macros for pushing and pulling trapframes from the stack
49  *
50  * These macros are used to handle the irqframe and trapframe structures
51  * defined above.
52  */
53
54 /*
55  * PUSHFRAME - macro to push a trap frame on the stack in the current mode
56  * Since the current mode is used, the SVC lr field is not defined.
57  *
58  * NOTE: r13 and r14 are stored separately as a work around for the
59  * SA110 rev 2 STM^ bug
60  */
61
62 #define PUSHFRAME                                                          \
63         str     lr, [sp, #-4]!;         /* Push the return address */      \
64         sub     sp, sp, #(4*17);        /* Adjust the stack pointer */     \
65         stmia   sp, {r0-r12};           /* Push the user mode registers */ \
66         add     r0, sp, #(4*13);        /* Adjust the stack pointer */     \
67         stmia   r0, {r13-r14}^;         /* Push the user mode registers */ \
68         mov     r0, r0;                 /* NOP for previous instruction */ \
69         mrs     r0, spsr_all;           /* Put the SPSR on the stack */    \
70         str     r0, [sp, #-4]!;                                            \
71         ldr     r0, =ARM_RAS_START;                                        \
72         mov     r1, #0;                                                    \
73         str     r1, [r0];                                                  \
74         ldr     r0, =ARM_RAS_END;                                          \
75         mov     r1, #0xffffffff;                                           \
76         str     r1, [r0];
77
78 /*
79  * PULLFRAME - macro to pull a trap frame from the stack in the current mode
80  * Since the current mode is used, the SVC lr field is ignored.
81  */
82
83 #define PULLFRAME                                                          \
84         ldr     r0, [sp], #0x0004;      /* Get the SPSR from stack */      \
85         msr     spsr_all, r0;                                              \
86         ldmia   sp, {r0-r14}^;          /* Restore registers (usr mode) */ \
87         mov     r0, r0;                 /* NOP for previous instruction */ \
88         add     sp, sp, #(4*17);        /* Adjust the stack pointer */     \
89         ldr     lr, [sp], #0x0004;      /* Pull the return address */
90
91 /*
92  * PUSHFRAMEINSVC - macro to push a trap frame on the stack in SVC32 mode
93  * This should only be used if the processor is not currently in SVC32
94  * mode. The processor mode is switched to SVC mode and the trap frame is
95  * stored. The SVC lr field is used to store the previous value of
96  * lr in SVC mode.  
97  *
98  * NOTE: r13 and r14 are stored separately as a work around for the
99  * SA110 rev 2 STM^ bug
100  */
101
102 #define PUSHFRAMEINSVC                                                     \
103         stmdb   sp, {r0-r3};            /* Save 4 registers */             \
104         mov     r0, lr;                 /* Save xxx32 r14 */               \
105         mov     r1, sp;                 /* Save xxx32 sp */                \
106         mrs     r3, spsr;               /* Save xxx32 spsr */              \
107         mrs     r2, cpsr;               /* Get the CPSR */                 \
108         bic     r2, r2, #(PSR_MODE);    /* Fix for SVC mode */             \
109         orr     r2, r2, #(PSR_SVC32_MODE);                                 \
110         msr     cpsr_c, r2;             /* Punch into SVC mode */          \
111         mov     r2, sp;                 /* Save SVC sp */                  \
112         str     r0, [sp, #-4]!;         /* Push return address */          \
113         str     lr, [sp, #-4]!;         /* Push SVC lr */                  \
114         str     r2, [sp, #-4]!;         /* Push SVC sp */                  \
115         msr     spsr_all, r3;           /* Restore correct spsr */         \
116         ldmdb   r1, {r0-r3};            /* Restore 4 regs from xxx mode */ \
117         sub     sp, sp, #(4*15);        /* Adjust the stack pointer */     \
118         stmia   sp, {r0-r12};           /* Push the user mode registers */ \
119         add     r0, sp, #(4*13);        /* Adjust the stack pointer */     \
120         stmia   r0, {r13-r14}^;         /* Push the user mode registers */ \
121         mov     r0, r0;                 /* NOP for previous instruction */ \
122         ldr     r5, =ARM_RAS_START;     /* Check if there's any RAS */     \
123         ldr     r3, [r5];                                                  \
124         cmp     r3, #0;                 /* Is the update needed ? */       \
125         ldrgt   lr, [r0, #16];                                             \
126         ldrgt   r1, =ARM_RAS_END;                                          \
127         ldrgt   r4, [r1];               /* Get the end of the RAS */       \
128         movgt   r2, #0;                 /* Reset the magic addresses */    \
129         strgt   r2, [r5];                                                  \
130         movgt   r2, #0xffffffff;                                           \
131         strgt   r2, [r1];                                                  \
132         cmpgt   lr, r3;                 /* Were we in the RAS ? */         \
133         cmpgt   r4, lr;                                                    \
134         strgt   r3, [r0, #16];          /* Yes, update the pc */           \
135         mrs     r0, spsr_all;           /* Put the SPSR on the stack */    \
136         str     r0, [sp, #-4]!
137
138 /*
139  * PULLFRAMEFROMSVCANDEXIT - macro to pull a trap frame from the stack
140  * in SVC32 mode and restore the saved processor mode and PC.
141  * This should be used when the SVC lr register needs to be restored on
142  * exit.
143  */
144
145 #define PULLFRAMEFROMSVCANDEXIT                                            \
146         ldr     r0, [sp], #0x0004;      /* Get the SPSR from stack */      \
147         msr     spsr_all, r0;           /* restore SPSR */                 \
148         ldmia   sp, {r0-r14}^;          /* Restore registers (usr mode) */ \
149         mov     r0, r0;                 /* NOP for previous instruction */ \
150         add     sp, sp, #(4*15);        /* Adjust the stack pointer */     \
151         ldmia   sp, {sp, lr, pc}^       /* Restore lr and exit */
152
153 #define DATA(name) \
154         .data ; \
155         _ALIGN_DATA ; \
156         .globl  name ; \
157         .type   name, %object ; \
158 name:
159
160 #define EMPTY
161
162                 
163 #define DO_AST                                                          \
164         ldr     r0, [sp]                /* Get the SPSR from stack */   ;\
165         mrs     r4, cpsr                /* save CPSR */                 ;\
166         orr     r1, r4, #(I32_bit|F32_bit)                              ;\
167         msr     cpsr_c, r1              /* Disable interrupts */        ;\
168         and     r0, r0, #(PSR_MODE)     /* Returning to USR mode? */    ;\
169         teq     r0, #(PSR_USR32_MODE)                                   ;\
170         bne     2f                      /* Nope, get out now */         ;\
171         bic     r4, r4, #(I32_bit|F32_bit)                              ;\
172 1:      ldr     r5, .Lcurthread                                         ;\
173         ldr     r5, [r5]                                                ;\
174         ldr     r1, [r5, #(TD_FLAGS)]                                   ;\
175         and     r1, r1, #(TDF_ASTPENDING|TDF_NEEDRESCHED)               ;\
176         teq     r1, #0x00000000                                         ;\
177         beq     2f                      /* Nope. Just bail */           ;\
178         msr     cpsr_c, r4              /* Restore interrupts */        ;\
179         mov     r0, sp                                                  ;\
180         bl      _C_LABEL(ast)           /* ast(frame) */                ;\
181         orr     r0, r4, #(I32_bit|F32_bit)                              ;\
182         msr     cpsr_c, r0                                              ;\
183         b       1b                                                      ;\
184 2:
185
186
187 #define AST_LOCALS                                                      ;\
188 .Lcurthread:                                                            ;\
189         .word   _C_LABEL(__pcpu) + PC_CURTHREAD
190
191 #endif /* LOCORE */
192
193 #endif /* _KERNEL */
194
195 #endif /* !_MACHINE_ASMACROS_H_ */