aboutsummaryrefslogtreecommitdiffstats
path: root/arch/h8300/platform
diff options
context:
space:
mode:
authorYoshinori Sato <ysato@users.sourceforge.jp>2007-07-16 02:38:36 -0400
committerLinus Torvalds <torvalds@woody.linux-foundation.org>2007-07-16 12:05:37 -0400
commit2fea299f74c846157b068be8ae15b406db0719d9 (patch)
tree649ee49eb7568927f2379f9ea2d213f2ec40e873 /arch/h8300/platform
parent542f739d12159e3198611aa471359cc63600be1a (diff)
h8300 entry.S update
Signed-off-by: Yoshinori Sato <ysato@users.sourceforge.jp> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Diffstat (limited to 'arch/h8300/platform')
-rw-r--r--arch/h8300/platform/h8300h/Makefile2
-rw-r--r--arch/h8300/platform/h8300h/entry.S332
-rw-r--r--arch/h8300/platform/h8s/Makefile2
-rw-r--r--arch/h8300/platform/h8s/entry.S331
4 files changed, 2 insertions, 665 deletions
diff --git a/arch/h8300/platform/h8300h/Makefile b/arch/h8300/platform/h8300h/Makefile
index b24ea08aa0a7..c5096369ea50 100644
--- a/arch/h8300/platform/h8300h/Makefile
+++ b/arch/h8300/platform/h8300h/Makefile
@@ -4,4 +4,4 @@
4# Reuse any files we can from the H8/300H 4# Reuse any files we can from the H8/300H
5# 5#
6 6
7obj-y := entry.o irq_pin.o ptrace_h8300h.o 7obj-y := irq_pin.o ptrace_h8300h.o
diff --git a/arch/h8300/platform/h8300h/entry.S b/arch/h8300/platform/h8300h/entry.S
deleted file mode 100644
index f86ac3b5d4de..000000000000
--- a/arch/h8300/platform/h8300h/entry.S
+++ /dev/null
@@ -1,332 +0,0 @@
1/* -*- mode: asm -*-
2 *
3 * linux/arch/h8300/platform/h8300h/entry.S
4 *
5 * Yoshinori Sato <ysato@users.sourceforge.jp>
6 * David McCullough <davidm@snapgear.com>
7 *
8 */
9
10/*
11 * entry.S
12 * include exception/interrupt gateway
13 * system call entry
14 */
15
16#include <linux/sys.h>
17#include <asm/unistd.h>
18#include <asm/setup.h>
19#include <asm/segment.h>
20#include <asm/linkage.h>
21#include <asm/asm-offsets.h>
22#include <asm/thread_info.h>
23#include <asm/errno.h>
24
25 .h8300h
26
27/* CPU context save/restore macros. */
28
29 .macro SAVE_ALL
30 mov.l er0,@-sp
31
32 stc ccr,r0l /* check kernel mode */
33 btst #4,r0l
34 bne 5f
35
36 mov.l sp,@SYMBOL_NAME(sw_usp) /* user mode */
37 mov.l @sp,er0
38 orc #0x10,ccr
39 mov.l @SYMBOL_NAME(sw_ksp),sp
40 sub.l #(LRET-LORIG),sp /* allocate LORIG - LRET */
41 mov.l er0,@-sp
42 mov.l er1,@-sp
43 mov.l @SYMBOL_NAME(sw_usp),er0
44 mov.l @(8:16,er0),er1 /* copy the RET addr */
45 mov.l er1,@(LRET-LER1:16,sp)
46
47 mov.w e1,r1 /* e1 highbyte = ccr */
48 and #0xef,r1h /* mask mode? flag */
49 sub.w r0,r0
50 mov.b r1h,r0l
51 mov.w r0,@(LCCR-LER1:16,sp) /* copy ccr */
52 mov.l @(LORIG-LER1:16,sp),er0
53 mov.l er0,@(LER0-LER1:16,sp) /* copy ER0 */
54 bra 6f
555:
56 mov.l @sp,er0 /* kernel mode */
57 subs #2,sp /* dummy ccr */
58 mov.l er0,@-sp
59 mov.l er1,@-sp
60 mov.w @(LRET-LER1:16,sp),r1 /* copy old ccr */
61 mov.b r1h,r1l
62 mov.b #0,r1h
63 mov.w r1,@(LCCR-LER1:16,sp) /* set ccr */
646:
65 mov.l er2,@-sp
66 mov.l er3,@-sp
67 mov.l er6,@-sp /* syscall arg #6 */
68 mov.l er5,@-sp /* syscall arg #5 */
69 mov.l er4,@-sp /* syscall arg #4 */
70 .endm
71
72 .macro RESTORE_ALL
73 mov.l @sp+,er4
74 mov.l @sp+,er5
75 mov.l @sp+,er6
76 mov.l @sp+,er3
77 mov.l @sp+,er2
78 mov.w @(LCCR-LER1:16,sp),r0 /* check kernel mode */
79 btst #4,r0l
80 bne 7f
81
82 orc #0x80,ccr
83 mov.l @SYMBOL_NAME(sw_usp),er0
84 mov.l @(LER0-LER1:16,sp),er1 /* restore ER0 */
85 mov.l er1,@er0
86 mov.w @(LCCR-LER1:16,sp),r1 /* restore the RET addr */
87 mov.b r1l,r1h
88 mov.b @(LRET+1-LER1:16,sp),r1l
89 mov.w r1,e1
90 mov.w @(LRET+2-LER1:16,sp),r1
91 mov.l er1,@(8:16,er0)
92
93 mov.l @sp+,er1
94 add.l #(LRET-LER1),sp /* remove LORIG - LRET */
95 mov.l sp,@SYMBOL_NAME(sw_ksp)
96 mov.l er0,sp
97 bra 8f
987:
99 mov.l @sp+,er1
100 adds #4,sp
101 adds #2,sp
1028:
103 mov.l @sp+,er0
104 adds #4,sp /* remove the sw created LVEC */
105 rte
106 .endm
107
108.globl SYMBOL_NAME(system_call)
109.globl SYMBOL_NAME(ret_from_exception)
110.globl SYMBOL_NAME(ret_from_fork)
111.globl SYMBOL_NAME(ret_from_interrupt)
112.globl SYMBOL_NAME(interrupt_redirect_table)
113.globl SYMBOL_NAME(sw_ksp),SYMBOL_NAME(sw_usp)
114.globl SYMBOL_NAME(resume)
115.globl SYMBOL_NAME(interrupt_redirect_table)
116.globl SYMBOL_NAME(interrupt_entry)
117.globl SYMBOL_NAME(system_call)
118.globl SYMBOL_NAME(trace_break)
119
120#if defined(CONFIG_ROMKERNEL)
121INTERRUPTS = 64
122 .section .int_redirect,"ax"
123SYMBOL_NAME_LABEL(interrupt_redirect_table)
124 .rept 7
125 .long 0
126 .endr
127 jsr @SYMBOL_NAME(interrupt_entry) /* NMI */
128 jmp @SYMBOL_NAME(system_call) /* TRAPA #0 (System call) */
129 .long 0
130 .long 0
131 jmp @SYMBOL_NAME(trace_break) /* TRAPA #3 (breakpoint) */
132 .rept INTERRUPTS-12
133 jsr @SYMBOL_NAME(interrupt_entry)
134 .endr
135#endif
136#if defined(CONFIG_RAMKERNEL)
137.globl SYMBOL_NAME(interrupt_redirect_table)
138 .section .bss
139SYMBOL_NAME_LABEL(interrupt_redirect_table)
140 .space 4
141#endif
142
143 .section .text
144 .align 2
145SYMBOL_NAME_LABEL(interrupt_entry)
146 SAVE_ALL
147 mov.w @(LCCR,sp),r0
148 btst #4,r0l
149 bne 1f
150 mov.l @SYMBOL_NAME(sw_usp),er0
151 mov.l @(4:16,er0),er0
152 bra 2f
1531:
154 mov.l @(LVEC,sp),er0
1552:
156#if defined(CONFIG_ROMKERNEL)
157 sub.l #SYMBOL_NAME(interrupt_redirect_table),er0
158#endif
159#if defined(CONFIG_RAMKERNEL)
160 mov.l @SYMBOL_NAME(interrupt_redirect_table),er1
161 sub.l er1,er0
162#endif
163 shlr.l er0
164 shlr.l er0
165 dec.l #1,er0
166 mov.l sp,er1
167 subs #4,er1 /* adjust ret_pc */
168 jsr @SYMBOL_NAME(do_IRQ)
169 mov.l @SYMBOL_NAME(irq_stat)+CPUSTAT_SOFTIRQ_PENDING,er0
170 beq 1f
171 jsr @SYMBOL_NAME(do_softirq)
1721:
173 jmp @SYMBOL_NAME(ret_from_interrupt)
174
175SYMBOL_NAME_LABEL(system_call)
176 subs #4,sp /* dummy LVEC */
177 SAVE_ALL
178 mov.w @(LCCR:16,sp),r1
179 bset #4,r1l
180 ldc r1l,ccr
181 mov.l er0,er4
182 mov.l #-ENOSYS,er0
183 mov.l er0,@(LER0:16,sp)
184
185 /* save top of frame */
186 mov.l sp,er0
187 jsr @SYMBOL_NAME(set_esp0)
188 cmp.l #NR_syscalls,er4
189 bcc SYMBOL_NAME(ret_from_exception):16
190 shll.l er4
191 shll.l er4
192 mov.l #SYMBOL_NAME(sys_call_table),er0
193 add.l er4,er0
194 mov.l @er0,er4
195 beq SYMBOL_NAME(ret_from_exception):16
196 mov.l sp,er2
197 and.w #0xe000,r2
198 mov.b @((TASK_FLAGS+3-(TIF_SYSCALL_TRACE >> 3)):16,er2),r2l
199 btst #(TIF_SYSCALL_TRACE & 7),r2l
200 bne 1f
201 mov.l @(LER1:16,sp),er0
202 mov.l @(LER2:16,sp),er1
203 mov.l @(LER3:16,sp),er2
204 jsr @er4
205 mov.l er0,@(LER0:16,sp) /* save the return value */
206#if defined(CONFIG_SYSCALL_PRINT)
207 jsr @SYMBOL_NAME(syscall_print)
208#endif
209 bra SYMBOL_NAME(ret_from_exception):8
2101:
211 jsr SYMBOL_NAME(syscall_trace)
212 mov.l @(LER1:16,sp),er0
213 mov.l @(LER2:16,sp),er1
214 mov.l @(LER3:16,sp),er2
215 jsr @er4
216 mov.l er0,@(LER0:16,sp) /* save the return value */
217 jsr @SYMBOL_NAME(syscall_trace)
218 bra SYMBOL_NAME(ret_from_exception):8
219
220SYMBOL_NAME_LABEL(ret_from_fork)
221 mov.l er2,er0
222 jsr @SYMBOL_NAME(schedule_tail)
223 bra SYMBOL_NAME(ret_from_exception):8
224
225SYMBOL_NAME_LABEL(reschedule)
226 /* save top of frame */
227 mov.l sp,er0
228 jsr @SYMBOL_NAME(set_esp0)
229 jsr @SYMBOL_NAME(schedule)
230
231SYMBOL_NAME_LABEL(ret_from_exception)
232#if defined(CONFIG_PREEMPT)
233 orc #0x80,ccr
234#endif
235SYMBOL_NAME_LABEL(ret_from_interrupt)
236 mov.b @(LCCR+1:16,sp),r0l
237 btst #4,r0l /* check if returning to kernel */
238 bne done:8 /* if so, skip resched, signals */
239 andc #0x7f,ccr
240 mov.l sp,er4
241 and.w #0xe000,r4
242 mov.l @(TI_FLAGS:16,er4),er1
243 and.l #_TIF_WORK_MASK,er1
244 beq done:8
2451:
246 mov.l @(TI_FLAGS:16,er4),er1
247 btst #TIF_NEED_RESCHED,r1l
248 bne SYMBOL_NAME(reschedule):16
249 mov.l sp,er0
250 subs #4,er0 /* adjust retpc */
251 mov.l er2,er1
252 jsr @SYMBOL_NAME(do_signal)
253#if defined(CONFIG_PREEMPT)
254 bra done:8 /* userspace thoru */
2553:
256 btst #4,r0l
257 beq done:8 /* userspace thoru */
2584:
259 mov.l @(TI_PRE_COUNT:16,er4),er1
260 bne done:8
261 mov.l @(TI_FLAGS:16,er4),er1
262 btst #TIF_NEED_RESCHED,r1l
263 beq done:8
264 mov.b r0l,r0l
265 bpl done:8 /* interrupt off (exception path?) */
266 mov.l #PREEMPT_ACTIVE,er1
267 mov.l er1,@(TI_PRE_COUNT:16,er4)
268 andc #0x7f,ccr
269 jsr @SYMBOL_NAME(schedule)
270 sub.l er1,er1
271 mov.l er1,@(TI_PRE_COUNT:16,er4)
272 orc #0x80,ccr
273 bra 4b:8
274#endif
275done:
276 RESTORE_ALL /* Does RTE */
277
278SYMBOL_NAME_LABEL(resume)
279 /*
280 * Beware - when entering resume, offset of tss is in d1,
281 * prev (the current task) is in a0, next (the new task)
282 * is in a1 and d2.b is non-zero if the mm structure is
283 * shared between the tasks, so don't change these
284 * registers until their contents are no longer needed.
285 */
286
287 /* save sr */
288 sub.w r3,r3
289 stc ccr,r3l
290 mov.w r3,@(THREAD_CCR+2:16,er0)
291
292 /* disable interrupts */
293 orc #0x80,ccr
294 mov.l @SYMBOL_NAME(sw_usp),er3
295 mov.l er3,@(THREAD_USP:16,er0)
296 mov.l sp,@(THREAD_KSP:16,er0)
297
298 /* Skip address space switching if they are the same. */
299 /* FIXME: what did we hack out of here, this does nothing! */
300
301 mov.l @(THREAD_USP:16,er1),er0
302 mov.l er0,@SYMBOL_NAME(sw_usp)
303 mov.l @(THREAD_KSP:16,er1),sp
304
305 /* restore status register */
306 mov.w @(THREAD_CCR+2:16,er1),r3
307
308 ldc r3l,ccr
309 rts
310
311SYMBOL_NAME_LABEL(trace_break)
312 subs #4,sp
313 SAVE_ALL
314 sub.l er1,er1
315 dec.l #1,er1
316 mov.l er1,@(LORIG,sp)
317 mov.l sp,er0
318 jsr @SYMBOL_NAME(set_esp0)
319 mov.l @SYMBOL_NAME(sw_usp),er0
320 mov.l @er0,er1
321 subs #2,er1
322 mov.l er1,@er0
323 and.w #0xff,e1
324 mov.l er1,er0
325 jsr @SYMBOL_NAME(trace_trap)
326 jmp @SYMBOL_NAME(ret_from_exception)
327
328 .section .bss
329SYMBOL_NAME_LABEL(sw_ksp)
330 .space 4
331SYMBOL_NAME_LABEL(sw_usp)
332 .space 4
diff --git a/arch/h8300/platform/h8s/Makefile b/arch/h8300/platform/h8s/Makefile
index 0847b15d4256..bf1241883766 100644
--- a/arch/h8300/platform/h8s/Makefile
+++ b/arch/h8300/platform/h8s/Makefile
@@ -4,4 +4,4 @@
4# Reuse any files we can from the H8S 4# Reuse any files we can from the H8S
5# 5#
6 6
7obj-y := entry.o ints_h8s.o ptrace_h8s.o 7obj-y := ints_h8s.o ptrace_h8s.o
diff --git a/arch/h8300/platform/h8s/entry.S b/arch/h8300/platform/h8s/entry.S
deleted file mode 100644
index f3d6b8e8f959..000000000000
--- a/arch/h8300/platform/h8s/entry.S
+++ /dev/null
@@ -1,331 +0,0 @@
1/* -*- mode: asm -*-
2 *
3 * linux/arch/h8300/platform/h8s/entry.S
4 *
5 * Yoshinori Sato <ysato@users.sourceforge.jp>
6 *
7 * fairly heavy changes to fix syscall args and signal processing
8 * by David McCullough <davidm@snapgear.com>
9 */
10
11/*
12 * entry.S
13 * include exception/interrupt gateway
14 * system call entry
15 */
16
17#include <linux/sys.h>
18#include <asm/unistd.h>
19#include <asm/setup.h>
20#include <asm/segment.h>
21#include <asm/linkage.h>
22#include <asm/asm-offsets.h>
23#include <asm/thread_info.h>
24#include <asm/errno.h>
25
26 .h8300s
27
28/* CPU context save/restore macros. */
29
30 .macro SAVE_ALL
31 mov.l er0,@-sp
32
33 stc ccr,r0l /* check kernel mode */
34 btst #4,r0l
35 bne 5f
36
37 /* user mode */
38 mov.l sp,@SYMBOL_NAME(sw_usp)
39 mov.l @sp,er0 /* restore saved er0 */
40 orc #0x10,ccr /* switch kernel stack */
41 mov.l @SYMBOL_NAME(sw_ksp),sp
42 sub.l #(LRET-LORIG),sp /* allocate LORIG - LRET */
43 stm.l er0-er3,@-sp
44 mov.l @SYMBOL_NAME(sw_usp),er0
45 mov.l @(10:16,er0),er1 /* copy the RET addr */
46 mov.l er1,@(LRET-LER3:16,sp)
47 mov.w @(8:16,er0),r1
48 mov.w r1,@(LEXR-LER3:16,sp) /* copy EXR */
49
50 mov.w e1,r1 /* e1 highbyte = ccr */
51 and #0xef,r1h /* mask mode? flag */
52 sub.w r0,r0
53 mov.b r1h,r0l
54 mov.w r0,@(LCCR-LER3:16,sp) /* copy ccr */
55 mov.l @(LORIG-LER3:16,sp),er0
56 mov.l er0,@(LER0-LER3:16,sp) /* copy ER0 */
57 bra 6f
585:
59 /* kernel mode */
60 mov.l @sp,er0 /* restore saved er0 */
61 subs #2,sp /* set dummy ccr */
62 stm.l er0-er3,@-sp
63 mov.w @(LRET-LER3:16,sp),r1 /* copy old ccr */
64 mov.b r1h,r1l
65 mov.b #0,r1h
66 mov.w r1,@(LCCR-LER3:16,sp)
676:
68 mov.l er6,@-sp /* syscall arg #6 */
69 mov.l er5,@-sp /* syscall arg #5 */
70 mov.l er4,@-sp /* syscall arg #4 */
71 .endm
72
73 .macro RESTORE_ALL
74 mov.l @sp+,er4
75 mov.l @sp+,er5
76 mov.l @sp+,er6
77 ldm.l @sp+,er2-er3
78 mov.w @(LCCR-LER1:16,sp),r0 /* check kernel mode */
79 btst #4,r0l
80 bne 7f
81
82 orc #0x80,ccr
83 mov.l @SYMBOL_NAME(sw_usp),er0
84 mov.l @(LER0-LER1:16,sp),er1 /* restore ER0 */
85 mov.l er1,@er0
86 mov.w @(LEXR-LER1:16,sp),r1 /* restore EXR */
87 mov.b r1l,r1h
88 mov.w r1,@(8:16,er0)
89 mov.w @(LCCR-LER1:16,sp),r1 /* restore the RET addr */
90 mov.b r1l,r1h
91 mov.b @(LRET+1-LER1:16,sp),r1l
92 mov.w r1,e1
93 mov.w @(LRET+2-LER1:16,sp),r1
94 mov.l er1,@(10:16,er0)
95
96 mov.l @sp+,er1
97 add.l #(LRET-LER1),sp /* remove LORIG - LRET */
98 mov.l sp,@SYMBOL_NAME(sw_ksp)
99 andc #0xef,ccr /* switch to user mode */
100 mov.l er0,sp
101 bra 8f
1027:
103 mov.l @sp+,er1
104 adds #4,sp
105 adds #2,sp
1068:
107 mov.l @sp+,er0
108 adds #4,sp /* remove the sw created LVEC */
109 rte
110 .endm
111
112.globl SYMBOL_NAME(system_call)
113.globl SYMBOL_NAME(ret_from_exception)
114.globl SYMBOL_NAME(ret_from_fork)
115.globl SYMBOL_NAME(ret_from_interrupt)
116.globl SYMBOL_NAME(interrupt_redirect_table)
117.globl SYMBOL_NAME(sw_ksp),SYMBOL_NAME(sw_usp)
118.globl SYMBOL_NAME(resume)
119.globl SYMBOL_NAME(trace_break)
120.globl SYMBOL_NAME(interrupt_entry)
121
122INTERRUPTS = 128
123#if defined(CONFIG_ROMKERNEL)
124 .section .int_redirect,"ax"
125SYMBOL_NAME_LABEL(interrupt_redirect_table)
126 .rept 7
127 .long 0
128 .endr
129 jsr @SYMBOL_NAME(interrupt_entry) /* NMI */
130 jmp @SYMBOL_NAME(system_call) /* TRAPA #0 (System call) */
131 .long 0
132 .long 0
133 jmp @SYMBOL_NAME(trace_break) /* TRAPA #3 (breakpoint) */
134 .rept INTERRUPTS-12
135 jsr @SYMBOL_NAME(interrupt_entry)
136 .endr
137#endif
138#if defined(CONFIG_RAMKERNEL)
139.globl SYMBOL_NAME(interrupt_redirect_table)
140 .section .bss
141SYMBOL_NAME_LABEL(interrupt_redirect_table)
142 .space 4
143#endif
144
145 .section .text
146 .align 2
147SYMBOL_NAME_LABEL(interrupt_entry)
148 SAVE_ALL
149 mov.w @(LCCR,sp),r0
150 btst #4,r0l
151 bne 1f
152 mov.l @SYMBOL_NAME(sw_usp),er0
153 mov.l @(4:16,er0),er0
154 bra 2f
1551:
156 mov.l @(LVEC:16,sp),er0
1572:
158#if defined(CONFIG_ROMKERNEL)
159 sub.l #SYMBOL_NAME(interrupt_redirect_table),er0
160#endif
161#if defined(CONFIG_RAMKERNEL)
162 mov.l @SYMBOL_NAME(interrupt_redirect_table),er1
163 sub.l er1,er0
164#endif
165 shlr.l #2,er0
166 dec.l #1,er0
167 mov.l sp,er1
168 subs #4,er1 /* adjust ret_pc */
169 jsr @SYMBOL_NAME(process_int)
170 mov.l @SYMBOL_NAME(irq_stat)+CPUSTAT_SOFTIRQ_PENDING,er0
171 beq 1f
172 jsr @SYMBOL_NAME(do_softirq)
1731:
174 jmp @SYMBOL_NAME(ret_from_exception)
175
176SYMBOL_NAME_LABEL(system_call)
177 subs #4,sp /* dummy LVEC */
178 SAVE_ALL
179 mov.l er0,er4
180 mov.l #-ENOSYS,er0
181 mov.l er0,@(LER0:16,sp)
182
183 /* save top of frame */
184 mov.l sp,er0
185 jsr @SYMBOL_NAME(set_esp0)
186 cmp.l #NR_syscalls,er4
187 bcc SYMBOL_NAME(ret_from_exception):16
188 shll.l #2,er4
189 mov.l #SYMBOL_NAME(sys_call_table),er0
190 add.l er4,er0
191 mov.l @er0,er0
192 mov.l er0,er4
193 beq SYMBOL_NAME(ret_from_exception):16
194 mov.l sp,er2
195 and.w #0xe000,r2
196 mov.b @((TASK_FLAGS+3-(TIF_SYSCALL_TRACE >> 3)):16,er2),r2l
197 btst #(TIF_SYSCALL_TRACE & 7),r2l
198 mov.l @(LER1:16,sp),er0
199 mov.l @(LER2:16,sp),er1
200 mov.l @(LER3:16,sp),er2
201 andc #0x7f,ccr
202 jsr @er4
203 mov.l er0,@(LER0:16,sp) /* save the return value */
204#if defined(CONFIG_SYSCALL_PRINT)
205 jsr @SYMBOL_NAME(syscall_print)
206#endif
207 bra SYMBOL_NAME(ret_from_exception):8
2081:
209 jsr SYMBOL_NAME(syscall_trace)
210 mov.l @(LER1:16,sp),er0
211 mov.l @(LER2:16,sp),er1
212 mov.l @(LER3:16,sp),er2
213 jsr @er4
214 mov.l er0,@(LER0:16,sp) /* save the return value */
215 jsr @SYMBOL_NAME(syscall_trace)
216 bra SYMBOL_NAME(ret_from_exception):8
217
218SYMBOL_NAME_LABEL(ret_from_fork)
219 mov.l er2,er0
220 jsr @SYMBOL_NAME(schedule_tail)
221 bra SYMBOL_NAME(ret_from_exception):8
222
223SYMBOL_NAME_LABEL(reschedule)
224 /* save top of frame */
225 mov.l sp,er0
226 jsr @SYMBOL_NAME(set_esp0)
227 jsr @SYMBOL_NAME(schedule)
228
229SYMBOL_NAME_LABEL(ret_from_exception)
230#if defined(CONFIG_PREEMPT)
231 orc #0x80,ccr
232#endif
233SYMBOL_NAME_LABEL(ret_from_interrupt)
234 mov.b @(LCCR+1:16,sp),r0l
235 btst #4,r0l /* check if returning to kernel */
236 bne done:8 /* if so, skip resched, signals */
237 andc #0x7f,ccr
238 mov.l sp,er4
239 and.w #0xe000,r4
240 mov.l @(TI_FLAGS:16,er4),er1
241 and.l #_TIF_WORK_MASK,er1
242 beq done:8
2431:
244 mov.l @(TI_FLAGS:16,er4),er1
245 btst #TIF_NEED_RESCHED,r1l
246 bne SYMBOL_NAME(reschedule):16
247 mov.l sp,er0
248 subs #4,er0 /* adjust retpc */
249 mov.l er2,er1
250 jsr @SYMBOL_NAME(do_signal)
251#if defined(CONFIG_PREEMPT)
252 bra done:8 /* userspace thoru */
2533:
254 btst #4,r0l
255 beq done:8 /* userspace thoru */
2564:
257 mov.l @(TI_PRE_COUNT:16,er4),er1
258 bne done:8
259 mov.l @(TI_FLAGS:16,er4),er1
260 btst #TIF_NEED_RESCHED,r1l
261 beq done:8
262 mov.b r0l,r0l
263 bpl done:8 /* interrupt off (exception path?) */
264 mov.l #PREEMPT_ACTIVE,er1
265 mov.l er1,@(TI_PRE_COUNT:16,er4)
266 andc #0x7f,ccr
267 jsr @SYMBOL_NAME(schedule)
268 sub.l er1,er1
269 mov.l er1,@(TI_PRE_COUNT:16,er4)
270 orc #0x80,ccr
271 bra 4b:8
272#endif
273done:
274 RESTORE_ALL /* Does RTE */
275
276SYMBOL_NAME_LABEL(resume)
277 /*
278 * er0 = prev
279 * er1 = next
280 * return last in er2
281 */
282
283 /* save sr */
284 sub.w r3,r3
285 stc ccr,r3l
286 stc exr,r3h
287 mov.w r3,@(THREAD_CCR+2:16,er0)
288
289 /* disable interrupts */
290 orc #0x80,ccr
291 mov.l @SYMBOL_NAME(sw_usp),er3
292 mov.l er3,@(THREAD_USP:16,er0)
293 mov.l sp,@(THREAD_KSP:16,er0)
294
295 /* Skip address space switching if they are the same. */
296 /* FIXME: what did we hack out of here, this does nothing! */
297
298 mov.l @(THREAD_USP:16,er1),er0
299 mov.l er0,@SYMBOL_NAME(sw_usp)
300 mov.l @(THREAD_KSP:16,er1),sp
301
302 /* restore status register */
303 mov.w @(THREAD_CCR+2:16,er1),r3
304
305 ldc r3l,ccr
306 ldc r3h,exr
307
308 rts
309
310SYMBOL_NAME_LABEL(trace_break)
311 subs #4,sp /* dummy LVEC */
312 SAVE_ALL
313 sub.l er1,er1
314 dec.l #1,er1
315 mov.l er1,@(LORIG,sp)
316 mov.l sp,er0
317 jsr @SYMBOL_NAME(set_esp0)
318 mov.l @SYMBOL_NAME(sw_usp),er0
319 mov.l @er0,er1
320 subs #2,er1
321 mov.l er1,@er0
322 and.w #0xff,e1
323 mov.l er1,er0
324 jsr @SYMBOL_NAME(trace_trap)
325 jmp @SYMBOL_NAME(ret_from_exception)
326
327 .section .bss
328SYMBOL_NAME_LABEL(sw_ksp)
329 .space 4
330SYMBOL_NAME_LABEL(sw_usp)
331 .space 4
generated by cgit v1.2.2 (git 2.25.0) at 2024-11-12 02:44:43 -0500