Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

prc_support.S@ 388

Last change on this file since 388 was 388, checked in by coas-nagasima, 5 years ago
Azure IoT Hub Device C SDK を使ったサンプルの追加
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 388 2019-05-22 11:25:18Z 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	wait
487	clrpsw i ; å
488	¨å²è¾¼ã¿ç¦æ¢
489
490	mov.l #__kernel_p_schedtsk, r4
491	mov.l [r4], r4 ; p_schedtsk -> r4
492	mov.l #__kernel_p_runtsk, r5
493	mov.l [r5], r5 ; p_runtsk -> r5
494	cmp r4, r5 ; p_schedtsk ã¨ p_runtsk ãåãã§ãã£ã¹ãããè¦æ±ç¡ããªã
495	beq dispatcher_idle_loop ; ã¢ã¤ãã«ã«ã¼ããç¹°ãè¿ã
496	mov.l #0, [r5] ; reqflgãtrueãªãfalseã«ãã
497	mov.l #__kernel_intnest, r5
498	mov.w #0, [r5] ; ã¿ã¹ã¯ã³ã³ããã¹ãã«åæã
499	#if TIPM_LOCK != -15
500	mov.l #__kernel_lock_flag, r5 ; CPUããã¯ç¶æ
501	ã¸
502	mov.l #1, [r5]
503	mov.l #__kernel_saved_ipl, r5
504	mov.l #0, [r5]
505	mvtc #(IPL_LOCK \| PSW_I_MASK), psw ; å
506	¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ
507
508	; å²è¾¼ã¿åªå
509	åº¦ãã¹ã¯å
510	¨è§£é¤ã§ãªãç¶æ
511
512	#endif
513	bra dispatcher ; dispatcher ã¸æ»ã
514
515
516	;
517	; ã«ã¼ãã«ã®çµäºå¦çã®å¼åºã
518	;
519	; ã¢ã¼ãã¨ã¹ã¿ãã¯ãéã¿ã¹ã¯ã³ã³ããã¹ãç¨ã«åãæ¿ãï¼
520	;
521	.global __kernel_call_exit_kernel
522	__kernel_call_exit_kernel:
523	#if TIPM_LOCK != -15
524	clrpsw i ; å
525	¨å²è¾¼ã¿ç¦æ¢
526	mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ
527	ã¸
528	mov.l #0, [r5]
529	#endif
530	mov.l #__kernel_istkpt, r5
531	mov.l [r5], r0 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ã
532	mov.l #__kernel_intnest, r5
533	mov.w #1, [r5] ; éã¿ã¹ã¯ã³ã³ããã¹ãã«åæã
534	bsr __kernel_exit_kernel
535	bra __kernel_call_exit_kernel
536
537
538	;
539	; å²è¾¼ã¿(CPUä¾å¤)ããã®ã¿ã¹ã¯ãã£ã¹ãããã£å
540	¥å£
541	;
542	; å¼åºãæ¡ä»¶:
543	; ã»å
544	¨å²è¾¼ã¿ããã¯ç¶æ
545	(PSWã¬ã¸ã¹ã¿Iããã = 0)
546	; ã»å²è¾¼ã¿åªå
547	åº¦ãã¹ã¯å
548	¨è§£é¤ã§ãªãç¶æ
549	(IPL != 0)
550	; ã»ã¿ã¹ã¯ã³ã³ããã¹ã(intnest=0)
551	; ã»ä½¿ç¨ã¹ã¿ãã¯ã¯ã¿ã¹ã¯ã¹ã¿ãã¯
552	; ã»reqflg = true
553	;
554	; ããã§ã¯, ãã£ã¹ãããã£ã¢ã¼ãã«å¤æ´ã, reqflgãOFFã«ãã¦ãã,
555	; é
556	å»¶ãã£ã¹ãããã®æç¡ãå¤æãã.
557	;
558
559	;
560	; ret_intå
561	é ã§ã¹ã¿ãã¯ã«ç©ã¾ãã¦ããPSWã¬ã¸ã¹ã¿ã¸ã®ãªãã»ãã
562	; ACC + FPSW + R14--R15 + R1--R5 + PC
563	;
564	.equ RET_INT_GET_PSW_OFFSET, (8+4+28+4)
565
566	ret_int:
567	.if TIPM_LOCK == -15
568	mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®IPLå¤åå¾
569	and #PSW_IPL_MASK, r5
570	mvtc r5, psw ; å
571	¨å²è¾¼ã¿ããã¯(CPUããã¯)ç¶æ
572
573	; å²è¾¼ã¿/CPUä¾å¤çºçåã®å²è¾¼ã¿åªå
574	åº¦
575	.else
576	mov.l #__kernel_lock_flag, r5 ; CPUããã¯ç¶æ
577	ã¸
578	mov.l #1, [r5]
579	mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®IPLå¤åå¾
580	and #PSW_IPL_MASK, r5
581	mov.l #__kernel_saved_ipl, r4
582	mov.l r5, [r4]
583	mvtc #(IPL_LOCK \| PSW_I_MASK), psw ; å
584	¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ
585
586	; å²è¾¼ã¿åªå
587	åº¦ãã¹ã¯å
588	¨è§£é¤ã§ãªãç¶æ
589
590	.endif
591	mov.l #__kernel_p_runtsk, r15
592	mov.l [r15], r14
593	mov.l #__kernel_p_schedtsk, r5
594	mov.l [r5], r5
595	cmp r5, r14 ; p_schedtsk ã¨ p_runtsk ãåããªã
596	beq ret_int_r_call_tex ; ret_int_r_call_tex ã¸
597	pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å
598	st_TCB_sp r0, r14, r5 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãTCBã«ä¿å
599	st_TCB_pc #ret_int_r, r14, r5 ; å®è¡åéçªå°ãTCBã«ä¿å
600	bra dispatcher
601
602	;
603	; å²è¾¼ã¿(CPUä¾å¤)ã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£
604	;
605	; å¼ã³åºãæ¡ä»¶:
606	; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç
607	§)
608	;
609	; ããã§ã¯, ã¿ã¹ã¯ä¾å¤ãã³ãã©å¼åºãã¨, å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ãã¸ã®
610	; å¤æ´ã¨, ã³ã³ããã¹ãã®å¾©å¸°ãè¡ã, å²è¾¼ã¿(CUPä¾å¤)çºçå
611	ã¸æ»ã.
612	;
613	__kernel_break_wait: ;ã¿ã¹ã¯ã¢ãã¿ç¨ã©ãã«
614	ret_int_r:
615	popm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿å¾©å¸°
616	ret_int_r_call_tex:
617	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 & 6.7.1 */
618	push.l r14
619	bsr __kernel_ovrtimer_start
620	pop r14
621	#endif /* TOPPERS_SUPPORT_OVRHDR */
622	ret_int_r_rte:
623	#if TIPM_LOCK != -15
624	clrpsw i ; å
625	¨å²è¾¼ã¿ç¦æ¢
626	mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ
627	ã¸
628	mov.l #0, [r5]
629	#endif
630	popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°
631	mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸°
632	mvtachi r4
633	popc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°
634	popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°
635	popm r1-r5
636	rte ; å²è¾¼ã¿åã®å¦çã«æ»ã
637
638
639	;
640	; å²è¾¼ã¿ã®åºå
641	¥å£å¦ç(ã¢ã»ã³ããªè¨èªè¨è¿°é¨å)
642	;
643	; å¼åºãæ¡ä»¶:
644	; ã»å²è¾¼ã¿çºçæã®H/Wå¦çã«ãã, PSWã¬ã¸ã¹ã¿ã®Iããã=0, IPLã¯åä»ã
645	; ãå²è¾¼ã¿ã®IPL.
646	; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã°
647	; ã¿ã¹ã¯ã¹ã¿ãã¯
648	; ã»å²è¾¼ã¿çºçæã®H/Wå¦çã«ãã,ã¹ã¿ãã¯ã«å²è¾¼ã¿ããã®å¾©å¸°PCã¨PSWã
649	; ä¿åããã¦ãã.
650	; ã»ãã¯ã¿ãã¼ãã«ã«ç»é²ãããåå¥ã®å
651	¥ãå£å¦çã«ãã, ã¹ã¿ãã¯ã«
652	; ã¹ã¯ã©ããã¬ã¸ã¹ã¿(R1-R5)ãä¿åããã¦ãã.
653	;
654	; å¼æ°:
655	; ã»r1:å²è¾¼ã¿è¦å çªå·
656	; ã»r2:å²è¾¼ã¿ãã³ãã©ã®ã¢ãã¬ã¹
657	;
658	; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ããããä»¥ä¸ã«ç¤ºã.
659	; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã
660	; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã.
661	;
662	; -------------------------
663	; \| ACC-HI(4byte) \|
664	; -------------------------(SP + 0)
665	; \| ACC-LO(4byte) \|
666	; -------------------------(SP + 4)
667	; \| FPSW(4byte) \|
668	; -------------------------(SP + 8)
669	; \| R14(4byte) \|
670	; -------------------------(SP + 12)
671	; \| R15(4byte) \|
672	; -------------------------(SP + 16)
673	; \| R1(4byte) \|
674	; -------------------------(SP + 20)
675	; \| R2(4byte) \|
676	; -------------------------(SP + 24)
677	; \| R3(4byte) \|
678	; -------------------------(SP + 28)
679	; \| R4(4byte) \|
680	; -------------------------(SP + 32)
681	; \| R5(4byte) \|
682	; -------------------------(SP + 36)
683	; \| PC(4byte) \|
684	; -------------------------(SP + 40)
685	; \| PSW(4byte) \|
686	; -------------------------(SP + 44)
687	;
688	; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã.
689	;
690	; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ãã¤ reqflg ã
691	; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²(é
692	å»¶ãã£ã¹ããã)ããï¼
693	;
694	; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã.
695	; intnest != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã.
696	;
697	; reqflg ã¯CPUããã¯ç¶æ
698	ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼
699	; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å
700	ã§
701	; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã.
702	;
703	_kernel_interrupt:
704	pushm r14-r15 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãéé¿
705	pushc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿éé¿
706	mvfacmi r5
707	shll #16, r5 ; ACCæä¸ä½16bitã¯0ã¨ãã
708	mvfachi r4
709	pushm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿éé¿
710	mov.l #__kernel_intnest, r5
711	mov.w [r5], r4
712	add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã
713	mov.w r4, [r5]
714	cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
715	bnz interrupt_from_int ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿
716	; åæ®µã®å²è¾¼ã¿
717	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 */
718	pushm r1-r5
719	bsr __kernel_ovrtimer_stop ; r1ã«å²è¾¼ã¿çªå·
720	popm r1-r5
721	#endif /* TOPPERS_SUPPORT_OVRHDR */
722	mov.l r0, r3 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãåãåºã
723	mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã
724	mov.l [r5], r0
725	push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ
726	interrupt_from_int: ; å¤éå²è¾¼ã¿
727	setpsw i ; å²è¾¼ã¿è¨±å¯(CPUããã¯è§£é¤ç¶æ
728	)
729
730	.if LOG_INH_LEAVE == 1
731	push.l r1 ; ãã°ãã¬ã¼ã¹ã®å¼æ°ãä¿æ
732	.endif
733
734	.if LOG_INH_ENTER == 1
735	push.l r2
736	bsr __kernel_log_inh_enter ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
737	; å¼æ°ã®å²è¾¼ã¿è¦å çªå·ã¯æ¢ã«r1ã«å
738	¥ã£ã¦ãã
739	pop r2
740	.endif
741
742	jsr r2 ; Cã«ã¼ãã³å¼ã³åºã
743
744	.if LOG_INH_LEAVE == 1
745	pop r1 ; å¼æ°ã«å²è¾¼ã¿è¦å çªå·ãè¨å®
746	bsr __kernel_log_inh_leave ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
747	.endif
748
749	clrpsw i ; å²è¾¼ã¿ç¦æ¢(CPUããã¯ç¶æ
750	)
751	mov.l #__kernel_intnest, r5
752	mov.w [r5], r4
753	sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã
754	mov.w r4, [r5]
755	cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
756	bnz interrupt_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³
757	; åæ®µã®å²è¾¼ã¿
758	pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã
759	mov.l #__kernel_p_schedtsk, r4
760	mov.l [r4], r4 ; p_schedtsk -> r4
761	mov.l #__kernel_p_runtsk, r5
762	mov.l [r5], r5 ; p_runtsk -> r5
763	cmp r4, r5 ; p_schedtsk ã¨ p_runtsk ãç°ãªããã£ã¹ãããè¦æ±æããªã
764	bne ret_int ; ret_int ã¸ã¸ã£ã³ã
765	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 */
766	mov.l #__kernel_p_runtsk, r5
767	mov.l [r5], r4
768	cmp #0, r4
769	beq interrupt_return
770	bsr __kernel_ovrtimer_start
771	#endif /* TOPPERS_SUPPORT_OVRHDR */
772	interrupt_return:
773	popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°
774	mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸°
775	mvtachi r4
776	popc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°
777	popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°
778	popm r1-r5
779	rte ; å²è¾¼ã¿åã®å¦çã«æ»ã
780
781
782	;
783	; CPUä¾å¤ã®åºå
784	¥å£å¦ç(ã¢ã»ã³ããªè¨èªè¨è¿°é¨å)
785	;
786	; å¼åºãæ¡ä»¶:
787	; ã»CPUä¾å¤çºçæã®H/Wå¦çã«ãã, PSWã¬ã¸ã¹ã¿ã®Iããã=0, IPL=0.
788	; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã°
789	; ã¿ã¹ã¯ã¹ã¿ãã¯
790	; ã»CPUä¾å¤çºçæã®H/Wå¦çã«ãã,ã¹ã¿ãã¯ã«CPUä¾å¤ããã®å¾©å¸°PCã¨
791	; PSWãä¿åããã¦ãã.
792	; ã»ãã¯ã¿ãã¼ãã«ã«ç»é²ãããåå¥ã®å
793	¥ãå£å¦çã«ãã, ã¹ã¿ãã¯ã«
794	; ã¹ã¯ã©ããã¬ã¸ã¹ã¿(R1-R5)ãä¿åããã¦ãã.
795	;
796	; å¼æ°:
797	; ã»r1:CPUä¾å¤è¦å çªå·
798	; ã»r2:CPUä¾å¤ãã³ãã©ã®ã¢ãã¬ã¹
799	;
800	; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ããããä»¥ä¸ã«ç¤ºã.
801	; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã
802	; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã.
803	; ãªã, CPUä¾å¤è¦å çªå·ã¨R6-R13ã¯CPUä¾å¤ãã³ãã©å
804	ã§æ
805	å ±ãåå¾
806	; ããç®çã§éé¿ãã¦ãã, åºå£å¦çã§ã¯ä¿åå
807	å®¹ãç ´æ£ããã°ãã.
808	;
809	; -------------------------
810	; \| CPUä¾å¤è¦å çªå· \| <----- p_excinf
811	; ------------------------- (intptr_t)(p_excinf + 0)
812	; \| R6(4byte) \|
813	; ------------------------- (intptr_t)(p_excinf + 4)
814	; \| R7(4byte) \|
815	; ------------------------- (intptr_t)(p_excinf + 8)
816	; \| R8(4byte) \|
817	; ------------------------- (intptr_t)(p_excinf + 12)
818	; \| R9(4byte) \|
819	; ------------------------- (intptr_t)(p_excinf + 16)
820	; \| R10(4byte) \|
821	; ------------------------- (intptr_t)(p_excinf + 20)
822	; \| R11(4byte) \|
823	; ------------------------- (intptr_t)(p_excinf + 24)
824	; \| R12(4byte) \|
825	; ------------------------- (intptr_t)(p_excinf + 28)
826	; \| R13(4byte) \|
827	; ------------------------- (intptr_t)(p_excinf + 32)
828	; \| ACC-HI(4byte) \|
829	; ------------------------- (intptr_t)(p_excinf + 36)
830	; \| ACC-LO(4byte) \|
831	; ------------------------- (intptr_t)(p_excinf + 40)
832	; \| FPSW(4byte) \|
833	; ------------------------- (intptr_t)(p_excinf + 44)
834	; \| R14(4byte) \|
835	; ------------------------- (intptr_t)(p_excinf + 48)
836	; \| R15(4byte) \|
837	; ------------------------- (intptr_t)(p_excinf + 52)
838	; \| R1(4byte) \|
839	; ------------------------- (intptr_t)(p_excinf + 56)
840	; \| R2(4byte) \|
841	; ------------------------- (intptr_t)(p_excinf + 60)
842	; \| R3(4byte) \|
843	; ------------------------- (intptr_t)(p_excinf + 64)
844	; \| R4(4byte) \|
845	; ------------------------- (intptr_t)(p_excinf + 68)
846	; \| R5(4byte) \|
847	; ------------------------- (intptr_t)(p_excinf + 72)
848	; \| PC(4byte) \|
849	; ------------------------- (intptr_t)(p_excinf + 76)
850	; \| PSW(4byte) \|
851	; ------------------------- (intptr_t)(p_excinf + 80)
852	;
853	; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã.
854	; CPUä¾å¤ãã³ãã©ã«æ¸¡ãVPåã®å¤æ° p_excinf ã¨ãã¦ISPã®å¤æ¸¡ãï¼
855	;
856	; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ãã¤ reqflg ã
857	; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²(é
858	å»¶ãã£ã¹ããã)ããï¼
859	;
860	; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã.
861	; intnest != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã.
862	;
863	; reqflg ã¯CPUããã¯ç¶æ
864	ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼
865	; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å
866	ã§
867	; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã.
868	;
869	;
870	; CPUä¾å¤å
871	¥å£å¦ç
872	;
873	; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã.
874	;
875
876	;
877	; CPUä¾å¤ãã³ãã©å¼åºãå¾ã«ä¸è¦ã¨ãªãã¹ã¿ãã¯æ
878	å ±ã®ãµã¤ãº
879	; EXCNO + R6--R13
880	;
881	.equ EXCINF_REG_SIZE, (4+32)
882
883	_kernel_exception:
884	pushm r14-r15 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãéé¿
885	pushc fpsw
886	mvfacmi r5
887	shll #16, r5 ; ACCæä¸ä½16bitã¯0ã¨ãã
888	mvfachi r4
889	pushm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿éé¿
890	pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å
891	push.l r1 ; CPUä¾å¤è¦å çªå·ãä¿æ
892	mov.l r0, r3 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãåãåºã
893	mov.l EXC_GET_PSW_OFFSET[r3], r5
894	and #PSW_I_MASK, r5
895	bz exception_nonkernel ; å
896	¨å²è¾¼ã¿ç¦æ¢(CPUããã¯)ç¶æ
897	ãªãç®¡çå¤
898	#if TIPM_LOCK != -15
899	mov.l EXC_GET_PSW_OFFSET[r3], r5
900	and #PSW_IPL_MASK, r5
901	cmp #IPL_LOCK, r5
902	bgt exception_nonkernel ; IPLãCPUããã¯ã¬ãã«ä»¥ä¸ãªãç®¡çå¤
903	#endif
904	mov.l #__kernel_intnest, r5
905	mov.w [r5], r4
906	add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã
907	mov.w r4, [r5]
908	cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
909	bnz exception_from_int ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿
910	; åæ®µã®å²è¾¼ã¿
911	#ifdef TOPPERS_SUPPORT_OVRHDR /* 6.7.1 */
912	pushm r1-r5
913	mov.l #255, r1 ; r1ã«ããã¼å²è¾¼ã¿çªå·
914	bsr __kernel_ovrtimer_stop
915	popm r1-r5
916	#endif /* TOPPERS_SUPPORT_OVRHDR */
917	mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã
918	mov.l [r5], r0
919	push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ
920	exception_from_int: ; å¤éå²è¾¼ã¿
921	mov.l EXC_GET_PSW_OFFSET[r3], r5
922	mvtc r5, psw ; CPUä¾å¤çºçåã®ç¶æ
923	ã«æ»ã
924	#if LOG_EXC_LEAVE == 1
925	push.l r1 ; ãã°ãã¬ã¼ã¹ã®å¼æ°ãä¿æ
926	#endif
927
928	#if LOG_EXC_ENTER == 1
929	pushm r2-r3
930	bsr __kernel_log_exc_enter ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
931	; å¼æ°ã®å²è¾¼ã¿è¦å çªå·ã¯æ¢ã«r1ã«å
932	¥ã£ã¦ãã
933	popm r2-r3
934	#endif
935
936	mov.l r3, r1 ; å¼æ°ã®p_excinfãè¨å®
937	jsr r2 ; Cã«ã¼ãã³å¼ã³åºã
938
939	.if LOG_EXC_LEAVE == 1
940	pop r1 ; å¼æ°ã«å²è¾¼ã¿è¦å çªå·ãè¨å®
941	bsr __kernel_log_exc_leave ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã
942	.endif
943
944	clrpsw i ; ããããã¯å¿
945	ãå²è¾¼ã¿ç¦æ¢
946	mov.l #__kernel_intnest, r5
947	mov.w [r5], r4
948	sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã
949	mov.w r4, [r5]
950	cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
951	bnz exception_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³
952	; åæ®µã®å²è¾¼ã¿
953	pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã
954	mov.l #__kernel_p_schedtsk, r4
955	mov.l [r4], r4 ; p_schedtsk -> r4
956	mov.l #__kernel_p_runtsk, r5
957	mov.l [r5], r5 ; p_runtsk -> r5
958	cmp r4, r5 ; p_schedtsk ã¨ p_runtsk ãåãã§ãã£ã¹ãããè¦æ±ç¡ãã
959	#ifndef TOPPERS_SUPPORT_OVRHDR /* 6.7.1 */
960	beq exception_return ; ãªããã°ãªã¿ã¼ã³
961	add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ
962	å ±ã®ç ´æ£
963	bra ret_int ; ããã° ret_int ã¸ã¸ã£ã³ã
964	#else /* TOPPERS_SUPPORT_OVRHDR */
965	beq exception_return_ovr ; ãªããã°ãªã¿ã¼ã³
966	add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ
967	å ±ã®ç ´æ£
968	bra ret_int ; ããã° ret_int ã¸ã¸ã£ã³ã
969	exception_return_ovr:
970	mov.l #__kernel_p_runtsk, r5
971	mov.l [r5], r4
972	cmp #0, r4
973	beq exception_return
974	bsr __kernel_ovrtimer_start
975	bra exception_return
976	#endif /* TOPPERS_SUPPORT_OVRHDR */
977
978	exception_nonkernel:
979	mov.l #__kernel_intnest, r5
980	mov.w [r5], r4
981	add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã
982	mov.w r4, [r5]
983	cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
984	bnz exception_from_nonkernelint ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿
985	; åæ®µã®å²è¾¼ã¿
986	mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã
987	mov.l [r5], r0
988	push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ
989	exception_from_nonkernelint: ; å¤éå²è¾¼ã¿
990	mov.l EXC_GET_PSW_OFFSET[r3], r5
991	mvtc r5, psw ; CPUä¾å¤çºçåã®ç¶æ
992	ã«æ»ã
993
994	mov.l r3, r1 ; å¼æ°ã®p_excinfãè¨å®
995	jsr r2 ; Cã«ã¼ãã³å¼ã³åºã
996
997	clrpsw i ; ããããã¯å¿
998	ãå²è¾¼ã¿ç¦æ¢
999	mov.l #__kernel_intnest, r5
1000	mov.w [r5], r4
1001	sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã
1002	mov.w r4, [r5]
1003	cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã
1004	bnz exception_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³
1005	; åæ®µã®å²è¾¼ã¿
1006	pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã
1007
1008	exception_return:
1009	add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ
1010	å ±ã®ç ´æ£
1011	popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°
1012	mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸°
1013	mvtachi r4
1014	popc fpsw ; FPUã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°
1015	popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°
1016	popm r1-r5
1017	rte ; å²è¾¼ã¿åã®å¦çã«æ»ã
1018
1019
1020	;
1021	; å¾®å°æéå¾
1022	ã¡
1023	;
1024	_sil_dly_nse:
1025	mov.l #SIL_DLY_TIM1, r5
1026	sub r5, r1
1027	ble sil_dly_nse_ret
1028	sil_dly_nse_loop:
1029	mov.l #SIL_DLY_TIM2, r5
1030	sub r5, r1
1031	bgt sil_dly_nse_loop
1032	sil_dly_nse_ret:
1033	rts
1034
1035	.end
1036

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

Download in other formats:

Original Format