blk: rq_data_dir() should not return a boolean
[cris-mirror.git] / arch / sh / kernel / cpu / sh2 / entry.S
blobc8a4331d9b8d7398e98df914178bb6ed4aed1eb9
1 /*
2  * arch/sh/kernel/cpu/sh2/entry.S
3  *
4  * The SH-2 exception entry
5  *
6  * Copyright (C) 2005-2008 Yoshinori Sato
7  * Copyright (C) 2005  AXE,Inc.
8  *
9  * This file is subject to the terms and conditions of the GNU General Public
10  * License.  See the file "COPYING" in the main directory of this archive
11  * for more details.
12  */
14 #include <linux/linkage.h>
15 #include <asm/asm-offsets.h>
16 #include <asm/thread_info.h>
17 #include <cpu/mmu_context.h>
18 #include <asm/unistd.h>
19 #include <asm/errno.h>
20 #include <asm/page.h>
21         
22 /* Offsets to the stack */
23 OFF_R0  =  0            /* Return value. New ABI also arg4 */
24 OFF_R1  =  4            /* New ABI: arg5 */
25 OFF_R2  =  8            /* New ABI: arg6 */
26 OFF_R3  =  12           /* New ABI: syscall_nr */
27 OFF_R4  =  16           /* New ABI: arg0 */
28 OFF_R5  =  20           /* New ABI: arg1 */
29 OFF_R6  =  24           /* New ABI: arg2 */
30 OFF_R7  =  28           /* New ABI: arg3 */
31 OFF_SP  =  (15*4)
32 OFF_PC  =  (16*4)
33 OFF_SR  =  (16*4+2*4)
34 OFF_TRA =  (16*4+6*4)
36 #include <asm/entry-macros.S>
38 ENTRY(exception_handler)
39         ! stack
40         ! r0 <- point sp
41         ! r1
42         ! pc
43         ! sr
44         ! r0 = temporary
45         ! r1 = vector (pseudo EXPEVT / INTEVT / TRA)
46         mov.l   r2,@-sp
47         mov.l   r3,@-sp
48         cli
49         mov.l   $cpu_mode,r2
50         mov.l   @r2,r0
51         mov.l   @(5*4,r15),r3   ! previous SR
52         or      r0,r3           ! set MD
53         tst     r0,r0
54         bf/s    1f              ! previous mode check
55          mov.l  r3,@(5*4,r15)   ! update SR
56         ! switch to kernel mode
57         mov.l   __md_bit,r0
58         mov.l   r0,@r2          ! enter kernel mode
59         mov.l   $current_thread_info,r2
60         mov.l   @r2,r2
61         mov     #(THREAD_SIZE >> 8),r0
62         shll8   r0
63         add     r2,r0
64         mov     r15,r2          ! r2 = user stack top
65         mov     r0,r15          ! switch kernel stack
66         mov.l   r1,@-r15        ! TRA
67         sts.l   macl, @-r15
68         sts.l   mach, @-r15
69         stc.l   gbr, @-r15
70         mov.l   @(5*4,r2),r0
71         mov.l   r0,@-r15        ! original SR
72         sts.l   pr,@-r15
73         mov.l   @(4*4,r2),r0
74         mov.l   r0,@-r15        ! original PC
75         mov     r2,r3
76         add     #(4+2)*4,r3     ! rewind r0 - r3 + exception frame
77         mov.l   r3,@-r15        ! original SP
78         mov.l   r14,@-r15
79         mov.l   r13,@-r15
80         mov.l   r12,@-r15
81         mov.l   r11,@-r15
82         mov.l   r10,@-r15
83         mov.l   r9,@-r15
84         mov.l   r8,@-r15
85         mov.l   r7,@-r15
86         mov.l   r6,@-r15
87         mov.l   r5,@-r15
88         mov.l   r4,@-r15
89         mov     r1,r9           ! save TRA
90         mov     r2,r8           ! copy user -> kernel stack
91         mov.l   @(0,r8),r3
92         mov.l   r3,@-r15
93         mov.l   @(4,r8),r2
94         mov.l   r2,@-r15
95         mov.l   @(12,r8),r1
96         mov.l   r1,@-r15
97         mov.l   @(8,r8),r0
98         bra     2f
99          mov.l  r0,@-r15
101         ! in kernel exception
102         mov     #(22-4-4-1)*4+4,r0
103         mov     r15,r2
104         sub     r0,r15
105         mov.l   @r2+,r0         ! old R3
106         mov.l   r0,@-r15        
107         mov.l   @r2+,r0         ! old R2
108         mov.l   r0,@-r15        
109         mov.l   @(4,r2),r0      ! old R1
110         mov.l   r0,@-r15        
111         mov.l   @r2,r0          ! old R0
112         mov.l   r0,@-r15
113         add     #8,r2
114         mov.l   @r2+,r3         ! old PC
115         mov.l   @r2+,r0         ! old SR
116         add     #-4,r2          ! exception frame stub (sr)
117         mov.l   r1,@-r2         ! TRA
118         sts.l   macl, @-r2
119         sts.l   mach, @-r2
120         stc.l   gbr, @-r2
121         mov.l   r0,@-r2         ! save old SR
122         sts.l   pr,@-r2
123         mov.l   r3,@-r2         ! save old PC
124         mov     r2,r0
125         add     #8*4,r0
126         mov.l   r0,@-r2         ! save old SP
127         mov.l   r14,@-r2
128         mov.l   r13,@-r2
129         mov.l   r12,@-r2
130         mov.l   r11,@-r2
131         mov.l   r10,@-r2
132         mov.l   r9,@-r2
133         mov.l   r8,@-r2
134         mov.l   r7,@-r2
135         mov.l   r6,@-r2
136         mov.l   r5,@-r2
137         mov.l   r4,@-r2
138         mov     r1,r9
139         mov.l   @(OFF_R0,r15),r0
140         mov.l   @(OFF_R1,r15),r1
141         mov.l   @(OFF_R2,r15),r2
142         mov.l   @(OFF_R3,r15),r3
144         mov     #64,r8
145         cmp/hs  r8,r9
146         bt      interrupt_entry ! vec >= 64 is interrupt
147         mov     #32,r8
148         cmp/hs  r8,r9
149         bt      trap_entry      ! 64 > vec >= 32  is trap
151         mov.l   4f,r8
152         mov     r9,r4
153         shll2   r9
154         add     r9,r8
155         mov.l   @r8,r8          ! exception handler address
156         tst     r8,r8
157         bf      3f
158         mov.l   8f,r8           ! unhandled exception
160         mov.l   5f,r10
161         jmp     @r8
162          lds    r10,pr
164 interrupt_entry:
165         mov     r9,r4
166         mov     r15,r5
167         mov.l   6f,r9
168         mov.l   7f,r8
169         jmp     @r8
170          lds    r9,pr
172         .align  2
173 4:      .long   exception_handling_table
174 5:      .long   ret_from_exception
175 6:      .long   ret_from_irq
176 7:      .long   do_IRQ
177 8:      .long   exception_error
179 trap_entry:
180         mov     #0x30,r8
181         cmp/ge  r8,r9           ! vector 0x20-0x2f is systemcall
182         bt      1f
183         add     #-0x10,r9       ! convert SH2 to SH3/4 ABI
184 1:      
185         shll2   r9                      ! TRA
186         bra     system_call     ! jump common systemcall entry
187          mov    r9,r8
188         
189 #if defined(CONFIG_SH_STANDARD_BIOS)
190         /* Unwind the stack and jmp to the debug entry */
191 ENTRY(sh_bios_handler)
192         mov     r15,r0
193         add     #(22-4)*4-4,r0
194         ldc.l   @r0+,gbr
195         lds.l   @r0+,mach
196         lds.l   @r0+,macl
197         mov     r15,r0
198         mov.l   @(OFF_SP,r0),r1
199         mov     #OFF_SR,r2
200         mov.l   @(r0,r2),r3
201         mov.l   r3,@-r1
202         mov     #OFF_SP,r2
203         mov.l   @(r0,r2),r3
204         mov.l   r3,@-r1
205         mov     r15,r0
206         add     #(22-4)*4-8,r0
207         mov.l   1f,r2
208         mov.l   @r2,r2
209         stc     sr,r3
210         mov.l   r2,@r0
211         mov.l   r3,@(4,r0)
212         mov.l   r1,@(8,r0)      
213         mov.l   @r15+, r0
214         mov.l   @r15+, r1
215         mov.l   @r15+, r2
216         mov.l   @r15+, r3
217         mov.l   @r15+, r4
218         mov.l   @r15+, r5
219         mov.l   @r15+, r6
220         mov.l   @r15+, r7
221         mov.l   @r15+, r8
222         mov.l   @r15+, r9
223         mov.l   @r15+, r10
224         mov.l   @r15+, r11
225         mov.l   @r15+, r12
226         mov.l   @r15+, r13
227         mov.l   @r15+, r14
228         add     #8,r15
229         lds.l   @r15+, pr
230         mov.l   @r15+,r15
231         rte
232          nop
233         .align  2
234 1:      .long   gdb_vbr_vector
235 #endif /* CONFIG_SH_STANDARD_BIOS */
237 ENTRY(address_error_trap_handler)
238         mov     r15,r4                          ! regs
239         mov     #OFF_PC,r0
240         mov.l   @(r0,r15),r6                    ! pc
241         mov.l   1f,r0
242         jmp     @r0
243          mov    #0,r5                           ! writeaccess is unknown
245         .align  2
246 1:      .long   do_address_error
248 restore_all:
249         stc     sr,r0
250         or      #0xf0,r0
251         ldc     r0,sr                           ! all interrupt block (same BL = 1)
252         ! restore special register
253         ! overlap exception frame
254         mov     r15,r0
255         add     #17*4,r0
256         lds.l   @r0+,pr
257         add     #4,r0
258         ldc.l   @r0+,gbr
259         lds.l   @r0+,mach
260         lds.l   @r0+,macl
261         mov     r15,r0
262         mov.l   $cpu_mode,r2
263         mov     #OFF_SR,r3
264         mov.l   @(r0,r3),r1
265         mov.l   __md_bit,r3
266         and     r1,r3                           ! copy MD bit
267         mov.l   r3,@r2
268         shll2   r1                              ! clear MD bit
269         shlr2   r1
270         mov.l   @(OFF_SP,r0),r2
271         add     #-8,r2
272         mov.l   r2,@(OFF_SP,r0)                 ! point exception frame top
273         mov.l   r1,@(4,r2)                      ! set sr
274         mov     #OFF_PC,r3
275         mov.l   @(r0,r3),r1
276         mov.l   r1,@r2                          ! set pc
277         get_current_thread_info r0, r1
278         mov.l   $current_thread_info,r1
279         mov.l   r0,@r1
280         mov.l   @r15+,r0
281         mov.l   @r15+,r1
282         mov.l   @r15+,r2
283         mov.l   @r15+,r3
284         mov.l   @r15+,r4
285         mov.l   @r15+,r5
286         mov.l   @r15+,r6
287         mov.l   @r15+,r7
288         mov.l   @r15+,r8
289         mov.l   @r15+,r9
290         mov.l   @r15+,r10
291         mov.l   @r15+,r11
292         mov.l   @r15+,r12
293         mov.l   @r15+,r13
294         mov.l   @r15+,r14
295         mov.l   @r15,r15
296         rte
297          nop
299         .align 2
300 __md_bit:
301         .long   0x40000000
302 $current_thread_info:
303         .long   __current_thread_info
304 $cpu_mode:      
305         .long   __cpu_mode
306                 
307 ! common exception handler
308 #include "../../entry-common.S"
309         
310         .data
311 ! cpu operation mode 
312 ! bit30 = MD (compatible SH3/4)
313 __cpu_mode:
314         .long   0x40000000
315                 
316         .section        .bss
317 __current_thread_info:
318         .long   0
320 ENTRY(exception_handling_table)
321         .space  4*32