cpu/sh2/entry.S

43 	mov.l	r2,@-sp
44 	mov.l	r3,@-sp
46 	mov.l	$cpu_mode,r2
48 	mov.l	$cpuid,r3
49 	mov.l	@r3,r3
50 	mov.l	@r3,r3
54 	mov.l	@r2,r0
55 	mov.l	@(5*4,r15),r3	! previous SR
58 	bf/s	1f		! previous mode check
59 	 mov.l	r3,@(5*4,r15)	! update SR
61 	mov.l	__md_bit,r0
62 	mov.l	r0,@r2		! enter kernel mode
63 	mov.l	$current_thread_info,r2
65 	mov.l	$cpuid,r0
66 	mov.l	@r0,r0
67 	mov.l	@r0,r0
71 	mov.l	@r2,r2
77 	mov.l	r1,@-r15	! TRA
78 	sts.l	macl, @-r15
79 	sts.l	mach, @-r15
80 	stc.l	gbr, @-r15
81 	mov.l	@(5*4,r2),r0
82 	mov.l	r0,@-r15	! original SR
83 	sts.l	pr,@-r15
84 	mov.l	@(4*4,r2),r0
85 	mov.l	r0,@-r15	! original PC
88 	mov.l	r3,@-r15	! original SP
89 	mov.l	r14,@-r15
90 	mov.l	r13,@-r15
91 	mov.l	r12,@-r15
92 	mov.l	r11,@-r15
93 	mov.l	r10,@-r15
94 	mov.l	r9,@-r15
95 	mov.l	r8,@-r15
96 	mov.l	r7,@-r15
97 	mov.l	r6,@-r15
98 	mov.l	r5,@-r15
99 	mov.l	r4,@-r15
102 	mov.l	@(0,r8),r3
103 	mov.l	r3,@-r15
104 	mov.l	@(4,r8),r2
105 	mov.l	r2,@-r15
106 	mov.l	@(12,r8),r1
107 	mov.l	r1,@-r15
108 	mov.l	@(8,r8),r0
110 	 mov.l	r0,@-r15
111 1:
113 	mov	#(22-4-4-1)*4+4,r0
116 	mov.l	@r2+,r0		! old R3
117 	mov.l	r0,@-r15
118 	mov.l	@r2+,r0		! old R2
119 	mov.l	r0,@-r15
120 	mov.l	@(4,r2),r0	! old R1
121 	mov.l	r0,@-r15
122 	mov.l	@r2,r0		! old R0
123 	mov.l	r0,@-r15
125 	mov.l	@r2+,r3		! old PC
126 	mov.l	@r2+,r0		! old SR
128 	mov.l	r1,@-r2		! TRA
129 	sts.l	macl, @-r2
130 	sts.l	mach, @-r2
131 	stc.l	gbr, @-r2
132 	mov.l	r0,@-r2		! save old SR
133 	sts.l	pr,@-r2
134 	mov.l	r3,@-r2		! save old PC
137 	mov.l	r0,@-r2		! save old SP
138 	mov.l	r14,@-r2
139 	mov.l	r13,@-r2
140 	mov.l	r12,@-r2
141 	mov.l	r11,@-r2
142 	mov.l	r10,@-r2
143 	mov.l	r9,@-r2
144 	mov.l	r8,@-r2
145 	mov.l	r7,@-r2
146 	mov.l	r6,@-r2
147 	mov.l	r5,@-r2
148 	mov.l	r4,@-r2
150 	mov.l	@(OFF_R0,r15),r0
151 	mov.l	@(OFF_R1,r15),r1
152 	mov.l	@(OFF_R2,r15),r2
153 	mov.l	@(OFF_R3,r15),r3
167 	mov.l	4f,r8
171 	mov.l	@r8,r8		! exception handler address
174 	mov.l	8f,r8		! unhandled exception
176 	mov.l	5f,r10
183 	mov.l	6f,r9
184 	mov.l	7f,r8
198 	bt	1f
200 1:
210 	ldc.l	@r0+,gbr
211 	lds.l	@r0+,mach
212 	lds.l	@r0+,macl
214 	mov.l	@(OFF_SP,r0),r1
216 	mov.l	@(r0,r2),r3
217 	mov.l	r3,@-r1
219 	mov.l	@(r0,r2),r3
220 	mov.l	r3,@-r1
223 	mov.l	1f,r2
224 	mov.l	@r2,r2
226 	mov.l	r2,@r0
227 	mov.l	r3,@(4,r0)
228 	mov.l	r1,@(8,r0)
229 	mov.l	@r15+, r0
230 	mov.l	@r15+, r1
231 	mov.l	@r15+, r2
232 	mov.l	@r15+, r3
233 	mov.l	@r15+, r4
234 	mov.l	@r15+, r5
235 	mov.l	@r15+, r6
236 	mov.l	@r15+, r7
237 	mov.l	@r15+, r8
238 	mov.l	@r15+, r9
239 	mov.l	@r15+, r10
240 	mov.l	@r15+, r11
241 	mov.l	@r15+, r12
242 	mov.l	@r15+, r13
243 	mov.l	@r15+, r14
245 	lds.l	@r15+, pr
246 	mov.l	@r15+,r15
250 1:	.long	gdb_vbr_vector
256 	mov.l	@(r0,r15),r6			! pc
257 	mov.l	1f,r0
262 1:	.long	do_address_error
267 	ldc	r0,sr				! all interrupt block (same BL = 1)
272 	lds.l	@r0+,pr
274 	ldc.l	@r0+,gbr
275 	lds.l	@r0+,mach
276 	lds.l	@r0+,macl
278 	mov.l	$cpu_mode,r2
280 	mov.l	$cpuid,r3
281 	mov.l	@r3,r3
282 	mov.l	@r3,r3
287 	mov.l	@(r0,r3),r1
288 	mov.l	__md_bit,r3
290 	mov.l	r3,@r2
293 	mov.l	@(OFF_SP,r0),r2
295 	mov.l	r2,@(OFF_SP,r0)			! point exception frame top
296 	mov.l	r1,@(4,r2)			! set sr
298 	mov.l	@(r0,r3),r1
299 	mov.l	r1,@r2				! set pc
301 	mov.l	$current_thread_info,r1
303 	mov.l	$cpuid,r3
304 	mov.l	@r3,r3
305 	mov.l	@r3,r3
309 	mov.l	r0,@r1
310 	mov.l	@r15+,r0
311 	mov.l	@r15+,r1
312 	mov.l	@r15+,r2
313 	mov.l	@r15+,r3
314 	mov.l	@r15+,r4
315 	mov.l	@r15+,r5
316 	mov.l	@r15+,r6
317 	mov.l	@r15+,r7
318 	mov.l	@r15+,r8
319 	mov.l	@r15+,r9
320 	mov.l	@r15+,r10
321 	mov.l	@r15+,r11
322 	mov.l	@r15+,r12
323 	mov.l	@r15+,r13
324 	mov.l	@r15+,r14
325 	mov.l	@r15,r15
347 #define NR_CPUS 1