Pull ec into release branch
[linux-2.6] / arch / m32r / kernel / entry.S
1 /*
2  *  linux/arch/m32r/kernel/entry.S
3  *
4  *  Copyright (c) 2001, 2002  Hirokazu Takata, Hitoshi Yamamoto, H. Kondo
5  *  Copyright (c) 2003  Hitoshi Yamamoto
6  *  Copyright (c) 2004  Hirokazu Takata <takata at linux-m32r.org>
7  *
8  *  Taken from i386 version.
9  *    Copyright (C) 1991, 1992  Linus Torvalds
10  */
11
12 /*
13  * entry.S contains the system-call and fault low-level handling routines.
14  * This also contains the timer-interrupt handler, as well as all interrupts
15  * and faults that can result in a task-switch.
16  *
17  * NOTE: This code handles signal-recognition, which happens every time
18  * after a timer-interrupt and after each system call.
19  *
20  * Stack layout in 'ret_from_system_call':
21  *      ptrace needs to have all regs on the stack.
22  *      if the order here is changed, it needs to be
23  *      updated in fork.c:copy_thread, signal.c:do_signal,
24  *      ptrace.c and ptrace.h
25  *
26  * M32Rx/M32R2                          M32R
27  *       @(sp)      - r4                ditto
28  *       @(0x04,sp) - r5                ditto
29  *       @(0x08,sp) - r6                ditto
30  *       @(0x0c,sp) - *pt_regs          ditto
31  *       @(0x10,sp) - r0                ditto
32  *       @(0x14,sp) - r1                ditto
33  *       @(0x18,sp) - r2                ditto
34  *       @(0x1c,sp) - r3                ditto
35  *       @(0x20,sp) - r7                ditto
36  *       @(0x24,sp) - r8                ditto
37  *       @(0x28,sp) - r9                ditto
38  *       @(0x2c,sp) - r10               ditto
39  *       @(0x30,sp) - r11               ditto
40  *       @(0x34,sp) - r12               ditto
41  *       @(0x38,sp) - syscall_nr        ditto
42  *       @(0x3c,sp) - acc0h             @(0x3c,sp) - acch
43  *       @(0x40,sp) - acc0l             @(0x40,sp) - accl
44  *       @(0x44,sp) - acc1h             @(0x44,sp) - dummy_acc1h
45  *       @(0x48,sp) - acc1l             @(0x48,sp) - dummy_acc1l
46  *       @(0x4c,sp) - psw               ditto
47  *       @(0x50,sp) - bpc               ditto
48  *       @(0x54,sp) - bbpsw             ditto
49  *       @(0x58,sp) - bbpc              ditto
50  *       @(0x5c,sp) - spu (cr3)         ditto
51  *       @(0x60,sp) - fp (r13)          ditto
52  *       @(0x64,sp) - lr (r14)          ditto
53  *       @(0x68,sp) - spi (cr2)         ditto
54  *       @(0x6c,sp) - orig_r0           ditto
55  */
56
57 #include <linux/config.h>
58 #include <linux/linkage.h>
59 #include <asm/irq.h>
60 #include <asm/unistd.h>
61 #include <asm/assembler.h>
62 #include <asm/thread_info.h>
63 #include <asm/errno.h>
64 #include <asm/segment.h>
65 #include <asm/smp.h>
66 #include <asm/page.h>
67 #include <asm/m32r.h>
68 #include <asm/mmu_context.h>
69
70 #if !defined(CONFIG_MMU)
71 #define sys_madvise             sys_ni_syscall
72 #define sys_readahead           sys_ni_syscall
73 #define sys_mprotect            sys_ni_syscall
74 #define sys_msync               sys_ni_syscall
75 #define sys_mlock               sys_ni_syscall
76 #define sys_munlock             sys_ni_syscall
77 #define sys_mlockall            sys_ni_syscall
78 #define sys_munlockall          sys_ni_syscall
79 #define sys_mremap              sys_ni_syscall
80 #define sys_mincore             sys_ni_syscall
81 #define sys_remap_file_pages    sys_ni_syscall
82 #endif /* CONFIG_MMU */
83
84 #define R4(reg)                 @reg
85 #define R5(reg)                 @(0x04,reg)
86 #define R6(reg)                 @(0x08,reg)
87 #define PTREGS(reg)             @(0x0C,reg)
88 #define R0(reg)                 @(0x10,reg)
89 #define R1(reg)                 @(0x14,reg)
90 #define R2(reg)                 @(0x18,reg)
91 #define R3(reg)                 @(0x1C,reg)
92 #define R7(reg)                 @(0x20,reg)
93 #define R8(reg)                 @(0x24,reg)
94 #define R9(reg)                 @(0x28,reg)
95 #define R10(reg)                @(0x2C,reg)
96 #define R11(reg)                @(0x30,reg)
97 #define R12(reg)                @(0x34,reg)
98 #define SYSCALL_NR(reg)         @(0x38,reg)
99 #if defined(CONFIG_ISA_M32R2) && defined(CONFIG_ISA_DSP_LEVEL2)
100 #define ACC0H(reg)              @(0x3C,reg)
101 #define ACC0L(reg)              @(0x40,reg)
102 #define ACC1H(reg)              @(0x44,reg)
103 #define ACC1L(reg)              @(0x48,reg)
104 #elif defined(CONFIG_ISA_M32R2) || defined(CONFIG_ISA_M32R)
105 #define ACCH(reg)               @(0x3C,reg)
106 #define ACCL(reg)               @(0x40,reg)
107 #else
108 #error unknown isa configuration
109 #endif
110 #define PSW(reg)                @(0x4C,reg)
111 #define BPC(reg)                @(0x50,reg)
112 #define BBPSW(reg)              @(0x54,reg)
113 #define BBPC(reg)               @(0x58,reg)
114 #define SPU(reg)                @(0x5C,reg)
115 #define FP(reg)                 @(0x60,reg)  /* FP = R13 */
116 #define LR(reg)                 @(0x64,reg)
117 #define SP(reg)                 @(0x68,reg)
118 #define ORIG_R0(reg)            @(0x6C,reg)
119
120 CF_MASK         = 0x00000001
121 TF_MASK         = 0x00000100
122 IF_MASK         = 0x00000200
123 DF_MASK         = 0x00000400
124 NT_MASK         = 0x00004000
125 VM_MASK         = 0x00020000
126
127 #ifdef CONFIG_PREEMPT
128 #define preempt_stop(x)         CLI(x)
129 #else
130 #define preempt_stop(x)
131 #define resume_kernel           restore_all
132 #endif
133
134 ENTRY(ret_from_fork)
135         pop     r0
136         bl      schedule_tail
137         GET_THREAD_INFO(r8)
138         bra     syscall_exit
139
140 /*
141  * Return to user mode is not as complex as all this looks,
142  * but we want the default path for a system call return to
143  * go as quickly as possible which is why some of this is
144  * less clear than it otherwise should be.
145  */
146
147         ; userspace resumption stub bypassing syscall exit tracing
148         ALIGN
149 ret_from_exception:
150         preempt_stop(r4)
151 ret_from_intr:
152         ld      r4, PSW(sp)
153 #ifdef CONFIG_ISA_M32R2
154         and3    r4, r4, #0x8800         ; check BSM and BPM bits
155 #else
156         and3    r4, r4, #0x8000         ; check BSM bit
157 #endif
158         beqz    r4, resume_kernel
159 ENTRY(resume_userspace)
160         CLI(r4)                         ; make sure we don't miss an interrupt
161                                         ; setting need_resched or sigpending
162                                         ; between sampling and the iret
163         GET_THREAD_INFO(r8)
164         ld      r9, @(TI_FLAGS, r8)
165         and3    r4, r9, #_TIF_WORK_MASK ; is there any work to be done on
166                                         ; int/exception return?
167         bnez    r4, work_pending
168         bra     restore_all
169
170 #ifdef CONFIG_PREEMPT
171 ENTRY(resume_kernel)
172         GET_THREAD_INFO(r8)
173         ld      r9, @(TI_PRE_COUNT, r8) ; non-zero preempt_count ?
174         bnez    r9, restore_all
175 need_resched:
176         ld      r9, @(TI_FLAGS, r8)     ; need_resched set ?
177         and3    r4, r9, #_TIF_NEED_RESCHED
178         beqz    r4, restore_all
179         ld      r4, PSW(sp)             ; interrupts off (exception path) ?
180         and3    r4, r4, #0x4000
181         beqz    r4, restore_all
182         LDIMM   (r4, PREEMPT_ACTIVE)
183         st      r4, @(TI_PRE_COUNT, r8)
184         STI(r4)
185         bl      schedule
186         ldi     r4, #0
187         st      r4, @(TI_PRE_COUNT, r8)
188         CLI(r4)
189         bra     need_resched
190 #endif
191
192         ; system call handler stub
193 ENTRY(system_call)
194         SWITCH_TO_KERNEL_STACK
195         SAVE_ALL
196         STI(r4)                         ; Enable interrupt
197         st      sp, PTREGS(sp)          ; implicit pt_regs parameter
198         cmpui   r7, #NR_syscalls
199         bnc     syscall_badsys
200         st      r7, SYSCALL_NR(sp)      ; syscall_nr
201                                         ; system call tracing in operation
202         GET_THREAD_INFO(r8)
203         ld      r9, @(TI_FLAGS, r8)
204         and3    r4, r9, #_TIF_SYSCALL_TRACE
205         bnez    r4, syscall_trace_entry
206 syscall_call:
207         slli    r7, #2                  ; table jump for the system call
208         LDIMM   (r4, sys_call_table)
209         add     r7, r4
210         ld      r7, @r7
211         jl      r7                      ; execute system call
212         st      r0, R0(sp)              ; save the return value
213 syscall_exit:
214         CLI(r4)                         ; make sure we don't miss an interrupt
215                                         ; setting need_resched or sigpending
216                                         ; between sampling and the iret
217         ld      r9, @(TI_FLAGS, r8)
218         and3    r4, r9, #_TIF_ALLWORK_MASK      ; current->work
219         bnez    r4, syscall_exit_work
220 restore_all:
221         RESTORE_ALL
222
223         # perform work that needs to be done immediately before resumption
224         # r9 : flags
225         ALIGN
226 work_pending:
227         and3    r4, r9, #_TIF_NEED_RESCHED
228         beqz    r4, work_notifysig
229 work_resched:
230         bl      schedule
231         CLI(r4)                         ; make sure we don't miss an interrupt
232                                         ; setting need_resched or sigpending
233                                         ; between sampling and the iret
234         ld      r9, @(TI_FLAGS, r8)
235         and3    r4, r9, #_TIF_WORK_MASK ; is there any work to be done other
236                                         ; than syscall tracing?
237         beqz    r4, restore_all
238         and3    r4, r4, #_TIF_NEED_RESCHED
239         bnez    r4, work_resched
240
241 work_notifysig:                         ; deal with pending signals and
242                                         ; notify-resume requests
243         mv      r0, sp                  ; arg1 : struct pt_regs *regs
244         ldi     r1, #0                  ; arg2 : sigset_t *oldset
245         mv      r2, r9                  ; arg3 : __u32 thread_info_flags
246         bl      do_notify_resume
247         bra     restore_all
248
249         ; perform syscall exit tracing
250         ALIGN
251 syscall_trace_entry:
252         ldi     r4, #-ENOSYS
253         st      r4, R0(sp)
254         bl      do_syscall_trace
255         ld      r0, ORIG_R0(sp)
256         ld      r1, R1(sp)
257         ld      r2, R2(sp)
258         ld      r3, R3(sp)
259         ld      r4, R4(sp)
260         ld      r5, R5(sp)
261         ld      r6, R6(sp)
262         ld      r7, SYSCALL_NR(sp)
263         cmpui   r7, #NR_syscalls
264         bc      syscall_call
265         bra     syscall_exit
266
267         ; perform syscall exit tracing
268         ALIGN
269 syscall_exit_work:
270         ld      r9, @(TI_FLAGS, r8)
271         and3    r4, r9, #_TIF_SYSCALL_TRACE
272         beqz    r4, work_pending
273         STI(r4)                         ; could let do_syscall_trace() call
274                                         ; schedule() instead
275         bl      do_syscall_trace
276         bra     resume_userspace
277
278         ALIGN
279 syscall_fault:
280         SAVE_ALL
281         GET_THREAD_INFO(r8)
282         ldi     r4, #-EFAULT
283         st      r4, R0(sp)
284         bra     resume_userspace
285
286         ALIGN
287 syscall_badsys:
288         ldi     r4, #-ENOSYS
289         st      r4, R0(sp)
290         bra     resume_userspace
291
292         .global eit_vector
293
294         .equ ei_vec_table, eit_vector + 0x0200
295
296 /*
297  * EI handler routine
298  */
299 ENTRY(ei_handler)
300 #if defined(CONFIG_CHIP_M32700)
301         SWITCH_TO_KERNEL_STACK
302         ; WORKAROUND: force to clear SM bit and use the kernel stack (SPI).
303 #endif
304         SAVE_ALL
305         mv      r1, sp                  ; arg1(regs)
306 #if defined(CONFIG_CHIP_VDEC2) || defined(CONFIG_CHIP_XNUX2) \
307         || defined(CONFIG_CHIP_M32700) || defined(CONFIG_CHIP_M32102) \
308         || defined(CONFIG_CHIP_OPSP) || defined(CONFIG_CHIP_M32104)
309
310 ;    GET_ICU_STATUS;
311         seth    r0, #shigh(M32R_ICU_ISTS_ADDR)
312         ld      r0, @(low(M32R_ICU_ISTS_ADDR),r0)
313         push    r0
314 #if defined(CONFIG_SMP)
315         /*
316          * If IRQ == 0      --> Nothing to do,  Not write IMASK
317          * If IRQ == IPI    --> Do IPI handler, Not write IMASK
318          * If IRQ != 0, IPI --> Do do_IRQ(),    Write IMASK
319          */
320         slli    r0, #4
321         srli    r0, #24                 ; r0(irq_num<<2)
322         ;; IRQ exist check
323 #if defined(CONFIG_CHIP_M32700)
324         /* WORKAROUND: IMASK bug M32700-TS1, TS2 chip. */
325         beqz    r0, 3f                  ; if (!irq_num) goto exit
326 #else
327         beqz    r0, 1f                  ; if (!irq_num) goto exit
328 #endif  /* WORKAROUND */
329         ;; IPI check
330         cmpi    r0, #(M32R_IRQ_IPI0<<2) ; ISN < IPI0 check
331         bc      2f
332         cmpi    r0, #((M32R_IRQ_IPI7+1)<<2)     ; ISN > IPI7 check
333         bnc     2f
334         LDIMM   (r2, ei_vec_table)
335         add     r2, r0
336         ld      r2, @r2
337         beqz    r2, 1f                  ; if (no IPI handler) goto exit
338         mv      r0, r1                  ; arg0(regs)
339         jl      r2
340         .fillinsn
341 1:
342         addi    sp, #4
343         bra     ret_to_intr
344 #if defined(CONFIG_CHIP_M32700)
345         /* WORKAROUND: IMASK bug M32700-TS1, TS2 chip. */
346         .fillinsn
347 3:
348         ld24    r14, #0x00070000
349         seth    r0, #shigh(M32R_ICU_IMASK_ADDR)
350         st      r14, @(low(M32R_ICU_IMASK_ADDR), r0)
351         addi    sp, #4
352         bra     ret_to_intr
353 #endif  /* WORKAROUND */
354         ;; do_IRQ
355         .fillinsn
356 2:
357         srli    r0, #2
358 #if defined(CONFIG_PLAT_USRV)
359         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
360         bnez    r2, 9f
361         ; read ICU status register of PLD
362         seth    r0, #high(PLD_ICUISTS)
363         or3     r0, r0, #low(PLD_ICUISTS)
364         lduh    r0, @r0
365         slli    r0, #21
366         srli    r0, #27                         ; ISN
367         addi    r0, #(M32700UT_PLD_IRQ_BASE)
368         .fillinsn
369 9:
370 #elif defined(CONFIG_PLAT_M32700UT)
371         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
372         bnez    r2, check_int0
373         ; read ICU status register of PLD
374         seth    r0, #high(PLD_ICUISTS)
375         or3     r0, r0, #low(PLD_ICUISTS)
376         lduh    r0, @r0
377         slli    r0, #21
378         srli    r0, #27                         ; ISN
379         addi    r0, #(M32700UT_PLD_IRQ_BASE)
380         bra     check_end
381         .fillinsn
382 check_int0:
383         add3    r2, r0, #-(M32R_IRQ_INT0)       ; INT0# interrupt
384         bnez    r2, check_int2
385         ; read ICU status of LAN-board
386         seth    r0, #high(M32700UT_LAN_ICUISTS)
387         or3     r0, r0, #low(M32700UT_LAN_ICUISTS)
388         lduh    r0, @r0
389         slli    r0, #21
390         srli    r0, #27                         ; ISN
391         add3    r0, r0, #(M32700UT_LAN_PLD_IRQ_BASE)
392         bra     check_end
393         .fillinsn
394 check_int2:
395         add3    r2, r0, #-(M32R_IRQ_INT2)       ; INT2# interrupt
396         bnez    r2, check_end
397         ; read ICU status of LCD-board
398         seth    r0, #high(M32700UT_LCD_ICUISTS)
399         or3     r0, r0, #low(M32700UT_LCD_ICUISTS)
400         lduh    r0, @r0
401         slli    r0, #21
402         srli    r0, #27                         ; ISN
403         add3    r0, r0, #(M32700UT_LCD_PLD_IRQ_BASE)
404         bra     check_end
405         .fillinsn
406 check_end:
407 #elif defined(CONFIG_PLAT_OPSPUT)
408         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
409         bnez    r2, check_int0
410         ; read ICU status register of PLD
411         seth    r0, #high(PLD_ICUISTS)
412         or3     r0, r0, #low(PLD_ICUISTS)
413         lduh    r0, @r0
414         slli    r0, #21
415         srli    r0, #27                         ; ISN
416         addi    r0, #(OPSPUT_PLD_IRQ_BASE)
417         bra     check_end
418         .fillinsn
419 check_int0:
420         add3    r2, r0, #-(M32R_IRQ_INT0)       ; INT0# interrupt
421         bnez    r2, check_int2
422         ; read ICU status of LAN-board
423         seth    r0, #high(OPSPUT_LAN_ICUISTS)
424         or3     r0, r0, #low(OPSPUT_LAN_ICUISTS)
425         lduh    r0, @r0
426         slli    r0, #21
427         srli    r0, #27                         ; ISN
428         add3    r0, r0, #(OPSPUT_LAN_PLD_IRQ_BASE)
429         bra     check_end
430         .fillinsn
431 check_int2:
432         add3    r2, r0, #-(M32R_IRQ_INT2)       ; INT2# interrupt
433         bnez    r2, check_end
434         ; read ICU status of LCD-board
435         seth    r0, #high(OPSPUT_LCD_ICUISTS)
436         or3     r0, r0, #low(OPSPUT_LCD_ICUISTS)
437         lduh    r0, @r0
438         slli    r0, #21
439         srli    r0, #27                         ; ISN
440         add3    r0, r0, #(OPSPUT_LCD_PLD_IRQ_BASE)
441         bra     check_end
442         .fillinsn
443 check_end:
444 #endif  /* CONFIG_PLAT_OPSPUT */
445         bl      do_IRQ                  ; r0(irq), r1(regs)
446 #else  /* not CONFIG_SMP */
447         srli    r0, #22                 ; r0(irq)
448 #if defined(CONFIG_PLAT_USRV)
449         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
450         bnez    r2, 1f
451         ; read ICU status register of PLD
452         seth    r0, #high(PLD_ICUISTS)
453         or3     r0, r0, #low(PLD_ICUISTS)
454         lduh    r0, @r0
455         slli    r0, #21
456         srli    r0, #27                         ; ISN
457         addi    r0, #(M32700UT_PLD_IRQ_BASE)
458         .fillinsn
459 1:
460 #elif defined(CONFIG_PLAT_M32700UT)
461         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
462         bnez    r2, check_int0
463         ; read ICU status register of PLD
464         seth    r0, #high(PLD_ICUISTS)
465         or3     r0, r0, #low(PLD_ICUISTS)
466         lduh    r0, @r0
467         slli    r0, #21
468         srli    r0, #27                         ; ISN
469         addi    r0, #(M32700UT_PLD_IRQ_BASE)
470         bra     check_end
471         .fillinsn
472 check_int0:
473         add3    r2, r0, #-(M32R_IRQ_INT0)       ; INT0# interrupt
474         bnez    r2, check_int2
475         ; read ICU status of LAN-board
476         seth    r0, #high(M32700UT_LAN_ICUISTS)
477         or3     r0, r0, #low(M32700UT_LAN_ICUISTS)
478         lduh    r0, @r0
479         slli    r0, #21
480         srli    r0, #27                         ; ISN
481         add3    r0, r0, #(M32700UT_LAN_PLD_IRQ_BASE)
482         bra     check_end
483         .fillinsn
484 check_int2:
485         add3    r2, r0, #-(M32R_IRQ_INT2)       ; INT2# interrupt
486         bnez    r2, check_end
487         ; read ICU status of LCD-board
488         seth    r0, #high(M32700UT_LCD_ICUISTS)
489         or3     r0, r0, #low(M32700UT_LCD_ICUISTS)
490         lduh    r0, @r0
491         slli    r0, #21
492         srli    r0, #27                         ; ISN
493         add3    r0, r0, #(M32700UT_LCD_PLD_IRQ_BASE)
494         bra     check_end
495         .fillinsn
496 check_end:
497 #elif defined(CONFIG_PLAT_OPSPUT)
498         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
499         bnez    r2, check_int0
500         ; read ICU status register of PLD
501         seth    r0, #high(PLD_ICUISTS)
502         or3     r0, r0, #low(PLD_ICUISTS)
503         lduh    r0, @r0
504         slli    r0, #21
505         srli    r0, #27                         ; ISN
506         addi    r0, #(OPSPUT_PLD_IRQ_BASE)
507         bra     check_end
508         .fillinsn
509 check_int0:
510         add3    r2, r0, #-(M32R_IRQ_INT0)       ; INT0# interrupt
511         bnez    r2, check_int2
512         ; read ICU status of LAN-board
513         seth    r0, #high(OPSPUT_LAN_ICUISTS)
514         or3     r0, r0, #low(OPSPUT_LAN_ICUISTS)
515         lduh    r0, @r0
516         slli    r0, #21
517         srli    r0, #27                         ; ISN
518         add3    r0, r0, #(OPSPUT_LAN_PLD_IRQ_BASE)
519         bra     check_end
520         .fillinsn
521 check_int2:
522         add3    r2, r0, #-(M32R_IRQ_INT2)       ; INT2# interrupt
523         bnez    r2, check_end
524         ; read ICU status of LCD-board
525         seth    r0, #high(OPSPUT_LCD_ICUISTS)
526         or3     r0, r0, #low(OPSPUT_LCD_ICUISTS)
527         lduh    r0, @r0
528         slli    r0, #21
529         srli    r0, #27                         ; ISN
530         add3    r0, r0, #(OPSPUT_LCD_PLD_IRQ_BASE)
531         bra     check_end
532         .fillinsn
533 check_end:
534 #elif defined(CONFIG_PLAT_M32104UT)
535         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
536         bnez    r2, check_end
537         ; read ICU status register of PLD
538         seth    r0, #high(PLD_ICUISTS)
539         or3     r0, r0, #low(PLD_ICUISTS)
540         lduh    r0, @r0
541         slli    r0, #21
542         srli    r0, #27                         ; ISN
543         addi    r0, #(M32104UT_PLD_IRQ_BASE)
544         bra     check_end
545         .fillinsn
546 check_end:
547 #endif  /* CONFIG_PLAT_M32104UT */
548         bl      do_IRQ
549 #endif  /* CONFIG_SMP */
550         pop     r14
551         seth    r0, #shigh(M32R_ICU_IMASK_ADDR)
552         st      r14, @(low(M32R_ICU_IMASK_ADDR),r0)
553 #else
554 #error no chip configuration
555 #endif
556 ret_to_intr:
557         bra  ret_from_intr
558
559 /*
560  * Default EIT handler
561  */
562         ALIGN
563 int_msg:
564         .asciz  "Unknown interrupt\n"
565         .byte   0
566
567 ENTRY(default_eit_handler)
568         push    r0
569         mvfc    r0, psw
570         push    r1
571         push    r2
572         push    r3
573         push    r0
574         LDIMM   (r0, __KERNEL_DS)
575         mv      r0, r1
576         mv      r0, r2
577         LDIMM   (r0, int_msg)
578         bl      printk
579         pop     r0
580         pop     r3
581         pop     r2
582         pop     r1
583         mvtc    r0, psw
584         pop     r0
585 infinit:
586         bra     infinit
587
588 #ifdef CONFIG_MMU
589 /*
590  * Access Exception handler
591  */
592 ENTRY(ace_handler)
593         SWITCH_TO_KERNEL_STACK
594         SAVE_ALL
595
596         seth    r2, #shigh(MMU_REG_BASE)        /* Check status register */
597         ld      r4, @(low(MESTS_offset),r2)
598         st      r4, @(low(MESTS_offset),r2)
599         srl3    r1, r4, #4
600 #ifdef CONFIG_CHIP_M32700
601         and3    r1, r1, #0x0000ffff
602         ; WORKAROUND: ignore TME bit for the M32700(TS1).
603 #endif /* CONFIG_CHIP_M32700 */
604         beqz    r1, inst
605 oprand:
606         ld      r2, @(low(MDEVA_offset),r2)     ; set address
607         srli    r2, #12
608         slli    r2, #12
609         srli    r1, #1
610         bra     1f
611 inst:
612         and3    r1, r4, #2
613         srli    r1, #1
614         or3     r1, r1, #8
615         mvfc    r2, bpc                         ; set address
616         .fillinsn
617 1:
618         mvfc    r3, psw
619         mv      r0, sp
620         and3    r3, r3, 0x800
621         srli    r3, #9
622         or      r1, r3
623         /*
624          * do_page_fault():
625          *    r0 : struct pt_regs *regs
626          *    r1 : unsigned long error-code
627          *    r2 : unsigned long address
628          * error-code:
629          *    +------+------+------+------+
630          *    | bit3 | bit2 | bit1 | bit0 |
631          *    +------+------+------+------+
632          *    bit 3 == 0:means data,          1:means instruction
633          *    bit 2 == 0:means kernel,        1:means user-mode
634          *    bit 1 == 0:means read,          1:means write
635          *    bit 0 == 0:means no page found  1:means protection fault
636          *
637          */
638         bl      do_page_fault
639         bra     ret_from_intr
640 #endif  /* CONFIG_MMU */
641
642
643 ENTRY(alignment_check)
644 /* void alignment_check(int error_code) */
645         SWITCH_TO_KERNEL_STACK
646         SAVE_ALL
647         ldi     r1, #0x30                       ; error_code
648         mv      r0, sp                          ; pt_regs
649         bl      do_alignment_check
650 error_code:
651         bra     ret_from_exception
652
653 ENTRY(rie_handler)
654 /* void rie_handler(int error_code) */
655         SWITCH_TO_KERNEL_STACK
656         SAVE_ALL
657         ldi     r1, #0x20                       ; error_code
658         mv      r0, sp                          ; pt_regs
659         bl      do_rie_handler
660         bra     error_code
661
662 ENTRY(pie_handler)
663 /* void pie_handler(int error_code) */
664         SWITCH_TO_KERNEL_STACK
665         SAVE_ALL
666         ldi     r1, #0                          ; error_code ; FIXME
667         mv      r0, sp                          ; pt_regs
668         bl      do_pie_handler
669         bra     error_code
670
671 ENTRY(debug_trap)
672         .global withdraw_debug_trap
673         /* void debug_trap(void) */
674         SWITCH_TO_KERNEL_STACK
675         SAVE_ALL
676         mv      r0, sp                          ; pt_regs
677         bl      withdraw_debug_trap
678         ldi     r1, #0                          ; error_code
679         mv      r0, sp                          ; pt_regs
680         bl      do_debug_trap
681         bra     error_code
682
683 ENTRY(ill_trap)
684         /* void ill_trap(void) */
685         SWITCH_TO_KERNEL_STACK
686         SAVE_ALL
687         ldi     r1, #0                          ; error_code ; FIXME
688         mv      r0, sp                          ; pt_regs
689         bl      do_ill_trap
690         bra     error_code
691
692
693 /* Cache flushing handler */
694 ENTRY(cache_flushing_handler)
695         .global _flush_cache_all
696         /* void _flush_cache_all(void); */
697         SWITCH_TO_KERNEL_STACK
698         push    r0
699         push    r1
700         push    r2
701         push    r3
702         push    r4
703         push    r5
704         push    r6
705         push    r7
706         push    lr
707         bl      _flush_cache_all
708         pop     lr
709         pop     r7
710         pop     r6
711         pop     r5
712         pop     r4
713         pop     r3
714         pop     r2
715         pop     r1
716         pop     r0
717         rte
718
719 .data
720 ENTRY(sys_call_table)
721         .long sys_restart_syscall       /* 0  -  old "setup()" system call*/
722         .long sys_exit
723         .long sys_fork
724         .long sys_read
725         .long sys_write
726         .long sys_open                  /* 5 */
727         .long sys_close
728         .long sys_waitpid
729         .long sys_creat
730         .long sys_link
731         .long sys_unlink                /* 10 */
732         .long sys_execve
733         .long sys_chdir
734         .long sys_time
735         .long sys_mknod
736         .long sys_chmod                 /* 15 */
737         .long sys_ni_syscall            /* lchown16 syscall holder */
738         .long sys_ni_syscall            /* old break syscall holder */
739         .long sys_ni_syscall            /* old stat syscall holder */
740         .long sys_lseek
741         .long sys_getpid                /* 20 */
742         .long sys_mount
743         .long sys_oldumount
744         .long sys_ni_syscall            /* setuid16 syscall holder */
745         .long sys_ni_syscall            /* getuid16 syscall holder */
746         .long sys_stime                 /* 25 */
747         .long sys_ptrace
748         .long sys_alarm
749         .long sys_ni_syscall            /* old fstat syscall holder */
750         .long sys_pause
751         .long sys_utime                 /* 30 */
752         .long sys_ni_syscall            /* old stty syscall holder */
753         .long sys_cachectl              /* for M32R */ /* old gtty syscall holder */
754         .long sys_access
755         .long sys_ni_syscall            /* nice syscall holder */
756         .long sys_ni_syscall            /* 35  -  old ftime syscall holder */
757         .long sys_sync
758         .long sys_kill
759         .long sys_rename
760         .long sys_mkdir
761         .long sys_rmdir                 /* 40 */
762         .long sys_dup
763         .long sys_pipe
764         .long sys_times
765         .long sys_ni_syscall            /* old prof syscall holder */
766         .long sys_brk                   /* 45 */
767         .long sys_ni_syscall            /* setgid16 syscall holder */
768         .long sys_getgid                /* will be unused */
769         .long sys_ni_syscall            /* signal syscall holder */
770         .long sys_ni_syscall            /* geteuid16  syscall holder */
771         .long sys_ni_syscall            /* 50 - getegid16 syscall holder */
772         .long sys_acct
773         .long sys_umount                /* recycled never used phys() */
774         .long sys_ni_syscall            /* old lock syscall holder */
775         .long sys_ioctl
776         .long sys_fcntl                 /* 55 - will be unused */
777         .long sys_ni_syscall            /* mpx syscall holder */
778         .long sys_setpgid
779         .long sys_ni_syscall            /* old ulimit syscall holder */
780         .long sys_ni_syscall            /* sys_olduname */
781         .long sys_umask                 /* 60 */
782         .long sys_chroot
783         .long sys_ustat
784         .long sys_dup2
785         .long sys_getppid
786         .long sys_getpgrp               /* 65 */
787         .long sys_setsid
788         .long sys_ni_syscall            /* sigaction syscall holder */
789         .long sys_ni_syscall            /* sgetmask syscall holder */
790         .long sys_ni_syscall            /* ssetmask syscall holder */
791         .long sys_ni_syscall            /* 70 - setreuid16 syscall holder */
792         .long sys_ni_syscall            /* setregid16 syscall holder */
793         .long sys_ni_syscall            /* sigsuspend syscall holder */
794         .long sys_ni_syscall            /* sigpending syscall holder */
795         .long sys_sethostname
796         .long sys_setrlimit             /* 75 */
797         .long sys_getrlimit/*will be unused*/
798         .long sys_getrusage
799         .long sys_gettimeofday
800         .long sys_settimeofday
801         .long sys_ni_syscall            /* 80 - getgroups16 syscall holder */
802         .long sys_ni_syscall            /* setgroups16 syscall holder */
803         .long sys_ni_syscall            /* sys_oldselect */
804         .long sys_symlink
805         .long sys_ni_syscall            /* old lstat syscall holder */
806         .long sys_readlink              /* 85 */
807         .long sys_uselib
808         .long sys_swapon
809         .long sys_reboot
810         .long sys_ni_syscall            /* readdir syscall holder */
811         .long sys_ni_syscall            /* 90 - old_mmap syscall holder */
812         .long sys_munmap
813         .long sys_truncate
814         .long sys_ftruncate
815         .long sys_fchmod
816         .long sys_ni_syscall            /* 95 - fchwon16  syscall holder */
817         .long sys_getpriority
818         .long sys_setpriority
819         .long sys_ni_syscall            /* old profil syscall holder */
820         .long sys_statfs
821         .long sys_fstatfs               /* 100 */
822         .long sys_ni_syscall            /* ioperm syscall holder */
823         .long sys_socketcall
824         .long sys_syslog
825         .long sys_setitimer
826         .long sys_getitimer             /* 105 */
827         .long sys_newstat
828         .long sys_newlstat
829         .long sys_newfstat
830         .long sys_ni_syscall            /* old uname syscall holder */
831         .long sys_ni_syscall            /* 110  -  iopl syscall holder */
832         .long sys_vhangup
833         .long sys_ni_syscall            /* idle syscall holder */
834         .long sys_ni_syscall            /* vm86old syscall holder */
835         .long sys_wait4
836         .long sys_swapoff               /* 115 */
837         .long sys_sysinfo
838         .long sys_ipc
839         .long sys_fsync
840         .long sys_ni_syscall            /* sigreturn syscall holder */
841         .long sys_clone                 /* 120 */
842         .long sys_setdomainname
843         .long sys_newuname
844         .long sys_ni_syscall            /* modify_ldt syscall holder */
845         .long sys_adjtimex
846         .long sys_mprotect              /* 125 */
847         .long sys_ni_syscall            /* sigprocmask syscall holder */
848         .long sys_ni_syscall            /* create_module syscall holder */
849         .long sys_init_module
850         .long sys_delete_module
851         .long sys_ni_syscall            /* 130 - get_kernel_syms */
852         .long sys_quotactl
853         .long sys_getpgid
854         .long sys_fchdir
855         .long sys_bdflush
856         .long sys_sysfs                 /* 135 */
857         .long sys_personality
858         .long sys_ni_syscall            /* afs_syscall syscall holder */
859         .long sys_ni_syscall            /* setfsuid16 syscall holder */
860         .long sys_ni_syscall            /* setfsgid16 syscall holder */
861         .long sys_llseek                /* 140 */
862         .long sys_getdents
863         .long sys_select
864         .long sys_flock
865         .long sys_msync
866         .long sys_readv                 /* 145 */
867         .long sys_writev
868         .long sys_getsid
869         .long sys_fdatasync
870         .long sys_sysctl
871         .long sys_mlock                 /* 150 */
872         .long sys_munlock
873         .long sys_mlockall
874         .long sys_munlockall
875         .long sys_sched_setparam
876         .long sys_sched_getparam        /* 155 */
877         .long sys_sched_setscheduler
878         .long sys_sched_getscheduler
879         .long sys_sched_yield
880         .long sys_sched_get_priority_max
881         .long sys_sched_get_priority_min        /* 160 */
882         .long sys_sched_rr_get_interval
883         .long sys_nanosleep
884         .long sys_mremap
885         .long sys_ni_syscall            /* setresuid16 syscall holder */
886         .long sys_ni_syscall            /* 165 - getresuid16 syscall holder */
887         .long sys_tas                   /* vm86 syscall holder */
888         .long sys_ni_syscall            /* query_module syscall holder */
889         .long sys_poll
890         .long sys_nfsservctl
891         .long sys_setresgid             /* 170 */
892         .long sys_getresgid
893         .long sys_prctl
894         .long sys_rt_sigreturn
895         .long sys_rt_sigaction
896         .long sys_rt_sigprocmask        /* 175 */
897         .long sys_rt_sigpending
898         .long sys_rt_sigtimedwait
899         .long sys_rt_sigqueueinfo
900         .long sys_rt_sigsuspend
901         .long sys_pread64               /* 180 */
902         .long sys_pwrite64
903         .long sys_ni_syscall            /* chown16 syscall holder */
904         .long sys_getcwd
905         .long sys_capget
906         .long sys_capset                /* 185 */
907         .long sys_sigaltstack
908         .long sys_sendfile
909         .long sys_ni_syscall            /* streams1 */
910         .long sys_ni_syscall            /* streams2 */
911         .long sys_vfork                 /* 190 */
912         .long sys_getrlimit
913         .long sys_mmap2
914         .long sys_truncate64
915         .long sys_ftruncate64
916         .long sys_stat64                /* 195 */
917         .long sys_lstat64
918         .long sys_fstat64
919         .long sys_lchown
920         .long sys_getuid
921         .long sys_getgid                /* 200 */
922         .long sys_geteuid
923         .long sys_getegid
924         .long sys_setreuid
925         .long sys_setregid
926         .long sys_getgroups             /* 205 */
927         .long sys_setgroups
928         .long sys_fchown
929         .long sys_setresuid
930         .long sys_getresuid
931         .long sys_setresgid             /* 210 */
932         .long sys_getresgid
933         .long sys_chown
934         .long sys_setuid
935         .long sys_setgid
936         .long sys_setfsuid              /* 215 */
937         .long sys_setfsgid
938         .long sys_pivot_root
939         .long sys_mincore
940         .long sys_madvise
941         .long sys_getdents64            /* 220 */
942         .long sys_fcntl64
943         .long sys_ni_syscall            /* reserved for TUX */
944         .long sys_ni_syscall            /* Reserved for Security */
945         .long sys_gettid
946         .long sys_readahead             /* 225 */
947         .long sys_setxattr
948         .long sys_lsetxattr
949         .long sys_fsetxattr
950         .long sys_getxattr
951         .long sys_lgetxattr             /* 230 */
952         .long sys_fgetxattr
953         .long sys_listxattr
954         .long sys_llistxattr
955         .long sys_flistxattr
956         .long sys_removexattr           /* 235 */
957         .long sys_lremovexattr
958         .long sys_fremovexattr
959         .long sys_tkill
960         .long sys_sendfile64
961         .long sys_futex                 /* 240 */
962         .long sys_sched_setaffinity
963         .long sys_sched_getaffinity
964         .long sys_ni_syscall            /* reserved for "set_thread_area" system call */
965         .long sys_ni_syscall            /* reserved for "get_thread_area" system call */
966         .long sys_io_setup              /* 245 */
967         .long sys_io_destroy
968         .long sys_io_getevents
969         .long sys_io_submit
970         .long sys_io_cancel
971         .long sys_fadvise64             /* 250 */
972         .long sys_ni_syscall
973         .long sys_exit_group
974         .long sys_lookup_dcookie
975         .long sys_epoll_create
976         .long sys_epoll_ctl             /* 255 */
977         .long sys_epoll_wait
978         .long sys_remap_file_pages
979         .long sys_set_tid_address
980         .long sys_timer_create
981         .long sys_timer_settime         /* 260 */
982         .long sys_timer_gettime
983         .long sys_timer_getoverrun
984         .long sys_timer_delete
985         .long sys_clock_settime
986         .long sys_clock_gettime         /* 265 */
987         .long sys_clock_getres
988         .long sys_clock_nanosleep
989         .long sys_statfs64
990         .long sys_fstatfs64
991         .long sys_tgkill                /* 270 */
992         .long sys_utimes
993         .long sys_fadvise64_64
994         .long sys_ni_syscall            /* Reserved for sys_vserver */
995         .long sys_ni_syscall            /* Reserved for sys_mbind */
996         .long sys_ni_syscall            /* Reserved for sys_get_mempolicy */
997         .long sys_ni_syscall            /* Reserved for sys_set_mempolicy */
998         .long sys_mq_open
999         .long sys_mq_unlink
1000         .long sys_mq_timedsend
1001         .long sys_mq_timedreceive       /* 280 */
1002         .long sys_mq_notify
1003         .long sys_mq_getsetattr
1004         .long sys_ni_syscall            /* reserved for kexec */
1005         .long sys_waitid
1006
1007 syscall_table_size=(.-sys_call_table)