Loading...
Note: File does not exist in v3.5.6.
1/*
2 * entry.S -- non-mmu 68000 interrupt and exception entry points
3 *
4 * Copyright (C) 1991, 1992 Linus Torvalds
5 *
6 * This file is subject to the terms and conditions of the GNU General Public
7 * License. See the file README.legal in the main directory of this archive
8 * for more details.
9 *
10 * Linux/m68k support by Hamish Macdonald
11 */
12
13#include <linux/linkage.h>
14#include <asm/thread_info.h>
15#include <asm/unistd.h>
16#include <asm/errno.h>
17#include <asm/setup.h>
18#include <asm/traps.h>
19#include <asm/asm-offsets.h>
20#include <asm/entry.h>
21
22.text
23
24.globl system_call
25.globl resume
26.globl ret_from_exception
27.globl sys_call_table
28.globl bad_interrupt
29.globl inthandler1
30.globl inthandler2
31.globl inthandler3
32.globl inthandler4
33.globl inthandler5
34.globl inthandler6
35.globl inthandler7
36
37badsys:
38 movel #-ENOSYS,%sp@(PT_OFF_D0)
39 jra ret_from_exception
40
41do_trace:
42 movel #-ENOSYS,%sp@(PT_OFF_D0) /* needed for strace*/
43 subql #4,%sp
44 SAVE_SWITCH_STACK
45 jbsr syscall_trace_enter
46 RESTORE_SWITCH_STACK
47 addql #4,%sp
48 movel %sp@(PT_OFF_ORIG_D0),%d1
49 movel #-ENOSYS,%d0
50 cmpl #NR_syscalls,%d1
51 jcc 1f
52 lsl #2,%d1
53 lea sys_call_table, %a0
54 jbsr %a0@(%d1)
55
561: movel %d0,%sp@(PT_OFF_D0) /* save the return value */
57 subql #4,%sp /* dummy return address */
58 SAVE_SWITCH_STACK
59 jbsr syscall_trace_leave
60 RESTORE_SWITCH_STACK
61 addql #4,%sp
62 jra ret_from_exception
63
64ENTRY(system_call)
65 SAVE_ALL_SYS
66
67 /* save top of frame*/
68 pea %sp@
69 jbsr set_esp0
70 addql #4,%sp
71
72 movel %sp@(PT_OFF_ORIG_D0),%d0
73
74 movel %sp,%d1 /* get thread_info pointer */
75 andl #-THREAD_SIZE,%d1
76 movel %d1,%a2
77 btst #(TIF_SYSCALL_TRACE%8),%a2@(TINFO_FLAGS+(31-TIF_SYSCALL_TRACE)/8)
78 jne do_trace
79 cmpl #NR_syscalls,%d0
80 jcc badsys
81 lsl #2,%d0
82 lea sys_call_table,%a0
83 movel %a0@(%d0), %a0
84 jbsr %a0@
85 movel %d0,%sp@(PT_OFF_D0) /* save the return value*/
86
87ret_from_exception:
88 btst #5,%sp@(PT_OFF_SR) /* check if returning to kernel*/
89 jeq Luser_return /* if so, skip resched, signals*/
90
91Lkernel_return:
92 RESTORE_ALL
93
94Luser_return:
95 /* only allow interrupts when we are really the last one on the*/
96 /* kernel stack, otherwise stack overflow can occur during*/
97 /* heavy interrupt load*/
98 andw #ALLOWINT,%sr
99
100 movel %sp,%d1 /* get thread_info pointer */
101 andl #-THREAD_SIZE,%d1
102 movel %d1,%a2
1031:
104 move %a2@(TINFO_FLAGS),%d1 /* thread_info->flags */
105 jne Lwork_to_do
106 RESTORE_ALL
107
108Lwork_to_do:
109 movel %a2@(TINFO_FLAGS),%d1 /* thread_info->flags */
110 btst #TIF_NEED_RESCHED,%d1
111 jne reschedule
112
113Lsignal_return:
114 subql #4,%sp /* dummy return address*/
115 SAVE_SWITCH_STACK
116 pea %sp@(SWITCH_STACK_SIZE)
117 bsrw do_notify_resume
118 addql #4,%sp
119 RESTORE_SWITCH_STACK
120 addql #4,%sp
121 jra 1b
122
123/*
124 * This is the main interrupt handler, responsible for calling process_int()
125 */
126inthandler1:
127 SAVE_ALL_INT
128 movew %sp@(PT_OFF_FORMATVEC), %d0
129 and #0x3ff, %d0
130
131 movel %sp,%sp@-
132 movel #65,%sp@- /* put vector # on stack*/
133 jbsr process_int /* process the IRQ*/
1343: addql #8,%sp /* pop parameters off stack*/
135 bra ret_from_exception
136
137inthandler2:
138 SAVE_ALL_INT
139 movew %sp@(PT_OFF_FORMATVEC), %d0
140 and #0x3ff, %d0
141
142 movel %sp,%sp@-
143 movel #66,%sp@- /* put vector # on stack*/
144 jbsr process_int /* process the IRQ*/
1453: addql #8,%sp /* pop parameters off stack*/
146 bra ret_from_exception
147
148inthandler3:
149 SAVE_ALL_INT
150 movew %sp@(PT_OFF_FORMATVEC), %d0
151 and #0x3ff, %d0
152
153 movel %sp,%sp@-
154 movel #67,%sp@- /* put vector # on stack*/
155 jbsr process_int /* process the IRQ*/
1563: addql #8,%sp /* pop parameters off stack*/
157 bra ret_from_exception
158
159inthandler4:
160 SAVE_ALL_INT
161 movew %sp@(PT_OFF_FORMATVEC), %d0
162 and #0x3ff, %d0
163
164 movel %sp,%sp@-
165 movel #68,%sp@- /* put vector # on stack*/
166 jbsr process_int /* process the IRQ*/
1673: addql #8,%sp /* pop parameters off stack*/
168 bra ret_from_exception
169
170inthandler5:
171 SAVE_ALL_INT
172 movew %sp@(PT_OFF_FORMATVEC), %d0
173 and #0x3ff, %d0
174
175 movel %sp,%sp@-
176 movel #69,%sp@- /* put vector # on stack*/
177 jbsr process_int /* process the IRQ*/
1783: addql #8,%sp /* pop parameters off stack*/
179 bra ret_from_exception
180
181inthandler6:
182 SAVE_ALL_INT
183 movew %sp@(PT_OFF_FORMATVEC), %d0
184 and #0x3ff, %d0
185
186 movel %sp,%sp@-
187 movel #70,%sp@- /* put vector # on stack*/
188 jbsr process_int /* process the IRQ*/
1893: addql #8,%sp /* pop parameters off stack*/
190 bra ret_from_exception
191
192inthandler7:
193 SAVE_ALL_INT
194 movew %sp@(PT_OFF_FORMATVEC), %d0
195 and #0x3ff, %d0
196
197 movel %sp,%sp@-
198 movel #71,%sp@- /* put vector # on stack*/
199 jbsr process_int /* process the IRQ*/
2003: addql #8,%sp /* pop parameters off stack*/
201 bra ret_from_exception
202
203inthandler:
204 SAVE_ALL_INT
205 movew %sp@(PT_OFF_FORMATVEC), %d0
206 and #0x3ff, %d0
207
208 movel %sp,%sp@-
209 movel %d0,%sp@- /* put vector # on stack*/
210 jbsr process_int /* process the IRQ*/
2113: addql #8,%sp /* pop parameters off stack*/
212 bra ret_from_exception
213
214/*
215 * Handler for uninitialized and spurious interrupts.
216 */
217ENTRY(bad_interrupt)
218 addql #1,irq_err_count
219 rte
220
221/*
222 * Beware - when entering resume, prev (the current task) is
223 * in a0, next (the new task) is in a1, so don't change these
224 * registers until their contents are no longer needed.
225 */
226ENTRY(resume)
227 movel %a0,%d1 /* save prev thread in d1 */
228 movew %sr,%a0@(TASK_THREAD+THREAD_SR) /* save sr */
229 SAVE_SWITCH_STACK
230 movel %sp,%a0@(TASK_THREAD+THREAD_KSP) /* save kernel stack */
231 movel %usp,%a3 /* save usp */
232 movel %a3,%a0@(TASK_THREAD+THREAD_USP)
233
234 movel %a1@(TASK_THREAD+THREAD_USP),%a3 /* restore user stack */
235 movel %a3,%usp
236 movel %a1@(TASK_THREAD+THREAD_KSP),%sp /* restore new thread stack */
237 RESTORE_SWITCH_STACK
238 movew %a1@(TASK_THREAD+THREAD_SR),%sr /* restore thread status reg */
239 rts
240