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