1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#include <linux/linkage.h>
37#include <asm/errno.h>
38#include <asm/setup.h>
39#include <asm/traps.h>
40#include <asm/unistd.h>
41#include <asm/asm-offsets.h>
42#include <asm/entry.h>
43
44.globl system_call, buserr, trap, resume
45.globl sys_call_table
46.globl __sys_fork, __sys_clone, __sys_vfork
47.globl bad_interrupt
48.globl auto_irqhandler_fixup
49.globl user_irqvec_fixup
50
51.text
52ENTRY(__sys_fork)
53 SAVE_SWITCH_STACK
54 jbsr sys_fork
55 lea %sp@(24),%sp
56 rts
57
58ENTRY(__sys_clone)
59 SAVE_SWITCH_STACK
60 pea %sp@(SWITCH_STACK_SIZE)
61 jbsr m68k_clone
62 lea %sp@(28),%sp
63 rts
64
65ENTRY(__sys_vfork)
66 SAVE_SWITCH_STACK
67 jbsr sys_vfork
68 lea %sp@(24),%sp
69 rts
70
71ENTRY(__sys_clone3)
72 SAVE_SWITCH_STACK
73 pea %sp@(SWITCH_STACK_SIZE)
74 jbsr m68k_clone3
75 lea %sp@(28),%sp
76 rts
77
78ENTRY(sys_sigreturn)
79 SAVE_SWITCH_STACK
80 movel %sp,%a1 | switch_stack pointer
81 lea %sp@(SWITCH_STACK_SIZE),%a0 | pt_regs pointer
82 lea %sp@(-84),%sp | leave a gap
83 movel %a1,%sp@-
84 movel %a0,%sp@-
85 jbsr do_sigreturn
86 jra 1f | shared with rt_sigreturn()
87
88ENTRY(sys_rt_sigreturn)
89 SAVE_SWITCH_STACK
90 movel %sp,%a1 | switch_stack pointer
91 lea %sp@(SWITCH_STACK_SIZE),%a0 | pt_regs pointer
92 lea %sp@(-84),%sp | leave a gap
93 movel %a1,%sp@-
94 movel %a0,%sp@-
95 | stack contents:
96 | [original pt_regs address] [original switch_stack address]
97 | [gap] [switch_stack] [pt_regs] [exception frame]
98 jbsr do_rt_sigreturn
99
1001:
101 | stack contents now:
102 | [original pt_regs address] [original switch_stack address]
103 | [unused part of the gap] [moved switch_stack] [moved pt_regs]
104 | [replacement exception frame]
105 | return value of do_{rt_,}sigreturn() points to moved switch_stack.
106
107 movel %d0,%sp | discard the leftover junk
108 RESTORE_SWITCH_STACK
109 | stack contents now is just [syscall return address] [pt_regs] [frame]
110 | return pt_regs.d0
111 movel %sp@(PT_OFF_D0+4),%d0
112 rts
113
114ENTRY(buserr)
115 SAVE_ALL_INT
116 GET_CURRENT(%d0)
117 movel %sp,%sp@- | stack frame pointer argument
118 jbsr buserr_c
119 addql
120 jra ret_from_exception
121
122ENTRY(trap)
123 SAVE_ALL_INT
124 GET_CURRENT(%d0)
125 movel %sp,%sp@- | stack frame pointer argument
126 jbsr trap_c
127 addql
128 jra ret_from_exception
129
130 | After a fork we jump here directly from resume,
131 | so that %d1 contains the previous task
132 | schedule_tail now used regardless of CONFIG_SMP
133ENTRY(ret_from_fork)
134 movel %d1,%sp@-
135 jsr schedule_tail
136 addql
137 jra ret_from_exception
138
139ENTRY(ret_from_kernel_thread)
140 | a3 contains the kernel thread payload, d7 - its argument
141 movel %d1,%sp@-
142 jsr schedule_tail
143 movel %d7,(%sp)
144 jsr %a3@
145 addql
146 jra ret_from_exception
147
148
149
150#ifdef TRAP_DBG_INTERRUPT
151
152.globl dbginterrupt
153ENTRY(dbginterrupt)
154 SAVE_ALL_INT
155 GET_CURRENT(%d0)
156 movel %sp,%sp@-
157 jsr dbginterrupt_c
158 addql
159 jra ret_from_exception
160#endif
161
162ENTRY(reschedule)
163
164 pea %sp@
165 jbsr set_esp0
166 addql
167 pea ret_from_exception
168 jmp schedule
169
170ENTRY(ret_from_user_signal)
171 moveq
172 trap
173
174ENTRY(ret_from_user_rt_signal)
175 movel
176 trap
177
178#else
179
180do_trace_entry:
181 movel
182 subql
183 SAVE_SWITCH_STACK
184 jbsr syscall_trace
185 RESTORE_SWITCH_STACK
186 addql
187 movel %sp@(PT_OFF_ORIG_D0),%d0
188 cmpl
189 jcs syscall
190badsys:
191 movel
192 jra ret_from_syscall
193
194do_trace_exit:
195 subql
196 SAVE_SWITCH_STACK
197 jbsr syscall_trace
198 RESTORE_SWITCH_STACK
199 addql
200 jra .Lret_from_exception
201
202ENTRY(system_call)
203 SAVE_ALL_SYS
204
205 GET_CURRENT(%d1)
206 movel %d1,%a1
207
208 | save top of frame
209 movel %sp,%curptr@(TASK_THREAD+THREAD_ESP0)
210
211 | syscall trace?
212 tstb %a1@(TINFO_FLAGS+2)
213 jmi do_trace_entry
214 cmpl
215 jcc badsys
216syscall:
217 jbsr @(sys_call_table,%d0:l:4)@(0)
218 movel %d0,%sp@(PT_OFF_D0) | save the return value
219ret_from_syscall:
220 |oriw
221 movel %curptr@(TASK_STACK),%a1
222 movew %a1@(TINFO_FLAGS+2),%d0
223 jne syscall_exit_work
2241: RESTORE_ALL
225
226syscall_exit_work:
227 btst
228 bnes 1b | if so, skip resched, signals
229 lslw
230 jcs do_trace_exit
231 jmi do_delayed_trace
232 lslw
233 jne do_signal_return
234 pea resume_userspace
235 jra schedule
236
237
238ENTRY(ret_from_exception)
239.Lret_from_exception:
240 btst
241 bnes 1f | if so, skip resched, signals
242 | only allow interrupts when we are really the last one on the
243 | kernel stack, otherwise stack overflow can occur during
244 | heavy interrupt load
245 andw
246
247resume_userspace:
248 movel %curptr@(TASK_STACK),%a1
249 moveb %a1@(TINFO_FLAGS+3),%d0
250 jne exit_work
2511: RESTORE_ALL
252
253exit_work:
254 | save top of frame
255 movel %sp,%curptr@(TASK_THREAD+THREAD_ESP0)
256 lslb
257 jne do_signal_return
258 pea resume_userspace
259 jra schedule
260
261
262do_signal_return:
263 |andw
264 subql
265 SAVE_SWITCH_STACK
266 pea %sp@(SWITCH_STACK_SIZE)
267 bsrl do_notify_resume
268 addql
269 RESTORE_SWITCH_STACK
270 addql
271 jbra resume_userspace
272
273do_delayed_trace:
274 bclr
275 pea 1 | send SIGTRAP
276 movel %curptr,%sp@-
277 pea LSIGTRAP
278 jbsr send_sig
279 addql
280 addql
281 jbra resume_userspace
282
283
284
285
286ENTRY(auto_inthandler)
287 SAVE_ALL_INT
288 GET_CURRENT(%d0)
289 | put exception
290 bfextu %sp@(PT_OFF_FORMATVEC){
291 subw
292
293 movel %sp,%sp@-
294 movel %d0,%sp@- | put vector
295auto_irqhandler_fixup = . + 2
296 jsr do_IRQ | process the IRQ
297 addql
298 jra ret_from_exception
299
300
301
302ENTRY(user_inthandler)
303 SAVE_ALL_INT
304 GET_CURRENT(%d0)
305 | put exception
306 bfextu %sp@(PT_OFF_FORMATVEC){
307user_irqvec_fixup = . + 2
308 subw
309
310 movel %sp,%sp@-
311 movel %d0,%sp@- | put vector
312 jsr do_IRQ | process the IRQ
313 addql
314 jra ret_from_exception
315
316
317
318ENTRY(bad_inthandler)
319 SAVE_ALL_INT
320 GET_CURRENT(%d0)
321
322 movel %sp,%sp@-
323 jsr handle_badint
324 addql
325 jra ret_from_exception
326
327resume:
328
329
330
331
332
333
334
335 movew %sr,%a0@(TASK_THREAD+THREAD_SR)
336
337
338 movec %sfc,%d0
339 movew %d0,%a0@(TASK_THREAD+THREAD_FC)
340
341
342
343 movec %usp,%d0
344 movel %d0,%a0@(TASK_THREAD+THREAD_USP)
345
346
347 SAVE_SWITCH_STACK
348
349
350 movel %sp,%a0@(TASK_THREAD+THREAD_KSP)
351
352
353#ifndef CONFIG_M68KFPU_EMU_ONLY
354#ifdef CONFIG_M68KFPU_EMU
355 tstl m68k_fputype
356 jeq 3f
357#endif
358 fsave %a0@(TASK_THREAD+THREAD_FPSTATE)
359
360
361
362 btst
363 beqs 1f
364#endif
365
366 tstb %a0@(TASK_THREAD+THREAD_FPSTATE+2)
367 jeq 3f
368
369 jra 2f
370#endif
371#endif
372
3731: tstb %a0@(TASK_THREAD+THREAD_FPSTATE)
374 jeq 3f
375#endif
3762: fmovemx %fp0-%fp7,%a0@(TASK_THREAD+THREAD_FPREG)
377 fmoveml %fpcr/%fpsr/%fpiar,%a0@(TASK_THREAD+THREAD_FPCNTL)
3783:
379#endif
380
381 movel %curptr,%d1
382
383
384 movel %a1,%curptr
385
386
387#ifndef CONFIG_M68KFPU_EMU_ONLY
388#ifdef CONFIG_M68KFPU_EMU
389 tstl m68k_fputype
390 jeq 4f
391#endif
392
393
394 btst
395 beqs 1f
396#endif
397
398 tstb %a1@(TASK_THREAD+THREAD_FPSTATE+2)
399 jeq 3f
400
401 jra 2f
402#endif
403#endif
404
4051: tstb %a1@(TASK_THREAD+THREAD_FPSTATE)
406 jeq 3f
407#endif
4082: fmovemx %a1@(TASK_THREAD+THREAD_FPREG),%fp0-%fp7
409 fmoveml %a1@(TASK_THREAD+THREAD_FPCNTL),%fpcr/%fpsr/%fpiar
4103: frestore %a1@(TASK_THREAD+THREAD_FPSTATE)
4114:
412#endif
413
414
415 movel %a1@(TASK_THREAD+THREAD_KSP),%sp
416
417
418 RESTORE_SWITCH_STACK
419
420
421 movel %a1@(TASK_THREAD+THREAD_USP),%a0
422 movel %a0,%usp
423
424
425 movew %a1@(TASK_THREAD+THREAD_FC),%a0
426 movec %a0,%sfc
427 movec %a0,%dfc
428
429
430 movew %a1@(TASK_THREAD+THREAD_SR),%sr
431
432 rts
433
434#endif
435