^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /* -*- mode: asm -*-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * linux/arch/m68k/kernel/entry.S
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 1991, 1992 Linus Torvalds
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * This file is subject to the terms and conditions of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * License. See the file README.legal in the main directory of this archive
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * Linux/m68k support by Hamish Macdonald
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * 68060 fixes by Jesper Skov
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) * entry.S contains the system-call and fault low-level handling routines.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) * This also contains the timer-interrupt handler, as well as all interrupts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) * and faults that can result in a task-switch.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) * NOTE: This code handles signal-recognition, which happens every time
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) * after a timer-interrupt and after each system call.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * 12/03/96 Jes: Currently we only support m68k single-cpu systems, so
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * all pointers that used to be 'current' are now entry
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * number 0 in the 'current_set' list.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) * 6/05/00 RZ: addedd writeback completion after return from sighandler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) * for 68040
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #include <linux/linkage.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #include <asm/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #include <asm/setup.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #include <asm/segment.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #include <asm/traps.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #include <asm/unistd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #include <asm/asm-offsets.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #include <asm/entry.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) .globl system_call, buserr, trap, resume
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) .globl sys_call_table
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) .globl __sys_fork, __sys_clone, __sys_vfork
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) .globl bad_interrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) .globl auto_irqhandler_fixup
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) .globl user_irqvec_fixup
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .text
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) ENTRY(__sys_fork)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) jbsr sys_fork
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) lea %sp@(24),%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) ENTRY(__sys_clone)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) pea %sp@(SWITCH_STACK_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) jbsr m68k_clone
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) lea %sp@(28),%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) ENTRY(__sys_vfork)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) jbsr sys_vfork
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) lea %sp@(24),%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) ENTRY(__sys_clone3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) pea %sp@(SWITCH_STACK_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) jbsr m68k_clone3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) lea %sp@(28),%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) ENTRY(sys_sigreturn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) movel %sp,%sp@- | switch_stack pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) pea %sp@(SWITCH_STACK_SIZE+4) | pt_regs pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) jbsr do_sigreturn
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) addql #8,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) ENTRY(sys_rt_sigreturn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) movel %sp,%sp@- | switch_stack pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) pea %sp@(SWITCH_STACK_SIZE+4) | pt_regs pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) jbsr do_rt_sigreturn
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) addql #8,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) ENTRY(buserr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) SAVE_ALL_INT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) GET_CURRENT(%d0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) movel %sp,%sp@- | stack frame pointer argument
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) jbsr buserr_c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) ENTRY(trap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) SAVE_ALL_INT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) GET_CURRENT(%d0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) movel %sp,%sp@- | stack frame pointer argument
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) jbsr trap_c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) | After a fork we jump here directly from resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) | so that %d1 contains the previous task
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) | schedule_tail now used regardless of CONFIG_SMP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) ENTRY(ret_from_fork)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) movel %d1,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) jsr schedule_tail
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) ENTRY(ret_from_kernel_thread)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) | a3 contains the kernel thread payload, d7 - its argument
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) movel %d1,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) jsr schedule_tail
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) movel %d7,(%sp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) jsr %a3@
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) #if defined(CONFIG_COLDFIRE) || !defined(CONFIG_MMU)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) #ifdef TRAP_DBG_INTERRUPT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) .globl dbginterrupt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) ENTRY(dbginterrupt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) SAVE_ALL_INT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) GET_CURRENT(%d0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) movel %sp,%sp@- /* stack frame pointer argument */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) jsr dbginterrupt_c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) ENTRY(reschedule)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) /* save top of frame */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) pea %sp@
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) jbsr set_esp0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) pea ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) jmp schedule
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) ENTRY(ret_from_user_signal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) moveq #__NR_sigreturn,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) trap #0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) ENTRY(ret_from_user_rt_signal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) movel #__NR_rt_sigreturn,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) trap #0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) do_trace_entry:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) movel #-ENOSYS,%sp@(PT_OFF_D0)| needed for strace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) subql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) jbsr syscall_trace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) movel %sp@(PT_OFF_ORIG_D0),%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) cmpl #NR_syscalls,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) jcs syscall
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) badsys:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) movel #-ENOSYS,%sp@(PT_OFF_D0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) jra ret_from_syscall
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) do_trace_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) subql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) jbsr syscall_trace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) jra .Lret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) ENTRY(ret_from_signal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) movel %curptr@(TASK_STACK),%a1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) tstb %a1@(TINFO_FLAGS+2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) jge 1f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) jbsr syscall_trace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 1: RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) /* on 68040 complete pending writebacks if any */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) #ifdef CONFIG_M68040
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) bfextu %sp@(PT_OFF_FORMATVEC){#0,#4},%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) subql #7,%d0 | bus error frame ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) jbne 1f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) movel %sp,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) jbsr berr_040cleanup
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) jra .Lret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) ENTRY(system_call)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) SAVE_ALL_SYS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) GET_CURRENT(%d1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) movel %d1,%a1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) | save top of frame
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) movel %sp,%curptr@(TASK_THREAD+THREAD_ESP0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) | syscall trace?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) tstb %a1@(TINFO_FLAGS+2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) jmi do_trace_entry
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) cmpl #NR_syscalls,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) jcc badsys
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) syscall:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) jbsr @(sys_call_table,%d0:l:4)@(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) movel %d0,%sp@(PT_OFF_D0) | save the return value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) ret_from_syscall:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) |oriw #0x0700,%sr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) movel %curptr@(TASK_STACK),%a1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) movew %a1@(TINFO_FLAGS+2),%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) jne syscall_exit_work
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 1: RESTORE_ALL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) syscall_exit_work:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) btst #5,%sp@(PT_OFF_SR) | check if returning to kernel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) bnes 1b | if so, skip resched, signals
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) lslw #1,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) jcs do_trace_exit
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) jmi do_delayed_trace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) lslw #8,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) jne do_signal_return
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) pea resume_userspace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) jra schedule
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) ENTRY(ret_from_exception)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) .Lret_from_exception:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) btst #5,%sp@(PT_OFF_SR) | check if returning to kernel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) bnes 1f | if so, skip resched, signals
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) | only allow interrupts when we are really the last one on the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) | kernel stack, otherwise stack overflow can occur during
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) | heavy interrupt load
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) andw #ALLOWINT,%sr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) resume_userspace:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) movel %curptr@(TASK_STACK),%a1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) moveb %a1@(TINFO_FLAGS+3),%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) jne exit_work
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 1: RESTORE_ALL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) exit_work:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) | save top of frame
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) movel %sp,%curptr@(TASK_THREAD+THREAD_ESP0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) lslb #1,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) jne do_signal_return
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) pea resume_userspace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) jra schedule
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) do_signal_return:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) |andw #ALLOWINT,%sr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) subql #4,%sp | dummy return address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) pea %sp@(SWITCH_STACK_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) bsrl do_notify_resume
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) jbra resume_userspace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) do_delayed_trace:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) bclr #7,%sp@(PT_OFF_SR) | clear trace bit in SR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) pea 1 | send SIGTRAP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) movel %curptr,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) pea LSIGTRAP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) jbsr send_sig
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) addql #8,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) jbra resume_userspace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) /* This is the main interrupt handler for autovector interrupts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) ENTRY(auto_inthandler)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) SAVE_ALL_INT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) GET_CURRENT(%d0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) | put exception # in d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) bfextu %sp@(PT_OFF_FORMATVEC){#4,#10},%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) subw #VEC_SPUR,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) movel %sp,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) movel %d0,%sp@- | put vector # on stack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) auto_irqhandler_fixup = . + 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) jsr do_IRQ | process the IRQ
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) addql #8,%sp | pop parameters off stack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) /* Handler for user defined interrupt vectors */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) ENTRY(user_inthandler)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) SAVE_ALL_INT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) GET_CURRENT(%d0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) | put exception # in d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) bfextu %sp@(PT_OFF_FORMATVEC){#4,#10},%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) user_irqvec_fixup = . + 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) subw #VEC_USER,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) movel %sp,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) movel %d0,%sp@- | put vector # on stack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) jsr do_IRQ | process the IRQ
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) addql #8,%sp | pop parameters off stack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) /* Handler for uninitialized and spurious interrupts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) ENTRY(bad_inthandler)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) SAVE_ALL_INT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) GET_CURRENT(%d0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) movel %sp,%sp@-
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) jsr handle_badint
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) addql #4,%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) jra ret_from_exception
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) resume:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) * Beware - when entering resume, prev (the current task) is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) * in a0, next (the new task) is in a1,so don't change these
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) * registers until their contents are no longer needed.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) /* save sr */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) movew %sr,%a0@(TASK_THREAD+THREAD_SR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /* save fs (sfc,%dfc) (may be pointing to kernel memory) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) movec %sfc,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) movew %d0,%a0@(TASK_THREAD+THREAD_FS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) /* save usp */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) /* it is better to use a movel here instead of a movew 8*) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) movec %usp,%d0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) movel %d0,%a0@(TASK_THREAD+THREAD_USP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) /* save non-scratch registers on stack */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) SAVE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) /* save current kernel stack pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) movel %sp,%a0@(TASK_THREAD+THREAD_KSP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) /* save floating point context */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) #ifndef CONFIG_M68KFPU_EMU_ONLY
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) #ifdef CONFIG_M68KFPU_EMU
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) tstl m68k_fputype
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) jeq 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) fsave %a0@(TASK_THREAD+THREAD_FPSTATE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) #if defined(CONFIG_M68060)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) #if !defined(CPU_M68060_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) btst #3,m68k_cputype+3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) beqs 1f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) /* The 060 FPU keeps status in bits 15-8 of the first longword */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) tstb %a0@(TASK_THREAD+THREAD_FPSTATE+2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) jeq 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) #if !defined(CPU_M68060_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) jra 2f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) #endif /* CONFIG_M68060 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) #if !defined(CPU_M68060_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 1: tstb %a0@(TASK_THREAD+THREAD_FPSTATE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) jeq 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 2: fmovemx %fp0-%fp7,%a0@(TASK_THREAD+THREAD_FPREG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) fmoveml %fpcr/%fpsr/%fpiar,%a0@(TASK_THREAD+THREAD_FPCNTL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) #endif /* CONFIG_M68KFPU_EMU_ONLY */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) /* Return previous task in %d1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) movel %curptr,%d1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) /* switch to new task (a1 contains new task) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) movel %a1,%curptr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) /* restore floating point context */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) #ifndef CONFIG_M68KFPU_EMU_ONLY
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) #ifdef CONFIG_M68KFPU_EMU
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) tstl m68k_fputype
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) jeq 4f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) #if defined(CONFIG_M68060)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) #if !defined(CPU_M68060_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) btst #3,m68k_cputype+3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) beqs 1f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) /* The 060 FPU keeps status in bits 15-8 of the first longword */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) tstb %a1@(TASK_THREAD+THREAD_FPSTATE+2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) jeq 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) #if !defined(CPU_M68060_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) jra 2f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) #endif /* CONFIG_M68060 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) #if !defined(CPU_M68060_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 1: tstb %a1@(TASK_THREAD+THREAD_FPSTATE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) jeq 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 2: fmovemx %a1@(TASK_THREAD+THREAD_FPREG),%fp0-%fp7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) fmoveml %a1@(TASK_THREAD+THREAD_FPCNTL),%fpcr/%fpsr/%fpiar
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 3: frestore %a1@(TASK_THREAD+THREAD_FPSTATE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) #endif /* CONFIG_M68KFPU_EMU_ONLY */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) /* restore the kernel stack pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) movel %a1@(TASK_THREAD+THREAD_KSP),%sp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) /* restore non-scratch registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) RESTORE_SWITCH_STACK
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) /* restore user stack pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) movel %a1@(TASK_THREAD+THREAD_USP),%a0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) movel %a0,%usp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) /* restore fs (sfc,%dfc) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) movew %a1@(TASK_THREAD+THREAD_FS),%a0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) movec %a0,%sfc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) movec %a0,%dfc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) /* restore status register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) movew %a1@(TASK_THREAD+THREAD_SR),%sr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) rts
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) #endif /* CONFIG_MMU && !CONFIG_COLDFIRE */
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags