Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

prc_support.S@ 317

Last change on this file since 317 was 317, checked in by coas-nagasima, 7 years ago
GR-SAKURA向けASP3を追加
Property svn:eol-style set to `native` Property svn:keywords set to `Id` Property svn:mime-type set to `text/plain`
File size: 30.9 KB

Line
1	;
2	; TOPPERS/ASP Kernel
3	; Toyohashi Open Platform for Embedded Real-Time Systems/
4	; Advanced Standard Profile Kernel
5	;
6	; Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7	; Toyohashi Univ. of Technology, JAPAN
8	; Copyright (C) 2007 by Embedded and Real-Time Systems Laboratory
9	; Graduate School of Information Science, Nagoya Univ., JAPAN
10	; Copyright (C) 2010 by Witz Corporation, JAPAN
11	; Copyright (C) 2013 by Mitsuhiro Matsuura
12	; Copyright (C) 2017 by Cores Co., Ltd. Japan
13	;
14	; ä¸è¨èä½æ¨©è
15	ã¯ï¼ä»¥ä¸ã®(1)ï½(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
16	; ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ãä½¿ç¨ã»è¤è£½ã»æ¹
17	; å¤ã»åé
18	å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
19	; (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
20	; æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
21	; ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
22	; (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
23	; ç¨ã§ããå½¢ã§åé
24	å¸ããå ´åã«ã¯ï¼åé
25	å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
26	; è
27	ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
28	; ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
29	; (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
30	; ç¨ã§ããªãå½¢ã§åé
31	å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
32	; ã¨ï¼
33	; (a) åé
34	å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
35	ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
36	; ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
37	; (b) åé
38	å¸ã®å½¢æ
39	ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
40	; å ±åãããã¨ï¼
41	; (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
42	; å®³ãããï¼ä¸è¨èä½æ¨©è
43	ããã³TOPPERSããã¸ã§ã¯ããå
44	è²¬ãããã¨ï¼
45	; ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãç
46	; ç±ã«åºã¥ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
47	ããã³TOPPERSããã¸ã§ã¯ãã
48	; å
49	è²¬ãããã¨ï¼
50	;
51	; æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
52	ã
53	; ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç
54	; ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§
55	; ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæå®³ã«é¢ãã¦ãï¼ã
56	; ã®è²¬ä»»ãè² ããªãï¼
57	;
58	; @(#) $Id: prc_support.S 317 2017-08-03 13:14:26Z coas-nagasima $
59	;
60
61	;
62	; ããã»ããµä¾åã¢ã¸ã¥ã¼ã« ã¢ã»ã³ããªè¨èªé¨ï¼RX630ç¨ï¼
63	;
64	#define TOPPERS_MACRO_ONLY
65	#define UINT_C(val) (val) /* uint_tåã®å®æ°ãä½ããã¯ã */
66	#define ULONG_C(val) (val) /* ulong_tåã®å®æ°ãä½ããã¯ã */
67	#define CAST(type, val) (val) /* åãã£ã¹ããè¡ããã¯ã */
68	#include "kernel_impl.h"
69
70	;
71	; ãã£ã¹ãããã£ããã³å²è¾¼ã¿(CPUä¾å¤)åºå
72	¥ãå£ã®ã«ã¼ã«:
73	; åä½ã¢ã¼ããä»¥ä¸ã®ããã«å®ç¾©ãã.
74	; ãã£ã¹ãããã£ã¢ã¼ã:
75	; CPUããã¯ç¶æ
76	, å²è¾¼ã¿åªå
77	åº¦ãã¹ã¯å
78	¨è§£é¤ç¶æ
79	,
80	; ã¿ã¹ã¯ã³ã³ããã¹ã(intnest = 0), ã¿ã¹ã¯ã¹ã¿ãã¯
81	; å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ã
82	; å
83	¨å²è¾¼ã¿ããã¯ç¶æ
84	(PSWã¬ã¸ã¹ã¿Iããã = 0),
85	; å²è¾¼ã¿åªå
86	åº¦ãã¹ã¯å
87	¨è§£é¤ã§ãªãç¶æ
88	(IPL != 0)
89	; å²è¾¼ã¿ã³ã³ããã¹ã(intnest != 0), å²è¾¼ã¿ã¹ã¿ãã¯
90	;
91	; ã«ã¼ãã«ç®¡çå¤å²è¾¼ã¿ã®ãµãã¼ãæç¡ã¨, CPUããã¯ç¶æ
92	, å²è¾¼ã¿åªå
93	åº¦
94	; ãã¹ã¯å
95	¨è§£é¤ç¶æ
96	ã®é¢ä¿ã¯ä»¥ä¸ã®éãã§ãã.
97	; ã«ã¼ãã«ç®¡çå¤å²è¾¼ã¿æªãµãã¼ãæ:
98	; CPUããã¯ç¶æ
99	(PSWã¬ã¸ã¹ã¿Iããã = 0)
100	; å²è¾¼ã¿åªå
101	åº¦ãã¹ã¯å
102	¨è§£é¤ç¶æ
103	(IPL = 0)
104	; ã«ã¼ãã«ç®¡çå¤å²è¾¼ã¿ãµãã¼ãæ:
105	; CPUããã¯ç¶æ
106
107	; (PSWã¬ã¸ã¹ã¿Iããã = 0, IPL = IPL_LOCK, lock_flag = true)
108	; å²è¾¼ã¿åªå
109	åº¦ãã¹ã¯å
110	¨è§£é¤ç¶æ
111	(saved_ipl = 0)
112	;
113	; åæ§é ä½ãã¤ã³ã¿ãä»¥ä¸ã®ããã«åã¬ã¸ã¹ã¿ã«ã¢ãµã¤ã³ãã.
114	; r15 = p_runtsk ãã ããã£ã¹ãããã£ã®ååºå£ã§ã¯ç¡å¹
115	; r14 = *p_runtsk dispatcher ã®ä¸ã§ã¯ p_runtsk ç¢ºå®æã«ååå¾ãã
116	; åå
117	¥ãå£ããæåã«å¤æ°ã¢ã¯ã»ã¹ããã¨ãã«ä¸è¨ã¬ã¸ã¹ã¿ã«ä¿åãã.
118	;
119	; æ§é ä½ã¢ã©ã¤ã¡ã³ãã¸ã®å¯¾å¿
120	; æ§é ä½ã¢ã©ã¤ã¡ã³ãã4Byte(ã¢ã³ããã¯)ã®å ´å:
121	; ä¸è¬çãªã¬ã¸ã¹ã¿ç¸å¯¾ã¢ãã¬ãã·ã³ã°ãå¯è½
122	; ä¾: mov.l #__kernel_p_runtsk, r15
123	; mov.l r0, TCB_sp[r15]
124	; æ§é ä½ã¢ã©ã¤ã¡ã³ãã4Byteã§ã¯ãªã(ããã¯)ã®å ´å:
125	; mov.lã®ããã«ãã³ã°ãµã¤ãºæå®ã®å ´åãç¸å¯¾å¤ã¯4ã®åæ°ã®ã¿æå¹
126	; ãã®ãã, ä¸åº¦å¯¾è±¡ã¢ãã¬ã¹ãæ±ãã¦ããã¢ã¯ã»ã¹ããå¿
127	è¦ããã
128	; ä¾: mov.l #__kernel_p_runtsk, r15
129	; add #TCB_sp, r15, r5
130	; mov.l r0, [r5]
131	; åãªãã»ããå¤ãå¤æã, æ¡ä»¶ã¢ã»ã³ãã«ã«ããã³ã¼ããåãæ¿ãã
132	;
133
134	;
135	; æ§é ä½ã¢ã¯ã»ã¹ã®ãªãã»ããå®ç¾©
136	;
137	#include "offset.h"
138
139	;
140	; åç¨®EQUå®ç¾©(Hãã¡ã¤ã«ã®#defineå®ç¾©)
141	;
142	#include "target_kernel_impl.h"
143	#include "prc_kernel_impl.h"
144
145	.global __kernel_istkpt
146
147	.global __kernel_p_runtsk
148	.global __kernel_p_schedtsk
149
150	.global __kernel_dispatch
151	.global __exit_and_dispatch
152	.global __kernel_start_r
153	.global __kernel_call_texrtn
154	.global _kernel_interrupt
155	.global _kernel_exception
156	.global __kernel_intnest
157	.global __kernel_call_exit_kernel
158	.global __kernel_start_dispatch
159
160	.global _ext_tsk
161	.global __kernel_exit_kernel
162
163	#if TIPM_LOCK != -15
164	.global __kernel_lock_flag
165	.global __kernel_saved_ipl
166	#endif
167
168	.global __kernel_break_wait
169	.global _sil_dly_nse
170
171	#if LOG_INH_ENTER == 1
172	.global _kernel_log_inh_enter
173	#endif /* LOG_INH_ENTER == 1 */
174	#if LOG_INH_LEAVE == 1
175	.global _kernel_log_inh_leave
176	#endif /* LOG_INH_LEAVE == 1 */
177	#if LOG_EXC_ENTER == 1
178	.global _kernel_log_exc_enter
179	#endif /* LOG_EXC_ENTER == 1 */
180	#if LOG_EXC_LEAVE == 1
181	.global _kernel_log_exc_leave
182	#endif /* LOG_EXC_LEAVE == 1 */
183	#if LOG_DSP_ENTER == 1
184	.global _kernel_log_dsp_enter
185	#endif /* LOG_DSP_ENTER == 1 */
186	#if LOG_DSP_LEAVE == 1
187	.global _kernel_log_dsp_leave
188	#endif /* LOG_DSP_LEAVE == 1 */
189
190	#ifdef TOPPERS_SUPPORT_OVRHDR
191	.global __kernel_ovrtimer_start
192	.global __kernel_ovrtimer_stop
193	#endif /* TOPPERS_SUPPORT_OVRHDR */
194
195	;
196	; TCB_sp ã¸ã®æ¸è¾¼ã¿ãã¯ã
197	;
198	.macro st_TCB_sp src, tcb, tmp
199	#if (TCB_sp % 4) == 0
200	mov.l \src, TCB_sp[\tcb]
201	#else
202	add #TCB_sp, \tcb, \tmp
203	mov.l \src, [\tmp]
204	#endif
205	.endm
206
207	;
208	; TCB_sp ããã®èªåºããã¯ã
209	;
210	.macro ld_TCB_sp dst, tcb, tmp
211	#if (TCB_sp % 4) == 0
212	mov.l TCB_sp[\tcb], \dst
213	#else
214	add #TCB_sp, \tcb, \tmp
215	mov.l [tmp], \dst
216	#endif
217	.endm
218
219	;
220	; TCB_pc ã¸ã®æ¸è¾¼ã¿ãã¯ã
221	;
222	.macro st_TCB_pc src, tcb, tmp
223	#if (TCB_pc % 4) == 0
224	mov.l \src, TCB_pc[\tcb]
225	#else
226	add #TCB_pc, \tcb, \tmp
227	mov.l \src, [\tmp]
228	#endif
229	.endm
230
231	;
232	; TCB_pc ããã®èªåºããã¯ã
233	;
234	.macro ld_TCB_pc dst, tcb, tmp
235	#if (TCB_pc % 4) == 0
236	mov.l TCB_pc[\tcb], \dst
237	#else
238	add #TCB_pc, \tcb, \tmp
239	mov.l [\tmp], \dst
240	#endif
241	.endm
242
243	;
244	; TCB_texptn ããã®èªåºããã¯ã
245	;
246	.macro ld_TCB_texptn dst, tcb, tmp
247	#if (TCB_texptn % 4) == 0
248	mov.l TCB_texptn[\tcb], \dst
249	#else
250	add #TCB_texptn, \tcb, \tmp
251	mov.l [\tmp], \dst
252	#endif
253	.endm
254
255	;
256	; TCB_p_tinib ããã®èªåºããã¯ã
257	;
258	.macro ld_TCB_p_tinib dst, tcb, tmp
259	#if (TCB_p_tinib % 4) == 0
260	mov.l TCB_p_tinib[\tcb], \dst
261	#else
262	add #TCB_p_tinib, \tcb, \tmp
263	mov.l [\tmp], \dst
264	#endif
265	.endm
266
267	;
268	; TINIB_exinf ããã®èªåºããã¯ã
269	;
270	.macro ld_TINIB_exinf dst, tinib, tmp
271	#if (TINIB_exinf % 4) == 0
272	mov.l TINIB_exinf[\tinib], \dst
273	#else
274	add #TINIB_exinf, \tinib, \tmp
275	mov.l [\tmp], \dst
276	#endif
277	.endm
278
279	;
280	; TINIB_task ããã®èªåºããã¯ã
281	;
282	.macro ld_TINIB_task dst, tinib, tmp
283	#if (TINIB_task % 4) == 0
284	mov.l TINIB_task[\tinib], \dst
285	#else
286	add #TINIB_task, \tinib, \tmp
287	mov.l [\tmp], \dst
288	#endif
289	.endm
290
291
292	.section P, CODE
293
294	;
295	; APIããã®ã¿ã¹ã¯ãã£ã¹ãããã£å
296	¥å£
297	;
298	; å¼ã³åºãæ¡ä»¶:
299	; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç
300	§)
301	;
302	; ããã§ã¯, ã³ã³ããã¹ãã®éé¿ã¨, å®è¡åéçªå°ã®è¨å®ããã.
303	;
304	__kernel_dispatch:
305	#ifdef TOPPERS_SUPPORT_OVRHDR /* (6-5-3-1) */
306	mov.l #255, r1 ; r1ã«ããã¼å²è¾¼ã¿çªå·
307	bsr __kernel_ovrtimer_stop
308	#endif /* TOPPERS_SUPPORT_OVRHDR */
309	pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å
310	mov.l #__kernel_p_runtsk, r15
311	mov.l [r15], r14
312	st_TCB_sp r0, r14, r5 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãTCBã«ä¿å
313	st_TCB_pc #dispatch_r, r14, r5 ; å®è¡åéçªå°ãTCBã«ä¿å
314	bra dispatcher
315
316	;
317	; APIã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£
318	;
319	; å¼ã³åºãæ¡ä»¶:
320	; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç
321	§)
322	;
323	; ããã§ã¯, ã¿ã¹ã¯ä¾å¤ãã³ãã©å¼åºãã¨, ã³ã³ããã¹ãã®å¾©å¸°ããã.
324	;
325	dispatch_r:
326	dispatch_r_rts:
327	popm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿å¾©å¸°
328	#ifdef TOPPERS_SUPPORT_OVRHDR /* (6-5-3-2) */
329	bsr __kernel_ovrtimer_start
330	#endif /* TOPPERS_SUPPORT_OVRHDR */
331	rts ; dispatch å¼ã³åºãå
332	ã¸æ»ã.
333
334	;
335	; ã¿ã¹ã¯èµ·åå¦ç(ã¿ã¹ã¯å
336	é ã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£)
337	;
338	; å¼ã³åºãæ¡ä»¶:
339	; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç
340	§)
341	;
342	; ããã§ã¯, CPUããã¯è§£é¤ç¶æ
343	ã«ã, ã¿ã¹ã¯ãèµ·åãã.
344	;
345	__kernel_start_r:
346	#ifdef TOPPERS_SUPPORT_OVRHDR /* (6-5-6-1) */
347	push.l r14
348	bsr __kernel_ovrtimer_start
349	pop r14
350	#endif /* TOPPERS_SUPPORT_OVRHDR */
351	mov.l #_ext_tsk, r5
352	push.l r5 ; æ»ãçªå°ãã¹ã¿ãã¯ã«ç©ã
353	ld_TCB_p_tinib r5, r14, r4
354	ld_TINIB_exinf r1, r5, r4 ; æ¡å¼µæ
355	å ±ãç¬¬ä¸å¼æ°ã«è¨å®
356	ld_TINIB_task r5, r5, r4 ; ã¿ã¹ã¯ã®èµ·åçªå°ãåå¾
357	.if TIPM_LOCK == -15
358	setpsw i ; å²è¾¼ã¿è¨±å¯(CPUããã¯è§£é¤ç¶æ
359	)
360	.else
361	mov.l #__kernel_lock_flag, r4 ; CPUããã¯è§£é¤ç¶æ
362	ã¸
363	mov.l #0, [r4] ; ããã«æ¥ãã¨ãã¯å¿
364	ã saved_ipl ã®
365	mvtc #00010000H, psw ; å¤ã¯ 0 ã®ãã, ç´å¤ãè¨å®ãã.
366	; å
367	¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ
368	( I = 1 )
369	; å²è¾¼ã¿åªå
370	åº¦ãã¹ã¯å
371	¨è§£é¤ç¶æ
372	( IPL = 0 )
373	.endif
374	jmp r5
375
376	;
377	; ã«ã¼ãã«èµ·åããã®ã¿ã¹ã¯ãã£ã¹ãããã£å
378	¥å£
379	;
380	; ãã®ã«ã¼ãã³ã¯ï¼ã«ã¼ãã«èµ·åæã«ï¼ãã¹ã¦ã®å²è¾¼ã¿ãç¦æ¢ããç¶æ
381
382	; ï¼å²è¾¼ã¿ããã¯ç¶æ
383	ã¨åçï¼ã§å¼ã³åºãããï¼ã¾ãï¼å²è¾¼ã¿ã¢ã¼ãï¼é
384	; ã¿ã¹ã¯ã³ã³ããã¹ãã¨åçï¼ã§å¼ã³åºããããã¨ãæ³å®ãã¦ããï¼
385	;
386	; å¼ã³åºãæ¡ä»¶:
387	; ã»å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ã(ãã¡ã¤ã«ãããåç
388	§)
389	;
390	; ããã§ã¯, ãã£ã¹ãããã£ã¢ã¼ãã«å¤æ´ãã.
391	;
392	__kernel_start_dispatch:
393	mov.l #__kernel_intnest, r5
394	mov.w #0, [r5] ; ã¿ã¹ã¯ã³ã³ããã¹ãã«åæã
395	#if TIPM_LOCK != -15
396	mvtc #(IPL_LOCK \| 00010000H), psw ; å
397	¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ
398
399	; å²è¾¼ã¿åªå
400	åº¦ãã¹ã¯å
401	¨è§£é¤ã§ãªãç¶æ
402
403	#endif
404
405	;
406	; ã¿ã¹ã¯çµäº(ç¾å¨ã®ã³ã³ããã¹ããæ¨ã¦ã)ããã®ã¿ã¹ã¯ãã£ã¹ãããã£å
407	¥å£
408	;
409	; å¼ã³åºãæ¡ä»¶:
410	; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç
411	§)
412	;
413	; ããã§ã¯, ä½ããããã¨ã¯ãªã.
414	; ãªã, p_runtsk ã®ã¢ãã¬ã¹åå¾ã ãã¯è¡ãªã.
415	;
416	__exit_and_dispatch:
417	mov.l #__kernel_p_runtsk, r15
418	.if LOG_DSP_ENTER == 1
419	mov.l [r15], r14
420	.endif
421	;
422	; ãã£ã¹ãããã£æ¬ä½
423	;
424	; å¼ã³åºãæ¡ä»¶:
425	; ã»ãã¹ã¦ã®ã¿ã¹ã¯ã®ã³ã³ããã¹ãã¯ä¿åããã¦ãã.
426	;
427	; dispatcher å¼åºæã®ã¹ã¿ãã¯:
428	; ã»__kernel_dispatch ããããå ´å : ã¿ã¹ã¯ã¹ã¿ãã¯
429	; ã»exit_and_dispatch ããããå ´å:
430	; exit_task ããããå ´å : ã¿ã¹ã¯ã¹ã¿ãã¯
431	; ã«ã¼ãã«èµ·åæ(__kernel_start_dispatch) : å²è¾¼ã¿ã¹ã¿ãã¯
432	; ã»ret_int ããããå ´å : ã¿ã¹ã¯ã¹ã¿ãã¯
433	; ã»dispatcher_idle_loop ããããå ´å : å²è¾¼ã¿ã¹ã¿ãã¯
434	;
435	dispatcher:
436	.if LOG_DSP_ENTER == 1
437	push.l r15
438	mov.l r14, r1 ; å¼æ°(ãã£ã¹ãããå
439	TCB)ãè¨å®
440	bsr __kernel_log_dsp_enter
441	pop r15
442	.endif
443	mov.l #__kernel_p_schedtsk, r5
444	mov.l [r5], [r15] ; p_schedtsk ã p_runtsk ã«
445	mov.l [r15], r14
446	cmp #0, r14
447	bz dispatcher_pre_idle ; schedtsk ããªããã°ã¢ã¤ãã«ã«ã¼ãã¸
448	ld_TCB_sp r0, r14, r5 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ãå¾©å¸°
449	.if LOG_DSP_LEAVE == 1
450	push.l r14
451	mov.l r14, r1 ; å¼æ°(ãã£ã¹ãããå
452	TCB)ãè¨å®
453	bsr __kernel_log_dsp_leave
454	pop r14
455	.endif
456	ld_TCB_pc r5, r14, r4
457	jmp r5 ; å®è¡åéçªå°ã¸ã¸ã£ã³ã
458
459	;
460	; schdedtskãNULLã®å ´åã¯ã¢ã¤ãã«ã«ã¼ãã«å
461	¥ã
462	; ã¢ã¤ãã«ã«ã¼ãã¯å²è¾¼ã¿å¦çã¢ã¼ãã§åä½ããã
463	;
464	; ããã§å²è¾¼ã¿ã¢ã¼ãã«åãæããã®ã¯ï¼ããã§çºçããå²è¾¼ã¿å¦çã«
465	; ã©ã®ã¹ã¿ãã¯ãä½¿ããã¨ããåé¡ã®è§£æ±ºã¨ï¼å²è¾¼ã¿ãã³ãã©å
466	ã§ã®ã¿
467	; ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ãã2ã¤ã®æå³ãããï¼
468	;
469	dispatcher_pre_idle:
470	mov.l #__kernel_istkpt,r5
471	mov.l [r5], r0 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ã
472	mov.l #__kernel_intnest, r5
473	mov.w #1, [r5] ; éã¿ã¹ã¯ã³ã³ããã¹ãã«åæã
474	#if TIPM_LOCK != -15
475	mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ
476	ã¸
477	mov.l #0, [r5]
478	mvtc #0, psw ; åªå
479	åº¦0ã®å²è¾¼ã¿å¦çä¸ãå½è£
480
481	#endif
482
483	dispatcher_idle_loop:
484	setpsw i ; å
485	¨å²è¾¼ã¿è¨±å¯
486	clrpsw i ; å
487	¨å²è¾¼ã¿ç¦æ¢
488
489	mov.l #__kernel_p_schedtsk, r4
490	mov.l [r4], r4 ; p_schedtsk -> r4
491	mov.l #__kernel_p_runtsk, r5
492	mov.l [r5], r5 ; p_runtsk -> r5
493	cmp r4, r5 ; p_schedtsk ã¨ p_runtsk ãåãã§ãã£ã¹ãããè¦æ±ç¡ããªã
494	beq dispatcher_idle_loop ; ã¢ã¤ãã«ã«ã¼ããç¹°ãè¿ã
495	mov.l #0, [r5] ; reqflgãtrueãªãfalseã«ãã
496	mov.l #__kernel_intnest, r5
497	mov.w #0, [r5] ; ã¿ã¹ã¯ã³ã³ããã¹ãã«åæã
498	#if TIPM_LOCK != -15
499	mov.l #__kernel_lock_flag, r5 ; CPUããã¯ç¶æ
500	ã¸
501	mov.l #1, [r5]
502	mov.l #__kernel_saved_ipl, r5
503	mov.l #0, [r5]
504	mvtc #(IPL_LOCK \| PSW_I_MASK), psw ; å
505	¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ
506
507	; å²è¾¼ã¿åªå
508	åº¦ãã¹ã¯å
509	¨è§£é¤ã§ãªãç¶æ
510
511	#endif
512	bra dispatcher ; dispatcher ã¸æ»ã
513
514
515	;
516	; ã«ã¼ãã«ã®çµäºå¦çã®å¼åºã
517	;
518	; ã¢ã¼ãã¨ã¹ã¿ãã¯ãéã¿ã¹ã¯ã³ã³ããã¹ãç¨ã«åãæ¿ãï¼
519	;
520	.global __kernel_call_exit_kernel
521	__kernel_call_exit_kernel:
522	#if TIPM_LOCK != -15
523	clrpsw i ; å
524	¨å²è¾¼ã¿ç¦æ¢
525	mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ
526	ã¸
527	mov.l #0, [r5]
528	#endif
529	mov.l #__kernel_istkpt, r5
530	mov.l [r5], r0 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ã
531	mov.l #__kernel_intnest, r5
532	mov.w #1, [r5] ; éã¿ã¹ã¯ã³ã³ããã¹ãã«åæã
533	bsr __kernel_exit_kernel
534	bra __kernel_call_exit_kernel
535
536
537	;
538	; å²è¾¼ã¿(CPUä¾å¤)ããã®ã¿ã¹ã¯ãã£ã¹ãããã£å
539	¥å£
540	;
541	; å¼åºãæ¡ä»¶:
542	; ã»å
543	¨å²è¾¼ã¿ããã¯ç¶æ
544	(PSWã¬ã¸ã¹ã¿Iããã = 0)
545	; ã»å²è¾¼ã¿åªå
546	åº¦ãã¹ã¯å
547	¨è§£é¤ã§ãªãç¶æ
548	(IPL != 0)
549	; ã»ã¿ã¹ã¯ã³ã³ããã¹ã(intnest=0)
550	; ã»ä½¿ç¨ã¹ã¿ãã¯ã¯ã¿ã¹ã¯ã¹ã¿ãã¯
551	; ã»reqflg = true
552	;
553	; ããã§ã¯, ãã£ã¹ãããã£ã¢ã¼ãã«å¤æ´ã, reqflgãOFFã«ãã¦ãã,
554	; é
555	å»¶ãã£ã¹ãããã®æç¡ãå¤æãã.
556	;
557
558	;
559	; ret_intå
560	é ã§ã¹ã¿ãã¯ã«ç©ã¾ãã¦ããPSWã¬ã¸ã¹ã¿ã¸ã®ãªãã»ãã
561	; ACC + FPSW + R14--R15 + R1--R5 + PC
562	;
563	.equ RET_INT_GET_PSW_OFFSET, (8+4+28+4)
564
565	ret_int:
566	.if TIPM_LOCK == -15
567	mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®IPLå¤åå¾
568	and #PSW_IPL_MASK, r5
569	mvtc r5, psw ; å
570	¨å²è¾¼ã¿ããã¯(CPUããã¯)ç¶æ
571
572	; å²è¾¼ã¿/CPUä¾å¤çºçåã®å²è¾¼ã¿åªå
573	åº¦
574	.else
575	mov.l #__kernel_lock_flag, r5 ; CPUããã¯ç¶æ
576	ã¸
577	mov.l #1, [r5]
578	mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®IPLå¤åå¾
579	and #PSW_IPL_MASK, r5
580	mov.l #__kernel_saved_ipl, r4
581	mov.l r5, [r4]
582	mvtc #(IPL_LOCK \| PSW_I_MASK), psw ; å
583	¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ
584
585	; å²è¾¼ã¿åªå
586	åº¦ãã¹ã¯å
587	¨è§£é¤ã§ãªãç¶æ
588
589	.endif
590	mov.l #__kernel_p_runtsk, r15
591	mov.l [r15], r14
592	mov.l #__kernel_p_schedtsk, r5
593	mov.l [r5], r5
594	cmp r5, r14 ; p_schedtsk ã¨ p_runtsk ãåããªã
595	beq ret_int_r_call_tex ; ret_int_r_call_tex ã¸
596	pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å
597	st_TCB_sp r0, r14, r5 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãTCBã«ä¿å
598	st_TCB_pc #ret_int_r, r14, r5 ; å®è¡åéçªå°ãTCBã«ä¿å
599	bra dispatcher
600
601	;
602	; å²è¾¼ã¿(CPUä¾å¤)ã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£
603	;
604	; å¼ã³åºãæ¡ä»¶:
605	; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç
606	§)
607	;
608	; ããã§ã¯, ã¿ã¹ã¯ä¾å¤ãã³ãã©å¼åºãã¨, å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ãã¸ã®
609	; å¤æ´ã¨, ã³ã³ããã¹ãã®å¾©å¸°ãè¡ã, å²è¾¼ã¿(CUPä¾å¤)çºçå
610	ã¸æ»ã.
611	;
612	__kernel_break_wait: ;ã¿ã¹ã¯ã¢ãã¿ç¨ã©ãã«
613	ret_int_r:
614	popm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿å¾©å¸°
615	ret_int_r_call_tex:
616	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 & 6.7.1 */
617	push.l r14
618	bsr __kernel_ovrtimer_start
619	pop r14
620	#endif /* TOPPERS_SUPPORT_OVRHDR */
621	ret_int_r_rte:
622	#if TIPM_LOCK != -15
623	clrpsw i ; å
624	¨å²è¾¼ã¿ç¦æ¢
625	mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ
626	ã¸
627	mov.l #0, [r5]
628	#endif
629	popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°
630	mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸°
631	mvtachi r4
632	popc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°
633	popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°
634	popm r1-r5
635	rte ; å²è¾¼ã¿åã®å¦çã«æ»ã
636
637
638	;
639	; å²è¾¼ã¿ã®åºå
640	¥å£å¦ç(ã¢ã»ã³ããªè¨èªè¨è¿°é¨å)
641	;
642	; å¼åºãæ¡ä»¶:
643	; ã»å²è¾¼ã¿çºçæã®H/Wå¦çã«ãã, PSWã¬ã¸ã¹ã¿ã®Iããã=0, IPLã¯åä»ã
644	; ãå²è¾¼ã¿ã®IPL.
645	; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã°
646	; ã¿ã¹ã¯ã¹ã¿ãã¯
647	; ã»å²è¾¼ã¿çºçæã®H/Wå¦çã«ãã,ã¹ã¿ãã¯ã«å²è¾¼ã¿ããã®å¾©å¸°PCã¨PSWã
648	; ä¿åããã¦ãã.
649	; ã»ãã¯ã¿ãã¼ãã«ã«ç»é²ãããåå¥ã®å
650	¥ãå£å¦çã«ãã, ã¹ã¿ãã¯ã«
651	; ã¹ã¯ã©ããã¬ã¸ã¹ã¿(R1-R5)ãä¿åããã¦ãã.
652	;
653	; å¼æ°:
654	; ã»r1:å²è¾¼ã¿è¦å çªå·
655	; ã»r2:å²è¾¼ã¿ãã³ãã©ã®ã¢ãã¬ã¹
656	;
657	; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ããããä»¥ä¸ã«ç¤ºã.
658	; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã
659	; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã.
660	;
661	; -------------------------
662	; \| ACC-HI(4byte) \|
663	; -------------------------(SP + 0)
664	; \| ACC-LO(4byte) \|
665	; -------------------------(SP + 4)
666	; \| FPSW(4byte) \|
667	; -------------------------(SP + 8)
668	; \| R14(4byte) \|
669	; -------------------------(SP + 12)
670	; \| R15(4byte) \|
671	; -------------------------(SP + 16)
672	; \| R1(4byte) \|
673	; -------------------------(SP + 20)
674	; \| R2(4byte) \|
675	; -------------------------(SP + 24)
676	; \| R3(4byte) \|
677	; -------------------------(SP + 28)
678	; \| R4(4byte) \|
679	; -------------------------(SP + 32)
680	; \| R5(4byte) \|
681	; -------------------------(SP + 36)
682	; \| PC(4byte) \|
683	; -------------------------(SP + 40)
684	; \| PSW(4byte) \|
685	; -------------------------(SP + 44)
686	;
687	; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã.
688	;
689	; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ãã¤ reqflg ã
690	; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²(é
691	å»¶ãã£ã¹ããã)ããï¼
692	;
693	; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã.
694	; intnest != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã.
695	;
696	; reqflg ã¯CPUããã¯ç¶æ
697	ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼
698	; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å
699	ã§
700	; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã.
701	;
702	_kernel_interrupt:
703	pushm r14-r15 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãéé¿
704	pushc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿éé¿
705	mvfacmi r5
706	shll #16, r5 ; ACCæä¸ä½16bitã¯0ã¨ãã
707	mvfachi r4
708	pushm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿éé¿
709	mov.l #__kernel_intnest, r5
710	mov.w [r5], r4
711	add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã
712	mov.w r4, [r5]
713	cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
714	bnz interrupt_from_int ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿
715	; åæ®µã®å²è¾¼ã¿
716	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 */
717	pushm r1-r5
718	bsr __kernel_ovrtimer_stop ; r1ã«å²è¾¼ã¿çªå·
719	popm r1-r5
720	#endif /* TOPPERS_SUPPORT_OVRHDR */
721	mov.l r0, r3 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãåãåºã
722	mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã
723	mov.l [r5], r0
724	push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ
725	interrupt_from_int: ; å¤éå²è¾¼ã¿
726	setpsw i ; å²è¾¼ã¿è¨±å¯(CPUããã¯è§£é¤ç¶æ
727	)
728
729	.if LOG_INH_LEAVE == 1
730	push.l r1 ; ãã°ãã¬ã¼ã¹ã®å¼æ°ãä¿æ
731	.endif
732
733	.if LOG_INH_ENTER == 1
734	push.l r2
735	bsr __kernel_log_inh_enter ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
736	; å¼æ°ã®å²è¾¼ã¿è¦å çªå·ã¯æ¢ã«r1ã«å
737	¥ã£ã¦ãã
738	pop r2
739	.endif
740
741	jsr r2 ; Cã«ã¼ãã³å¼ã³åºã
742
743	.if LOG_INH_LEAVE == 1
744	pop r1 ; å¼æ°ã«å²è¾¼ã¿è¦å çªå·ãè¨å®
745	bsr __kernel_log_inh_leave ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
746	.endif
747
748	clrpsw i ; å²è¾¼ã¿ç¦æ¢(CPUããã¯ç¶æ
749	)
750	mov.l #__kernel_intnest, r5
751	mov.w [r5], r4
752	sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã
753	mov.w r4, [r5]
754	cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
755	bnz interrupt_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³
756	; åæ®µã®å²è¾¼ã¿
757	pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã
758	mov.l #__kernel_p_schedtsk, r4
759	mov.l [r4], r4 ; p_schedtsk -> r4
760	mov.l #__kernel_p_runtsk, r5
761	mov.l [r5], r5 ; p_runtsk -> r5
762	cmp r4, r5 ; p_schedtsk ã¨ p_runtsk ãç°ãªããã£ã¹ãããè¦æ±æããªã
763	bne ret_int ; ret_int ã¸ã¸ã£ã³ã
764	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 */
765	mov.l #__kernel_p_runtsk, r5
766	mov.l [r5], r4
767	cmp #0, r4
768	beq interrupt_return
769	bsr __kernel_ovrtimer_start
770	#endif /* TOPPERS_SUPPORT_OVRHDR */
771	interrupt_return:
772	popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°
773	mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸°
774	mvtachi r4
775	popc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°
776	popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°
777	popm r1-r5
778	rte ; å²è¾¼ã¿åã®å¦çã«æ»ã
779
780
781	;
782	; CPUä¾å¤ã®åºå
783	¥å£å¦ç(ã¢ã»ã³ããªè¨èªè¨è¿°é¨å)
784	;
785	; å¼åºãæ¡ä»¶:
786	; ã»CPUä¾å¤çºçæã®H/Wå¦çã«ãã, PSWã¬ã¸ã¹ã¿ã®Iããã=0, IPL=0.
787	; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã°
788	; ã¿ã¹ã¯ã¹ã¿ãã¯
789	; ã»CPUä¾å¤çºçæã®H/Wå¦çã«ãã,ã¹ã¿ãã¯ã«CPUä¾å¤ããã®å¾©å¸°PCã¨
790	; PSWãä¿åããã¦ãã.
791	; ã»ãã¯ã¿ãã¼ãã«ã«ç»é²ãããåå¥ã®å
792	¥ãå£å¦çã«ãã, ã¹ã¿ãã¯ã«
793	; ã¹ã¯ã©ããã¬ã¸ã¹ã¿(R1-R5)ãä¿åããã¦ãã.
794	;
795	; å¼æ°:
796	; ã»r1:CPUä¾å¤è¦å çªå·
797	; ã»r2:CPUä¾å¤ãã³ãã©ã®ã¢ãã¬ã¹
798	;
799	; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ããããä»¥ä¸ã«ç¤ºã.
800	; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã
801	; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã.
802	; ãªã, CPUä¾å¤è¦å çªå·ã¨R6-R13ã¯CPUä¾å¤ãã³ãã©å
803	ã§æ
804	å ±ãåå¾
805	; ããç®çã§éé¿ãã¦ãã, åºå£å¦çã§ã¯ä¿åå
806	å®¹ãç ´æ£ããã°ãã.
807	;
808	; -------------------------
809	; \| CPUä¾å¤è¦å çªå· \| <----- p_excinf
810	; ------------------------- (intptr_t)(p_excinf + 0)
811	; \| R6(4byte) \|
812	; ------------------------- (intptr_t)(p_excinf + 4)
813	; \| R7(4byte) \|
814	; ------------------------- (intptr_t)(p_excinf + 8)
815	; \| R8(4byte) \|
816	; ------------------------- (intptr_t)(p_excinf + 12)
817	; \| R9(4byte) \|
818	; ------------------------- (intptr_t)(p_excinf + 16)
819	; \| R10(4byte) \|
820	; ------------------------- (intptr_t)(p_excinf + 20)
821	; \| R11(4byte) \|
822	; ------------------------- (intptr_t)(p_excinf + 24)
823	; \| R12(4byte) \|
824	; ------------------------- (intptr_t)(p_excinf + 28)
825	; \| R13(4byte) \|
826	; ------------------------- (intptr_t)(p_excinf + 32)
827	; \| ACC-HI(4byte) \|
828	; ------------------------- (intptr_t)(p_excinf + 36)
829	; \| ACC-LO(4byte) \|
830	; ------------------------- (intptr_t)(p_excinf + 40)
831	; \| FPSW(4byte) \|
832	; ------------------------- (intptr_t)(p_excinf + 44)
833	; \| R14(4byte) \|
834	; ------------------------- (intptr_t)(p_excinf + 48)
835	; \| R15(4byte) \|
836	; ------------------------- (intptr_t)(p_excinf + 52)
837	; \| R1(4byte) \|
838	; ------------------------- (intptr_t)(p_excinf + 56)
839	; \| R2(4byte) \|
840	; ------------------------- (intptr_t)(p_excinf + 60)
841	; \| R3(4byte) \|
842	; ------------------------- (intptr_t)(p_excinf + 64)
843	; \| R4(4byte) \|
844	; ------------------------- (intptr_t)(p_excinf + 68)
845	; \| R5(4byte) \|
846	; ------------------------- (intptr_t)(p_excinf + 72)
847	; \| PC(4byte) \|
848	; ------------------------- (intptr_t)(p_excinf + 76)
849	; \| PSW(4byte) \|
850	; ------------------------- (intptr_t)(p_excinf + 80)
851	;
852	; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã.
853	; CPUä¾å¤ãã³ãã©ã«æ¸¡ãVPåã®å¤æ° p_excinf ã¨ãã¦ISPã®å¤æ¸¡ãï¼
854	;
855	; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ãã¤ reqflg ã
856	; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²(é
857	å»¶ãã£ã¹ããã)ããï¼
858	;
859	; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã.
860	; intnest != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã.
861	;
862	; reqflg ã¯CPUããã¯ç¶æ
863	ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼
864	; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å
865	ã§
866	; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã.
867	;
868	;
869	; CPUä¾å¤å
870	¥å£å¦ç
871	;
872	; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã.
873	;
874
875	;
876	; CPUä¾å¤ãã³ãã©å¼åºãå¾ã«ä¸è¦ã¨ãªãã¹ã¿ãã¯æ
877	å ±ã®ãµã¤ãº
878	; EXCNO + R6--R13
879	;
880	.equ EXCINF_REG_SIZE, (4+32)
881
882	_kernel_exception:
883	pushm r14-r15 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãéé¿
884	pushc fpsw
885	mvfacmi r5
886	shll #16, r5 ; ACCæä¸ä½16bitã¯0ã¨ãã
887	mvfachi r4
888	pushm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿éé¿
889	pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å
890	push.l r1 ; CPUä¾å¤è¦å çªå·ãä¿æ
891	mov.l r0, r3 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãåãåºã
892	mov.l EXC_GET_PSW_OFFSET[r3], r5
893	and #PSW_I_MASK, r5
894	bz exception_nonkernel ; å
895	¨å²è¾¼ã¿ç¦æ¢(CPUããã¯)ç¶æ
896	ãªãç®¡çå¤
897	#if TIPM_LOCK != -15
898	mov.l EXC_GET_PSW_OFFSET[r3], r5
899	and #PSW_IPL_MASK, r5
900	cmp #IPL_LOCK, r5
901	bgt exception_nonkernel ; IPLãCPUããã¯ã¬ãã«ä»¥ä¸ãªãç®¡çå¤
902	#endif
903	mov.l #__kernel_intnest, r5
904	mov.w [r5], r4
905	add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã
906	mov.w r4, [r5]
907	cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
908	bnz exception_from_int ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿
909	; åæ®µã®å²è¾¼ã¿
910	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.7.1 */
911	pushm r1-r5
912	mov.l #255, r1 ; r1ã«ããã¼å²è¾¼ã¿çªå·
913	bsr __kernel_ovrtimer_stop
914	popm r1-r5
915	#endif /* TOPPERS_SUPPORT_OVRHDR */
916	mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã
917	mov.l [r5], r0
918	push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ
919	exception_from_int: ; å¤éå²è¾¼ã¿
920	mov.l EXC_GET_PSW_OFFSET[r3], r5
921	mvtc r5, psw ; CPUä¾å¤çºçåã®ç¶æ
922	ã«æ»ã
923	#if LOG_EXC_LEAVE == 1
924	push.l r1 ; ãã°ãã¬ã¼ã¹ã®å¼æ°ãä¿æ
925	#endif
926
927	#if LOG_EXC_ENTER == 1
928	pushm r2-r3
929	bsr __kernel_log_exc_enter ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
930	; å¼æ°ã®å²è¾¼ã¿è¦å çªå·ã¯æ¢ã«r1ã«å
931	¥ã£ã¦ãã
932	popm r2-r3
933	#endif
934
935	mov.l r3, r1 ; å¼æ°ã®p_excinfãè¨å®
936	jsr r2 ; Cã«ã¼ãã³å¼ã³åºã
937
938	.if LOG_EXC_LEAVE == 1
939	pop r1 ; å¼æ°ã«å²è¾¼ã¿è¦å çªå·ãè¨å®
940	bsr __kernel_log_exc_leave ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
941	.endif
942
943	clrpsw i ; ããããã¯å¿
944	ãå²è¾¼ã¿ç¦æ¢
945	mov.l #__kernel_intnest, r5
946	mov.w [r5], r4
947	sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã
948	mov.w r4, [r5]
949	cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
950	bnz exception_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³
951	; åæ®µã®å²è¾¼ã¿
952	pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã
953	mov.l #__kernel_p_schedtsk, r4
954	mov.l [r4], r4 ; p_schedtsk -> r4
955	mov.l #__kernel_p_runtsk, r5
956	mov.l [r5], r5 ; p_runtsk -> r5
957	cmp r4, r5 ; p_schedtsk ã¨ p_runtsk ãåãã§ãã£ã¹ãããè¦æ±ç¡ãã
958	#ifndef TOPPERS_SUPPORT_OVRHDR /* 6.7.1 */
959	beq exception_return ; ãªããã°ãªã¿ã¼ã³
960	add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ
961	å ±ã®ç ´æ£
962	bra ret_int ; ããã° ret_int ã¸ã¸ã£ã³ã
963	#else /* TOPPERS_SUPPORT_OVRHDR */
964	beq exception_return_ovr ; ãªããã°ãªã¿ã¼ã³
965	add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ
966	å ±ã®ç ´æ£
967	bra ret_int ; ããã° ret_int ã¸ã¸ã£ã³ã
968	exception_return_ovr:
969	mov.l #__kernel_p_runtsk, r5
970	mov.l [r5], r4
971	cmp #0, r4
972	beq exception_return
973	bsr __kernel_ovrtimer_start
974	bra exception_return
975	#endif /* TOPPERS_SUPPORT_OVRHDR */
976
977	exception_nonkernel:
978	mov.l #__kernel_intnest, r5
979	mov.w [r5], r4
980	add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã
981	mov.w r4, [r5]
982	cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
983	bnz exception_from_nonkernelint ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿
984	; åæ®µã®å²è¾¼ã¿
985	mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã
986	mov.l [r5], r0
987	push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ
988	exception_from_nonkernelint: ; å¤éå²è¾¼ã¿
989	mov.l EXC_GET_PSW_OFFSET[r3], r5
990	mvtc r5, psw ; CPUä¾å¤çºçåã®ç¶æ
991	ã«æ»ã
992
993	mov.l r3, r1 ; å¼æ°ã®p_excinfãè¨å®
994	jsr r2 ; Cã«ã¼ãã³å¼ã³åºã
995
996	clrpsw i ; ããããã¯å¿
997	ãå²è¾¼ã¿ç¦æ¢
998	mov.l #__kernel_intnest, r5
999	mov.w [r5], r4
1000	sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã
1001	mov.w r4, [r5]
1002	cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
1003	bnz exception_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³
1004	; åæ®µã®å²è¾¼ã¿
1005	pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã
1006
1007	exception_return:
1008	add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ
1009	å ±ã®ç ´æ£
1010	popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°
1011	mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸°
1012	mvtachi r4
1013	popc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°
1014	popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°
1015	popm r1-r5
1016	rte ; å²è¾¼ã¿åã®å¦çã«æ»ã
1017
1018
1019	;
1020	; å¾®å°æéå¾
1021	ã¡
1022	;
1023	_sil_dly_nse:
1024	mov.l #SIL_DLY_TIM1, r5
1025	sub r5, r1
1026	ble sil_dly_nse_ret
1027	sil_dly_nse_loop:
1028	mov.l #SIL_DLY_TIM2, r5
1029	sub r5, r1
1030	bgt sil_dly_nse_loop
1031	sil_dly_nse_ret:
1032	rts
1033
1034	.end
1035

Note: See TracBrowser for help on using the repository browser.

Download in other formats:

Original Format