Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

prc_support.S@ 313

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

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

Download in other formats:

Original Format