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 #define nr_syscalls ((syscall_table_size)/4)
 113
 114 #ifdef CONFIG_PREEMPT
 115 #define preempt_stop(x)         DISABLE_INTERRUPTS(x)
 116 #else
 117 #define preempt_stop(x)
 118 #define resume_kernel           restore_all
 119 #endif
 120
 121 ENTRY(ret_from_fork)
 122         pop     r0
 123         bl      schedule_tail
 124         GET_THREAD_INFO(r8)
 125         bra     syscall_exit
 126
 127 /*
 128  * Return to user mode is not as complex as all this looks,
 129  * but we want the default path for a system call return to
 130  * go as quickly as possible which is why some of this is
 131  * less clear than it otherwise should be.
 132  */
 133
 134         ; userspace resumption stub bypassing syscall exit tracing
 135         ALIGN
 136 ret_from_exception:
 137         preempt_stop(r4)
 138 ret_from_intr:
 139         ld      r4, PSW(sp)
 140 #ifdef CONFIG_ISA_M32R2
 141         and3    r4, r4, #0x8800         ; check BSM and BPM bits
 142 #else
 143         and3    r4, r4, #0x8000         ; check BSM bit
 144 #endif
 145         beqz    r4, resume_kernel
 146 ENTRY(resume_userspace)
 147         DISABLE_INTERRUPTS(r4)          ; make sure we don't miss an interrupt
 148                                         ; setting need_resched or sigpending
 149                                         ; between sampling and the iret
 150         GET_THREAD_INFO(r8)
 151         ld      r9, @(TI_FLAGS, r8)
 152         and3    r4, r9, #_TIF_WORK_MASK ; is there any work to be done on
 153                                         ; int/exception return?
 154         bnez    r4, work_pending
 155         bra     restore_all
 156
 157 #ifdef CONFIG_PREEMPT
 158 ENTRY(resume_kernel)
 159         GET_THREAD_INFO(r8)
 160         ld      r9, @(TI_PRE_COUNT, r8) ; non-zero preempt_count ?
 161         bnez    r9, restore_all
 162 need_resched:
 163         ld      r9, @(TI_FLAGS, r8)     ; need_resched set ?
 164         and3    r4, r9, #_TIF_NEED_RESCHED
 165         beqz    r4, restore_all
 166         ld      r4, PSW(sp)             ; interrupts off (exception path) ?
 167         and3    r4, r4, #0x4000
 168         beqz    r4, restore_all
 169         LDIMM   (r4, PREEMPT_ACTIVE)
 170         st      r4, @(TI_PRE_COUNT, r8)
 171         ENABLE_INTERRUPTS(r4)
 172         bl      schedule
 173         ldi     r4, #0
 174         st      r4, @(TI_PRE_COUNT, r8)
 175         DISABLE_INTERRUPTS(r4)
 176         bra     need_resched
 177 #endif
 178
 179         ; system call handler stub
 180 ENTRY(system_call)
 181         SWITCH_TO_KERNEL_STACK
 182         SAVE_ALL
 183         ENABLE_INTERRUPTS(r4)           ; Enable interrupt
 184         st      sp, PTREGS(sp)          ; implicit pt_regs parameter
 185         cmpui   r7, #NR_syscalls
 186         bnc     syscall_badsys
 187         st      r7, SYSCALL_NR(sp)      ; syscall_nr
 188                                         ; system call tracing in operation
 189         GET_THREAD_INFO(r8)
 190         ld      r9, @(TI_FLAGS, r8)
 191         and3    r4, r9, #_TIF_SYSCALL_TRACE
 192         bnez    r4, syscall_trace_entry
 193 syscall_call:
 194         slli    r7, #2                  ; table jump for the system call
 195         LDIMM   (r4, sys_call_table)
 196         add     r7, r4
 197         ld      r7, @r7
 198         jl      r7                      ; execute system call
 199         st      r0, R0(sp)              ; save the return value
 200 syscall_exit:
 201         DISABLE_INTERRUPTS(r4)          ; make sure we don't miss an interrupt
 202                                         ; setting need_resched or sigpending
 203                                         ; between sampling and the iret
 204         ld      r9, @(TI_FLAGS, r8)
 205         and3    r4, r9, #_TIF_ALLWORK_MASK      ; current->work
 206         bnez    r4, syscall_exit_work
 207 restore_all:
 208         RESTORE_ALL
 209
 210         # perform work that needs to be done immediately before resumption
 211         # r9 : flags
 212         ALIGN
 213 work_pending:
 214         and3    r4, r9, #_TIF_NEED_RESCHED
 215         beqz    r4, work_notifysig
 216 work_resched:
 217         bl      schedule
 218         DISABLE_INTERRUPTS(r4)          ; make sure we don't miss an interrupt
 219                                         ; setting need_resched or sigpending
 220                                         ; between sampling and the iret
 221         ld      r9, @(TI_FLAGS, r8)
 222         and3    r4, r9, #_TIF_WORK_MASK ; is there any work to be done other
 223                                         ; than syscall tracing?
 224         beqz    r4, restore_all
 225         and3    r4, r4, #_TIF_NEED_RESCHED
 226         bnez    r4, work_resched
 227
 228 work_notifysig:                         ; deal with pending signals and
 229                                         ; notify-resume requests
 230         mv      r0, sp                  ; arg1 : struct pt_regs *regs
 231         ldi     r1, #0                  ; arg2 : sigset_t *oldset
 232         mv      r2, r9                  ; arg3 : __u32 thread_info_flags
 233         bl      do_notify_resume
 234         bra     restore_all
 235
 236         ; perform syscall exit tracing
 237         ALIGN
 238 syscall_trace_entry:
 239         ldi     r4, #-ENOSYS
 240         st      r4, R0(sp)
 241         bl      do_syscall_trace
 242         ld      r0, ORIG_R0(sp)
 243         ld      r1, R1(sp)
 244         ld      r2, R2(sp)
 245         ld      r3, R3(sp)
 246         ld      r4, R4(sp)
 247         ld      r5, R5(sp)
 248         ld      r6, R6(sp)
 249         ld      r7, SYSCALL_NR(sp)
 250         cmpui   r7, #NR_syscalls
 251         bc      syscall_call
 252         bra     syscall_exit
 253
 254         ; perform syscall exit tracing
 255         ALIGN
 256 syscall_exit_work:
 257         ld      r9, @(TI_FLAGS, r8)
 258         and3    r4, r9, #_TIF_SYSCALL_TRACE
 259         beqz    r4, work_pending
 260         ENABLE_INTERRUPTS(r4)           ; could let do_syscall_trace() call
 261                                         ; schedule() instead
 262         bl      do_syscall_trace
 263         bra     resume_userspace
 264
 265         ALIGN
 266 syscall_fault:
 267         SAVE_ALL
 268         GET_THREAD_INFO(r8)
 269         ldi     r4, #-EFAULT
 270         st      r4, R0(sp)
 271         bra     resume_userspace
 272
 273         ALIGN
 274 syscall_badsys:
 275         ldi     r4, #-ENOSYS
 276         st      r4, R0(sp)
 277         bra     resume_userspace
 278
 279         .global eit_vector
 280
 281         .equ ei_vec_table, eit_vector + 0x0200
 282
 283 /*
 284  * EI handler routine
 285  */
 286 ENTRY(ei_handler)
 287 #if defined(CONFIG_CHIP_M32700)
 288         ; WORKAROUND: force to clear SM bit and use the kernel stack (SPI).
 289         SWITCH_TO_KERNEL_STACK
 290 #endif
 291         SAVE_ALL
 292         mv      r1, sp                  ; arg1(regs)
 293         ; get ICU status
 294         seth    r0, #shigh(M32R_ICU_ISTS_ADDR)
 295         ld      r0, @(low(M32R_ICU_ISTS_ADDR),r0)
 296         push    r0
 297 #if defined(CONFIG_SMP)
 298         /*
 299          * If IRQ == 0      --> Nothing to do,  Not write IMASK
 300          * If IRQ == IPI    --> Do IPI handler, Not write IMASK
 301          * If IRQ != 0, IPI --> Do do_IRQ(),    Write IMASK
 302          */
 303         slli    r0, #4
 304         srli    r0, #24                 ; r0(irq_num<<2)
 305         ;; IRQ exist check
 306 #if defined(CONFIG_CHIP_M32700)
 307         /* WORKAROUND: IMASK bug M32700-TS1, TS2 chip. */
 308         bnez    r0, 0f
 309         ld24    r14, #0x00070000
 310         seth    r0, #shigh(M32R_ICU_IMASK_ADDR)
 311         st      r14, @(low(M32R_ICU_IMASK_ADDR),r0)
 312         bra     1f
 313         .fillinsn
 314 0:
 315 #endif /* CONFIG_CHIP_M32700 */
 316         beqz    r0, 1f                  ; if (!irq_num) goto exit
 317         ;; IPI check
 318         cmpi    r0, #(M32R_IRQ_IPI0<<2) ; ISN < IPI0 check
 319         bc      2f
 320         cmpi    r0, #((M32R_IRQ_IPI7+1)<<2)     ; ISN > IPI7 check
 321         bnc     2f
 322         LDIMM   (r2, ei_vec_table)
 323         add     r2, r0
 324         ld      r2, @r2
 325         beqz    r2, 1f                  ; if (no IPI handler) goto exit
 326         mv      r0, r1                  ; arg0(regs)
 327         jl      r2
 328         .fillinsn
 329 1:
 330         addi    sp, #4
 331         bra     restore_all
 332         .fillinsn
 333 2:
 334         srli    r0, #2
 335 #else /* not CONFIG_SMP */
 336         srli    r0, #22                 ; r0(irq)
 337 #endif /* not CONFIG_SMP */
 338
 339 #if defined(CONFIG_PLAT_HAS_INT1ICU)
 340         add3    r2, r0, #-(M32R_IRQ_INT1)       ; INT1# interrupt
 341         bnez    r2, 3f
 342         seth    r0, #shigh(M32R_INT1ICU_ISTS)
 343         lduh    r0, @(low(M32R_INT1ICU_ISTS),r0)        ; bit10-6 : ISN
 344         slli    r0, #21
 345         srli    r0, #27                         ; ISN
 346         addi    r0, #(M32R_INT1ICU_IRQ_BASE)
 347         bra     check_end
 348         .fillinsn
 349 3:
 350 #endif /* CONFIG_PLAT_HAS_INT1ICU */
 351 #if defined(CONFIG_PLAT_HAS_INT0ICU)
 352         add3    r2, r0, #-(M32R_IRQ_INT0)       ; INT0# interrupt
 353         bnez    r2, 4f
 354         seth    r0, #shigh(M32R_INT0ICU_ISTS)
 355         lduh    r0, @(low(M32R_INT0ICU_ISTS),r0)        ; bit10-6 : ISN
 356         slli    r0, #21
 357         srli    r0, #27                         ; ISN
 358         add3    r0, r0, #(M32R_INT0ICU_IRQ_BASE)
 359         bra     check_end
 360         .fillinsn
 361 4:
 362 #endif /* CONFIG_PLAT_HAS_INT0ICU */
 363 #if defined(CONFIG_PLAT_HAS_INT2ICU)
 364         add3    r2, r0, #-(M32R_IRQ_INT2)       ; INT2# interrupt
 365         bnez    r2, 5f
 366         seth    r0, #shigh(M32R_INT2ICU_ISTS)
 367         lduh    r0, @(low(M32R_INT2ICU_ISTS),r0)        ; bit10-6 : ISN
 368         slli    r0, #21
 369         srli    r0, #27                         ; ISN
 370         add3    r0, r0, #(M32R_INT2ICU_IRQ_BASE)
 371         ; bra   check_end
 372         .fillinsn
 373 5:
 374 #endif /* CONFIG_PLAT_HAS_INT2ICU */
 375
 376 check_end:
 377         bl      do_IRQ
 378         pop     r14
 379         seth    r0, #shigh(M32R_ICU_IMASK_ADDR)
 380         st      r14, @(low(M32R_ICU_IMASK_ADDR),r0)
 381         bra  ret_from_intr
 382
 383 /*
 384  * Default EIT handler
 385  */
 386         ALIGN
 387 int_msg:
 388         .asciz  "Unknown interrupt\n"
 389         .byte   0
 390
 391 ENTRY(default_eit_handler)
 392         push    r0
 393         mvfc    r0, psw
 394         push    r1
 395         push    r2
 396         push    r3
 397         push    r0
 398         LDIMM   (r0, __KERNEL_DS)
 399         mv      r0, r1
 400         mv      r0, r2
 401         LDIMM   (r0, int_msg)
 402         bl      printk
 403         pop     r0
 404         pop     r3
 405         pop     r2
 406         pop     r1
 407         mvtc    r0, psw
 408         pop     r0
 409 infinit:
 410         bra     infinit
 411
 412 #ifdef CONFIG_MMU
 413 /*
 414  * Access Exception handler
 415  */
 416 ENTRY(ace_handler)
 417         SWITCH_TO_KERNEL_STACK
 418         SAVE_ALL
 419
 420         seth    r2, #shigh(MMU_REG_BASE)        /* Check status register */
 421         ld      r4, @(low(MESTS_offset),r2)
 422         st      r4, @(low(MESTS_offset),r2)
 423         srl3    r1, r4, #4
 424 #ifdef CONFIG_CHIP_M32700
 425         and3    r1, r1, #0x0000ffff
 426         ; WORKAROUND: ignore TME bit for the M32700(TS1).
 427 #endif /* CONFIG_CHIP_M32700 */
 428         beqz    r1, inst
 429 oprand:
 430         ld      r2, @(low(MDEVA_offset),r2)     ; set address
 431         srli    r1, #1
 432         bra     1f
 433 inst:
 434         and3    r1, r4, #2
 435         srli    r1, #1
 436         or3     r1, r1, #8
 437         mvfc    r2, bpc                         ; set address
 438         .fillinsn
 439 1:
 440         mvfc    r3, psw
 441         mv      r0, sp
 442         and3    r3, r3, 0x800
 443         srli    r3, #9
 444         or      r1, r3
 445         /*
 446          * do_page_fault():
 447          *    r0 : struct pt_regs *regs
 448          *    r1 : unsigned long error-code
 449          *    r2 : unsigned long address
 450          * error-code:
 451          *    +------+------+------+------+
 452          *    | bit3 | bit2 | bit1 | bit0 |
 453          *    +------+------+------+------+
 454          *    bit 3 == 0:means data,          1:means instruction
 455          *    bit 2 == 0:means kernel,        1:means user-mode
 456          *    bit 1 == 0:means read,          1:means write
 457          *    bit 0 == 0:means no page found  1:means protection fault
 458          *
 459          */
 460         bl      do_page_fault
 461         bra     ret_from_intr
 462 #endif  /* CONFIG_MMU */
 463
 464
 465 ENTRY(alignment_check)
 466         /* void alignment_check(int error_code) */
 467         SWITCH_TO_KERNEL_STACK
 468         SAVE_ALL
 469         ldi     r1, #0x30                       ; error_code
 470         mv      r0, sp                          ; pt_regs
 471         bl      do_alignment_check
 472 error_code:
 473         bra     ret_from_exception
 474
 475 ENTRY(rie_handler)
 476         /* void rie_handler(int error_code) */
 477         SWITCH_TO_KERNEL_STACK
 478         SAVE_ALL
 479         ldi     r1, #0x20                       ; error_code
 480         mv      r0, sp                          ; pt_regs
 481         bl      do_rie_handler
 482         bra     error_code
 483
 484 ENTRY(pie_handler)
 485         /* void pie_handler(int error_code) */
 486         SWITCH_TO_KERNEL_STACK
 487         SAVE_ALL
 488         ldi     r1, #0                          ; error_code ; FIXME
 489         mv      r0, sp                          ; pt_regs
 490         bl      do_pie_handler
 491         bra     error_code
 492
 493 ENTRY(debug_trap)
 494         /* void debug_trap(void) */
 495         .global withdraw_debug_trap
 496         SWITCH_TO_KERNEL_STACK
 497         SAVE_ALL
 498         mv      r0, sp                          ; pt_regs
 499         bl      withdraw_debug_trap
 500         ldi     r1, #0                          ; error_code
 501         mv      r0, sp                          ; pt_regs
 502         bl      do_debug_trap
 503         bra     error_code
 504
 505 ENTRY(ill_trap)
 506         /* void ill_trap(void) */
 507         SWITCH_TO_KERNEL_STACK
 508         SAVE_ALL
 509         ldi     r1, #0                          ; error_code ; FIXME
 510         mv      r0, sp                          ; pt_regs
 511         bl      do_ill_trap
 512         bra     error_code
 513
 514 ENTRY(cache_flushing_handler)
 515         /* void _flush_cache_all(void); */
 516         .global _flush_cache_all
 517         SWITCH_TO_KERNEL_STACK
 518         push    r0
 519         push    r1
 520         push    r2
 521         push    r3
 522         push    r4
 523         push    r5
 524         push    r6
 525         push    r7
 526         push    lr
 527         bl      _flush_cache_all
 528         pop     lr
 529         pop     r7
 530         pop     r6
 531         pop     r5
 532         pop     r4
 533         pop     r3
 534         pop     r2
 535         pop     r1
 536         pop     r0
 537         rte
 538
 539         .section .rodata,"a"
 540 #include "syscall_table.S"
 541
 542 syscall_table_size=(.-sys_call_table)