|  | /* $Id: entry.S,v 1.37 2004/06/11 13:02:46 doyu Exp $ | 
|  | * | 
|  | *  linux/arch/sh/entry.S | 
|  | * | 
|  | *  Copyright (C) 1999, 2000, 2002  Niibe Yutaka | 
|  | *  Copyright (C) 2003  Paul Mundt | 
|  | * | 
|  | * This file is subject to the terms and conditions of the GNU General Public | 
|  | * License.  See the file "COPYING" in the main directory of this archive | 
|  | * for more details. | 
|  | * | 
|  | */ | 
|  |  | 
|  | #include <linux/sys.h> | 
|  | #include <linux/linkage.h> | 
|  | #include <asm/asm-offsets.h> | 
|  | #include <asm/thread_info.h> | 
|  | #include <asm/cpu/mmu_context.h> | 
|  | #include <asm/unistd.h> | 
|  |  | 
|  | #if !defined(CONFIG_NFSD) && !defined(CONFIG_NFSD_MODULE) | 
|  | #define sys_nfsservctl		sys_ni_syscall | 
|  | #endif | 
|  |  | 
|  | #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 | 
|  |  | 
|  | ! NOTE: | 
|  | ! GNU as (as of 2.9.1) changes bf/s into bt/s and bra, when the address | 
|  | ! to be jumped is too far, but it causes illegal slot exception. | 
|  |  | 
|  | /* | 
|  | * 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. | 
|  | * | 
|  | * NOTE: This code uses a convention that instructions in the delay slot | 
|  | * of a transfer-control instruction are indented by an extra space, thus: | 
|  | * | 
|  | *    jmp	@k0	    ! control-transfer instruction | 
|  | *     ldc	k1, ssr     ! delay slot | 
|  | * | 
|  | * Stack layout in 'ret_from_syscall': | 
|  | * 	ptrace needs to have all regs on the stack. | 
|  | *	if the order here is changed, it needs to be | 
|  | *	updated in ptrace.c and ptrace.h | 
|  | * | 
|  | *	r0 | 
|  | *      ... | 
|  | *	r15 = stack pointer | 
|  | *	spc | 
|  | *	pr | 
|  | *	ssr | 
|  | *	gbr | 
|  | *	mach | 
|  | *	macl | 
|  | *	syscall # | 
|  | * | 
|  | */ | 
|  |  | 
|  | ENOSYS = 38 | 
|  | EINVAL = 22 | 
|  |  | 
|  | #if defined(CONFIG_KGDB_NMI) | 
|  | NMI_VEC = 0x1c0			! Must catch early for debounce | 
|  | #endif | 
|  |  | 
|  | /* Offsets to the stack */ | 
|  | OFF_R0  =  0		/* Return value. New ABI also arg4 */ | 
|  | OFF_R1  =  4     	/* New ABI: arg5 */ | 
|  | OFF_R2  =  8     	/* New ABI: arg6 */ | 
|  | OFF_R3  =  12     	/* New ABI: syscall_nr */ | 
|  | OFF_R4  =  16     	/* New ABI: arg0 */ | 
|  | OFF_R5  =  20     	/* New ABI: arg1 */ | 
|  | OFF_R6  =  24     	/* New ABI: arg2 */ | 
|  | OFF_R7  =  28     	/* New ABI: arg3 */ | 
|  | OFF_SP	=  (15*4) | 
|  | OFF_PC  =  (16*4) | 
|  | OFF_SR	=  (16*4+8) | 
|  | OFF_TRA	=  (16*4+6*4) | 
|  |  | 
|  |  | 
|  | #define k0	r0 | 
|  | #define k1	r1 | 
|  | #define k2	r2 | 
|  | #define k3	r3 | 
|  | #define k4	r4 | 
|  |  | 
|  | #define k_ex_code	r2_bank	/* r2_bank1 */ | 
|  | #define g_imask		r6	/* r6_bank1 */ | 
|  | #define k_g_imask	r6_bank	/* r6_bank1 */ | 
|  | #define current		r7	/* r7_bank1 */ | 
|  |  | 
|  | /* | 
|  | * Kernel mode register usage: | 
|  | *	k0	scratch | 
|  | *	k1	scratch | 
|  | *	k2	scratch (Exception code) | 
|  | *	k3	scratch (Return address) | 
|  | *	k4	scratch | 
|  | *	k5	reserved | 
|  | *	k6	Global Interrupt Mask (0--15 << 4) | 
|  | *	k7	CURRENT_THREAD_INFO (pointer to current thread info) | 
|  | */ | 
|  |  | 
|  | ! | 
|  | ! TLB Miss / Initial Page write exception handling | 
|  | !			_and_ | 
|  | ! TLB hits, but the access violate the protection. | 
|  | ! It can be valid access, such as stack grow and/or C-O-W. | 
|  | ! | 
|  | ! | 
|  | ! Find the pmd/pte entry and loadtlb | 
|  | ! If it's not found, cause address error (SEGV) | 
|  | ! | 
|  | ! Although this could be written in assembly language (and it'd be faster), | 
|  | ! this first version depends *much* on C implementation. | 
|  | ! | 
|  |  | 
|  | #define CLI()				\ | 
|  | stc	sr, r0;			\ | 
|  | or	#0xf0, r0;		\ | 
|  | ldc	r0, sr | 
|  |  | 
|  | #define STI()				\ | 
|  | mov.l	__INV_IMASK, r11;	\ | 
|  | stc	sr, r10;		\ | 
|  | and	r11, r10;		\ | 
|  | stc	k_g_imask, r11;		\ | 
|  | or	r11, r10;		\ | 
|  | ldc	r10, sr | 
|  |  | 
|  | #if defined(CONFIG_PREEMPT) | 
|  | #  define preempt_stop()	CLI() | 
|  | #else | 
|  | #  define preempt_stop() | 
|  | #  define resume_kernel		restore_all | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_MMU) | 
|  | .align	2 | 
|  | ENTRY(tlb_miss_load) | 
|  | bra	call_dpf | 
|  | mov	#0, r5 | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(tlb_miss_store) | 
|  | bra	call_dpf | 
|  | mov	#1, r5 | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(initial_page_write) | 
|  | bra	call_dpf | 
|  | mov	#1, r5 | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(tlb_protection_violation_load) | 
|  | bra	call_dpf | 
|  | mov	#0, r5 | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(tlb_protection_violation_store) | 
|  | bra	call_dpf | 
|  | mov	#1, r5 | 
|  |  | 
|  | call_dpf: | 
|  | mov.l	1f, r0 | 
|  | mov	r5, r8 | 
|  | mov.l	@r0, r6 | 
|  | mov	r6, r9 | 
|  | mov.l	2f, r0 | 
|  | sts	pr, r10 | 
|  | jsr	@r0 | 
|  | mov	r15, r4 | 
|  | ! | 
|  | tst	r0, r0 | 
|  | bf/s	0f | 
|  | lds	r10, pr | 
|  | rts | 
|  | nop | 
|  | 0:	STI() | 
|  | mov.l	3f, r0 | 
|  | mov	r9, r6 | 
|  | mov	r8, r5 | 
|  | jmp	@r0 | 
|  | mov	r15, r4 | 
|  |  | 
|  | .align 2 | 
|  | 1:	.long	MMU_TEA | 
|  | 2:	.long	__do_page_fault | 
|  | 3:	.long	do_page_fault | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(address_error_load) | 
|  | bra	call_dae | 
|  | mov	#0,r5		! writeaccess = 0 | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(address_error_store) | 
|  | bra	call_dae | 
|  | mov	#1,r5		! writeaccess = 1 | 
|  |  | 
|  | .align	2 | 
|  | call_dae: | 
|  | mov.l	1f, r0 | 
|  | mov.l	@r0, r6		! address | 
|  | mov.l	2f, r0 | 
|  | jmp	@r0 | 
|  | mov	r15, r4		! regs | 
|  |  | 
|  | .align 2 | 
|  | 1:	.long	MMU_TEA | 
|  | 2:	.long   do_address_error | 
|  | #endif /* CONFIG_MMU */ | 
|  |  | 
|  | #if defined(CONFIG_SH_STANDARD_BIOS) || defined(CONFIG_SH_KGDB) | 
|  | ! Handle kernel debug if either kgdb (SW) or gdb-stub (FW) is present. | 
|  | ! If both are configured, handle the debug traps (breakpoints) in SW, | 
|  | ! but still allow BIOS traps to FW. | 
|  |  | 
|  | .align	2 | 
|  | debug_kernel: | 
|  | #if defined(CONFIG_SH_STANDARD_BIOS) && defined(CONFIG_SH_KGDB) | 
|  | /* Force BIOS call to FW (debug_trap put TRA in r8) */ | 
|  | mov	r8,r0 | 
|  | shlr2	r0 | 
|  | cmp/eq	#0x3f,r0 | 
|  | bt	debug_kernel_fw | 
|  | #endif /* CONFIG_SH_STANDARD_BIOS && CONFIG_SH_KGDB */ | 
|  |  | 
|  | debug_enter: | 
|  | #if defined(CONFIG_SH_KGDB) | 
|  | /* Jump to kgdb, pass stacked regs as arg */ | 
|  | debug_kernel_sw: | 
|  | mov.l	3f, r0 | 
|  | jmp	@r0 | 
|  | mov	r15, r4 | 
|  | .align	2 | 
|  | 3:	.long	kgdb_handle_exception | 
|  | #endif /* CONFIG_SH_KGDB */ | 
|  |  | 
|  | #if defined(CONFIG_SH_STANDARD_BIOS) | 
|  | /* Unwind the stack and jmp to the debug entry */ | 
|  | debug_kernel_fw: | 
|  | mov.l	@r15+, r0 | 
|  | mov.l	@r15+, r1 | 
|  | mov.l	@r15+, r2 | 
|  | mov.l	@r15+, r3 | 
|  | mov.l	@r15+, r4 | 
|  | mov.l	@r15+, r5 | 
|  | mov.l	@r15+, r6 | 
|  | mov.l	@r15+, r7 | 
|  | stc	sr, r8 | 
|  | mov.l	1f, r9			! BL =1, RB=1, IMASK=0x0F | 
|  | or	r9, r8 | 
|  | ldc	r8, sr			! here, change the register bank | 
|  | mov.l	@r15+, r8 | 
|  | mov.l	@r15+, r9 | 
|  | mov.l	@r15+, r10 | 
|  | mov.l	@r15+, r11 | 
|  | mov.l	@r15+, r12 | 
|  | mov.l	@r15+, r13 | 
|  | mov.l	@r15+, r14 | 
|  | mov.l	@r15+, k0 | 
|  | ldc.l	@r15+, spc | 
|  | lds.l	@r15+, pr | 
|  | mov.l	@r15+, k1 | 
|  | ldc.l	@r15+, gbr | 
|  | lds.l	@r15+, mach | 
|  | lds.l	@r15+, macl | 
|  | mov	k0, r15 | 
|  | ! | 
|  | mov.l	2f, k0 | 
|  | mov.l	@k0, k0 | 
|  | jmp	@k0 | 
|  | ldc	k1, ssr | 
|  | .align	2 | 
|  | 1:	.long	0x300000f0 | 
|  | 2:	.long	gdb_vbr_vector | 
|  | #endif /* CONFIG_SH_STANDARD_BIOS */ | 
|  |  | 
|  | #endif /* CONFIG_SH_STANDARD_BIOS || CONFIG_SH_KGDB */ | 
|  |  | 
|  |  | 
|  | .align	2 | 
|  | debug_trap: | 
|  | #if defined(CONFIG_SH_STANDARD_BIOS) || defined(CONFIG_SH_KGDB) | 
|  | mov	#OFF_SR, r0 | 
|  | mov.l	@(r0,r15), r0		! get status register | 
|  | shll	r0 | 
|  | shll	r0			! kernel space? | 
|  | bt/s	debug_kernel | 
|  | #endif | 
|  | mov.l	@r15, r0		! Restore R0 value | 
|  | mov.l	1f, r8 | 
|  | jmp	@r8 | 
|  | nop | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(exception_error) | 
|  | ! | 
|  | STI() | 
|  | mov.l	2f, r0 | 
|  | jmp	@r0 | 
|  | nop | 
|  |  | 
|  | ! | 
|  | .align	2 | 
|  | 1:	.long	break_point_trap_software | 
|  | 2:	.long	do_exception_error | 
|  |  | 
|  | .align	2 | 
|  | ret_from_exception: | 
|  | preempt_stop() | 
|  | ret_from_irq: | 
|  | ! | 
|  | mov	#OFF_SR, r0 | 
|  | mov.l	@(r0,r15), r0	! get status register | 
|  | shll	r0 | 
|  | shll	r0		! kernel space? | 
|  | bt/s	resume_kernel	! Yes, it's from kernel, go back soon | 
|  | GET_THREAD_INFO(r8) | 
|  |  | 
|  | #ifdef CONFIG_PREEMPT | 
|  | bra	resume_userspace | 
|  | nop | 
|  | ENTRY(resume_kernel) | 
|  | mov.l	@(TI_PRE_COUNT,r8), r0	! current_thread_info->preempt_count | 
|  | tst	r0, r0 | 
|  | bf	noresched | 
|  | need_resched: | 
|  | mov.l	@(TI_FLAGS,r8), r0	! current_thread_info->flags | 
|  | tst	#_TIF_NEED_RESCHED, r0	! need_resched set? | 
|  | bt	noresched | 
|  |  | 
|  | mov	#OFF_SR, r0 | 
|  | mov.l	@(r0,r15), r0		! get status register | 
|  | and	#0xf0, r0		! interrupts off (exception path)? | 
|  | cmp/eq	#0xf0, r0 | 
|  | bt	noresched | 
|  |  | 
|  | mov.l	1f, r0 | 
|  | mov.l	r0, @(TI_PRE_COUNT,r8) | 
|  |  | 
|  | STI() | 
|  | mov.l	2f, r0 | 
|  | jsr	@r0 | 
|  | nop | 
|  | mov	#0, r0 | 
|  | mov.l	r0, @(TI_PRE_COUNT,r8) | 
|  | CLI() | 
|  |  | 
|  | bra	need_resched | 
|  | nop | 
|  | noresched: | 
|  | bra	restore_all | 
|  | nop | 
|  |  | 
|  | .align 2 | 
|  | 1:	.long	PREEMPT_ACTIVE | 
|  | 2:	.long	schedule | 
|  | #endif | 
|  |  | 
|  | ENTRY(resume_userspace) | 
|  | ! r8: current_thread_info | 
|  | CLI() | 
|  | mov.l	@(TI_FLAGS,r8), r0		! current_thread_info->flags | 
|  | tst	#_TIF_WORK_MASK, r0 | 
|  | bt/s	restore_all | 
|  | tst	#_TIF_NEED_RESCHED, r0 | 
|  |  | 
|  | .align	2 | 
|  | work_pending: | 
|  | ! r0: current_thread_info->flags | 
|  | ! r8: current_thread_info | 
|  | ! t:  result of "tst	#_TIF_NEED_RESCHED, r0" | 
|  | bf/s	work_resched | 
|  | tst	#_TIF_SIGPENDING, r0 | 
|  | work_notifysig: | 
|  | bt/s	restore_all | 
|  | mov	r15, r4 | 
|  | mov	#0, r5 | 
|  | mov.l	2f, r1 | 
|  | mova	restore_all, r0 | 
|  | jmp	@r1 | 
|  | lds	r0, pr | 
|  | work_resched: | 
|  | #ifndef CONFIG_PREEMPT | 
|  | ! gUSA handling | 
|  | mov.l	@(OFF_SP,r15), r0	! get user space stack pointer | 
|  | mov	r0, r1 | 
|  | shll	r0 | 
|  | bf/s	1f | 
|  | shll	r0 | 
|  | bf/s	1f | 
|  | mov	#OFF_PC, r0 | 
|  | ! 				  SP >= 0xc0000000 : gUSA mark | 
|  | mov.l	@(r0,r15), r2		! get user space PC (program counter) | 
|  | mov.l	@(OFF_R0,r15), r3	! end point | 
|  | cmp/hs	r3, r2			! r2 >= r3? | 
|  | bt	1f | 
|  | add	r3, r1			! rewind point #2 | 
|  | mov.l	r1, @(r0,r15)		! reset PC to rewind point #2 | 
|  | ! | 
|  | 1: | 
|  | #endif | 
|  | mov.l	1f, r1 | 
|  | jsr	@r1				! schedule | 
|  | nop | 
|  | CLI() | 
|  | ! | 
|  | mov.l	@(TI_FLAGS,r8), r0		! current_thread_info->flags | 
|  | tst	#_TIF_WORK_MASK, r0 | 
|  | bt	restore_all | 
|  | bra	work_pending | 
|  | tst	#_TIF_NEED_RESCHED, r0 | 
|  |  | 
|  | .align	2 | 
|  | 1:	.long	schedule | 
|  | 2:	.long	do_signal | 
|  |  | 
|  | .align	2 | 
|  | syscall_exit_work: | 
|  | ! r0: current_thread_info->flags | 
|  | ! r8: current_thread_info | 
|  | tst	#_TIF_SYSCALL_TRACE, r0 | 
|  | bt/s	work_pending | 
|  | tst	#_TIF_NEED_RESCHED, r0 | 
|  | STI() | 
|  | ! XXX setup arguments... | 
|  | mov.l	4f, r0			! do_syscall_trace | 
|  | jsr	@r0 | 
|  | nop | 
|  | bra	resume_userspace | 
|  | nop | 
|  |  | 
|  | .align	2 | 
|  | syscall_trace_entry: | 
|  | !                     	Yes it is traced. | 
|  | ! XXX setup arguments... | 
|  | mov.l	4f, r11		! Call do_syscall_trace which notifies | 
|  | jsr	@r11	    	! superior (will chomp R[0-7]) | 
|  | nop | 
|  | !			Reload R0-R4 from kernel stack, where the | 
|  | !   	    	    	parent may have modified them using | 
|  | !   	    	    	ptrace(POKEUSR).  (Note that R0-R2 are | 
|  | !   	    	    	used by the system call handler directly | 
|  | !   	    	    	from the kernel stack anyway, so don't need | 
|  | !   	    	    	to be reloaded here.)  This allows the parent | 
|  | !   	    	    	to rewrite system calls and args on the fly. | 
|  | mov.l	@(OFF_R4,r15), r4   ! arg0 | 
|  | mov.l	@(OFF_R5,r15), r5 | 
|  | mov.l	@(OFF_R6,r15), r6 | 
|  | mov.l	@(OFF_R7,r15), r7   ! arg3 | 
|  | mov.l	@(OFF_R3,r15), r3   ! syscall_nr | 
|  | !   	    	    Arrange for do_syscall_trace to be called | 
|  | !   	    	    again as the system call returns. | 
|  | mov.l	2f, r10			! Number of syscalls | 
|  | cmp/hs	r10, r3 | 
|  | bf	syscall_call | 
|  | mov	#-ENOSYS, r0 | 
|  | bra	syscall_exit | 
|  | mov.l	r0, @(OFF_R0,r15)	! Return value | 
|  |  | 
|  | /* | 
|  | * Syscall interface: | 
|  | * | 
|  | *	Syscall #: R3 | 
|  | *	Arguments #0 to #3: R4--R7 | 
|  | *	Arguments #4 to #6: R0, R1, R2 | 
|  | *	TRA: (number of arguments + 0x10) x 4 | 
|  | * | 
|  | * This code also handles delegating other traps to the BIOS/gdb stub | 
|  | * according to: | 
|  | * | 
|  | * Trap number | 
|  | * (TRA>>2) 	    Purpose | 
|  | * -------- 	    ------- | 
|  | * 0x0-0xf  	    old syscall ABI | 
|  | * 0x10-0x1f  	    new syscall ABI | 
|  | * 0x20-0xff  	    delegated through debug_trap to BIOS/gdb stub. | 
|  | * | 
|  | * Note: When we're first called, the TRA value must be shifted | 
|  | * right 2 bits in order to get the value that was used as the "trapa" | 
|  | * argument. | 
|  | */ | 
|  |  | 
|  | .align	2 | 
|  | .globl	ret_from_fork | 
|  | ret_from_fork: | 
|  | mov.l	1f, r8 | 
|  | jsr	@r8 | 
|  | mov	r0, r4 | 
|  | bra	syscall_exit | 
|  | nop | 
|  | .align	2 | 
|  | 1:	.long	schedule_tail | 
|  | ! | 
|  | ENTRY(system_call) | 
|  | mov.l	1f, r9 | 
|  | mov.l	@r9, r8		! Read from TRA (Trap Address) Register | 
|  | ! | 
|  | ! Is the trap argument >= 0x20? (TRA will be >= 0x80) | 
|  | mov	#0x7f, r9 | 
|  | cmp/hi	r9, r8 | 
|  | bt/s	0f | 
|  | mov	#OFF_TRA, r9 | 
|  | add	r15, r9 | 
|  | ! | 
|  | mov.l	r8, @r9			! set TRA value to tra | 
|  | STI() | 
|  | !   	    	    Call the system call handler through the table. | 
|  | !   	    	    First check for bad syscall number | 
|  | mov	r3, r9 | 
|  | mov.l	2f, r8			! Number of syscalls | 
|  | cmp/hs	r8, r9 | 
|  | bf/s	good_system_call | 
|  | GET_THREAD_INFO(r8) | 
|  | syscall_badsys:			! Bad syscall number | 
|  | mov	#-ENOSYS, r0 | 
|  | bra	resume_userspace | 
|  | mov.l	r0, @(OFF_R0,r15)	! Return value | 
|  | ! | 
|  | 0: | 
|  | bra	debug_trap | 
|  | nop | 
|  | ! | 
|  | good_system_call:		! Good syscall number | 
|  | mov.l	@(TI_FLAGS,r8), r8 | 
|  | mov	#_TIF_SYSCALL_TRACE, r10 | 
|  | tst	r10, r8 | 
|  | bf	syscall_trace_entry | 
|  | ! | 
|  | syscall_call: | 
|  | shll2	r9		! x4 | 
|  | mov.l	3f, r8		! Load the address of sys_call_table | 
|  | add	r8, r9 | 
|  | mov.l	@r9, r8 | 
|  | jsr	@r8	    	! jump to specific syscall handler | 
|  | nop | 
|  | mov.l	r0, @(OFF_R0,r15)		! save the return value | 
|  | ! | 
|  | syscall_exit: | 
|  | CLI() | 
|  | ! | 
|  | GET_THREAD_INFO(r8) | 
|  | mov.l	@(TI_FLAGS,r8), r0		! current_thread_info->flags | 
|  | tst	#_TIF_ALLWORK_MASK, r0 | 
|  | bf	syscall_exit_work | 
|  | restore_all: | 
|  | mov.l	@r15+, r0 | 
|  | mov.l	@r15+, r1 | 
|  | mov.l	@r15+, r2 | 
|  | mov.l	@r15+, r3 | 
|  | mov.l	@r15+, r4 | 
|  | mov.l	@r15+, r5 | 
|  | mov.l	@r15+, r6 | 
|  | mov.l	@r15+, r7 | 
|  | ! | 
|  | stc	sr, r8 | 
|  | mov.l	7f, r9 | 
|  | or	r9, r8			! BL =1, RB=1 | 
|  | ldc	r8, sr			! here, change the register bank | 
|  | ! | 
|  | mov.l	@r15+, r8 | 
|  | mov.l	@r15+, r9 | 
|  | mov.l	@r15+, r10 | 
|  | mov.l	@r15+, r11 | 
|  | mov.l	@r15+, r12 | 
|  | mov.l	@r15+, r13 | 
|  | mov.l	@r15+, r14 | 
|  | mov.l	@r15+, k4		! original stack pointer | 
|  | ldc.l	@r15+, spc | 
|  | lds.l	@r15+, pr | 
|  | mov.l	@r15+, k3		! original SR | 
|  | ldc.l	@r15+, gbr | 
|  | lds.l	@r15+, mach | 
|  | lds.l	@r15+, macl | 
|  | add	#4, r15			! Skip syscall number | 
|  | ! | 
|  | #ifdef CONFIG_SH_DSP | 
|  | mov.l	@r15+, k0		! DSP mode marker | 
|  | mov.l	5f, k1 | 
|  | cmp/eq	k0, k1			! Do we have a DSP stack frame? | 
|  | bf	skip_restore | 
|  |  | 
|  | stc	sr, k0			! Enable CPU DSP mode | 
|  | or	k1, k0			! (within kernel it may be disabled) | 
|  | ldc	k0, sr | 
|  | mov	r2, k0			! Backup r2 | 
|  |  | 
|  | ! Restore DSP registers from stack | 
|  | mov	r15, r2 | 
|  | movs.l	@r2+, a1 | 
|  | movs.l	@r2+, a0g | 
|  | movs.l	@r2+, a1g | 
|  | movs.l	@r2+, m0 | 
|  | movs.l	@r2+, m1 | 
|  | mov	r2, r15 | 
|  |  | 
|  | lds.l	@r15+, a0 | 
|  | lds.l	@r15+, x0 | 
|  | lds.l	@r15+, x1 | 
|  | lds.l	@r15+, y0 | 
|  | lds.l	@r15+, y1 | 
|  | lds.l	@r15+, dsr | 
|  | ldc.l	@r15+, rs | 
|  | ldc.l	@r15+, re | 
|  | ldc.l	@r15+, mod | 
|  |  | 
|  | mov	k0, r2			! Restore r2 | 
|  | skip_restore: | 
|  | #endif | 
|  | ! | 
|  | ! Calculate new SR value | 
|  | mov	k3, k2			! original SR value | 
|  | mov.l	9f, k1 | 
|  | and	k1, k2			! Mask orignal SR value | 
|  | ! | 
|  | mov	k3, k0			! Calculate IMASK-bits | 
|  | shlr2	k0 | 
|  | and	#0x3c, k0 | 
|  | cmp/eq	#0x3c, k0 | 
|  | bt/s	6f | 
|  | shll2	k0 | 
|  | mov	g_imask, k0 | 
|  | ! | 
|  | 6:	or	k0, k2			! Set the IMASK-bits | 
|  | ldc	k2, ssr | 
|  | ! | 
|  | #if defined(CONFIG_KGDB_NMI) | 
|  | ! Clear in_nmi | 
|  | mov.l	4f, k0 | 
|  | mov	#0, k1 | 
|  | mov.b	k1, @k0 | 
|  | #endif | 
|  | mov.l	@r15+, k2		! restore EXPEVT | 
|  | mov	k4, r15 | 
|  | rte | 
|  | nop | 
|  |  | 
|  | .align	2 | 
|  | 1:	.long	TRA | 
|  | 2:	.long	NR_syscalls | 
|  | 3:	.long	sys_call_table | 
|  | 4:	.long	do_syscall_trace | 
|  | 5:	.long	0x00001000	! DSP | 
|  | 7:	.long	0x30000000 | 
|  | 9: | 
|  | __INV_IMASK: | 
|  | .long	0xffffff0f	! ~(IMASK) | 
|  |  | 
|  | ! Exception Vector Base | 
|  | ! | 
|  | !	Should be aligned page boundary. | 
|  | ! | 
|  | .balign 	4096,0,4096 | 
|  | ENTRY(vbr_base) | 
|  | .long	0 | 
|  | ! | 
|  | .balign 	256,0,256 | 
|  | general_exception: | 
|  | mov.l	1f, k2 | 
|  | mov.l	2f, k3 | 
|  | bra	handle_exception | 
|  | mov.l	@k2, k2 | 
|  | .align	2 | 
|  | 1:	.long	EXPEVT | 
|  | 2:	.long	ret_from_exception | 
|  | ! | 
|  | ! | 
|  | .balign 	1024,0,1024 | 
|  | tlb_miss: | 
|  | mov.l	1f, k2 | 
|  | mov.l	4f, k3 | 
|  | bra	handle_exception | 
|  | mov.l	@k2, k2 | 
|  | ! | 
|  | .balign 	512,0,512 | 
|  | interrupt: | 
|  | mov.l	2f, k2 | 
|  | mov.l	3f, k3 | 
|  | #if defined(CONFIG_KGDB_NMI) | 
|  | ! Debounce (filter nested NMI) | 
|  | mov.l	@k2, k0 | 
|  | mov.l	5f, k1 | 
|  | cmp/eq	k1, k0 | 
|  | bf	0f | 
|  | mov.l	6f, k1 | 
|  | tas.b	@k1 | 
|  | bt	0f | 
|  | rte | 
|  | nop | 
|  | .align	2 | 
|  | 5:	.long	NMI_VEC | 
|  | 6:	.long	in_nmi | 
|  | 0: | 
|  | #endif /* defined(CONFIG_KGDB_NMI) */ | 
|  | bra	handle_exception | 
|  | mov.l	@k2, k2 | 
|  |  | 
|  | .align	2 | 
|  | 1:	.long	EXPEVT | 
|  | 2:	.long	INTEVT | 
|  | 3:	.long	ret_from_irq | 
|  | 4:	.long	ret_from_exception | 
|  |  | 
|  | ! | 
|  | ! | 
|  | .align	2 | 
|  | handle_exception: | 
|  | ! Using k0, k1 for scratch registers (r0_bank1, r1_bank), | 
|  | ! save all registers onto stack. | 
|  | ! | 
|  | stc	ssr, k0		! Is it from kernel space? | 
|  | shll	k0		! Check MD bit (bit30) by shifting it into... | 
|  | shll	k0		!       ...the T bit | 
|  | bt/s	1f		! It's a kernel to kernel transition. | 
|  | mov	r15, k0		! save original stack to k0 | 
|  | /* User space to kernel */ | 
|  | mov	#0x20, k1 | 
|  | shll8	k1		! k1 := 8192 (== THREAD_SIZE) | 
|  | add	current, k1 | 
|  | mov	k1, r15		! change to kernel stack | 
|  | ! | 
|  | 1:  	mov	#-1, k4 | 
|  | mov.l	2f, k1 | 
|  | ! | 
|  | #ifdef CONFIG_SH_DSP | 
|  | mov.l	r2, @-r15		! Save r2, we need another reg | 
|  | stc	sr, k4 | 
|  | mov.l	1f, r2 | 
|  | tst	r2, k4			! Check if in DSP mode | 
|  | mov.l	@r15+, r2		! Restore r2 now | 
|  | bt/s	skip_save | 
|  | mov	#0, k4			! Set marker for no stack frame | 
|  |  | 
|  | mov	r2, k4			! Backup r2 (in k4) for later | 
|  |  | 
|  | ! Save DSP registers on stack | 
|  | stc.l	mod, @-r15 | 
|  | stc.l	re, @-r15 | 
|  | stc.l	rs, @-r15 | 
|  | sts.l	dsr, @-r15 | 
|  | sts.l	y1, @-r15 | 
|  | sts.l	y0, @-r15 | 
|  | sts.l	x1, @-r15 | 
|  | sts.l	x0, @-r15 | 
|  | sts.l	a0, @-r15 | 
|  |  | 
|  | ! GAS is broken, does not generate correct "movs.l Ds,@-As" instr. | 
|  |  | 
|  | ! FIXME: Make sure that this is still the case with newer toolchains, | 
|  | ! as we're not at all interested in supporting ancient toolchains at | 
|  | ! this point. -- PFM. | 
|  |  | 
|  | mov	r15, r2 | 
|  | .word	0xf653			! movs.l	a1, @-r2 | 
|  | .word	0xf6f3			! movs.l	a0g, @-r2 | 
|  | .word	0xf6d3			! movs.l	a1g, @-r2 | 
|  | .word	0xf6c3			! movs.l	m0, @-r2 | 
|  | .word	0xf6e3			! movs.l	m1, @-r2 | 
|  | mov	r2, r15 | 
|  |  | 
|  | mov	k4, r2			! Restore r2 | 
|  | mov.l	1f, k4			! Force DSP stack frame | 
|  | skip_save: | 
|  | mov.l	k4, @-r15		! Push DSP mode marker onto stack | 
|  | #endif | 
|  | ! Save the user registers on the stack. | 
|  | mov.l	k2, @-r15	! EXPEVT | 
|  | mov.l	k4, @-r15	! set TRA (default: -1) | 
|  | ! | 
|  | sts.l	macl, @-r15 | 
|  | sts.l	mach, @-r15 | 
|  | stc.l	gbr, @-r15 | 
|  | stc.l	ssr, @-r15 | 
|  | sts.l	pr, @-r15 | 
|  | stc.l	spc, @-r15 | 
|  | ! | 
|  | lds	k3, pr		! Set the return address to pr | 
|  | ! | 
|  | mov.l	k0, @-r15	! save orignal stack | 
|  | mov.l	r14, @-r15 | 
|  | mov.l	r13, @-r15 | 
|  | mov.l	r12, @-r15 | 
|  | mov.l	r11, @-r15 | 
|  | mov.l	r10, @-r15 | 
|  | mov.l	r9, @-r15 | 
|  | mov.l	r8, @-r15 | 
|  | ! | 
|  | stc	sr, r8		! Back to normal register bank, and | 
|  | or	k1, r8		! Block all interrupts | 
|  | mov.l	3f, k1 | 
|  | and	k1, r8		! ... | 
|  | ldc	r8, sr		! ...changed here. | 
|  | ! | 
|  | mov.l	r7, @-r15 | 
|  | mov.l	r6, @-r15 | 
|  | mov.l	r5, @-r15 | 
|  | mov.l	r4, @-r15 | 
|  | mov.l	r3, @-r15 | 
|  | mov.l	r2, @-r15 | 
|  | mov.l	r1, @-r15 | 
|  | mov.l	r0, @-r15 | 
|  | ! Then, dispatch to the handler, according to the exception code. | 
|  | stc	k_ex_code, r8 | 
|  | shlr2	r8 | 
|  | shlr	r8 | 
|  | mov.l	4f, r9 | 
|  | add	r8, r9 | 
|  | mov.l	@r9, r9 | 
|  | jmp	@r9 | 
|  | nop | 
|  |  | 
|  | .align	2 | 
|  | 1:	.long	0x00001000	! DSP=1 | 
|  | 2:	.long	0x000080f0	! FD=1, IMASK=15 | 
|  | 3:	.long	0xcfffffff	! RB=0, BL=0 | 
|  | 4:	.long	exception_handling_table | 
|  |  | 
|  | .align	2 | 
|  | ENTRY(exception_none) | 
|  | rts | 
|  | nop | 
|  |  | 
|  | .data | 
|  | ENTRY(sys_call_table) | 
|  | .long sys_ni_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_lchown16 | 
|  | .long sys_ni_syscall	/* old break syscall holder */ | 
|  | .long sys_stat | 
|  | .long sys_lseek | 
|  | .long sys_getpid		/* 20 */ | 
|  | .long sys_mount | 
|  | .long sys_oldumount | 
|  | .long sys_setuid16 | 
|  | .long sys_getuid16 | 
|  | .long sys_stime		/* 25 */ | 
|  | .long sys_ptrace | 
|  | .long sys_alarm | 
|  | .long sys_fstat | 
|  | .long sys_pause | 
|  | .long sys_utime		/* 30 */ | 
|  | .long sys_ni_syscall	/* old stty syscall holder */ | 
|  | .long sys_ni_syscall	/* old gtty syscall holder */ | 
|  | .long sys_access | 
|  | .long sys_nice | 
|  | .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_setgid16 | 
|  | .long sys_getgid16 | 
|  | .long sys_signal | 
|  | .long sys_geteuid16 | 
|  | .long sys_getegid16	/* 50 */ | 
|  | .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 */ | 
|  | .long sys_ni_syscall	/* old 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_sigaction | 
|  | .long sys_sgetmask | 
|  | .long sys_ssetmask | 
|  | .long sys_setreuid16	/* 70 */ | 
|  | .long sys_setregid16 | 
|  | .long sys_sigsuspend | 
|  | .long sys_sigpending | 
|  | .long sys_sethostname | 
|  | .long sys_setrlimit	/* 75 */ | 
|  | .long sys_old_getrlimit | 
|  | .long sys_getrusage | 
|  | .long sys_gettimeofday | 
|  | .long sys_settimeofday | 
|  | .long sys_getgroups16	/* 80 */ | 
|  | .long sys_setgroups16 | 
|  | .long sys_ni_syscall	/* sys_oldselect */ | 
|  | .long sys_symlink | 
|  | .long sys_lstat | 
|  | .long sys_readlink		/* 85 */ | 
|  | .long sys_uselib | 
|  | .long sys_swapon | 
|  | .long sys_reboot | 
|  | .long old_readdir | 
|  | .long old_mmap		/* 90 */ | 
|  | .long sys_munmap | 
|  | .long sys_truncate | 
|  | .long sys_ftruncate | 
|  | .long sys_fchmod | 
|  | .long sys_fchown16		/* 95 */ | 
|  | .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 */ | 
|  | .long sys_socketcall | 
|  | .long sys_syslog | 
|  | .long sys_setitimer | 
|  | .long sys_getitimer	/* 105 */ | 
|  | .long sys_newstat | 
|  | .long sys_newlstat | 
|  | .long sys_newfstat | 
|  | .long sys_uname | 
|  | .long sys_ni_syscall	/* 110 */ /* iopl */ | 
|  | .long sys_vhangup | 
|  | .long sys_ni_syscall	/* idle */ | 
|  | .long sys_ni_syscall	/* vm86old */ | 
|  | .long sys_wait4 | 
|  | .long sys_swapoff		/* 115 */ | 
|  | .long sys_sysinfo | 
|  | .long sys_ipc | 
|  | .long sys_fsync | 
|  | .long sys_sigreturn | 
|  | .long sys_clone		/* 120 */ | 
|  | .long sys_setdomainname | 
|  | .long sys_newuname | 
|  | .long sys_ni_syscall	/* sys_modify_ldt */ | 
|  | .long sys_adjtimex | 
|  | .long sys_mprotect		/* 125 */ | 
|  | .long sys_sigprocmask | 
|  | .long sys_ni_syscall	/* old "create_module" */ | 
|  | .long sys_init_module | 
|  | .long sys_delete_module | 
|  | .long sys_ni_syscall	/* 130: old "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	/* for afs_syscall */ | 
|  | .long sys_setfsuid16 | 
|  | .long sys_setfsgid16 | 
|  | .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_setresuid16 | 
|  | .long sys_getresuid16	/* 165 */ | 
|  | .long sys_ni_syscall	/* vm86 */ | 
|  | .long sys_ni_syscall	/* old "query_module" */ | 
|  | .long sys_poll | 
|  | .long sys_nfsservctl | 
|  | .long sys_setresgid16	/* 170 */ | 
|  | .long sys_getresgid16 | 
|  | .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_pread_wrapper	   /* 180 */ | 
|  | .long sys_pwrite_wrapper | 
|  | .long sys_chown16 | 
|  | .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 | 
|  | .long sys_ni_syscall | 
|  | .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_wrapper | 
|  | .long sys_ni_syscall	/* Reserved for vserver */ | 
|  | .long sys_ni_syscall	/* Reserved for mbind */ | 
|  | .long sys_ni_syscall	/* 275 - get_mempolicy */ | 
|  | .long sys_ni_syscall	/* 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 | 
|  | .long sys_add_key		/* 285 */ | 
|  | .long sys_request_key | 
|  | .long sys_keyctl | 
|  | .long sys_ioprio_set | 
|  | .long sys_ioprio_get | 
|  | .long sys_inotify_init		/* 290 */ | 
|  | .long sys_inotify_add_watch | 
|  | .long sys_inotify_rm_watch | 
|  |  | 
|  | /* End of entry.S */ |