| /* | |
| * linux/arch/m32r/kernel/entry.S | |
| * | |
| * Copyright (c) 2001, 2002 Hirokazu Takata, Hitoshi Yamamoto, H. Kondo | |
| * Copyright (c) 2003 Hitoshi Yamamoto | |
| * Copyright (c) 2004 Hirokazu Takata <takata at linux-m32r.org> | |
| * | |
| * Taken from i386 version. | |
| * Copyright (C) 1991, 1992 Linus Torvalds | |
| */ | |
| /* | |
| * entry.S contains the system-call and fault low-level handling routines. | |
| * This also contains the timer-interrupt handler, as well as all interrupts | |
| * and faults that can result in a task-switch. | |
| * | |
| * NOTE: This code handles signal-recognition, which happens every time | |
| * after a timer-interrupt and after each system call. | |
| * | |
| * Stack layout in 'ret_from_system_call': | |
| * ptrace needs to have all regs on the stack. | |
| * if the order here is changed, it needs to be | |
| * updated in fork.c:copy_thread, signal.c:do_signal, | |
| * ptrace.c and ptrace.h | |
| * | |
| * M32Rx/M32R2 M32R | |
| * @(sp) - r4 ditto | |
| * @(0x04,sp) - r5 ditto | |
| * @(0x08,sp) - r6 ditto | |
| * @(0x0c,sp) - *pt_regs ditto | |
| * @(0x10,sp) - r0 ditto | |
| * @(0x14,sp) - r1 ditto | |
| * @(0x18,sp) - r2 ditto | |
| * @(0x1c,sp) - r3 ditto | |
| * @(0x20,sp) - r7 ditto | |
| * @(0x24,sp) - r8 ditto | |
| * @(0x28,sp) - r9 ditto | |
| * @(0x2c,sp) - r10 ditto | |
| * @(0x30,sp) - r11 ditto | |
| * @(0x34,sp) - r12 ditto | |
| * @(0x38,sp) - syscall_nr ditto | |
| * @(0x3c,sp) - acc0h @(0x3c,sp) - acch | |
| * @(0x40,sp) - acc0l @(0x40,sp) - accl | |
| * @(0x44,sp) - acc1h @(0x44,sp) - dummy_acc1h | |
| * @(0x48,sp) - acc1l @(0x48,sp) - dummy_acc1l | |
| * @(0x4c,sp) - psw ditto | |
| * @(0x50,sp) - bpc ditto | |
| * @(0x54,sp) - bbpsw ditto | |
| * @(0x58,sp) - bbpc ditto | |
| * @(0x5c,sp) - spu (cr3) ditto | |
| * @(0x60,sp) - fp (r13) ditto | |
| * @(0x64,sp) - lr (r14) ditto | |
| * @(0x68,sp) - spi (cr2) ditto | |
| * @(0x6c,sp) - orig_r0 ditto | |
| */ | |
| #include <linux/linkage.h> | |
| #include <asm/irq.h> | |
| #include <asm/unistd.h> | |
| #include <asm/assembler.h> | |
| #include <asm/thread_info.h> | |
| #include <asm/errno.h> | |
| #include <asm/segment.h> | |
| #include <asm/smp.h> | |
| #include <asm/page.h> | |
| #include <asm/m32r.h> | |
| #include <asm/mmu_context.h> | |
| #if !defined(CONFIG_MMU) | |
| #define sys_madvise sys_ni_syscall | |
| #define sys_readahead sys_ni_syscall | |
| #define sys_mprotect sys_ni_syscall | |
| #define sys_msync sys_ni_syscall | |
| #define sys_mlock sys_ni_syscall | |
| #define sys_munlock sys_ni_syscall | |
| #define sys_mlockall sys_ni_syscall | |
| #define sys_munlockall sys_ni_syscall | |
| #define sys_mremap sys_ni_syscall | |
| #define sys_mincore sys_ni_syscall | |
| #define sys_remap_file_pages sys_ni_syscall | |
| #endif /* CONFIG_MMU */ | |
| #define R4(reg) @reg | |
| #define R5(reg) @(0x04,reg) | |
| #define R6(reg) @(0x08,reg) | |
| #define PTREGS(reg) @(0x0C,reg) | |
| #define R0(reg) @(0x10,reg) | |
| #define R1(reg) @(0x14,reg) | |
| #define R2(reg) @(0x18,reg) | |
| #define R3(reg) @(0x1C,reg) | |
| #define R7(reg) @(0x20,reg) | |
| #define R8(reg) @(0x24,reg) | |
| #define R9(reg) @(0x28,reg) | |
| #define R10(reg) @(0x2C,reg) | |
| #define R11(reg) @(0x30,reg) | |
| #define R12(reg) @(0x34,reg) | |
| #define SYSCALL_NR(reg) @(0x38,reg) | |
| #if defined(CONFIG_ISA_M32R2) && defined(CONFIG_ISA_DSP_LEVEL2) | |
| #define ACC0H(reg) @(0x3C,reg) | |
| #define ACC0L(reg) @(0x40,reg) | |
| #define ACC1H(reg) @(0x44,reg) | |
| #define ACC1L(reg) @(0x48,reg) | |
| #elif defined(CONFIG_ISA_M32R2) || defined(CONFIG_ISA_M32R) | |
| #define ACCH(reg) @(0x3C,reg) | |
| #define ACCL(reg) @(0x40,reg) | |
| #else | |
| #error unknown isa configuration | |
| #endif | |
| #define PSW(reg) @(0x4C,reg) | |
| #define BPC(reg) @(0x50,reg) | |
| #define BBPSW(reg) @(0x54,reg) | |
| #define BBPC(reg) @(0x58,reg) | |
| #define SPU(reg) @(0x5C,reg) | |
| #define FP(reg) @(0x60,reg) /* FP = R13 */ | |
| #define LR(reg) @(0x64,reg) | |
| #define SP(reg) @(0x68,reg) | |
| #define ORIG_R0(reg) @(0x6C,reg) | |
| CF_MASK = 0x00000001 | |
| TF_MASK = 0x00000100 | |
| IF_MASK = 0x00000200 | |
| DF_MASK = 0x00000400 | |
| NT_MASK = 0x00004000 | |
| VM_MASK = 0x00020000 | |
| #ifdef CONFIG_PREEMPT | |
| #define preempt_stop(x) CLI(x) | |
| #else | |
| #define preempt_stop(x) | |
| #define resume_kernel restore_all | |
| #endif | |
| ENTRY(ret_from_fork) | |
| pop r0 | |
| bl schedule_tail | |
| GET_THREAD_INFO(r8) | |
| bra syscall_exit | |
| /* | |
| * Return to user mode is not as complex as all this looks, | |
| * but we want the default path for a system call return to | |
| * go as quickly as possible which is why some of this is | |
| * less clear than it otherwise should be. | |
| */ | |
| ; userspace resumption stub bypassing syscall exit tracing | |
| ALIGN | |
| ret_from_exception: | |
| preempt_stop(r4) | |
| ret_from_intr: | |
| ld r4, PSW(sp) | |
| #ifdef CONFIG_ISA_M32R2 | |
| and3 r4, r4, #0x8800 ; check BSM and BPM bits | |
| #else | |
| and3 r4, r4, #0x8000 ; check BSM bit | |
| #endif | |
| beqz r4, resume_kernel | |
| ENTRY(resume_userspace) | |
| CLI(r4) ; make sure we don't miss an interrupt | |
| ; setting need_resched or sigpending | |
| ; between sampling and the iret | |
| GET_THREAD_INFO(r8) | |
| ld r9, @(TI_FLAGS, r8) | |
| and3 r4, r9, #_TIF_WORK_MASK ; is there any work to be done on | |
| ; int/exception return? | |
| bnez r4, work_pending | |
| bra restore_all | |
| #ifdef CONFIG_PREEMPT | |
| ENTRY(resume_kernel) | |
| GET_THREAD_INFO(r8) | |
| ld r9, @(TI_PRE_COUNT, r8) ; non-zero preempt_count ? | |
| bnez r9, restore_all | |
| need_resched: | |
| ld r9, @(TI_FLAGS, r8) ; need_resched set ? | |
| and3 r4, r9, #_TIF_NEED_RESCHED | |
| beqz r4, restore_all | |
| ld r4, PSW(sp) ; interrupts off (exception path) ? | |
| and3 r4, r4, #0x4000 | |
| beqz r4, restore_all | |
| LDIMM (r4, PREEMPT_ACTIVE) | |
| st r4, @(TI_PRE_COUNT, r8) | |
| STI(r4) | |
| bl schedule | |
| ldi r4, #0 | |
| st r4, @(TI_PRE_COUNT, r8) | |
| CLI(r4) | |
| bra need_resched | |
| #endif | |
| ; system call handler stub | |
| ENTRY(system_call) | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| STI(r4) ; Enable interrupt | |
| st sp, PTREGS(sp) ; implicit pt_regs parameter | |
| cmpui r7, #NR_syscalls | |
| bnc syscall_badsys | |
| st r7, SYSCALL_NR(sp) ; syscall_nr | |
| ; system call tracing in operation | |
| GET_THREAD_INFO(r8) | |
| ld r9, @(TI_FLAGS, r8) | |
| and3 r4, r9, #_TIF_SYSCALL_TRACE | |
| bnez r4, syscall_trace_entry | |
| syscall_call: | |
| slli r7, #2 ; table jump for the system call | |
| LDIMM (r4, sys_call_table) | |
| add r7, r4 | |
| ld r7, @r7 | |
| jl r7 ; execute system call | |
| st r0, R0(sp) ; save the return value | |
| syscall_exit: | |
| CLI(r4) ; make sure we don't miss an interrupt | |
| ; setting need_resched or sigpending | |
| ; between sampling and the iret | |
| ld r9, @(TI_FLAGS, r8) | |
| and3 r4, r9, #_TIF_ALLWORK_MASK ; current->work | |
| bnez r4, syscall_exit_work | |
| restore_all: | |
| RESTORE_ALL | |
| # perform work that needs to be done immediately before resumption | |
| # r9 : flags | |
| ALIGN | |
| work_pending: | |
| and3 r4, r9, #_TIF_NEED_RESCHED | |
| beqz r4, work_notifysig | |
| work_resched: | |
| bl schedule | |
| CLI(r4) ; make sure we don't miss an interrupt | |
| ; setting need_resched or sigpending | |
| ; between sampling and the iret | |
| ld r9, @(TI_FLAGS, r8) | |
| and3 r4, r9, #_TIF_WORK_MASK ; is there any work to be done other | |
| ; than syscall tracing? | |
| beqz r4, restore_all | |
| and3 r4, r4, #_TIF_NEED_RESCHED | |
| bnez r4, work_resched | |
| work_notifysig: ; deal with pending signals and | |
| ; notify-resume requests | |
| mv r0, sp ; arg1 : struct pt_regs *regs | |
| ldi r1, #0 ; arg2 : sigset_t *oldset | |
| mv r2, r9 ; arg3 : __u32 thread_info_flags | |
| bl do_notify_resume | |
| bra restore_all | |
| ; perform syscall exit tracing | |
| ALIGN | |
| syscall_trace_entry: | |
| ldi r4, #-ENOSYS | |
| st r4, R0(sp) | |
| bl do_syscall_trace | |
| ld r0, ORIG_R0(sp) | |
| ld r1, R1(sp) | |
| ld r2, R2(sp) | |
| ld r3, R3(sp) | |
| ld r4, R4(sp) | |
| ld r5, R5(sp) | |
| ld r6, R6(sp) | |
| ld r7, SYSCALL_NR(sp) | |
| cmpui r7, #NR_syscalls | |
| bc syscall_call | |
| bra syscall_exit | |
| ; perform syscall exit tracing | |
| ALIGN | |
| syscall_exit_work: | |
| ld r9, @(TI_FLAGS, r8) | |
| and3 r4, r9, #_TIF_SYSCALL_TRACE | |
| beqz r4, work_pending | |
| STI(r4) ; could let do_syscall_trace() call | |
| ; schedule() instead | |
| bl do_syscall_trace | |
| bra resume_userspace | |
| ALIGN | |
| syscall_fault: | |
| SAVE_ALL | |
| GET_THREAD_INFO(r8) | |
| ldi r4, #-EFAULT | |
| st r4, R0(sp) | |
| bra resume_userspace | |
| ALIGN | |
| syscall_badsys: | |
| ldi r4, #-ENOSYS | |
| st r4, R0(sp) | |
| bra resume_userspace | |
| .global eit_vector | |
| .equ ei_vec_table, eit_vector + 0x0200 | |
| /* | |
| * EI handler routine | |
| */ | |
| ENTRY(ei_handler) | |
| #if defined(CONFIG_CHIP_M32700) | |
| SWITCH_TO_KERNEL_STACK | |
| ; WORKAROUND: force to clear SM bit and use the kernel stack (SPI). | |
| #endif | |
| SAVE_ALL | |
| mv r1, sp ; arg1(regs) | |
| #if defined(CONFIG_CHIP_VDEC2) || defined(CONFIG_CHIP_XNUX2) \ | |
| || defined(CONFIG_CHIP_M32700) || defined(CONFIG_CHIP_M32102) \ | |
| || defined(CONFIG_CHIP_OPSP) || defined(CONFIG_CHIP_M32104) | |
| ; GET_ICU_STATUS; | |
| seth r0, #shigh(M32R_ICU_ISTS_ADDR) | |
| ld r0, @(low(M32R_ICU_ISTS_ADDR),r0) | |
| push r0 | |
| #if defined(CONFIG_SMP) | |
| /* | |
| * If IRQ == 0 --> Nothing to do, Not write IMASK | |
| * If IRQ == IPI --> Do IPI handler, Not write IMASK | |
| * If IRQ != 0, IPI --> Do do_IRQ(), Write IMASK | |
| */ | |
| slli r0, #4 | |
| srli r0, #24 ; r0(irq_num<<2) | |
| ;; IRQ exist check | |
| #if defined(CONFIG_CHIP_M32700) | |
| /* WORKAROUND: IMASK bug M32700-TS1, TS2 chip. */ | |
| beqz r0, 3f ; if (!irq_num) goto exit | |
| #else | |
| beqz r0, 1f ; if (!irq_num) goto exit | |
| #endif /* WORKAROUND */ | |
| ;; IPI check | |
| cmpi r0, #(M32R_IRQ_IPI0<<2) ; ISN < IPI0 check | |
| bc 2f | |
| cmpi r0, #((M32R_IRQ_IPI7+1)<<2) ; ISN > IPI7 check | |
| bnc 2f | |
| LDIMM (r2, ei_vec_table) | |
| add r2, r0 | |
| ld r2, @r2 | |
| beqz r2, 1f ; if (no IPI handler) goto exit | |
| mv r0, r1 ; arg0(regs) | |
| jl r2 | |
| .fillinsn | |
| 1: | |
| addi sp, #4 | |
| bra ret_to_intr | |
| #if defined(CONFIG_CHIP_M32700) | |
| /* WORKAROUND: IMASK bug M32700-TS1, TS2 chip. */ | |
| .fillinsn | |
| 3: | |
| ld24 r14, #0x00070000 | |
| seth r0, #shigh(M32R_ICU_IMASK_ADDR) | |
| st r14, @(low(M32R_ICU_IMASK_ADDR), r0) | |
| addi sp, #4 | |
| bra ret_to_intr | |
| #endif /* WORKAROUND */ | |
| ;; do_IRQ | |
| .fillinsn | |
| 2: | |
| srli r0, #2 | |
| #if defined(CONFIG_PLAT_USRV) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, 9f | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(M32700UT_PLD_IRQ_BASE) | |
| .fillinsn | |
| 9: | |
| #elif defined(CONFIG_PLAT_M32700UT) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, check_int0 | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(M32700UT_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int0: | |
| add3 r2, r0, #-(M32R_IRQ_INT0) ; INT0# interrupt | |
| bnez r2, check_int2 | |
| ; read ICU status of LAN-board | |
| seth r0, #high(M32700UT_LAN_ICUISTS) | |
| or3 r0, r0, #low(M32700UT_LAN_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(M32700UT_LAN_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int2: | |
| add3 r2, r0, #-(M32R_IRQ_INT2) ; INT2# interrupt | |
| bnez r2, check_end | |
| ; read ICU status of LCD-board | |
| seth r0, #high(M32700UT_LCD_ICUISTS) | |
| or3 r0, r0, #low(M32700UT_LCD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(M32700UT_LCD_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_end: | |
| #elif defined(CONFIG_PLAT_OPSPUT) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, check_int0 | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(OPSPUT_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int0: | |
| add3 r2, r0, #-(M32R_IRQ_INT0) ; INT0# interrupt | |
| bnez r2, check_int2 | |
| ; read ICU status of LAN-board | |
| seth r0, #high(OPSPUT_LAN_ICUISTS) | |
| or3 r0, r0, #low(OPSPUT_LAN_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(OPSPUT_LAN_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int2: | |
| add3 r2, r0, #-(M32R_IRQ_INT2) ; INT2# interrupt | |
| bnez r2, check_end | |
| ; read ICU status of LCD-board | |
| seth r0, #high(OPSPUT_LCD_ICUISTS) | |
| or3 r0, r0, #low(OPSPUT_LCD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(OPSPUT_LCD_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_end: | |
| #endif /* CONFIG_PLAT_OPSPUT */ | |
| bl do_IRQ ; r0(irq), r1(regs) | |
| #else /* not CONFIG_SMP */ | |
| srli r0, #22 ; r0(irq) | |
| #if defined(CONFIG_PLAT_USRV) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, 1f | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(M32700UT_PLD_IRQ_BASE) | |
| .fillinsn | |
| 1: | |
| #elif defined(CONFIG_PLAT_M32700UT) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, check_int0 | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(M32700UT_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int0: | |
| add3 r2, r0, #-(M32R_IRQ_INT0) ; INT0# interrupt | |
| bnez r2, check_int2 | |
| ; read ICU status of LAN-board | |
| seth r0, #high(M32700UT_LAN_ICUISTS) | |
| or3 r0, r0, #low(M32700UT_LAN_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(M32700UT_LAN_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int2: | |
| add3 r2, r0, #-(M32R_IRQ_INT2) ; INT2# interrupt | |
| bnez r2, check_end | |
| ; read ICU status of LCD-board | |
| seth r0, #high(M32700UT_LCD_ICUISTS) | |
| or3 r0, r0, #low(M32700UT_LCD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(M32700UT_LCD_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_end: | |
| #elif defined(CONFIG_PLAT_OPSPUT) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, check_int0 | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(OPSPUT_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int0: | |
| add3 r2, r0, #-(M32R_IRQ_INT0) ; INT0# interrupt | |
| bnez r2, check_int2 | |
| ; read ICU status of LAN-board | |
| seth r0, #high(OPSPUT_LAN_ICUISTS) | |
| or3 r0, r0, #low(OPSPUT_LAN_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(OPSPUT_LAN_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_int2: | |
| add3 r2, r0, #-(M32R_IRQ_INT2) ; INT2# interrupt | |
| bnez r2, check_end | |
| ; read ICU status of LCD-board | |
| seth r0, #high(OPSPUT_LCD_ICUISTS) | |
| or3 r0, r0, #low(OPSPUT_LCD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| add3 r0, r0, #(OPSPUT_LCD_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_end: | |
| #elif defined(CONFIG_PLAT_M32104UT) | |
| add3 r2, r0, #-(M32R_IRQ_INT1) ; INT1# interrupt | |
| bnez r2, check_end | |
| ; read ICU status register of PLD | |
| seth r0, #high(PLD_ICUISTS) | |
| or3 r0, r0, #low(PLD_ICUISTS) | |
| lduh r0, @r0 | |
| slli r0, #21 | |
| srli r0, #27 ; ISN | |
| addi r0, #(M32104UT_PLD_IRQ_BASE) | |
| bra check_end | |
| .fillinsn | |
| check_end: | |
| #endif /* CONFIG_PLAT_M32104UT */ | |
| bl do_IRQ | |
| #endif /* CONFIG_SMP */ | |
| pop r14 | |
| seth r0, #shigh(M32R_ICU_IMASK_ADDR) | |
| st r14, @(low(M32R_ICU_IMASK_ADDR),r0) | |
| #else | |
| #error no chip configuration | |
| #endif | |
| ret_to_intr: | |
| bra ret_from_intr | |
| /* | |
| * Default EIT handler | |
| */ | |
| ALIGN | |
| int_msg: | |
| .asciz "Unknown interrupt\n" | |
| .byte 0 | |
| ENTRY(default_eit_handler) | |
| push r0 | |
| mvfc r0, psw | |
| push r1 | |
| push r2 | |
| push r3 | |
| push r0 | |
| LDIMM (r0, __KERNEL_DS) | |
| mv r0, r1 | |
| mv r0, r2 | |
| LDIMM (r0, int_msg) | |
| bl printk | |
| pop r0 | |
| pop r3 | |
| pop r2 | |
| pop r1 | |
| mvtc r0, psw | |
| pop r0 | |
| infinit: | |
| bra infinit | |
| #ifdef CONFIG_MMU | |
| /* | |
| * Access Exception handler | |
| */ | |
| ENTRY(ace_handler) | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| seth r2, #shigh(MMU_REG_BASE) /* Check status register */ | |
| ld r4, @(low(MESTS_offset),r2) | |
| st r4, @(low(MESTS_offset),r2) | |
| srl3 r1, r4, #4 | |
| #ifdef CONFIG_CHIP_M32700 | |
| and3 r1, r1, #0x0000ffff | |
| ; WORKAROUND: ignore TME bit for the M32700(TS1). | |
| #endif /* CONFIG_CHIP_M32700 */ | |
| beqz r1, inst | |
| oprand: | |
| ld r2, @(low(MDEVA_offset),r2) ; set address | |
| srli r2, #12 | |
| slli r2, #12 | |
| srli r1, #1 | |
| bra 1f | |
| inst: | |
| and3 r1, r4, #2 | |
| srli r1, #1 | |
| or3 r1, r1, #8 | |
| mvfc r2, bpc ; set address | |
| .fillinsn | |
| 1: | |
| mvfc r3, psw | |
| mv r0, sp | |
| and3 r3, r3, 0x800 | |
| srli r3, #9 | |
| or r1, r3 | |
| /* | |
| * do_page_fault(): | |
| * r0 : struct pt_regs *regs | |
| * r1 : unsigned long error-code | |
| * r2 : unsigned long address | |
| * error-code: | |
| * +------+------+------+------+ | |
| * | bit3 | bit2 | bit1 | bit0 | | |
| * +------+------+------+------+ | |
| * bit 3 == 0:means data, 1:means instruction | |
| * bit 2 == 0:means kernel, 1:means user-mode | |
| * bit 1 == 0:means read, 1:means write | |
| * bit 0 == 0:means no page found 1:means protection fault | |
| * | |
| */ | |
| bl do_page_fault | |
| bra ret_from_intr | |
| #endif /* CONFIG_MMU */ | |
| ENTRY(alignment_check) | |
| /* void alignment_check(int error_code) */ | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| ldi r1, #0x30 ; error_code | |
| mv r0, sp ; pt_regs | |
| bl do_alignment_check | |
| error_code: | |
| bra ret_from_exception | |
| ENTRY(rie_handler) | |
| /* void rie_handler(int error_code) */ | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| ldi r1, #0x20 ; error_code | |
| mv r0, sp ; pt_regs | |
| bl do_rie_handler | |
| bra error_code | |
| ENTRY(pie_handler) | |
| /* void pie_handler(int error_code) */ | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| ldi r1, #0 ; error_code ; FIXME | |
| mv r0, sp ; pt_regs | |
| bl do_pie_handler | |
| bra error_code | |
| ENTRY(debug_trap) | |
| .global withdraw_debug_trap | |
| /* void debug_trap(void) */ | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| mv r0, sp ; pt_regs | |
| bl withdraw_debug_trap | |
| ldi r1, #0 ; error_code | |
| mv r0, sp ; pt_regs | |
| bl do_debug_trap | |
| bra error_code | |
| ENTRY(ill_trap) | |
| /* void ill_trap(void) */ | |
| SWITCH_TO_KERNEL_STACK | |
| SAVE_ALL | |
| ldi r1, #0 ; error_code ; FIXME | |
| mv r0, sp ; pt_regs | |
| bl do_ill_trap | |
| bra error_code | |
| /* Cache flushing handler */ | |
| ENTRY(cache_flushing_handler) | |
| .global _flush_cache_all | |
| /* void _flush_cache_all(void); */ | |
| SWITCH_TO_KERNEL_STACK | |
| push r0 | |
| push r1 | |
| push r2 | |
| push r3 | |
| push r4 | |
| push r5 | |
| push r6 | |
| push r7 | |
| push lr | |
| bl _flush_cache_all | |
| pop lr | |
| pop r7 | |
| pop r6 | |
| pop r5 | |
| pop r4 | |
| pop r3 | |
| pop r2 | |
| pop r1 | |
| pop r0 | |
| rte | |
| .data | |
| ENTRY(sys_call_table) | |
| .long sys_restart_syscall /* 0 - old "setup()" system call*/ | |
| .long sys_exit | |
| .long sys_fork | |
| .long sys_read | |
| .long sys_write | |
| .long sys_open /* 5 */ | |
| .long sys_close | |
| .long sys_waitpid | |
| .long sys_creat | |
| .long sys_link | |
| .long sys_unlink /* 10 */ | |
| .long sys_execve | |
| .long sys_chdir | |
| .long sys_time | |
| .long sys_mknod | |
| .long sys_chmod /* 15 */ | |
| .long sys_ni_syscall /* lchown16 syscall holder */ | |
| .long sys_ni_syscall /* old break syscall holder */ | |
| .long sys_ni_syscall /* old stat syscall holder */ | |
| .long sys_lseek | |
| .long sys_getpid /* 20 */ | |
| .long sys_mount | |
| .long sys_oldumount | |
| .long sys_ni_syscall /* setuid16 syscall holder */ | |
| .long sys_ni_syscall /* getuid16 syscall holder */ | |
| .long sys_stime /* 25 */ | |
| .long sys_ptrace | |
| .long sys_alarm | |
| .long sys_ni_syscall /* old fstat syscall holder */ | |
| .long sys_pause | |
| .long sys_utime /* 30 */ | |
| .long sys_ni_syscall /* old stty syscall holder */ | |
| .long sys_cachectl /* for M32R */ /* old gtty syscall holder */ | |
| .long sys_access | |
| .long sys_ni_syscall /* nice syscall holder */ | |
| .long sys_ni_syscall /* 35 - old ftime syscall holder */ | |
| .long sys_sync | |
| .long sys_kill | |
| .long sys_rename | |
| .long sys_mkdir | |
| .long sys_rmdir /* 40 */ | |
| .long sys_dup | |
| .long sys_pipe | |
| .long sys_times | |
| .long sys_ni_syscall /* old prof syscall holder */ | |
| .long sys_brk /* 45 */ | |
| .long sys_ni_syscall /* setgid16 syscall holder */ | |
| .long sys_getgid /* will be unused */ | |
| .long sys_ni_syscall /* signal syscall holder */ | |
| .long sys_ni_syscall /* geteuid16 syscall holder */ | |
| .long sys_ni_syscall /* 50 - getegid16 syscall holder */ | |
| .long sys_acct | |
| .long sys_umount /* recycled never used phys() */ | |
| .long sys_ni_syscall /* old lock syscall holder */ | |
| .long sys_ioctl | |
| .long sys_fcntl /* 55 - will be unused */ | |
| .long sys_ni_syscall /* mpx syscall holder */ | |
| .long sys_setpgid | |
| .long sys_ni_syscall /* old ulimit syscall holder */ | |
| .long sys_ni_syscall /* sys_olduname */ | |
| .long sys_umask /* 60 */ | |
| .long sys_chroot | |
| .long sys_ustat | |
| .long sys_dup2 | |
| .long sys_getppid | |
| .long sys_getpgrp /* 65 */ | |
| .long sys_setsid | |
| .long sys_ni_syscall /* sigaction syscall holder */ | |
| .long sys_ni_syscall /* sgetmask syscall holder */ | |
| .long sys_ni_syscall /* ssetmask syscall holder */ | |
| .long sys_ni_syscall /* 70 - setreuid16 syscall holder */ | |
| .long sys_ni_syscall /* setregid16 syscall holder */ | |
| .long sys_ni_syscall /* sigsuspend syscall holder */ | |
| .long sys_ni_syscall /* sigpending syscall holder */ | |
| .long sys_sethostname | |
| .long sys_setrlimit /* 75 */ | |
| .long sys_getrlimit/*will be unused*/ | |
| .long sys_getrusage | |
| .long sys_gettimeofday | |
| .long sys_settimeofday | |
| .long sys_ni_syscall /* 80 - getgroups16 syscall holder */ | |
| .long sys_ni_syscall /* setgroups16 syscall holder */ | |
| .long sys_ni_syscall /* sys_oldselect */ | |
| .long sys_symlink | |
| .long sys_ni_syscall /* old lstat syscall holder */ | |
| .long sys_readlink /* 85 */ | |
| .long sys_uselib | |
| .long sys_swapon | |
| .long sys_reboot | |
| .long sys_ni_syscall /* readdir syscall holder */ | |
| .long sys_ni_syscall /* 90 - old_mmap syscall holder */ | |
| .long sys_munmap | |
| .long sys_truncate | |
| .long sys_ftruncate | |
| .long sys_fchmod | |
| .long sys_ni_syscall /* 95 - fchwon16 syscall holder */ | |
| .long sys_getpriority | |
| .long sys_setpriority | |
| .long sys_ni_syscall /* old profil syscall holder */ | |
| .long sys_statfs | |
| .long sys_fstatfs /* 100 */ | |
| .long sys_ni_syscall /* ioperm syscall holder */ | |
| .long sys_socketcall | |
| .long sys_syslog | |
| .long sys_setitimer | |
| .long sys_getitimer /* 105 */ | |
| .long sys_newstat | |
| .long sys_newlstat | |
| .long sys_newfstat | |
| .long sys_ni_syscall /* old uname syscall holder */ | |
| .long sys_ni_syscall /* 110 - iopl syscall holder */ | |
| .long sys_vhangup | |
| .long sys_ni_syscall /* idle syscall holder */ | |
| .long sys_ni_syscall /* vm86old syscall holder */ | |
| .long sys_wait4 | |
| .long sys_swapoff /* 115 */ | |
| .long sys_sysinfo | |
| .long sys_ipc | |
| .long sys_fsync | |
| .long sys_ni_syscall /* sigreturn syscall holder */ | |
| .long sys_clone /* 120 */ | |
| .long sys_setdomainname | |
| .long sys_newuname | |
| .long sys_ni_syscall /* modify_ldt syscall holder */ | |
| .long sys_adjtimex | |
| .long sys_mprotect /* 125 */ | |
| .long sys_ni_syscall /* sigprocmask syscall holder */ | |
| .long sys_ni_syscall /* create_module syscall holder */ | |
| .long sys_init_module | |
| .long sys_delete_module | |
| .long sys_ni_syscall /* 130 - get_kernel_syms */ | |
| .long sys_quotactl | |
| .long sys_getpgid | |
| .long sys_fchdir | |
| .long sys_bdflush | |
| .long sys_sysfs /* 135 */ | |
| .long sys_personality | |
| .long sys_ni_syscall /* afs_syscall syscall holder */ | |
| .long sys_ni_syscall /* setfsuid16 syscall holder */ | |
| .long sys_ni_syscall /* setfsgid16 syscall holder */ | |
| .long sys_llseek /* 140 */ | |
| .long sys_getdents | |
| .long sys_select | |
| .long sys_flock | |
| .long sys_msync | |
| .long sys_readv /* 145 */ | |
| .long sys_writev | |
| .long sys_getsid | |
| .long sys_fdatasync | |
| .long sys_sysctl | |
| .long sys_mlock /* 150 */ | |
| .long sys_munlock | |
| .long sys_mlockall | |
| .long sys_munlockall | |
| .long sys_sched_setparam | |
| .long sys_sched_getparam /* 155 */ | |
| .long sys_sched_setscheduler | |
| .long sys_sched_getscheduler | |
| .long sys_sched_yield | |
| .long sys_sched_get_priority_max | |
| .long sys_sched_get_priority_min /* 160 */ | |
| .long sys_sched_rr_get_interval | |
| .long sys_nanosleep | |
| .long sys_mremap | |
| .long sys_ni_syscall /* setresuid16 syscall holder */ | |
| .long sys_ni_syscall /* 165 - getresuid16 syscall holder */ | |
| .long sys_tas /* vm86 syscall holder */ | |
| .long sys_ni_syscall /* query_module syscall holder */ | |
| .long sys_poll | |
| .long sys_nfsservctl | |
| .long sys_setresgid /* 170 */ | |
| .long sys_getresgid | |
| .long sys_prctl | |
| .long sys_rt_sigreturn | |
| .long sys_rt_sigaction | |
| .long sys_rt_sigprocmask /* 175 */ | |
| .long sys_rt_sigpending | |
| .long sys_rt_sigtimedwait | |
| .long sys_rt_sigqueueinfo | |
| .long sys_rt_sigsuspend | |
| .long sys_pread64 /* 180 */ | |
| .long sys_pwrite64 | |
| .long sys_ni_syscall /* chown16 syscall holder */ | |
| .long sys_getcwd | |
| .long sys_capget | |
| .long sys_capset /* 185 */ | |
| .long sys_sigaltstack | |
| .long sys_sendfile | |
| .long sys_ni_syscall /* streams1 */ | |
| .long sys_ni_syscall /* streams2 */ | |
| .long sys_vfork /* 190 */ | |
| .long sys_getrlimit | |
| .long sys_mmap2 | |
| .long sys_truncate64 | |
| .long sys_ftruncate64 | |
| .long sys_stat64 /* 195 */ | |
| .long sys_lstat64 | |
| .long sys_fstat64 | |
| .long sys_lchown | |
| .long sys_getuid | |
| .long sys_getgid /* 200 */ | |
| .long sys_geteuid | |
| .long sys_getegid | |
| .long sys_setreuid | |
| .long sys_setregid | |
| .long sys_getgroups /* 205 */ | |
| .long sys_setgroups | |
| .long sys_fchown | |
| .long sys_setresuid | |
| .long sys_getresuid | |
| .long sys_setresgid /* 210 */ | |
| .long sys_getresgid | |
| .long sys_chown | |
| .long sys_setuid | |
| .long sys_setgid | |
| .long sys_setfsuid /* 215 */ | |
| .long sys_setfsgid | |
| .long sys_pivot_root | |
| .long sys_mincore | |
| .long sys_madvise | |
| .long sys_getdents64 /* 220 */ | |
| .long sys_fcntl64 | |
| .long sys_ni_syscall /* reserved for TUX */ | |
| .long sys_ni_syscall /* Reserved for Security */ | |
| .long sys_gettid | |
| .long sys_readahead /* 225 */ | |
| .long sys_setxattr | |
| .long sys_lsetxattr | |
| .long sys_fsetxattr | |
| .long sys_getxattr | |
| .long sys_lgetxattr /* 230 */ | |
| .long sys_fgetxattr | |
| .long sys_listxattr | |
| .long sys_llistxattr | |
| .long sys_flistxattr | |
| .long sys_removexattr /* 235 */ | |
| .long sys_lremovexattr | |
| .long sys_fremovexattr | |
| .long sys_tkill | |
| .long sys_sendfile64 | |
| .long sys_futex /* 240 */ | |
| .long sys_sched_setaffinity | |
| .long sys_sched_getaffinity | |
| .long sys_ni_syscall /* reserved for "set_thread_area" system call */ | |
| .long sys_ni_syscall /* reserved for "get_thread_area" system call */ | |
| .long sys_io_setup /* 245 */ | |
| .long sys_io_destroy | |
| .long sys_io_getevents | |
| .long sys_io_submit | |
| .long sys_io_cancel | |
| .long sys_fadvise64 /* 250 */ | |
| .long sys_ni_syscall | |
| .long sys_exit_group | |
| .long sys_lookup_dcookie | |
| .long sys_epoll_create | |
| .long sys_epoll_ctl /* 255 */ | |
| .long sys_epoll_wait | |
| .long sys_remap_file_pages | |
| .long sys_set_tid_address | |
| .long sys_timer_create | |
| .long sys_timer_settime /* 260 */ | |
| .long sys_timer_gettime | |
| .long sys_timer_getoverrun | |
| .long sys_timer_delete | |
| .long sys_clock_settime | |
| .long sys_clock_gettime /* 265 */ | |
| .long sys_clock_getres | |
| .long sys_clock_nanosleep | |
| .long sys_statfs64 | |
| .long sys_fstatfs64 | |
| .long sys_tgkill /* 270 */ | |
| .long sys_utimes | |
| .long sys_fadvise64_64 | |
| .long sys_ni_syscall /* Reserved for sys_vserver */ | |
| .long sys_ni_syscall /* Reserved for sys_mbind */ | |
| .long sys_ni_syscall /* Reserved for sys_get_mempolicy */ | |
| .long sys_ni_syscall /* Reserved for sys_set_mempolicy */ | |
| .long sys_mq_open | |
| .long sys_mq_unlink | |
| .long sys_mq_timedsend | |
| .long sys_mq_timedreceive /* 280 */ | |
| .long sys_mq_notify | |
| .long sys_mq_getsetattr | |
| .long sys_ni_syscall /* reserved for kexec */ | |
| .long sys_waitid | |
| syscall_table_size=(.-sys_call_table) |