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