/* * File: arch/blackfin/mach-common/entry.S * Based on: * Author: Linus Torvalds * * Created: ? * Description: 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. * * Modified: * Copyright 2004-2006 Analog Devices Inc. * * Bugs: Enter bugs at http://blackfin.uclinux.org/ * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, see the file COPYING, or write * to the Free Software Foundation, Inc., * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ /* NOTE: This code handles signal-recognition, which happens every time * after a timer-interrupt and after each system call. */ #include #include #include #include #include #include #include /* TIF_NEED_RESCHED */ #include #include #include #if defined(CONFIG_BFIN_SCRATCH_REG_RETN) # define EX_SCRATCH_REG RETN #elif defined(CONFIG_BFIN_SCRATCH_REG_RETE) # define EX_SCRATCH_REG RETE #else # define EX_SCRATCH_REG CYCLES #endif #ifdef CONFIG_EXCPT_IRQ_SYSC_L1 .section .l1.text #else .text #endif /* Slightly simplified and streamlined entry point for CPLB misses. * This one does not lower the level to IRQ5, and thus can be used to * patch up CPLB misses on the kernel stack. */ #if ANOMALY_05000261 #define _ex_dviol _ex_workaround_261 #define _ex_dmiss _ex_workaround_261 #define _ex_dmult _ex_workaround_261 ENTRY(_ex_workaround_261) /* * Work around an anomaly: if we see a new DCPLB fault, return * without doing anything. Then, if we get the same fault again, * handle it. */ P4 = R7; /* Store EXCAUSE */ p5.l = _last_cplb_fault_retx; p5.h = _last_cplb_fault_retx; r7 = [p5]; r6 = retx; [p5] = r6; cc = r6 == r7; if !cc jump _bfin_return_from_exception; /* fall through */ R7 = P4; R6 = 0x26; /* Data CPLB Miss */ cc = R6 == R7; if cc jump _ex_dcplb_miss (BP); R6 = 0x23; /* Data CPLB Miss */ cc = R6 == R7; if cc jump _ex_dcplb_viol (BP); /* Handle 0x23 Data CPLB Protection Violation * and Data CPLB Multiple Hits - Linux Trap Zero */ jump _ex_trap_c; ENDPROC(_ex_workaround_261) #else #ifdef CONFIG_MPU #define _ex_dviol _ex_dcplb_viol #else #define _ex_dviol _ex_trap_c #endif #define _ex_dmiss _ex_dcplb_miss #define _ex_dmult _ex_trap_c #endif ENTRY(_ex_dcplb_viol) ENTRY(_ex_dcplb_miss) ENTRY(_ex_icplb_miss) (R7:6,P5:4) = [sp++]; ASTAT = [sp++]; SAVE_ALL_SYS #ifdef CONFIG_MPU /* We must load R1 here, _before_ DEBUG_HWTRACE_SAVE, since that * will change the stack pointer. */ R0 = SEQSTAT; R1 = SP; #endif DEBUG_HWTRACE_SAVE(p5, r7) #ifdef CONFIG_MPU sp += -12; call _cplb_hdr; sp += 12; CC = R0 == 0; IF !CC JUMP _handle_bad_cplb; #else call __cplb_hdr; #endif #ifdef CONFIG_DEBUG_DOUBLEFAULT /* While we were processing this, did we double fault? */ r7 = SEQSTAT; /* reason code is in bit 5:0 */ r6.l = lo(SEQSTAT_EXCAUSE); r6.h = hi(SEQSTAT_EXCAUSE); r7 = r7 & r6; r6 = 0x25; CC = R7 == R6; if CC JUMP _double_fault; #endif DEBUG_HWTRACE_RESTORE(p5, r7) RESTORE_ALL_SYS SP = EX_SCRATCH_REG; rtx; ENDPROC(_ex_icplb_miss) ENTRY(_ex_syscall) raise 15; /* invoked by TRAP #0, for sys call */ jump.s _bfin_return_from_exception; ENDPROC(_ex_syscall) ENTRY(_ex_soft_bp) r7 = retx; r7 += -2; retx = r7; jump.s _ex_trap_c; ENDPROC(_ex_soft_bp) ENTRY(_ex_single_step) /* If we just returned from an interrupt, the single step event is for the RTI instruction. */ r7 = retx; r6 = reti; cc = r7 == r6; if cc jump _bfin_return_from_exception; #ifdef CONFIG_KGDB /* Don't do single step in hardware exception handler */ p5.l = lo(IPEND); p5.h = hi(IPEND); r6 = [p5]; cc = bittst(r6, 4); if cc jump _bfin_return_from_exception; cc = bittst(r6, 5); if cc jump _bfin_return_from_exception; /* skip single step if current interrupt priority is higher than * that of the first instruction, from which gdb starts single step */ r6 >>= 6; r7 = 10; .Lfind_priority_start: cc = bittst(r6, 0); if cc jump .Lfind_priority_done; r6 >>= 1; r7 += -1; cc = r7 == 0; if cc jump .Lfind_priority_done; jump.s .Lfind_priority_start; .Lfind_priority_done: p4.l = _kgdb_single_step; p4.h = _kgdb_single_step; r6 = [p4]; cc = r6 == 0; if cc jump .Ldo_single_step; r6 += -1; cc = r6 < r7; if cc jump 1f; .Ldo_single_step: #else /* If we were in user mode, do the single step normally. */ p5.l = lo(IPEND); p5.h = hi(IPEND); r6 = [p5]; r7 = 0xffe0 (z); r7 = r7 & r6; cc = r7 == 0; if !cc jump 1f; #endif /* Single stepping only a single instruction, so clear the trace * bit here. */ r7 = syscfg; bitclr (r7, 0); syscfg = R7; jump _ex_trap_c; 1: /* * We were in an interrupt handler. By convention, all of them save * SYSCFG with their first instruction, so by checking whether our * RETX points at the entry point, we can determine whether to allow * a single step, or whether to clear SYSCFG. * * First, find out the interrupt level and the event vector for it. */ p5.l = lo(EVT0); p5.h = hi(EVT0); p5 += -4; 2: r7 = rot r7 by -1; p5 += 4; if !cc jump 2b; /* What we actually do is test for the _second_ instruction in the * IRQ handler. That way, if there are insns following the restore * of SYSCFG after leaving the handler, we will not turn off SYSCFG * for them. */ r7 = [p5]; r7 += 2; r6 = RETX; cc = R7 == R6; if !cc jump _bfin_return_from_exception; r7 = syscfg; bitclr (r7, 0); syscfg = R7; /* Fall through to _bfin_return_from_exception. */ ENDPROC(_ex_single_step) ENTRY(_bfin_return_from_exception) #if ANOMALY_05000257 R7=LC0; LC0=R7; R7=LC1; LC1=R7; #endif #ifdef CONFIG_DEBUG_DOUBLEFAULT /* While we were processing the current exception, * did we cause another, and double fault? */ r7 = SEQSTAT; /* reason code is in bit 5:0 */ r6.l = lo(SEQSTAT_EXCAUSE); r6.h = hi(SEQSTAT_EXCAUSE); r7 = r7 & r6; r6 = 0x25; CC = R7 == R6; if CC JUMP _double_fault; /* Did we cause a HW error? */ p5.l = lo(ILAT); p5.h = hi(ILAT); r6 = [p5]; r7 = 0x20; /* Did I just cause anther HW error? */ r6 = r7 & r6; CC = R7 == R6; if CC JUMP _double_fault; #endif (R7:6,P5:4) = [sp++]; ASTAT = [sp++]; sp = EX_SCRATCH_REG; rtx; ENDPROC(_bfin_return_from_exception) ENTRY(_handle_bad_cplb) DEBUG_HWTRACE_RESTORE(p5, r7) /* To get here, we just tried and failed to change a CPLB * so, handle things in trap_c (C code), by lowering to * IRQ5, just like we normally do. Since this is not a * "normal" return path, we have a do alot of stuff to * the stack to get ready so, we can fall through - we * need to make a CPLB exception look like a normal exception */ RESTORE_ALL_SYS [--sp] = ASTAT; [--sp] = (R7:6,P5:4); ENTRY(_ex_replaceable) nop; ENTRY(_ex_trap_c) /* Make sure we are not in a double fault */ p4.l = lo(IPEND); p4.h = hi(IPEND); r7 = [p4]; CC = BITTST (r7, 5); if CC jump _double_fault; /* Call C code (trap_c) to handle the exception, which most * likely involves sending a signal to the current process. * To avoid double faults, lower our priority to IRQ5 first. */ P5.h = _exception_to_level5; P5.l = _exception_to_level5; p4.l = lo(EVT5); p4.h = hi(EVT5); [p4] = p5; csync; #ifndef CONFIG_DEBUG_DOUBLEFAULT /* * Save these registers, as they are only valid in exception context * (where we are now - as soon as we defer to IRQ5, they can change) * DCPLB_STATUS and ICPLB_STATUS are also only valid in EVT3, * but they are not very interesting, so don't save them */ p4.l = lo(DCPLB_FAULT_ADDR); p4.h = hi(DCPLB_FAULT_ADDR); r7 = [p4]; p5.h = _saved_dcplb_fault_addr; p5.l = _saved_dcplb_fault_addr; [p5] = r7; r7 = [p4 + (ICPLB_FAULT_ADDR - DCPLB_FAULT_ADDR)]; p5.h = _saved_icplb_fault_addr; p5.l = _saved_icplb_fault_addr; [p5] = r7; r6 = retx; p4.l = _saved_retx; p4.h = _saved_retx; [p4] = r6; #endif r6 = SYSCFG; [p4 + 4] = r6; BITCLR(r6, 0); SYSCFG = r6; /* Disable all interrupts, but make sure level 5 is enabled so * we can switch to that level. Save the old mask. */ cli r6; [p4 + 8] = r6; p4.l = lo(SAFE_USER_INSTRUCTION); p4.h = hi(SAFE_USER_INSTRUCTION); retx = p4; r6 = 0x3f; sti r6; raise 5; jump.s _bfin_return_from_exception; ENDPROC(_ex_trap_c) /* We just realized we got an exception, while we were processing a different * exception. This is a unrecoverable event, so crash */ ENTRY(_double_fault) /* Turn caches & protection off, to ensure we don't get any more * double exceptions */ P4.L = LO(IMEM_CONTROL); P4.H = HI(IMEM_CONTROL); R5 = [P4]; /* Control Register*/ BITCLR(R5,ENICPLB_P); SSYNC; /* SSYNC required before writing to IMEM_CONTROL. */ .align 8; [P4] = R5; SSYNC; P4.L = LO(DMEM_CONTROL); P4.H = HI(DMEM_CONTROL); R5 = [P4]; BITCLR(R5,ENDCPLB_P); SSYNC; /* SSYNC required before writing to DMEM_CONTROL. */ .align 8; [P4] = R5; SSYNC; /* Fix up the stack */ (R7:6,P5:4) = [sp++]; ASTAT = [sp++]; SP = EX_SCRATCH_REG; /* We should be out of the exception stack, and back down into * kernel or user space stack */ SAVE_ALL_SYS /* The dumping functions expect the return address in the RETI * slot. */ r6 = retx; [sp + PT_PC] = r6; r0 = sp; /* stack frame pt_regs pointer argument ==> r0 */ SP += -12; call _double_fault_c; SP += 12; .L_double_fault_panic: JUMP .L_double_fault_panic ENDPROC(_double_fault) ENTRY(_exception_to_level5) SAVE_ALL_SYS p4.l = _saved_retx; p4.h = _saved_retx; r6 = [p4]; [sp + PT_PC] = r6; r6 = [p4 + 4]; [sp + PT_SYSCFG] = r6; /* Restore interrupt mask. We haven't pushed RETI, so this * doesn't enable interrupts until we return from this handler. */ r6 = [p4 + 8]; sti r6; /* Restore the hardware error vector. */ P5.h = _evt_ivhw; P5.l = _evt_ivhw; p4.l = lo(EVT5); p4.h = hi(EVT5); [p4] = p5; csync; p2.l = lo(IPEND); p2.h = hi(IPEND); csync; r0 = [p2]; /* Read current IPEND */ [sp + PT_IPEND] = r0; /* Store IPEND */ r0 = sp; /* stack frame pt_regs pointer argument ==> r0 */ SP += -12; call _trap_c; SP += 12; #ifdef CONFIG_DEBUG_DOUBLEFAULT /* Grab ILAT */ p2.l = lo(ILAT); p2.h = hi(ILAT); r0 = [p2]; r1 = 0x20; /* Did I just cause anther HW error? */ r0 = r0 & r1; CC = R0 == R1; if CC JUMP _double_fault; #endif call _ret_from_exception; RESTORE_ALL_SYS rti; ENDPROC(_exception_to_level5) ENTRY(_trap) /* Exception: 4th entry into system event table(supervisor mode)*/ /* Since the kernel stack can be anywhere, it's not guaranteed to be * covered by a CPLB. Switch to an exception stack; use RETN as a * scratch register (for want of a better option). */ EX_SCRATCH_REG = sp; sp.l = _exception_stack_top; sp.h = _exception_stack_top; /* Try to deal with syscalls quickly. */ [--sp] = ASTAT; [--sp] = (R7:6,P5:4); #if ANOMALY_05000283 || ANOMALY_05000315 cc = r7 == r7; p5.h = HI(CHIPID); p5.l = LO(CHIPID); if cc jump 1f; r7.l = W[p5]; 1: #endif #ifdef CONFIG_DEBUG_DOUBLEFAULT /* * Save these registers, as they are only valid in exception context * (where we are now - as soon as we defer to IRQ5, they can change) * DCPLB_STATUS and ICPLB_STATUS are also only valid in EVT3, * but they are not very interesting, so don't save them */ p4.l = lo(DCPLB_FAULT_ADDR); p4.h = hi(DCPLB_FAULT_ADDR); r7 = [p4]; p5.h = _saved_dcplb_fault_addr; p5.l = _saved_dcplb_fault_addr; [p5] = r7; r7 = [p4 + (ICPLB_FAULT_ADDR - DCPLB_FAULT_ADDR)]; p5.h = _saved_icplb_fault_addr; p5.l = _saved_icplb_fault_addr; [p5] = r7; p4.l = _saved_retx; p4.h = _saved_retx; r6 = retx; [p4] = r6; r7 = SEQSTAT; /* reason code is in bit 5:0 */ p4.l = _saved_seqstat; p4.h = _saved_seqstat; [p4] = r7; #else r7 = SEQSTAT; /* reason code is in bit 5:0 */ #endif r6.l = lo(SEQSTAT_EXCAUSE); r6.h = hi(SEQSTAT_EXCAUSE); r7 = r7 & r6; p5.h = _ex_table; p5.l = _ex_table; p4 = r7; p5 = p5 + (p4 << 2); p4 = [p5]; jump (p4); .Lbadsys: r7 = -ENOSYS; /* signextending enough */ [sp + PT_R0] = r7; /* return value from system call */ jump .Lsyscall_really_exit; ENDPROC(_trap) ENTRY(_kernel_execve) link SIZEOF_PTREGS; p0 = sp; r3 = SIZEOF_PTREGS / 4; r4 = 0(x); 0: [p0++] = r4; r3 += -1; cc = r3 == 0; if !cc jump 0b (bp); p0 = sp; sp += -16; [sp + 12] = p0; call _do_execve; SP += 16; cc = r0 == 0; if ! cc jump 1f; /* Success. Copy our temporary pt_regs to the top of the kernel * stack and do a normal exception return. */ r1 = sp; r0 = (-KERNEL_STACK_SIZE) (x); r1 = r1 & r0; p2 = r1; p3 = [p2]; r0 = KERNEL_STACK_SIZE - 4 (z); p1 = r0; p1 = p1 + p2; p0 = fp; r4 = [p0--]; r3 = SIZEOF_PTREGS / 4; 0: r4 = [p0--]; [p1--] = r4; r3 += -1; cc = r3 == 0; if ! cc jump 0b (bp); r0 = (KERNEL_STACK_SIZE - SIZEOF_PTREGS) (z); p1 = r0; p1 = p1 + p2; sp = p1; r0 = syscfg; [SP + PT_SYSCFG] = r0; [p3 + (TASK_THREAD + THREAD_KSP)] = sp; RESTORE_CONTEXT; rti; 1: unlink; rts; ENDPROC(_kernel_execve) ENTRY(_system_call) /* Store IPEND */ p2.l = lo(IPEND); p2.h = hi(IPEND); csync; r0 = [p2]; [sp + PT_IPEND] = r0; /* Store RETS for now */ r0 = rets; [sp + PT_RESERVED] = r0; /* Set the stack for the current process */ r7 = sp; r6.l = lo(ALIGN_PAGE_MASK); r6.h = hi(ALIGN_PAGE_MASK); r7 = r7 & r6; /* thread_info */ p2 = r7; p2 = [p2]; [p2+(TASK_THREAD+THREAD_KSP)] = sp; /* Check the System Call */ r7 = __NR_syscall; /* System call number is passed in P0 */ r6 = p0; cc = r6 < r7; if ! cc jump .Lbadsys; /* are we tracing syscalls?*/ r7 = sp; r6.l = lo(ALIGN_PAGE_MASK); r6.h = hi(ALIGN_PAGE_MASK); r7 = r7 & r6; p2 = r7; r7 = [p2+TI_FLAGS]; CC = BITTST(r7,TIF_SYSCALL_TRACE); if CC JUMP _sys_trace; /* Execute the appropriate system call */ p4 = p0; p5.l = _sys_call_table; p5.h = _sys_call_table; p5 = p5 + (p4 << 2); r0 = [sp + PT_R0]; r1 = [sp + PT_R1]; r2 = [sp + PT_R2]; p5 = [p5]; [--sp] = r5; [--sp] = r4; [--sp] = r3; SP += -12; call (p5); SP += 24; [sp + PT_R0] = r0; .Lresume_userspace: r7 = sp; r4.l = lo(ALIGN_PAGE_MASK); r4.h = hi(ALIGN_PAGE_MASK); r7 = r7 & r4; /* thread_info->flags */ p5 = r7; .Lresume_userspace_1: /* Disable interrupts. */ [--sp] = reti; reti = [sp++]; r7 = [p5 + TI_FLAGS]; r4.l = lo(_TIF_WORK_MASK); r4.h = hi(_TIF_WORK_MASK); r7 = r7 & r4; .Lsyscall_resched: cc = BITTST(r7, TIF_NEED_RESCHED); if !cc jump .Lsyscall_sigpending; /* Reenable interrupts. */ [--sp] = reti; r0 = [sp++]; SP += -12; call _schedule; SP += 12; jump .Lresume_userspace_1; .Lsyscall_sigpending: cc = BITTST(r7, TIF_RESTORE_SIGMASK); if cc jump .Lsyscall_do_signals; cc = BITTST(r7, TIF_SIGPENDING); if !cc jump .Lsyscall_really_exit; .Lsyscall_do_signals: /* Reenable interrupts. */ [--sp] = reti; r0 = [sp++]; r0 = sp; SP += -12; call _do_signal; SP += 12; .Lsyscall_really_exit: r5 = [sp + PT_RESERVED]; rets = r5; rts; ENDPROC(_system_call) /* Do not mark as ENTRY() to avoid error in assembler ... * this symbol need not be global anyways, so ... */ _sys_trace: call _syscall_trace; /* Execute the appropriate system call */ p4 = [SP + PT_P0]; p5.l = _sys_call_table; p5.h = _sys_call_table; p5 = p5 + (p4 << 2); r0 = [sp + PT_R0]; r1 = [sp + PT_R1]; r2 = [sp + PT_R2]; r3 = [sp + PT_R3]; r4 = [sp + PT_R4]; r5 = [sp + PT_R5]; p5 = [p5]; [--sp] = r5; [--sp] = r4; [--sp] = r3; SP += -12; call (p5); SP += 24; [sp + PT_R0] = r0; call _syscall_trace; jump .Lresume_userspace; ENDPROC(_sys_trace) ENTRY(_resume) /* * Beware - when entering resume, prev (the current task) is * in r0, next (the new task) is in r1. */ p0 = r0; p1 = r1; [--sp] = rets; [--sp] = fp; [--sp] = (r7:4, p5:3); /* save usp */ p2 = usp; [p0+(TASK_THREAD+THREAD_USP)] = p2; /* save current kernel stack pointer */ [p0+(TASK_THREAD+THREAD_KSP)] = sp; /* save program counter */ r1.l = _new_old_task; r1.h = _new_old_task; [p0+(TASK_THREAD+THREAD_PC)] = r1; /* restore the kernel stack pointer */ sp = [p1+(TASK_THREAD+THREAD_KSP)]; /* restore user stack pointer */ p0 = [p1+(TASK_THREAD+THREAD_USP)]; usp = p0; /* restore pc */ p0 = [p1+(TASK_THREAD+THREAD_PC)]; jump (p0); /* * Following code actually lands up in a new (old) task. */ _new_old_task: (r7:4, p5:3) = [sp++]; fp = [sp++]; rets = [sp++]; /* * When we come out of resume, r0 carries "old" task, becuase we are * in "new" task. */ rts; ENDPROC(_resume) ENTRY(_ret_from_exception) p2.l = lo(IPEND); p2.h = hi(IPEND); csync; r0 = [p2]; [sp + PT_IPEND] = r0; 1: r2 = LO(~0x37) (Z); r0 = r2 & r0; cc = r0 == 0; if !cc jump 4f; /* if not return to user mode, get out */ /* Make sure any pending system call or deferred exception * return in ILAT for this process to get executed, otherwise * in case context switch happens, system call of * first process (i.e in ILAT) will be carried * forward to the switched process */ p2.l = lo(ILAT); p2.h = hi(ILAT); r0 = [p2]; r1 = (EVT_IVG14 | EVT_IVG15) (z); r0 = r0 & r1; cc = r0 == 0; if !cc jump 5f; /* Set the stack for the current process */ r7 = sp; r4.l = lo(ALIGN_PAGE_MASK); r4.h = hi(ALIGN_PAGE_MASK); r7 = r7 & r4; /* thread_info->flags */ p5 = r7; r7 = [p5 + TI_FLAGS]; r4.l = lo(_TIF_WORK_MASK); r4.h = hi(_TIF_WORK_MASK); r7 = r7 & r4; cc = r7 == 0; if cc jump 4f; p0.l = lo(EVT15); p0.h = hi(EVT15); p1.l = _schedule_and_signal; p1.h = _schedule_and_signal; [p0] = p1; csync; raise 15; /* raise evt14 to do signal or reschedule */ 4: r0 = syscfg; bitclr(r0, 0); syscfg = r0; 5: rts; ENDPROC(_ret_from_exception) ENTRY(_return_from_int) /* If someone else already raised IRQ 15, do nothing. */ csync; p2.l = lo(ILAT); p2.h = hi(ILAT); r0 = [p2]; cc = bittst (r0, EVT_IVG15_P); if cc jump 2f; /* if not return to user mode, get out */ p2.l = lo(IPEND); p2.h = hi(IPEND); r0 = [p2]; r1 = 0x17(Z); r2 = ~r1; r2.h = 0; r0 = r2 & r0; r1 = 1; r1 = r0 - r1; r2 = r0 & r1; cc = r2 == 0; if !cc jump 2f; /* Lower the interrupt level to 15. */ p0.l = lo(EVT15); p0.h = hi(EVT15); p1.l = _schedule_and_signal_from_int; p1.h = _schedule_and_signal_from_int; [p0] = p1; csync; #if ANOMALY_05000281 r0.l = lo(SAFE_USER_INSTRUCTION); r0.h = hi(SAFE_USER_INSTRUCTION); reti = r0; #endif r0 = 0x801f (z); STI r0; raise 15; /* raise evt15 to do signal or reschedule */ rti; 2: rts; ENDPROC(_return_from_int) ENTRY(_lower_to_irq14) #if ANOMALY_05000281 r0.l = lo(SAFE_USER_INSTRUCTION); r0.h = hi(SAFE_USER_INSTRUCTION); reti = r0; #endif r0 = 0x401f; sti r0; raise 14; rti; ENTRY(_evt14_softirq) #ifdef CONFIG_DEBUG_HWERR r0 = 0x3f; sti r0; #else cli r0; #endif [--sp] = RETI; SP += 4; rts; _schedule_and_signal_from_int: /* To end up here, vector 15 was changed - so we have to change it * back. */ p0.l = lo(EVT15); p0.h = hi(EVT15); p1.l = _evt_system_call; p1.h = _evt_system_call; [p0] = p1; csync; /* Set orig_p0 to -1 to indicate this isn't the end of a syscall. */ r0 = -1 (x); [sp + PT_ORIG_P0] = r0; p1 = rets; [sp + PT_RESERVED] = p1; p0.l = _irq_flags; p0.h = _irq_flags; r0 = [p0]; sti r0; r0 = sp; sp += -12; call _finish_atomic_sections; sp += 12; jump.s .Lresume_userspace; _schedule_and_signal: SAVE_CONTEXT_SYSCALL /* To end up here, vector 15 was changed - so we have to change it * back. */ p0.l = lo(EVT15); p0.h = hi(EVT15); p1.l = _evt_system_call; p1.h = _evt_system_call; [p0] = p1; csync; p0.l = 1f; p0.h = 1f; [sp + PT_RESERVED] = P0; call .Lresume_userspace; 1: RESTORE_CONTEXT rti; ENDPROC(_lower_to_irq14) /* We handle this 100% in exception space - to reduce overhead * Only potiential problem is if the software buffer gets swapped out of the * CPLB table - then double fault. - so we don't let this happen in other places */ #ifdef CONFIG_DEBUG_BFIN_HWTRACE_EXPAND ENTRY(_ex_trace_buff_full) [--sp] = P3; [--sp] = P2; [--sp] = LC0; [--sp] = LT0; [--sp] = LB0; P5.L = _trace_buff_offset; P5.H = _trace_buff_offset; P3 = [P5]; /* trace_buff_offset */ P5.L = lo(TBUFSTAT); P5.H = hi(TBUFSTAT); R7 = [P5]; R7 <<= 1; /* double, since we need to read twice */ LC0 = R7; R7 <<= 2; /* need to shift over again, * to get the number of bytes */ P5.L = lo(TBUF); P5.H = hi(TBUF); R6 = ((1 << CONFIG_DEBUG_BFIN_HWTRACE_EXPAND_LEN)*1024) - 1; P2 = R7; P3 = P3 + P2; R7 = P3; R7 = R7 & R6; P3 = R7; P2.L = _trace_buff_offset; P2.H = _trace_buff_offset; [P2] = P3; P2.L = _software_trace_buff; P2.H = _software_trace_buff; LSETUP (.Lstart, .Lend) LC0; .Lstart: R7 = [P5]; /* read TBUF */ P4 = P3 + P2; [P4] = R7; P3 += -4; R7 = P3; R7 = R7 & R6; .Lend: P3 = R7; LB0 = [sp++]; LT0 = [sp++]; LC0 = [sp++]; P2 = [sp++]; P3 = [sp++]; jump _bfin_return_from_exception; ENDPROC(_ex_trace_buff_full) #if CONFIG_DEBUG_BFIN_HWTRACE_EXPAND_LEN == 4 .data #else .section .l1.data.B #endif /* CONFIG_DEBUG_BFIN_HWTRACE_EXPAND_LEN */ ENTRY(_trace_buff_offset) .long 0; ALIGN ENTRY(_software_trace_buff) .rept ((1 << CONFIG_DEBUG_BFIN_HWTRACE_EXPAND_LEN)*256); .long 0 .endr #endif /* CONFIG_DEBUG_BFIN_HWTRACE_EXPAND */ #if CONFIG_EARLY_PRINTK __INIT ENTRY(_early_trap) SAVE_ALL_SYS trace_buffer_stop(p0,r0); #if ANOMALY_05000283 || ANOMALY_05000315 cc = r5 == r5; p4.h = HI(CHIPID); p4.l = LO(CHIPID); if cc jump 1f; r5.l = W[p4]; 1: #endif /* Turn caches off, to ensure we don't get double exceptions */ P4.L = LO(IMEM_CONTROL); P4.H = HI(IMEM_CONTROL); R5 = [P4]; /* Control Register*/ BITCLR(R5,ENICPLB_P); CLI R1; SSYNC; /* SSYNC required before writing to IMEM_CONTROL. */ .align 8; [P4] = R5; SSYNC; P4.L = LO(DMEM_CONTROL); P4.H = HI(DMEM_CONTROL); R5 = [P4]; BITCLR(R5,ENDCPLB_P); SSYNC; /* SSYNC required before writing to DMEM_CONTROL. */ .align 8; [P4] = R5; SSYNC; STI R1; r0 = sp; /* stack frame pt_regs pointer argument ==> r0 */ r1 = RETX; SP += -12; call _early_trap_c; SP += 12; ENDPROC(_early_trap) __FINIT #endif /* CONFIG_EARLY_PRINTK */ /* * Put these in the kernel data section - that should always be covered by * a CPLB. This is needed to ensure we don't get double fault conditions */ #ifdef CONFIG_SYSCALL_TAB_L1 .section .l1.data #else .data #endif ENTRY(_ex_table) /* entry for each EXCAUSE[5:0] * This table must be in sync with the table in ./kernel/traps.c * EXCPT instruction can provide 4 bits of EXCAUSE, allowing 16 to be user defined */ .long _ex_syscall /* 0x00 - User Defined - Linux Syscall */ .long _ex_soft_bp /* 0x01 - User Defined - Software breakpoint */ #ifdef CONFIG_KGDB .long _ex_trap_c /* 0x02 - User Defined - KGDB initial connection and break signal trap */ #else .long _ex_replaceable /* 0x02 - User Defined */ #endif .long _ex_trap_c /* 0x03 - User Defined - userspace stack overflow */ .long _ex_trap_c /* 0x04 - User Defined - dump trace buffer */ .long _ex_replaceable /* 0x05 - User Defined */ .long _ex_replaceable /* 0x06 - User Defined */ .long _ex_replaceable /* 0x07 - User Defined */ .long _ex_replaceable /* 0x08 - User Defined */ .long _ex_replaceable /* 0x09 - User Defined */ .long _ex_replaceable /* 0x0A - User Defined */ .long _ex_replaceable /* 0x0B - User Defined */ .long _ex_replaceable /* 0x0C - User Defined */ .long _ex_replaceable /* 0x0D - User Defined */ .long _ex_replaceable /* 0x0E - User Defined */ .long _ex_replaceable /* 0x0F - User Defined */ .long _ex_single_step /* 0x10 - HW Single step */ #ifdef CONFIG_DEBUG_BFIN_HWTRACE_EXPAND .long _ex_trace_buff_full /* 0x11 - Trace Buffer Full */ #else .long _ex_trap_c /* 0x11 - Trace Buffer Full */ #endif .long _ex_trap_c /* 0x12 - Reserved */ .long _ex_trap_c /* 0x13 - Reserved */ .long _ex_trap_c /* 0x14 - Reserved */ .long _ex_trap_c /* 0x15 - Reserved */ .long _ex_trap_c /* 0x16 - Reserved */ .long _ex_trap_c /* 0x17 - Reserved */ .long _ex_trap_c /* 0x18 - Reserved */ .long _ex_trap_c /* 0x19 - Reserved */ .long _ex_trap_c /* 0x1A - Reserved */ .long _ex_trap_c /* 0x1B - Reserved */ .long _ex_trap_c /* 0x1C - Reserved */ .long _ex_trap_c /* 0x1D - Reserved */ .long _ex_trap_c /* 0x1E - Reserved */ .long _ex_trap_c /* 0x1F - Reserved */ .long _ex_trap_c /* 0x20 - Reserved */ .long _ex_trap_c /* 0x21 - Undefined Instruction */ .long _ex_trap_c /* 0x22 - Illegal Instruction Combination */ .long _ex_dviol /* 0x23 - Data CPLB Protection Violation */ .long _ex_trap_c /* 0x24 - Data access misaligned */ .long _ex_trap_c /* 0x25 - Unrecoverable Event */ .long _ex_dmiss /* 0x26 - Data CPLB Miss */ .long _ex_dmult /* 0x27 - Data CPLB Multiple Hits - Linux Trap Zero */ .long _ex_trap_c /* 0x28 - Emulation Watchpoint */ .long _ex_trap_c /* 0x29 - Instruction fetch access error (535 only) */ .long _ex_trap_c /* 0x2A - Instruction fetch misaligned */ .long _ex_trap_c /* 0x2B - Instruction CPLB protection Violation */ .long _ex_icplb_miss /* 0x2C - Instruction CPLB miss */ .long _ex_trap_c /* 0x2D - Instruction CPLB Multiple Hits */ .long _ex_trap_c /* 0x2E - Illegal use of Supervisor Resource */ .long _ex_trap_c /* 0x2E - Illegal use of Supervisor Resource */ .long _ex_trap_c /* 0x2F - Reserved */ .long _ex_trap_c /* 0x30 - Reserved */ .long _ex_trap_c /* 0x31 - Reserved */ .long _ex_trap_c /* 0x32 - Reserved */ .long _ex_trap_c /* 0x33 - Reserved */ .long _ex_trap_c /* 0x34 - Reserved */ .long _ex_trap_c /* 0x35 - Reserved */ .long _ex_trap_c /* 0x36 - Reserved */ .long _ex_trap_c /* 0x37 - Reserved */ .long _ex_trap_c /* 0x38 - Reserved */ .long _ex_trap_c /* 0x39 - Reserved */ .long _ex_trap_c /* 0x3A - Reserved */ .long _ex_trap_c /* 0x3B - Reserved */ .long _ex_trap_c /* 0x3C - Reserved */ .long _ex_trap_c /* 0x3D - Reserved */ .long _ex_trap_c /* 0x3E - Reserved */ .long _ex_trap_c /* 0x3F - Reserved */ END(_ex_table) ENTRY(_sys_call_table) .long _sys_restart_syscall /* 0 */ .long _sys_exit .long _sys_fork .long _sys_read .long _sys_write .long _sys_open /* 5 */ .long _sys_close .long _sys_ni_syscall /* old 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_chown /* chown16 */ .long _sys_ni_syscall /* old break syscall holder */ .long _sys_ni_syscall /* old stat */ .long _sys_lseek .long _sys_getpid /* 20 */ .long _sys_mount .long _sys_ni_syscall /* old umount */ .long _sys_setuid .long _sys_getuid .long _sys_stime /* 25 */ .long _sys_ptrace .long _sys_alarm .long _sys_ni_syscall /* old fstat */ .long _sys_pause .long _sys_ni_syscall /* old 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_setgid .long _sys_getgid .long _sys_ni_syscall /* old sys_signal */ .long _sys_geteuid /* geteuid16 */ .long _sys_getegid /* 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 /* old old uname */ .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 /* old sys_sigaction */ .long _sys_sgetmask .long _sys_ssetmask .long _sys_setreuid /* setreuid16 */ /* 70 */ .long _sys_setregid /* setregid16 */ .long _sys_ni_syscall /* old sys_sigsuspend */ .long _sys_ni_syscall /* old sys_sigpending */ .long _sys_sethostname .long _sys_setrlimit /* 75 */ .long _sys_ni_syscall /* old getrlimit */ .long _sys_getrusage .long _sys_gettimeofday .long _sys_settimeofday .long _sys_getgroups /* getgroups16 */ /* 80 */ .long _sys_setgroups /* setgroups16 */ .long _sys_ni_syscall /* old_select */ .long _sys_symlink .long _sys_ni_syscall /* old lstat */ .long _sys_readlink /* 85 */ .long _sys_uselib .long _sys_ni_syscall /* sys_swapon */ .long _sys_reboot .long _sys_ni_syscall /* old_readdir */ .long _sys_ni_syscall /* sys_mmap */ /* 90 */ .long _sys_munmap .long _sys_truncate .long _sys_ftruncate .long _sys_fchmod .long _sys_fchown /* 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 .long _sys_ni_syscall /* old 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 */ .long _sys_ni_syscall /* iopl for i386 */ /* 110 */ .long _sys_vhangup .long _sys_ni_syscall /* obsolete idle() syscall */ .long _sys_ni_syscall /* vm86old for i386 */ .long _sys_wait4 .long _sys_ni_syscall /* 115 */ /* sys_swapoff */ .long _sys_sysinfo .long _sys_ni_syscall /* old sys_ipc */ .long _sys_fsync .long _sys_ni_syscall /* old sys_sigreturn */ .long _sys_clone /* 120 */ .long _sys_setdomainname .long _sys_newuname .long _sys_ni_syscall /* old sys_modify_ldt */ .long _sys_adjtimex .long _sys_ni_syscall /* 125 */ /* sys_mprotect */ .long _sys_ni_syscall /* old sys_sigprocmask */ .long _sys_ni_syscall /* old "creat_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_ni_syscall /* 135 */ /* sys_sysfs */ .long _sys_personality .long _sys_ni_syscall /* for afs_syscall */ .long _sys_setfsuid /* setfsuid16 */ .long _sys_setfsgid /* setfsgid16 */ .long _sys_llseek /* 140 */ .long _sys_getdents .long _sys_ni_syscall /* sys_select */ .long _sys_flock .long _sys_ni_syscall /* sys_msync */ .long _sys_readv /* 145 */ .long _sys_writev .long _sys_getsid .long _sys_fdatasync .long _sys_sysctl .long _sys_ni_syscall /* 150 */ /* sys_mlock */ .long _sys_ni_syscall /* sys_munlock */ .long _sys_ni_syscall /* sys_mlockall */ .long _sys_ni_syscall /* 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_setresuid /* setresuid16 */ .long _sys_getresuid /* getresuid16 */ /* 165 */ .long _sys_ni_syscall /* for vm86 */ .long _sys_ni_syscall /* old "query_module" */ .long _sys_ni_syscall /* sys_poll */ .long _sys_nfsservctl .long _sys_setresgid /* setresgid16 */ /* 170 */ .long _sys_getresgid /* 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_pread64 /* 180 */ .long _sys_pwrite64 .long _sys_lchown /* lchown16 */ .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_chown .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_lchown .long _sys_setuid .long _sys_setgid .long _sys_setfsuid /* 215 */ .long _sys_setfsgid .long _sys_pivot_root .long _sys_ni_syscall /* sys_mincore */ .long _sys_ni_syscall /* sys_madvise */ .long _sys_getdents64 /* 220 */ .long _sys_fcntl64 .long _sys_ni_syscall /* reserved for TUX */ .long _sys_ni_syscall .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 /* sys_set_thread_area */ .long _sys_ni_syscall /* sys_get_thread_area */ .long _sys_io_setup /* 245 */ .long _sys_io_destroy .long _sys_io_getevents .long _sys_io_submit .long _sys_io_cancel .long _sys_ni_syscall /* 250 */ /* sys_alloc_hugepages */ .long _sys_ni_syscall /* sys_freec_hugepages */ .long _sys_exit_group .long _sys_lookup_dcookie .long _sys_bfin_spinlock .long _sys_epoll_create /* 255 */ .long _sys_epoll_ctl .long _sys_epoll_wait .long _sys_ni_syscall /* remap_file_pages */ .long _sys_set_tid_address .long _sys_timer_create /* 260 */ .long _sys_timer_settime .long _sys_timer_gettime .long _sys_timer_getoverrun .long _sys_timer_delete .long _sys_clock_settime /* 265 */ .long _sys_clock_gettime .long _sys_clock_getres .long _sys_clock_nanosleep .long _sys_statfs64 .long _sys_fstatfs64 /* 270 */ .long _sys_tgkill .long _sys_utimes .long _sys_fadvise64_64 .long _sys_ni_syscall /* vserver */ .long _sys_ni_syscall /* 275, mbind */ .long _sys_ni_syscall /* get_mempolicy */ .long _sys_ni_syscall /* set_mempolicy */ .long _sys_mq_open .long _sys_mq_unlink .long _sys_mq_timedsend /* 280 */ .long _sys_mq_timedreceive .long _sys_mq_notify .long _sys_mq_getsetattr .long _sys_ni_syscall /* kexec_load */ .long _sys_waitid /* 285 */ .long _sys_add_key .long _sys_request_key .long _sys_keyctl .long _sys_ioprio_set .long _sys_ioprio_get /* 290 */ .long _sys_inotify_init .long _sys_inotify_add_watch .long _sys_inotify_rm_watch .long _sys_ni_syscall /* migrate_pages */ .long _sys_openat /* 295 */ .long _sys_mkdirat .long _sys_mknodat .long _sys_fchownat .long _sys_futimesat .long _sys_fstatat64 /* 300 */ .long _sys_unlinkat .long _sys_renameat .long _sys_linkat .long _sys_symlinkat .long _sys_readlinkat /* 305 */ .long _sys_fchmodat .long _sys_faccessat .long _sys_pselect6 .long _sys_ppoll .long _sys_unshare /* 310 */ .long _sys_sram_alloc .long _sys_sram_free .long _sys_dma_memcpy .long _sys_accept .long _sys_bind /* 315 */ .long _sys_connect .long _sys_getpeername .long _sys_getsockname .long _sys_getsockopt .long _sys_listen /* 320 */ .long _sys_recv .long _sys_recvfrom .long _sys_recvmsg .long _sys_send .long _sys_sendmsg /* 325 */ .long _sys_sendto .long _sys_setsockopt .long _sys_shutdown .long _sys_socket .long _sys_socketpair /* 330 */ .long _sys_semctl .long _sys_semget .long _sys_semop .long _sys_msgctl .long _sys_msgget /* 335 */ .long _sys_msgrcv .long _sys_msgsnd .long _sys_shmat .long _sys_shmctl .long _sys_shmdt /* 340 */ .long _sys_shmget .long _sys_splice .long _sys_sync_file_range .long _sys_tee .long _sys_vmsplice /* 345 */ .long _sys_epoll_pwait .long _sys_utimensat .long _sys_signalfd .long _sys_timerfd_create .long _sys_eventfd /* 350 */ .long _sys_pread64 .long _sys_pwrite64 .long _sys_fadvise64 .long _sys_set_robust_list .long _sys_get_robust_list /* 355 */ .long _sys_fallocate .long _sys_semtimedop .long _sys_timerfd_settime .long _sys_timerfd_gettime .long _sys_signalfd4 /* 360 */ .long _sys_eventfd2 .long _sys_epoll_create1 .long _sys_dup3 .long _sys_pipe2 .long _sys_inotify_init1 /* 365 */ .rept NR_syscalls-(.-_sys_call_table)/4 .long _sys_ni_syscall .endr END(_sys_call_table) _exception_stack: .rept 1024 .long 0; .endr _exception_stack_top: #if ANOMALY_05000261 /* Used by the assembly entry point to work around an anomaly. */ _last_cplb_fault_retx: .long 0; #endif