Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

prc_support.asm@ 172

Last change on this file since 172 was 172, checked in by ertl-ishikawa, 8 years ago
ATK2-SC3 1.4.0 RH850依存部非信頼C2ISR対応を追加
File size: 71.4 KB

Line
1	;/*
2	;* TOPPERS ATK2
3	;* Toyohashi Open Platform for Embedded Real-Time Systems
4	;* Automotive Kernel Version 2
5	;*
6	;* Copyright (C) 2012-2016 by Center for Embedded Computing Systems
7	;* Graduate School of Information Science, Nagoya Univ., JAPAN
8	;* Copyright (C) 2012-2013 by FUJI SOFT INCORPORATED, JAPAN
9	;* Copyright (C) 2012-2013 by FUJITSU VLSI LIMITED, JAPAN
10	;* Copyright (C) 2012-2013 by NEC Communication Systems, Ltd., JAPAN
11	;* Copyright (C) 2012-2013 by Panasonic Advanced Technology Development Co., Ltd., JAPAN
12	;* Copyright (C) 2012-2013 by Renesas Electronics Corporation, JAPAN
13	;* Copyright (C) 2012-2013 by Sunny Giken Inc., JAPAN
14	;* Copyright (C) 2012-2013 by TOSHIBA CORPORATION, JAPAN
15	;* Copyright (C) 2012-2013 by Witz Corporation, JAPAN
16	;* Copyright (C) 2013 by Embedded and Real-Time Systems Laboratory
17	;* Graduate School of Information Science, Nagoya Univ., JAPAN
18	;*
19	;* ä¸è¨èä½æ¨©è
20	ã¯ï¼ä»¥ä¸ã®(1)ã(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
21	;* ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ãä½¿ç¨ã»è¤è£½ã»æ¹
22	;* å¤ã»åé
23	å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
24	;* (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
25	;* æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
26	;* ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
27	;* (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
28	;* ç¨ã§ããå½¢ã§åé
29	å¸ããå ´åã«ã¯ï¼åé
30	å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
31	;* è
32	ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
33	;* ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
34	;* (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
35	;* ç¨ã§ããªãå½¢ã§åé
36	å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
37	;* ã¨ï¼
38	;* (a) åé
39	å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
40	ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
41	;* ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
42	;* (b) åé
43	å¸ã®å½¢æ
44	ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
45	;* å ±åãããã¨ï¼
46	;* (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
47	;* å®³ãããï¼ä¸è¨èä½æ¨©è
48	ããã³TOPPERSããã¸ã§ã¯ããå
49	è²¬ãããã¨ï¼
50	;* ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãç
51	;* ç±ã«åºã¥ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
52	ããã³TOPPERSããã¸ã§ã¯ãã
53	;* å
54	è²¬ãããã¨ï¼
55	;*
56	;* æ¬ã½ããã¦ã§ã¢ã¯ï¼AUTOSARï¼AUTomotive Open System ARchitectureï¼ä»
57	;* æ§ã«åºã¥ãã¦ããï¼ä¸è¨ã®è¨±è«¾ã¯ï¼AUTOSARã®ç¥çè²¡ç£æ¨©ãè¨±è«¾ãããã®ã§
58	;* ã¯ãªãï¼AUTOSARã¯ï¼AUTOSARä»æ§ã«åºã¥ããã½ããã¦ã§ã¢ãåç¨ç®çã§å©
59	;* ç¨ããè
60	ã«å¯¾ãã¦ï¼AUTOSARãã¼ããã¼ã«ãªããã¨ãæ±ãã¦ããï¼
61	;*
62	;* æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
63	ã
64	;* ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç
65	;* ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§
66	;* ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæå®³ã«é¢ãã¦ãï¼ã
67	;* ã®è²¬ä»»ãè² ããªãï¼
68	;*
69	;* $Id: prc_support.S 189 2015-06-26 01:54:57Z t_ishikawa $
70	;*/
71
72	;/*
73	;* ã¿ã¼ã²ããä¾åæ
74	å ±ã®å®ç¾©
75	;*/
76	$include (v850asm.inc)
77	$include (offset.h)
78	$include (Os_Cfg_asm.inc)
79
80	$ifdef USE_ASMCONFIG_INC
81	$include (asm_config.inc)
82	$endif ;/* USE_ASMCONFIG_INC */
83
84	$ifdef __v850e2v3__
85
86	;/*
87	;* V850E2ç¨ã®å²è¾¼ã¿ã³ã³ããã¼ã©æä½ã«ã¼ãã³
88	;*/
89	GET_ISPR .macro reg
90	mov ISPR_H, reg
91	ld.h 0[reg],reg
92	.endm
93
94	CLEAR_ISPR .macro reg1, reg2
95	mov ISPC_H,reg1
96	mov 0xffff,reg2
97	st.h reg2,0[reg1]
98	mov ISPR_H, reg1
99	st.h r0,0[reg1]
100	.endm
101
102	SET_PMR .macro reg_val, reg_tmp
103	mov PMR, reg_tmp
104	st.h reg_val, 0[reg_tmp] ;/* set interrupt level */
105	syncm
106	.endm
107
108	$endif ;/* __v850e2v3__ */
109
110	$ifdef __v850e3v5__
111
112	;/*
113	;* V850E3V5ç¨ã®å²è¾¼ã¿ã³ã³ããã¼ã©æä½ã«ã¼ãã³
114	;*/
115	GET_ISPR .macro reg
116	stsr 10, reg, 2
117	.endm
118
119	SET_ISPR .macro val, reg
120	movea val,r0,reg
121	ldsr reg, 10, 2
122	syncp
123	.endm
124
125	SET_INTCFG .macro val, reg
126	movea val,r0,reg
127	ldsr reg, 13, 2
128	syncp
129	.endm
130
131	CLEAR_ISPR .macro reg1, reg2
132	SET_INTCFG 1, reg1 ;/* ISPR ãæ¸ãæãå¯è½ã« */
133	SET_ISPR 0, reg1 ;/* ISPR ã®ã¯ãªã¢ */
134	SET_INTCFG 0, reg1 ;/* ISPR ãæ¸ãæãç¦æ¢ã«(èªåæ´æ°ã«) */
135	.endm
136
137	GET_PMR .macro reg
138	stsr 11, reg, 2
139	.endm
140
141	SET_PMR .macro reg_val, reg_tmp
142	stsr psw, reg_tmp
143	di
144	ldsr reg_val, 11, 2
145	ldsr reg_tmp, psw
146	syncp
147	.endm
148
149	GET_ICSR .macro reg
150	stsr sr12, reg, 2
151	.endm
152
153	SET_ICSR .macro val, reg
154	movea val,r0,reg
155	ldsr \reg, sr12, 2
156	.endm
157
158	$endif ;/* !__v850e3v5__ */
159
160
161	;/*
162	;* OSå²è¾¼ã¿ç¦æ¢ãã¯ã
163	;* ãã¹ãã®ä¸çªå¤å´ã§å¼ã³åºããããã¨ãæ³å®ãã¦ãã
164	;*/
165	OUTER_LOCK_OS_INT .macro reg12, reg13
166
167	;/* pmr_isr2_mask -> PMR */
168	Lea _pmr_isr2_mask, reg13
169	ld.h 0[reg13], reg13
170	SET_PMR reg13, reg12
171
172	;/* nested_lock_os_int_cnt = 1 */
173	Lea _nested_lock_os_int_cnt, reg12
174	mov 1, reg13
175	st.b reg13, 0[reg12]
176
177	.endm
178
179	;/*
180	;* OSå²è¾¼ã¿ç¦æ¢è§£é¤ãã¯ã
181	;* ãã¹ãã®ä¸çªå¤å´ã§å¼ã³åºããããã¨ãæ³å®ãã¦ãã
182	;*/
183	OUTER_UNLOCK_OS_INT .macro reg12, reg13
184
185	;/* nested_lock_os_int_cnt = 0 */
186	Lea _nested_lock_os_int_cnt, reg12
187	mov r0, reg13
188	st.b reg13, 0[reg12]
189
190	;/* pmr_setting_tbl[current_iintpri] -> PMR */
191	Lea _current_iintpri, reg12
192	ld.bu 0[reg12], reg12
193	shl 1, reg12
194
195	Lea _pmr_setting_tbl, reg13
196	add reg12, reg13
197	ld.h 0[reg13], reg13
198	SET_PMR reg13, reg12 ;/* set interrupt level */
199
200	.endm
201
202	;/* =begin modified for SC3 */
203	;/*
204	;* OSå²è¾¼ã¿ç¦æ¢ãã¯ã
205	;* ãã¹ããã
206	;*/
207	NESTED_LOCK_OS_INT .macro reg12, reg13
208
209	;/* nested_lock_os_int_cnt == 0 ? */
210	Lea _nested_lock_os_int_cnt, reg13
211	ld.b 0[reg13], reg12
212	cmp r0, reg12
213	bne increment_nest_lock
214
215	;/* pmr_isr2_mask -> PMR */
216	Lea _pmr_isr2_mask, reg13
217	ld.h 0[reg13], reg13
218	SET_PMR reg13, reg12 ;/* set interrupt level */
219	Lea _nested_lock_os_int_cnt, reg13
220	mov r0, reg12 ;/* nested_lock_os_int_cnt = 0 */
221
222	increment_nest_lock:
223	;/* nested_lock_os_int_cnt += 1 */
224	add 1, reg12
225	st.b reg12, 0[reg13]
226
227	.endm
228
229	;/*
230	;* OSå²è¾¼ã¿ç¦æ¢è§£é¤ãã¯ã
231	;* ãã¹ããã
232	;*/
233	NESTED_UNLOCK_OS_INT .macro reg12, reg13
234
235	;/* nested_lock_os_int_cnt -= 1 */
236	Lea _nested_lock_os_int_cnt, reg12
237	ld.b 0[reg12], reg13
238	add -1, reg13
239	st.b reg13, 0[reg12]
240	cmp r0, reg13
241	bne nested_unlock_exit
242
243	;/* pmr_setting_tbl[current_iintpri] -> PMR */
244	Lea _current_iintpri, reg12
245	ld.bu 0[reg12], reg12
246	shl 1, reg12
247
248	Lea _pmr_setting_tbl, reg13
249	add reg12, reg13
250	ld.h 0[reg13], reg13
251	SET_PMR reg13, reg12 ;/* set interrupt level */
252
253	nested_unlock_exit:
254	.endm
255
256	;/* =end modified for SC3 */
257
258	;/*
259	;* å²è¾¼ã¿/ä¾å¤ã®å
260	é ã§å®è¡ããå¦ç
261	;*/
262	PRE_INT_EXC .macro
263	$ifdef _RH850G3M_
264	;/* ä¸é¨ä¸æåä¾å¤ãã³ãã©ã§ã®ã¿å¿
265	è¦ã ãä¸å¾å®è¡ãã */
266	syncp
267	$endif ;/* _RH850G3M_ */
268	.endm
269
270	;/*
271	;* å²è¾¼ã¿ä¾å¤å
272	¥ãå£ã§ã®ã¬ã¸ã¹ã¿ã®ä¿åãã¯ã
273	;*/
274	INT_EXC_SAVEREG .macro
275	$ifndef TOPPERS_USE_PUSHSP
276	$ifdef TOPPERS_USE_HFLOAT
277	addi -88 , sp , sp
278	$else ;/* !TOPPERS_USE_HFLOAT */
279	addi -84 , sp , sp
280	$endif ;/* TOPPERS_USE_HFLOAT */
281	st.w r30, 12[sp] ;/* r30(ep) */
282	;/*
283	;* å²è¾¼ã¿çºçåã®r2ã¯eiwrã«ä¿åããã¦ãã
284	;* ããã§ï¼r2ã¯ãã§ã«ã¯ã¼ã¯ã¬ã¸ã¹ã¿ã¨ãã¦
285	;* ä½¿ç¨ä¸ã§ããããï¼ä¸æ¸ãããªã
286	;* r2ã«å
287	¥ã£ã¦ããå²è¾¼ã¿çªå·ãç ´å£ããªãããã«
288	;*/
289	stsr eiwr, r30 ;/* r2->r30ã«å¾©å¸° */
290	st.w r30, 76[sp]
291	mov sp, ep
292	sst.w r1, 80[ep]
293	sst.w r5, 72[ep]
294	sst.w r6, 68[ep]
295	sst.w r7, 64[ep]
296	sst.w r8, 60[ep]
297	sst.w r9, 56[ep]
298	sst.w r10, 52[ep]
299	sst.w r11, 48[ep]
300	sst.w r12, 44[ep]
301	sst.w r13, 40[ep]
302	sst.w r14, 36[ep]
303	sst.w r15, 32[ep]
304	sst.w r16, 28[ep]
305	sst.w r17, 24[ep]
306	sst.w r18, 20[ep]
307	sst.w r19, 16[ep]
308	sst.w r31, 8[ep]
309	$ifdef TOPPERS_USE_HFLOAT
310	stsr fpsr, r19 ;/* load FPSR */
311	sst.w r19, 84[ep]
312	$endif ;/* TOPPERS_USE_HFLOAT */
313
314	$else ;/* TOPPERS_USE_PUSHSP */
315	pushsp r1-r1
316	;/*
317	;* å²è¾¼ã¿çºçåã®r2ã¯eiwrã«ä¿åããã¦ãã
318	;* ããã§ï¼r2ã¯ãã§ã«ã¯ã¼ã¯ã¬ã¸ã¹ã¿ã¨ãã¦
319	;* ä½¿ç¨ä¸ã§ããããï¼ä¸æ¸ãããªã
320	;* r2ã«å
321	¥ã£ã¦ããå²è¾¼ã¿çªå·ãç ´å£ããªãããã«
322	;*/
323	stsr eiwr, r1 ;/* r2->r1ã«å¾©å¸° */
324	pushsp r1-r1
325	$ifdef TOPPERS_USE_HFLOAT
326	stsr fpsr, r1 ;/* load FPSR */
327	pushsp r1-r1
328	$endif ;/* TOPPERS_USE_HFLOAT */
329	pushsp r5-r19
330	pushsp r30-r31
331	addi -8, sp , sp
332	mov sp, ep
333	$endif ;/* TOPPERS_USE_PUSHSP */
334	.endm
335
336	;/*
337	;* å²è¾¼ã¿ä¾å¤å
338	¥ãå£ã§ã®ã¬ã¸ã¹ã¿ã®å¾©å¸°ãã¯ã
339	;*/
340	INT_EXC_RESTOREREG .macro
341	$ifndef TOPPERS_USE_PUSHSP
342	$ifdef TOPPERS_USE_HFLOAT
343	sld.w 84[ep], r19
344	ldsr r19, fpsr ;/* store FPSR */
345	$endif ;/* TOPPERS_USE_HFLOAT */
346	sld.w 80[ep], r1
347	sld.w 76[ep], r2
348	sld.w 72[ep], r5
349	sld.w 68[ep], r6
350	sld.w 64[ep], r7
351	sld.w 60[ep], r8
352	sld.w 56[ep], r9
353	sld.w 52[ep], r10
354	sld.w 48[ep], r11
355	sld.w 44[ep], r12
356	sld.w 40[ep], r13
357	sld.w 36[ep], r14
358	sld.w 32[ep], r15
359	sld.w 28[ep], r16
360	sld.w 24[ep], r17
361	sld.w 20[ep], r18
362	sld.w 16[ep], r19
363	sld.w 8[ep], r31
364	$ifdef TOPPERS_USE_HFLOAT
365	addi 88, ep, sp
366	$else ;/* !TOPPERS_USE_HFLOAT */
367	addi 84, ep, sp
368	$endif ;/* TOPPERS_USE_HFLOAT */
369	sld.w 12[ep], r30 ;/* r30(ep) */
370	ldsr r2, eiwr ;/* r2ãéé¿ */
371
372	$else ;/* TOPPERS_USE_PUSHSP */
373	addi 8, sp , sp
374	popsp r30-r31
375	popsp r5-r19
376	$ifdef TOPPERS_USE_HFLOAT
377	popsp r1-r1
378	ldsr r1, fpsr ;/* store FPSR */
379	$endif ;/* TOPPERS_USE_HFLOAT */
380	;/*
381	;* å²è¾¼ã¿çºçåã®r2ã¯eiwrã«å¾©å¸°
382	;*/
383	popsp r1-r1
384	ldsr r1, eiwr ;/* r2->eiwrã«å¾©å¸° */
385	popsp r1-r1
386	$endif ;/* TOPPERS_USE_PUSHSP */
387	.endm
388
389
390	$ifdef __v850e3v5__
391	;/*
392	;* V850E3V5ç¨ãã¯ã¿
393	;* ããã«RBASEãè¨å®ããããã¨ãæ³å®ï¼ãããé»æºæå
394	¥æã®éå§ã¢ãã¬ã¹ï¼
395	;* (EIã¬ãã«å²è¾¼ã¿ã¯ãã¼ãã«åç
396	§æ¹å¼ãä½¿ç¨ããããæ¬ãã¯ã¿ã¯ä½¿ç¨ããªã)
397	;*/
398	RESET .cseg text
399	.extern __reset
400	__reset:
401	jr __start
402	.rept 6
403	nop
404	.endm
405	__syserr: ;/* 0x0010 */
406	ldsr r2, eiwr
407	movea E_OS_PROTECTION_EXCEPTION, r0, r2
408	jr _fe_exception_entry
409	.rept 2
410	nop
411	.endm
412	__hvtrap: ;/* 0x0020 */
413	ldsr r2, eiwr
414	movea E_OS_PROTECTION_EXCEPTION, r0, r2
415	jr _fe_exception_entry
416	.rept 2
417	nop
418	.endm
419	__fetrap: ;/* 0x0030 */
420	ldsr r2, eiwr
421	movea E_OS_PROTECTION_EXCEPTION, r0, r2
422	jr _fe_exception_entry
423	.rept 2
424	nop
425	.endm
426	__trap0: ;/* 0x0040 */
427	ldsr r2, eiwr
428	movea E_OS_PROTECTION_EXCEPTION, r0, r2
429	jr _ei_exception_entry
430	.rept 2
431	nop
432	.endm
433	__trap1: ;/* 0x0050 */
434	ldsr r2, eiwr
435	movea E_OS_PROTECTION_EXCEPTION, r0, r2
436	jr _ei_exception_entry
437	.rept 2
438	nop
439	.endm
440	__rie: ;/* 0x0060 */
441	ldsr r2, eiwr
442	movea E_OS_PROTECTION_EXCEPTION, r0, r2
443	jr _ei_exception_entry
444	.rept 2
445	nop
446	.endm
447	__fppfpi: ;/* 0x0070 */
448	ldsr r2, eiwr
449	movea E_OS_PROTECTION_EXCEPTION, r0, r2
450	jr _ei_exception_entry
451	.rept 2
452	nop
453	.endm
454	__ucpop: ;/* 0x080 */
455	ldsr r2, eiwr
456	movea E_OS_PROTECTION_EXCEPTION, r0, r2
457	jr _fe_exception_entry
458	.rept 2
459	nop
460	.endm
461	__mip: ;/* 0x0090 */
462	ldsr r2, eiwr
463	movea E_OS_PROTECTION_MEMORY, r0, r2
464	jr _fe_exception_entry
465	.rept 2
466	nop
467	.endm
468	__pie: ;/* 0x00a0 */
469	ldsr r2, eiwr
470	movea E_OS_PROTECTION_EXCEPTION, r0, r2
471	jr _fe_exception_entry
472	.rept 2
473	nop
474	.endm
475	__debug: ;/* 0x00b0 */
476	jr __debug
477	.rept 6
478	nop
479	.endm
480	__mae: ;/* 0x00c0 */
481	ldsr r2, eiwr
482	movea E_OS_PROTECTION_EXCEPTION, r0, r2
483	jr _fe_exception_entry
484	.rept 2
485	nop
486	.endm
487	__rfu: ;/* 0x00d0 */
488	jr __rfu
489	.rept 6
490	nop
491	.endm
492	__fenmi: ;/* 0x00e0 */
493	ldsr r2, eiwr
494	movea E_OS_PROTECTION_EXCEPTION, r0, r2
495	jr _fe_exception_entry
496	.rept 2
497	nop
498	.endm
499	__feint: ;/* 0x00f0 */
500	ldsr r2, eiwr
501	movea E_OS_PROTECTION_EXCEPTION, r0, r2
502	jr _fe_exception_entry
503	.rept 2
504	nop
505	.endm
506	__eiintn0: ;/*ï¼åªå
507	åº¦0ï¼ 0x0100 */
508	jr _default_int_handler
509	.rept 6
510	nop
511	.endm
512	__eiintn1: ;/*ï¼åªå
513	åº¦1ï¼ 0x0110 */
514	jr _default_int_handler
515	.rept 6
516	nop
517	.endm
518	__eiintn2: ;/*ï¼åªå
519	åº¦2ï¼ 0x0120 */
520	jr _default_int_handler
521	.rept 6
522	nop
523	.endm
524	__eiintn3: ;/*ï¼åªå
525	åº¦3ï¼ 0x0130 */
526	jr _default_int_handler
527	.rept 6
528	nop
529	.endm
530	__eiintn4: ;/*ï¼åªå
531	åº¦4ï¼ 0x0140 */
532	jr _default_int_handler
533	.rept 6
534	nop
535	.endm
536	__eiintn5: ;/*ï¼åªå
537	åº¦5ï¼ 0x0150 */
538	jr _default_int_handler
539	.rept 6
540	nop
541	.endm
542	__eiintn6: ;/*ï¼åªå
543	åº¦6ï¼ 0x0160 */
544	jr _default_int_handler
545	.rept 6
546	nop
547	.endm
548	__eiintn7: ;/*ï¼åªå
549	åº¦7ï¼ 0x0170 */
550	jr _default_int_handler
551	.rept 6
552	nop
553	.endm
554	__eiintn8: ;/*ï¼åªå
555	åº¦8ï¼ 0x0180 */
556	jr _default_int_handler
557	.rept 6
558	nop
559	.endm
560	__eiintn9: ;/*ï¼åªå
561	åº¦9ï¼ 0x0190 */
562	jr _default_int_handler
563	.rept 6
564	nop
565	.endm
566	__eiintn10: ;/*ï¼åªå
567	åº¦10ï¼ 0x01a0 */
568	jr _default_int_handler
569	.rept 6
570	nop
571	.endm
572	__eiintn11: ;/*ï¼åªå
573	åº¦11ï¼ 0x01b0 */
574	jr _default_int_handler
575	.rept 6
576	nop
577	.endm
578	__eiintn12: ;/*ï¼åªå
579	åº¦12ï¼ 0x01c0 */
580	jr _default_int_handler
581	.rept 6
582	nop
583	.endm
584	__eiintn13: ;/*ï¼åªå
585	åº¦13ï¼ 0x01d0 */
586	jr _default_int_handler
587	.rept 6
588	nop
589	.endm
590	__eiintn14: ;/*ï¼åªå
591	åº¦14ï¼ 0x01e0 */
592	jr _default_int_handler
593	.rept 6
594	nop
595	.endm
596	__eiintn15: ;/*ï¼åªå
597	åº¦15ï¼ 0x01f0 */
598	jr _default_int_handler
599	.rept 6
600	nop
601	.endm
602
603	$endif ;/* __v850e3v5__ */
604
605	.cseg text_kernel
606	;/*
607	;* ä¾å¤ã¨ã³ããªï¼feretã§ãªã¿ã¼ã³ããä¾å¤ç¨ï¼
608	;* ããã§ï¼CY = FEPSW.IMPï¼r2 = error code
609	;* r2ã¯ä¾å¤ã¨ã³ããªã§ã¹ã¿ãã¯ã«ä¿åæ¸ã¿
610	;* r2ã®æä¸ä½ãããã«ï¼ä¾å¤å
611	ã®ã³ã³ããã¹ããç¹æ¨©ãã©ãããä¿åãã
612	;*/
613	.extern _fe_exception_entry
614	_fe_exception_entry:
615	;/* å²è¾¼ã¿/ä¾å¤ã®å
616	é ã§å®è¡ããå¦ç */
617	PRE_INT_EXC
618
619	ldsr r2, fewr ;/* ã¨ã©ã¼ã³ã¼ããä¿å */
620	stsr fepsw, r2
621	shl PSW_SV, r2 ;/* r2 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
622	stsr fewr, r2 ;/* ã¨ã©ã¼ã³ã¼ããå¾©å¸° */
623	bnc fe_exception_0 ;/* ç¹æ¨©ããã®ä¾å¤ãªãã°ã¹ããã */
624	;/*
625	;* ã¦ã¼ã¶ã¿ã¹ã¯ããã®ä¾å¤
626	;*/
627	ori 0x1000, r2, r2 ;/* r2 \|= 0x1000 */
628	ldsr r6, fewr ;/* r6ãéé¿ */
629	Lea _p_runtsk, r6
630	ld.w 0[r6], r6
631	st.w sp, TCB_usp[r6] ;/* uspãTCBã«ä¿å */
632	ld.w TCB_p_tinib[r6], r6
633	ld.w TINIB_sstk_bottom[r6], sp ;/* sspãå¾©å¸° */
634	stsr fewr, r6 ;/* r6ãå¾©å¸° */
635	fe_exception_0:
636	;/* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãä¿å */
637	INT_EXC_SAVEREG
638
639	;/* å¤éå²è¾¼ã¿ã®ããï¼ç¾å¨ã®FEPCã¨FEPSWãä¿å */
640	stsr fepc, r6
641	sst.w r6, 4[ep]
642	stsr fepsw, r6
643	sst.w r6, 0[ep]
644
645	;/*
646	;* ãããã¯ã·ã§ã³ããã¯ã¯OSå¦çã¬ãã«ã§å®è¡ããããOSå²è¾¼ã¿ç¦æ¢ç¶æ
647	ã«ãã
648	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
649	ã§ä¾å¤ãçºçããå¯è½æ§ãããããï¼ãã¹ãç®¡çãè¡ãï¼
650	;* ä¾å¤ã¯æ¬¡ã®æ¡ä»¶ã§çºçãã
651	;* ã»ISR1å®è¡ç¶æ
652	ã§çºçããå ´å
653	;* ã»ISR1å®è¡ç¶æ
654	ä»¥å¤ã§çºçããå ´å
655	;* ã»OSå²è¾¼ã¿è§£é¤ç¶æ
656	ã§çºçããå ´å
657	;* ã»OSå²è¾¼ã¿ç¦æ¢ç¶æ
658	ã§çºçããå ´å
659	;*/
660
661	;/*
662	;* ã«ãã´ãª1ã®å²è¾¼ã¿ä»¥å¤ã§ä¾å¤ãçºçãããã®å¤æãã
663	;* ã«ãã´ãª1ã§ä¾å¤ãçºçï¼fe_exception_1ã¸ã¸ã£ã³ã
664	;*/
665	GET_ISPR r6
666	Lea _pmr_isr1_mask, r7
667	ld.h 0[r7], r7
668	and r7, r6
669	cmp r0, r6
670	bne fe_exception_1
671
672	;/*
673	;* ISR1å®è¡ç¶æ
674	ä»¥å¤ã§çºçããå ´å
675	;*/
676	Lea _nested_lock_os_int_cnt, r12
677	ld.b 0[r12], r13
678	mov 1, r14
679	add r14, r13
680	st.b r13, 0[r12]
681	cmp 1, r13
682	bne fe_exception_1
683
684	;/*
685	;* OSå²è¾¼ã¿è§£é¤ç¶æ
686	ã§çºçããå ´å
687	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
688	ã¨ãã
689	;*/
690	Lea _pmr_isr2_mask, r7
691	ld.h 0[r7], r7
692	SET_PMR r7, r6 ;/* pmr_isr2_mask -> PMR */
693
694	fe_exception_1:
695	;/*
696	;* å²è¾¼ã¿çºçæã«å¤æ´ãããã®ã§å²è¾¼ã¿è§£é¤åã«åå¾
697	;*/
698	stsr feic, r19 ;/* ä¾å¤è¦å */
699	stsr fepc, r18 ;/* ä¾å¤çºçPC */
700
701	;/*
702	;* C1ISRãåãä»ããããï¼NPbit ã¯ãªã¢
703	;*/
704	stsr psw, r12
705	mov !0x0080, r13
706	and r12, r13
707	ldsr r13, psw
708
709	fe_exception_2:
710	;/*
711	;* ã«ã¼ãã«èµ·åãã¦ããªãå ´åã«èµ·ããCPUä¾å¤ã¯ï¼ç¡éã«ã¼ãã¸
712	;*/
713	Lea _kerflg, r12 ;/* kerflgãFALSEãªãç¡éã«ã¼ã */
714	ld.b 0[r12], r12
715	cmp r0, r12
716	infinity_loop_fe:
717	be infinity_loop_fe
718
719	;/*
720	;* å¤éå²è¾¼ã¿ãå¤å®
721	;*/
722	Lea _except_nest_cnt, r12
723	ld.w 0[r12], r13
724	mov 1, r14 ;/* å²è¾¼ã¿ã»ä¾å¤ã®ãã¹ãåæ°ã®ã¤ã³ã¯ãªã¡ã³ã */
725	add r14, r13
726	st.w r13, 0[r12]
727
728	mov sp, r9 ;/* sp ãr9ã«éé¿ */
729
730	cmp 1, r13
731	bne fe_exception_3 ;/* _nested_lock_os_int_cnt > 1 -> fe_exception_3 */
732
733	;/*
734	;* C1ISRå®è¡ç¶æ
735	ã§çºçããå ´åã¯ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
736	¥ãæ¿ãããªã
737	;*/
738	GET_ISPR r6
739	Lea _pmr_isr1_mask, r7
740	ld.h 0[r7], r7
741	and r7, r6
742	cmp r0, r6
743	bne fe_exception_3
744
745	;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿åã¨å
746	¥ãæ¿ã */
747	Lea __ostkpt, r12
748	ld.w 0[r12], r12
749	add -4, r12
750	st.w sp, 0[r12] ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
751	mov r12, sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®åãæ¿ã */
752
753	fe_exception_3:
754	;/* FEPSW.ID == 1ã®å ´åã¯å
755	¨å²è¾¼ã¿ç¦æ¢ç¶æ
756	ãªã®ã§è§£é¤ããªã */
757	stsr fepsw, r12
758	mov 0x20, r13
759	tst r12, r13
760	bne fe_exception_4
761	UNLOCK_ALL_INT
762
763	fe_exception_4:
764	$ifdef CFG_USE_PROTECTIONHOOK
765	;/* v850_cpu_exp_ãéé¿ããã¹ãã¼ã¹ãç¢ºä¿ /
766	addi -12, sp, sp
767
768	;/* v850_cpu_exp_spã®éé¿ã¨è¨å® */
769	Lea _v850_cpu_exp_sp, r12
770	st.w r9, 0[r12]
771	st.w ep, 0[sp]
772	mov sp, ep
773
774	;/* v850_cpu_exp_noã®éé¿ã¨è¨å® */
775	Lea _v850_cpu_exp_no, r12
776	ld.w 0[r12], r13
777	sst.w r13, 8[ep]
778	st.w r19, 0[r12] ;/* r19 ä¾å¤è¦å */
779
780	;/* v850_cpu_exp_pcã®éé¿ã¨è¨å® */
781	Lea _v850_cpu_exp_pc, r12
782	ld.w 0[r12], r13
783	sst.w r13, 4[ep]
784	mov r18, r17 ;/* r18:fepc */
785	add -4, r17
786	st.w r17, 0[r12]
787
788	$endif ;/* CFG_USE_PROTECTIONHOOK */
789
790	;/*
791	;* CPUä¾å¤ãçºçããå ´åï¼OSã¯E_OS_PROTECTION_EXCEPTIONããã©ã¡ã¼ã¿ã¨ãã¦
792	;* ãããã¯ã·ã§ã³ããã¯ãå¼ã³åºã
793	;*/
794	;/* =begin modified for SC3 */
795	andi 0xefff, r2, r6 ;/* ã¨ã©ã¼ã³ã¼ããç¬¬1å¼æ°ã«(r6=r2 & !0x1000) */
796	shr 12, r2 ;/* ä¾å¤ã®çºçå
797	ãã¦ã¼ã¶ã¢ã¼ããªãr2=1 */
798	xori 0x0001, r2, r2 ;/* r2 = r2==1? 0: 1 */
799	Lea _pre_protection_supervised, r12
800	st.b r2, 0[r12]
801	;/* =end modified for SC3 */
802	jarl _call_protectionhk_main, r31
803
804	$ifdef CFG_USE_PROTECTIONHOOK
805	mov sp, ep
806
807	;/* v850_cpu_exp_noãå¾©å¸° */
808	Lea _v850_cpu_exp_no, r12
809	sld.w 8[ep], r13
810	st.w r13, 0[r12]
811
812	;/* v850_cpu_exp_pcãå¾©å¸° */
813	Lea _v850_cpu_exp_pc, r12
814	sld.w 4[ep], r13
815	st.w r13, 0[r12]
816
817	;/* v850_cpu_exp_spéé¿ */
818	Lea _v850_cpu_exp_sp, r12
819	sld.w 0[ep], r13
820	st.w r13, 0[r12]
821
822	;/* v850_cpu_exp_ãéé¿ããã¹ãã¼ã¹ãæ»ã /
823	addi 12, sp, sp
824	$endif ;/* CFG_USE_PROTECTIONHOOK */
825
826	fe_ret_exc:
827	LOCK_ALL_INT
828
829	;/*
830	;* ãããã¯ã·ã§ã³ããã¯ã¯OSå²è¾¼ã¿ç¦æ¢ç¶æ
831	ã§å®è¡ãã
832	;*/
833
834	;/*
835	;* å²è¾¼ã¿ã»ä¾å¤ã®ãã¹ãåæ°ã®ãã¯ãªã¡ã³ã
836	;*/
837	Lea _except_nest_cnt, r12
838	ld.w 0[r12], r13
839	mov -1, r14
840	add r14, r13
841	st.w r13, 0[r12]
842
843	;/*
844	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
845	ã®è§£é¤
846	;*/
847	;/*
848	;* ISR1å®è¡ç¶æ
849	ã§çºçããå ´åã¯
850	;* (1)ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
851	¥ãæ¿ããããªã
852	;* (2)OSå²è¾¼ã¿ç¦æ¢ç¶æ
853	ã®è§£é¤ãããªã
854	;*/
855	GET_ISPR r6
856	Lea _pmr_isr1_mask, r7
857	ld.h 0[r7], r7
858	and r7, r6
859	cmp r0, r6
860	bne ret_exc_2
861
862	;/*
863	;* ãã¹ãåæ°ã1ä»¥ä¸ãªãå²è¾¼ã¿å
864	ãISRãªããä¾å¤çºçå
865	ã¸å¾©å¸°
866	;* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
867	¥ãæ¿ãããªã
868	;*/
869	cmp r0, r13
870	bne ret_exc_1
871
872	;/*
873	;* æ»ãå
874	ãã¿ã¹ã¯ãªããã¹ã¿ãã¯ãæ»ã
875	;*/
876	ld.w 0[sp], sp
877
878	ret_exc_1:
879	;/*
880	;* ISR1å®è¡ç¶æ
881	ä»¥å¤ã§çºçããå ´åï¼OSå²è¾¼ã¿ç¦æ¢ç¶æ
882	ã®è§£é¤
883	;*/
884	Lea _nested_lock_os_int_cnt, r12
885	ld.b 0[r12], r13
886	mov -1, r14
887	add r14, r13
888	st.b r13, 0[r12]
889	cmp r0, r13
890	bne ret_exc_2
891
892	;/* OSå²è¾¼ã¿ãè§£é¤ */
893	;/* pmr_setting_tbl[current_iintpri] -> PMR */
894	Lea _current_iintpri, r12
895	ld.bu 0[r12], r12
896	shl 1, r12
897
898	Lea _pmr_setting_tbl, r13
899	add r12, r13
900	ld.h 0[r13], r13
901	SET_PMR r13, r12 ;/* set interrupt level */
902
903	;/*
904	;* ä¾å¤çºçå
905	ã¸å¾©å¸°
906	;*/
907	ret_exc_2:
908	;/*
909	;* ã¬ã¸ã¹ã¿ãå¾©å¸°
910	;*/
911	mov sp, ep
912	sld.w 4[ep], r10
913	ldsr r10, fepc
914	sld.w 0[ep], r10
915	ldsr r10, fepsw
916
917	;/* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã®å¾©å¸° */
918	INT_EXC_RESTOREREG
919
920	stsr fepsw, r2 ;/* r2 = fepsw */
921	shl PSW_SV, r2 ;/* r2 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
922	bnc return_from_fe_exception ;/* ç¹æ¨©ããã®ä¾å¤ãªãã°ã¹ããã */
923	fe_exception_to_utask:
924	Lea _p_runtsk, r2
925	ld.w 0[r2], r2
926	ld.w TCB_usp[r2], sp ;/* uspãå¾©å¸° */
927	return_from_fe_exception:
928	stsr eiwr, r2
929	feret
930
931	;/*
932	;* ä¾å¤ã¨ã³ããªï¼eiretã§ãªã¿ã¼ã³ããä¾å¤ç¨ï¼
933	;* ããã§ï¼CY = EIPSW.IMPï¼r2 = error code
934	;* r2ã¯OSå´ã§äºç´ããï¼å²è¾¼ã¿ã»ä¾å¤ã®åºå
935	¥å£ã®
936	;* ã¯ã¼ã¯ã¬ã¸ã¹ã¿ã¨ãã¦ä½¿ç¨ããï¼ããï¼
937	;* ã¹ã¿ãã¯ã«ä¿åããªã
938	;*/
939	.extern _ei_exception_entry
940	_ei_exception_entry:
941	;/* å²è¾¼ã¿/ä¾å¤ã®å
942	é ã§å®è¡ããå¦ç */
943	PRE_INT_EXC
944
945	stsr eipsw, r2
946	shl PSW_SV, r2 ;/* r2 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
947	mov r0, r2 ;/* movå½ä»¤ã§ã¯ã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿ã¯å¤åããªã */
948	bnc ei_exception_0 ;/* ç¹æ¨©ããã®ä¾å¤ãªãã°ã¹ããã */
949	;/*
950	;* ã¦ã¼ã¶ã¿ã¹ã¯ããã®ä¾å¤
951	;*/
952	Lea _p_runtsk, r2
953	ld.w 0[r2], r2
954	st.w sp, TCB_usp[r2] ;/* uspãä¿å */
955	ld.w TCB_p_tinib[r2], r2
956	ld.w TINIB_sstk_bottom[r2], sp ;/* sspãå¾©å¸° */
957	ori 0x1000, r0, r2 ;/* r2 = 0x1000 */
958	ei_exception_0:
959	;/*
960	;* EIä¾å¤ã«ããè¦å ã¯E_OS_PROTECTION_EXCEPTIONã®ã¿ã§ãã
961	;*/
962	ori E_OS_PROTECTION_EXCEPTION, r2, r2 ;/* r2 \|= E_OS_PROTECTION_EXCEPTION */
963
964	;/* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã®ä¿å */
965	INT_EXC_SAVEREG
966
967	;/* å¤éå²è¾¼ã¿ã®ããï¼ç¾å¨ã®EIPCã¨EIPSWãä¿å */
968	stsr eipc, r6
969	sst.w r6, 4[ep]
970	stsr eipsw, r6
971	sst.w r6, 0[ep]
972
973	;/*
974	;* ãããã¯ã·ã§ã³ããã¯ã¯OSå¦çã¬ãã«ã§å®è¡ããããOSå²è¾¼ã¿ç¦æ¢ç¶æ
975	ã«ãã
976	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
977	ã§ä¾å¤ãçºçããå¯è½æ§ãããããï¼ãã¹ãç®¡çãè¡ãï¼
978	;* ä¾å¤ã¯æ¬¡ã®æ¡ä»¶ã§çºçãã
979	;* ã»ISR1å®è¡ç¶æ
980	ã§çºçããå ´å
981	;* ã»ISR1å®è¡ç¶æ
982	ä»¥å¤ã§çºçããå ´å
983	;* ã»OSå²è¾¼ã¿è§£é¤ç¶æ
984	ã§çºçããå ´å
985	;* ã»OSå²è¾¼ã¿ç¦æ¢ç¶æ
986	ã§çºçããå ´å
987	;*/
988
989	;/*
990	;* ã«ãã´ãª1ã®å²ãè¾¼ã¿ä»¥å¤ã§ä¾å¤ãçºçãããã®å¤æãã
991	;* ã«ãã´ãª1ã§ä¾å¤ãçºçï¼ei_exception_1ã¸ã¸ã£ã³ã
992	;*/
993	GET_ISPR r6
994	Lea _pmr_isr1_mask, r7
995	ld.h 0[r7], r7
996	and r7, r6
997	cmp r0, r6
998	bne ei_exception_1
999
1000	;/*
1001	;* ISR1å®è¡ç¶æ
1002	ä»¥å¤ã§çºçããå ´å
1003	;*/
1004	Lea _nested_lock_os_int_cnt, r12
1005	ld.b 0[r12], r13
1006	mov 1, r14
1007	add r14, r13
1008	st.b r13, 0[r12]
1009	cmp 1, r13
1010	bne ei_exception_1
1011
1012	;/*
1013	;* OSå²è¾¼ã¿è§£é¤ç¶æ
1014	ã§çºçããå ´å
1015	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
1016	ã¨ãã
1017	;*/
1018	Lea _pmr_isr2_mask, r7
1019	ld.h 0[r7], r7
1020	SET_PMR r7, r6 ;/* pmr_isr2_mask -> PMR */
1021
1022	ei_exception_1:
1023	;/*
1024	;* å²è¾¼ã¿çºçæã«å¤æ´ãããã®ã§å²è¾¼ã¿è§£é¤åã«åå¾
1025	;*/
1026	stsr eiic, r19 ;/* ä¾å¤è¦å */
1027	stsr eipc, r18 ;/* ä¾å¤çºçPC */
1028
1029
1030	ei_exception_2:
1031	;/*
1032	;* ã«ã¼ãã«èµ·åãã¦ããªãå ´åã«èµ·ããCPUä¾å¤ã¯ï¼ç¡éã«ã¼ãã¸
1033	;*/
1034	Lea _kerflg, r12 ;/* kerflgãFALSEãªãç¡éã«ã¼ã */
1035	ld.b 0[r12], r12
1036	cmp r0, r12
1037	infinity_loop_ei:
1038	be infinity_loop_ei
1039
1040	;/*
1041	;* å¤éå²è¾¼ã¿ãå¤å®
1042	;*/
1043	Lea _except_nest_cnt, r12
1044	ld.w 0[r12], r13
1045	mov 1, r14 ;/* å²è¾¼ã¿ã»ä¾å¤ã®ãã¹ãåæ°ã®ã¤ã³ã¯ãªã¡ã³ã */
1046	add r14, r13
1047	st.w r13, 0[r12]
1048
1049	mov sp, r9 ;/* sp ãr9ã«éé¿ */
1050
1051	cmp 1, r13
1052	bne ei_exception_3 ;/* _nested_lock_os_int_cnt > 1 -> ei_exception_3 */
1053
1054	;/*
1055	;* ISR1å®è¡ç¶æ
1056	ã§çºçããå ´åã¯ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
1057	¥ãæ¿ãããªã
1058	;*/
1059	GET_ISPR r6
1060	Lea _pmr_isr1_mask, r7
1061	ld.h 0[r7], r7
1062	and r7, r6
1063	cmp r0, r6
1064	bne ei_exception_3
1065
1066	;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿åã¨å
1067	¥ãæ¿ã */
1068	Lea __ostkpt, r12
1069	ld.w 0[r12], r12
1070	add -4, r12
1071	st.w sp, 0[r12] ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
1072	mov r12, sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®åãæ¿ã */
1073
1074	ei_exception_3:
1075	;/* EIPSW.ID == 1ã®å ´åã¯ããã«ããªãããï¼æ¡ä»¶å¤å®ã¯ä¸è¦ */
1076	UNLOCK_ALL_INT
1077
1078	$ifdef CFG_USE_PROTECTIONHOOK
1079	;/* v850_cpu_exp_ãéé¿ããã¹ãã¼ã¹ãç¢ºä¿ /
1080	addi -12, sp, sp
1081
1082	;/* v850_cpu_exp_spã®éé¿ã¨è¨å® */
1083	Lea _v850_cpu_exp_sp, r12
1084	st.w r9, 0[r12]
1085	st.w ep, 0[sp]
1086	mov sp, ep
1087
1088	;/* v850_cpu_exp_noã®éé¿ã¨è¨å® */
1089	Lea _v850_cpu_exp_no, r12
1090	ld.w 0[r12], r13
1091	sst.w r13, 8[ep]
1092	st.w r19, 0[r12] ;/* r19 ä¾å¤è¦å */
1093
1094	;/* v850_cpu_exp_pcã®éé¿ã¨è¨å® */
1095	Lea _v850_cpu_exp_pc, r12
1096	ld.w 0[r12], r13
1097	sst.w r13, 4[ep]
1098	mov r18, r17 ;/* r18:fepc */
1099	add -4, r17
1100	st.w r17, 0[r12]
1101
1102	$endif ;/* CFG_USE_PROTECTIONHOOK */
1103
1104	;/*
1105	;* CPUä¾å¤ãçºçããå ´åï¼OSã¯E_OS_PROTECTION_EXCEPTIONããã©ã¡ã¼ã¿ã¨ãã¦
1106	;* ãããã¯ã·ã§ã³ããã¯ãå¼ã³åºã
1107	;*/
1108	;/* =begin modified for SC3 */
1109	andi 0xefff, r2, r6 ;/* ã¨ã©ã¼ã³ã¼ããç¬¬1å¼æ°ã«(r6=r2 & !0x1000) */
1110	shr 12, r2 ;/* ä¾å¤ã®çºçå
1111	ãç¹æ¨©ã¢ã¼ããªãr2=1 */
1112	xori 0x0001, r2, r2 ;/* r2 = r2==1? 0: 1 */
1113	Lea _pre_protection_supervised, r12
1114	st.b r2, 0[r12]
1115	;/* =end modified for SC3 */
1116	jarl _call_protectionhk_main, r31
1117
1118	$ifdef CFG_USE_PROTECTIONHOOK
1119	mov sp, ep
1120
1121	;/* v850_cpu_exp_noãå¾©å¸° */
1122	Lea _v850_cpu_exp_no, r12
1123	sld.w 8[ep], r13
1124	st.w r13, 0[r12]
1125
1126	;/* v850_cpu_exp_pcãå¾©å¸° */
1127	Lea _v850_cpu_exp_pc, r12
1128	sld.w 4[ep], r13
1129	st.w r13, 0[r12]
1130
1131	;/* v850_cpu_exp_spéé¿ */
1132	Lea _v850_cpu_exp_sp, r12
1133	sld.w 0[ep], r13
1134	st.w r13, 0[r12]
1135
1136	;/* v850_cpu_exp_ãéé¿ããã¹ãã¼ã¹ãæ»ã /
1137	addi 12, sp, sp
1138	$endif ;/* CFG_USE_PROTECTIONHOOK */
1139
1140	ei_ret_exc:
1141	LOCK_ALL_INT
1142
1143	;/*
1144	;* ãããã¯ã·ã§ã³ããã¯ã¯OSå²è¾¼ã¿ç¦æ¢ç¶æ
1145	ã§å®è¡ãã
1146	;*/
1147
1148	;/*
1149	;* å²è¾¼ã¿ã»ä¾å¤ã®ãã¹ãåæ°ã®ãã¯ãªã¡ã³ã
1150	;*/
1151	Lea _except_nest_cnt, r12
1152	ld.w 0[r12], r13
1153	mov -1, r14
1154	add r14, r13
1155	st.w r13, 0[r12]
1156
1157	;/*
1158	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
1159	ã®è§£é¤
1160	;*/
1161	;/*
1162	;* ISR1å®è¡ç¶æ
1163	ã§çºçããå ´åã¯
1164	;* (1)ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
1165	¥ãæ¿ããããªã
1166	;* (2)OSå²è¾¼ã¿ç¦æ¢ç¶æ
1167	ã®è§£é¤ãããªã
1168	;*/
1169	GET_ISPR r6
1170	Lea _pmr_isr1_mask, r7
1171	ld.h 0[r7], r7
1172	and r7, r6
1173	cmp r0, r6
1174	bne ei_ret_exc_2
1175
1176	;/*
1177	;* ãã¹ãåæ°ã1ä»¥ä¸ãªãå²è¾¼ã¿å
1178	ãISRãªããä¾å¤çºçå
1179	ã¸å¾©å¸°
1180	;* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
1181	¥ãæ¿ãããªã
1182	;*/
1183	cmp r0, r13
1184	bne ei_ret_exc_1
1185
1186	;/*
1187	;* æ»ãå
1188	ãã¿ã¹ã¯ãªããã¹ã¿ãã¯ãæ»ã
1189	;*/
1190	ld.w 0[sp], sp
1191
1192	ei_ret_exc_1:
1193	;/*
1194	;* ISR1å®è¡ç¶æ
1195	ä»¥å¤ã§çºçããå ´åï¼OSå²è¾¼ã¿ç¦æ¢ç¶æ
1196	ã®è§£é¤
1197	;*/
1198	Lea _nested_lock_os_int_cnt, r12
1199	ld.b 0[r12], r13
1200	mov -1, r14
1201	add r14, r13
1202	st.b r13, 0[r12]
1203	cmp r0, r13
1204	bne ei_ret_exc_2
1205
1206	;/* OSå²è¾¼ã¿ãè§£é¤ */
1207	;/* pmr_setting_tbl[current_iintpri] -> PMR */
1208	Lea _current_iintpri, r12
1209	ld.bu 0[r12], r12
1210	shl 1, r12
1211
1212	Lea _pmr_setting_tbl, r13
1213	add r12, r13
1214	ld.h 0[r13], r13
1215	SET_PMR r13, r12 ;/* set interrupt level */
1216
1217	;/*
1218	;* ä¾å¤çºçå
1219	ã¸å¾©å¸°
1220	;*/
1221	ei_ret_exc_2:
1222	;/*
1223	;* ã¬ã¸ã¹ã¿ãå¾©å¸°
1224	;*/
1225	mov sp, ep
1226	sld.w 4[ep], r10
1227	ldsr r10, eipc
1228	sld.w 0[ep], r10
1229	ldsr r10, eipsw
1230
1231	;/* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã®å¾©å¸° */
1232	INT_EXC_RESTOREREG
1233
1234	stsr eipsw, r2 ;/* r2 = eipsw */
1235	shl PSW_SV, r2 ;/* r2 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
1236	bnc return_from_ei_exception ;/* ç¹æ¨©ããã®ä¾å¤ãªãã°ã¹ããã */
1237	ei_exception_to_utask:
1238	Lea _p_runtsk, r2
1239	ld.w 0[r2], r2
1240	ld.w TCB_usp[r2], sp ;/* uspãå¾©å¸° */
1241	return_from_ei_exception:
1242	stsr eiwr, r2
1243	eiret
1244
1245	;/*
1246	;* ã«ã¼ãã«èµ·åãã¦ããªãå ´åã«èµ·ããCPUä¾å¤ã®ç¡éã«ã¼ã
1247	;*/
1248	infinity_loop:
1249	br infinity_loop
1250
1251	;/*
1252	;* å²ãè¾¼ã¿ã¨ã³ããª
1253	;* V850E2
1254	;* ãã¯ã¿ã¼ãã¼ãã«ãã Os_Lcfg.c ã«çæãããåå²è¾¼ã¿ã®å²è¾¼ã¿ã¨ã³ããª
1255	;* ããã¸ã£ã³ããï¼r2ã«å²è¾¼ã¿çªå·ãä¿åãããç¶æ
1256	ã§å®è¡ããã
1257	;* V850E3V5
1258	;* ãã¯ã¿ã¼ãã¼ãã«ããç´æ¥å®è¡ãããããï¼ã¹ã¿ãã¯ã®ç¢ºä¿ãã¬ã¸ã¹ã¿ã®ä¿åã¯
1259	;* ç¹ã«è¡ããã¦ããªãç¶æ
1260	ã§å®è¡ããã
1261	;*/
1262	.extern _interrupt
1263	_interrupt:
1264	;/* å²è¾¼ã¿/ä¾å¤ã®å
1265	é ã§å®è¡ããå¦ç */
1266	PRE_INT_EXC
1267
1268	$ifdef __v850e3v5__
1269	ldsr r2, eiwr
1270	$endif ;/* __v850e3v5__ */
1271	;/*
1272	;* æ®ãã®ã¬ã¸ã¹ã¿éé¿ï¼ EPã§ã®ã¢ã¯ã»ã¹ã«åãæ¿ãã¦è¡ã
1273	;* ããã§ï¼CY = EIPSW.IMPï¼r2[31:16] = intno
1274	;* r2ã¯OSå´ã§äºç´ããï¼å²è¾¼ã¿ã»ä¾å¤ã®åºå
1275	¥å£ã®
1276	;* ã¯ã¼ã¯ã¬ã¸ã¹ã¿ã¨ãã¦ä½¿ç¨ããï¼ããï¼
1277	;* ã¹ã¿ãã¯ã«ä¿åããªã
1278	;*/
1279	stsr eipsw, r2
1280	shl PSW_SV, r2 ;/* r2 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
1281	bnc interrupt_0 ;/* ç¹æ¨©ããã®å²è¾¼ã¿ãªãã°ã¹ããã */
1282	;/*
1283	;* ã¦ã¼ã¶ã¿ã¹ã¯ã¸ã®å²è¾¼ã¿
1284	;*/
1285	Lea _p_runtsk, r2
1286	ld.w 0[r2], r2
1287	st.w sp, TCB_usp[r2] ;/* uspãä¿å */
1288	ld.w TCB_p_tinib[r2], r2
1289	ld.w TINIB_sstk_bottom[r2], sp ;/* sspãå¾©å¸° */
1290	interrupt_0:
1291	$ifdef __v850e3v5__
1292	;/* å²è¾¼ã¿è¦å ã®ç¹å® */
1293	stsr eiic, r2
1294	;/* EICå²è¾¼ã¿ã¯0x1000 ãã */
1295	addi -0x1000, r2, r2
1296	$endif ;/* __v850e3v5__ */
1297
1298	;/* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã®ä¿å */
1299	INT_EXC_SAVEREG
1300
1301	;/* å¤éå²è¾¼ã¿ã®ããï¼ç¾å¨ã®EIPCã¨EIPSWãä¿å */
1302	stsr eipc, r6
1303	sst.w r6, 4[ep]
1304	stsr eipsw, r6
1305	sst.w r6, 0[ep]
1306
1307	mov r2, r12
1308
1309	;/* å²è¾¼ã¿åªå
1310	åº¦ãåå¾(r11) */
1311	GET_ISPR r13
1312	sch1r r13, r11
1313	add -1,r11
1314
1315	;/*
1316	;* _current_iintpri ã®æ´æ°
1317	;* å²ãè¾¼ã¿å¦çä¸ã¯ISPRãèªåçã«è¨å®ããã¦ããããï¼PMRã¯è¨å®ããå¿
1318	è¦ããªãï¼
1319	;*/
1320	Lea _current_iintpri, r6
1321	ld.bu 0[r6], r19
1322	st.b r11,0[r6]
1323
1324	;/*
1325	;* å¤éå²è¾¼ã¿ãå¤å®
1326	;*/
1327	Lea _except_nest_cnt, r13
1328	ld.w 0[r13], r6
1329
1330	;/*
1331	;* å²è¾¼ã¿ã»ä¾å¤ã®ãã¹ãåæ°ã®ã¤ã³ã¯ãªã¡ã³ã
1332	;*/
1333	add 1, r6
1334	st.w r6, 0[r13]
1335	cmp 1, r6
1336	bne interrupt_1 ;/* ãã¹ããã¦ããå ´åã¯ã¹ã¿ãã¯åæ¿ç¡ã */
1337
1338	;/*
1339	;* ã¿ã¹ã¯ã«å²è¾¼ãã å ´å
1340	;* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿åã¨å
1341	¥ãæ¿ã
1342	;*/
1343	mov sp , r13
1344	Lea __ostkpt, sp
1345	ld.w 0[r3], r3
1346	add -4, sp
1347	st.w r13, 0[sp]
1348
1349	interrupt_1:
1350	;/*
1351	;* å²è¾¼ã¿çºçæã®å²è¾¼ã¿åªå
1352	åº¦ãã¹ã¯ãã¹ã¿ãã¯ã«ä¿å
1353	;*/
1354	add -4, sp
1355	st.w r19, 0[sp]
1356
1357	UNLOCK_ALL_INT
1358
1359	$ifdef CFG_USE_STACKMONITORING
1360	;/*
1361	;* å²è¾¼ã¿çªå·ã®ä¿å
1362	;* ã¹ã¿ãã¯ãªã¼ãããã¼ã®ãããã¯ã·ã§ã³ããã¯ã§ç ´å£ãããå¯è½æ§ããã
1363	;*/
1364	push r12
1365	;/*
1366	;* ã¿ã¹ã¯ã¹ã¿ãã¯ã®ãªã¼ãããã¼ãã§ãã¯
1367	;*/
1368
1369	;/*
1370	;* å¤éå²è¾¼ã¿ã®å ´åã¯ã¿ã¹ã¯ã¹ã¿ãã¯ã®ã¹ã¿ãã¯ã¢ãã¿ãªã³ã°ãè¡ããªã
1371	;*/
1372	cmp 1, r6
1373	bne int_nested
1374
1375	;/*
1376	;* ã¹ã¿ãã¯ãã¤ã³ã¿ãã§ãã¯æ¹å¼
1377	;*/
1378	Lea _p_runtsk, r6 ;/* ç®¡çãããã¯ã®å
1379	é ã¢ãã¬ã¹åå¾ */
1380	ld.w 0[r6], r6
1381	ld.w TCB_p_tinib[r6], r6 ;/* ã¿ã¹ã¯åæåãããã¯å
1382	é ã¢ãã¬ã¹åå¾ */
1383	;/* =begin modified for SC3 */
1384	;/* ã·ã¹ãã ã¹ã¿ãã¯ã¢ãã¿ãªã³ã° */
1385	ld.w TINIB_sstksz[r6], r7 ;/* ã¿ã¹ã¯ã·ã¹ãã ã¹ã¿ãã¯ãµã¤ãºåå¾ */
1386	ld.w TINIB_sstk_bottom[r6], r6 ;/* ã¿ã¹ã¯ã·ã¹ãã ã¹ã¿ãã¯çµç«¯ã¢ãã¬ã¹åå¾ */
1387	sub r7, r6
1388	mov r0, r9
1389	cmp r6, r13 ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ <= ã¹ã¿ãã¯ã®å
1390	é ã®å ´åNG */
1391	Lea stack_monitoring_exit, lp
1392	;/* =end modified for SC3 */
1393	bnh stack_monitoring_error_isr
1394
1395	;/*
1396	;* ãã¸ãã¯ãã³ãã¼ãã§ãã¯æ¹å¼
1397	;*/
1398	ld.w 0[r6], r6
1399	mov STACK_MAGIC_NUMBER, r7
1400	;/*
1401	;* ãã¸ãã¯ãã³ãã¼æªç ´å£ãªãï¼å²è¾¼ã¿å¦çã«é£ã¶
1402	;* ã¿ã¹ã¯ã«å²è¾¼ãã å ´åï¼å²è¾¼ã¿ã¹ã¿ãã¯ããã§ãã¯ããªã
1403	;*/
1404	cmp r7, r6
1405	be stack_monitoring_exit
1406	;/* =begin modified for SC3 */
1407	Lea stack_monitoring_exit, lp
1408	;/* =end modified for SC3 */
1409	br stack_monitoring_error_isr
1410
1411	;/*
1412	;* å¤éå²è¾¼ã¿ã®å ´å
1413	;*/
1414	int_nested:
1415	;/*
1416	;* å²è¾¼ã¿ã¹ã¿ãã¯ã®ãªã¼ãããã¼ãã§ãã¯
1417	;*/
1418
1419	;/*
1420	;* ã¹ã¿ãã¯æ®éãã§ãã¯æ¹å¼
1421	;*/
1422	Lea _isr_p_isrcb_tbl, r7
1423	mov r12, r11
1424	shl 2, r11 ;/* å²è¾¼ã¿çªå·ã4åãã¦ãªãã»ãããçæ */
1425	add r11, r7
1426	ld.w 0[r7], r7 ;/* r7 = &isrcb_table[x] */
1427	;/* =begin modified for SC3 */
1428	ld.w ISRCB_p_isrinib[r7], r7
1429	ld.w ISRINIB_p_intinib[r7], r7
1430	mov 1, r9
1431	;/* =end modified for SC3 */
1432	ld.w INTINIB_remain_stksz[r7], r7 ;/* å²è¾¼ã¿çªå·ã«å¯¾å¿ããã¹ã¿ãã¯ãµã¤ãºã®åå¾ */
1433	Lea __ostk, r6 ;/* å²è¾¼ã¿ã¹ã¿ãã¯ã®å
1434	é ã¢ãã¬ã¹åå¾ */
1435	ld.w 0[r6], r6
1436	add r6, r7 ;/* å
1437	é ã¢ãã¬ã¹ï¼ISRã®ä½¿ç¨ããã¹ã¿ãã¯ãµã¤ãº */
1438	cmp r7, sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ <= å
1439	é ã¢ãã¬ã¹ï¼ISRã®ä½¿ç¨ããã¹ã¿ãã¯ãµã¤ãºã®å ´åOK */
1440	;/* =begin modified for SC3 */
1441	Lea stack_monitoring_exit, lp
1442	;/* =end modified for SC3 */
1443	bnh stack_monitoring_error_isr
1444
1445	;/*
1446	;* ãã¸ãã¯ãã³ãã¼ãã§ãã¯æ¹å¼
1447	;*/
1448	ld.w 0[r6], r6 ;/* ãã®ã¢ãã¬ã¹ã®ç¤ºãå
1449	ã«ãã¸ãã¯ãã³ãã¼ãå
1450	¥ã£ã¦ãã */
1451	mov STACK_MAGIC_NUMBER, r7
1452	cmp r7, r6
1453	;/* =begin modified for SC3 */
1454	Lea stack_monitoring_exit, lp
1455	;/* =end modified for SC3 */
1456	bne stack_monitoring_error_isr
1457
1458	stack_monitoring_exit:
1459	pop r12
1460	$endif ;/* CFG_USE_STACKMONITORING */
1461
1462	;/*
1463	;* _callevel_stat ä¿å
1464	;*/
1465	Lea _callevel_stat, r6
1466	ld.h 0[r6], r7
1467	Push r7
1468
1469	;/*
1470	;* _callevel_stat è¨å®
1471	;*/
1472	mov TCL_ISR2, r8
1473	or r8, r7
1474	st.h r7, 0[r6]
1475
1476	;/* =begin added for SC3 */
1477	;/*
1478	;* run_trusted ä¿å
1479	;*/
1480	Lea _run_trusted, r6
1481	ld.b 0[r6], r7
1482	Push r7
1483
1484	;/*
1485	;* run_trusted è¨å®
1486	;*/
1487	mov TRUE, r8
1488	st.b r8, 0[r6]
1489
1490	;/*
1491	;* p_runosap ä¿å
1492	;*/
1493	Lea _p_runosap, r6
1494	ld.w 0[r6], r7
1495	Push r7
1496	;/* =end added for SC3 */
1497
1498	;/*
1499	;* p_runisr ä¿å
1500	;*/
1501	Lea _p_runisr, r6
1502	ld.w 0[r6], r7
1503	Push r7
1504
1505	;/*
1506	;* p_runisr è¨å®
1507	;*/
1508	Lea _isr_p_isrcb_tbl, r7
1509	shl 2, r12 ;/* å²è¾¼ã¿çªå·ã4åãã¦ãªãã»ãããçæ */
1510	add r12, r7
1511	Lea _p_runisr, r8
1512	ld.w 0[r7], r7
1513	st.w r7, 0[r8]
1514
1515	;/*
1516	;* å²è¾¼ã¿ãã³ãã©ã®ã¢ãã¬ã¹ãèªã¿è¾¼ã
1517	;*/
1518	Lea _isr_tbl, r6
1519	add r12, r6
1520
1521	;/* =begin modified for SC3 */
1522	;/*
1523	;* p_runosap è¨å®
1524	;*/
1525	cmp r7, r0 ;/* r7 = p_runisr == NULL ? */
1526	be int_handler_call ;/* p_runisr ã NULL ã§ãªããã°ã¹ããã */
1527	ld.w ISRCB_p_isrinib[r7], ep ;/* ep = p_runisr->p_isrinib */
1528	sld.w ISRINIB_p_osapcb[ep], r8 ;/* r8 = p_runisr->p_isrinib->p_osapcb */
1529	Lea _p_runosap, ep
1530	sst.w r8, 0[ep] ;/* p_runosap = p_runisr->p_isrinib->p_osapcb */
1531
1532	int_handler_call:
1533	;/* =end modified for SC3 */
1534	;/*
1535	;* å²è¾¼ã¿ãã³ãã©å¼ã³åºã
1536	;*/
1537	Lea end_int_handler, r31
1538	ld.w 0[r6], r6
1539	jmp [r6]
1540
1541	;/*
1542	;* ã¹ã¿ãã¯ãªã¼ãããã¼æã®å¦ç
1543	;*/
1544	$ifdef CFG_USE_STACKMONITORING
1545	;/*
1546	;* ã¹ã¿ãã¯ãªã¼ãããã¼æãããã¯ã·ã§ã³ããã¯ãå¼ã³åºã
1547	;* ã¹ã¿ãã¯ãæ´ã«å£ããªãããï¼å²è¾¼ã¿ã¹ã¿ãã¯ã®åæå¤ãä½¿ç¨ãã
1548	;* ISRã®åºå
1549	¥å£ããç¸å¯¾ã¸ã£ã³ãã§ããããã«ããã«ç½®ã
1550	;* stack_monitoring_errorã¸ã®è¸ã¿å°
1551	;*/
1552	stack_monitoring_error_isr:
1553	br stack_monitoring_error
1554	$endif ;/* CFG_USE_STACKMONITORING */
1555
1556	end_int_handler:
1557
1558	$ifdef CFG_USE_STACKMONITORING
1559	;/*
1560	;* å²è¾¼ã¿ã¹ã¿ãã¯ã®ãªã¼ãããã¼ãã§ãã¯
1561	;* å²è¾¼ã¿ããæ»ã£ãæï¼ã¹ã¿ãã¯ãã¤ã³ã¿ãæ»ã£ãã¯ããªã®ã§ï¼
1562	;* ãã¸ãã¯ãã³ãã¼ãã§ãã¯æ¹å¼ã®ã¿å®æ½
1563	;*/
1564
1565	;/*
1566	;* ãã¸ãã¯ãã³ãã¼ãã§ãã¯æ¹å¼
1567	;*/
1568	Lea __ostk, r6 ;/* å²è¾¼ã¿ã¹ã¿ãã¯ã®å
1569	é ã¢ãã¬ã¹åå¾ */
1570	ld.w 0[r6], r6
1571	ld.w 0[r6], r6 ;/* ãã®ã¢ãã¬ã¹ã®ç¤ºãå
1572	ã«ãã¸ãã¯ãã³ãã¼ãå
1573	¥ã£ã¦ãã */
1574	;/* =begin modified for SC3 */
1575	mov 1, r9
1576	mov STACK_MAGIC_NUMBER, r7
1577	cmp r7, r6
1578	Lea stack_monitoring_exit2, lp
1579	bne stack_monitoring_error_isr
1580
1581	stack_monitoring_exit2:
1582	;/* =end modified for SC3 */
1583	$endif ;/* CFG_USE_STACKMONITORING */
1584
1585	;/*
1586	;* ISR2ã®ä¸æ£çµäºãã§ãã¯
1587	;*/
1588	jarl _exit_isr2, r31
1589
1590	;/*
1591	;* p_runisr ã®å¾©å¸°
1592	;*/
1593	Lea _p_runisr, r7
1594	Pop r6
1595	st.w r6, 0[r7]
1596
1597	;/* =begin modified for SC3 */
1598	;/*
1599	;* p_runosap å¾©å¸°
1600	;*/
1601	Lea _p_runosap, r7
1602	Pop r6
1603	st.w r6, 0[r7]
1604
1605	;/*
1606	;* run_trusted å¾©å¸°
1607	;*/
1608	Lea _run_trusted, r7
1609	Pop r6
1610	st.b r6, 0[r7]
1611	;/* =end modified for SC3 */
1612
1613
1614	;/*
1615	;* _callevel_stat ã®å¾©å¸°
1616	;*/
1617	Lea _callevel_stat, r7
1618	Pop r6
1619	st.h r6, 0[r7]
1620
1621	;/*
1622	;* å²è¾¼ã¿ãã³ãã©åºå£å¦ç
1623	;*/
1624	ret_int:
1625	;/*
1626	;* _except_nest_cntã®æä½ã¨ã¹ã¿ãã¯åãæ¿ãã®éã¯OSå²è¾¼ã¿ç¦æ¢ã«ãã
1627	;* å¿
1628	è¦ããã
1629	;* ãã®å
1630	ï¼å²è¾¼ã¿å
1631	ã¸ã®ãªã¿ã¼ã³ãï¼é
1632	å»¶ãã£ã¹ãããã«åå²ããï¼
1633	;* å²è¾¼ã¿å
1634	ã¸ã®ãªã¿ã¼ã³ã«ã¯å
1635	¨å²è¾¼ã¿ãå¿
1636	è¦ã§ããï¼é
1637	å»¶ãã£ã¹ãããæã«ã¯
1638	;* ãã¹ãç®¡çã®OSå²è¾¼ã¿ç¦æ¢ã«ããå¿
1639	è¦ãããããï¼ããã§ã¯ä¸æ¦å
1640	¨å²è¾¼ã¿ç¦
1641	;* æ¢ã¨ãã
1642	;*/
1643
1644	LOCK_ALL_INT
1645
1646	;/*
1647	;* å²è¾¼ã¿çºçæã®å²è¾¼ã¿åªå
1648	åº¦ãã¹ã¯ãã¹ã¿ãã¯ããå¾©å¸°
1649	;*/
1650	ld.w 0[sp], r19
1651	add 4, sp
1652	Lea _current_iintpri, r6
1653	st.b r19, 0[r6] ;/* current_iintpriãå¾©å¸° */
1654
1655	;/*
1656	;* å²è¾¼ã¿ã»ä¾å¤ã®ãã¹ãåæ°ã®ãã¯ãªã¡ã³ã
1657	;*/
1658	Lea _except_nest_cnt, r6
1659	ld.w 0[r6], r7
1660	add -1, r7
1661	st.w r7, 0[r6]
1662
1663	;/*
1664	;* ãã¹ãåæ°ã0ãªãï¼å²è¾¼ã¿å
1665	ãã¿ã¹ã¯
1666	;*/
1667	cmp r0, r7
1668	be ret_int_task
1669
1670	;/*
1671	;* ISR2å²è¾¼ã¿ããã®ãªã¿ã¼ã³æã¯å²è¾¼ã¿å
1672	ã
1673	;* ISR2ã§ãããããã®ã¾ã¾ãªã¿ã¼ã³
1674	;*/
1675	br ret_int_1
1676
1677
1678	;/*
1679	;* å²è¾¼ã¿å
1680	ãã¿ã¹ã¯ã®å ´å
1681	;*/
1682	ret_int_task:
1683	ld.w 0[sp], sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ãæ»ã */
1684
1685	;/*
1686	;* å²è¾¼ã¿åªå
1687	åº¦ãã¹ã¯ãå¤ããAPIããªãããï¼
1688	;* ATK2ã§ã¯å²è¾¼ã¿åªå
1689	åº¦ãã¹ã¯ã®å¾©å¸°å¦çã¯ä¸è¦
1690	;*/
1691	;/*
1692	;* å²è¾¼ã¿ãã³ãã©å®è¡æã«ã¯ï¼ISPRã§åªå
1693	åº¦ãèªåçã«ä¸ããããï¼
1694	;* PMRã¯å¤æ´ãã¦ããªããï¼å²ãè¾¼ã¿ãã³ãã©å
1695	ã§ x_nested_unlock_os_int() ã
1696	;* å¼ã³åºãã¨PMRãæ¸ãæããï¼ãã£ã¹ããããå¿
1697	è¦ã§ãªãå ´åã¯ï¼ret_int_1ã§
1698	;* PMRãå
1699	ã®å¤ã«æ»ãï¼ãã£ã¹ããããå¿
1700	è¦ãªå ´åã¯ï¼OSå²ãè¾¼ã¿ç¦æ¢ã¨ããããï¼
1701	;* ããã§ï¼PMRãæ´æ°ããå¿
1702	è¦ã¯ãªãï¼
1703	;*/
1704
1705	;/*
1706	;* æ»ãå
1707	ãã¿ã¹ã¯ã®å ´åï¼ãã£ã¹ãããã®å¿
1708	è¦ãããããã§ãã¯
1709	;*/
1710	Lea _p_runtsk, r6
1711	ld.w 0[r6], r6
1712	Lea _p_schedtsk, r7
1713	ld.w 0[r7], r7
1714	cmp r6, r7
1715	be ret_int_1 ;/* ãã£ã¹ãããã®å¿
1716	è¦ããªããã°å²è¾¼ã¿å
1717	ã¸æ»ã */
1718
1719	;/*
1720	;* ããã§ã¯ï¼æ»ãå
1721	ãã¿ã¹ã¯ã§ããï¼ã¹ã¿ãã¯ã¯ï¼ã¿ã¹ã¯ã¹ã¿ãã¯ã«
1722	;* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã®ã¿ãä¿åãããç¶æ
1723	ã«ãªã£ã¦ããï¼ã¾ãï¼
1724	;* å
1725	¨å²è¾¼ã¿ãç¦æ¢ããç¶æ
1726	ã¨ãªã£ã¦ãã
1727	;*/
1728
1729	;/*
1730	;* åªå
1731	åº¦ãã¹ã¯ã®ã¯ãªã¢
1732	;* eiretãå®è¡ããªãããï¼eiretã«ããå²è¾¼ã¿ã³ã³ããã¼ã©ã®åªå
1733	åº¦ãã¹ã¯
1734	;* (ã¤ã³ãµã¼ãã¹ãã©ã¤ãªãªãã£)ã®ã¯ãªã¢ãè¡ãããªãããï¼ä»£ããã«ISPC
1735	;* ãç¨ãã¦ã¯ãªã¢ããï¼
1736	;*/
1737	CLEAR_ISPR r10, r12
1738
1739	;/*
1740	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
1741	ã«ç§»è¡ãã
1742	;*
1743	;* ãã®æç¹ã§OSå²è¾¼ã¿ç¦æ¢ç¶æ
1744	ã¨ããã®ã¯ï¼dispatcherãå®è¡ããéã«
1745	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
1746	ã«ãªã£ã¦ããå¿
1747	è¦ãããããã§ãã
1748	;*
1749	;* (ã¢ãã«ä¸ã®)å²è¾¼ã¿åªå
1750	åº¦ãã¹ã¯ã¯0ã§ããããï¼ISR1ä»¥å¤ã®å²è¾¼ã¿ã¯å
1751	¨ã¦ç¦æ¢ãã
1752	;*/
1753
1754	OUTER_LOCK_OS_INT r12, r13
1755	;/* ret_int ã§å
1756	¨å²è¾¼ã¿ç¦æ¢ç¶æ
1757	ã¨ããããè§£é¤ */
1758	UNLOCK_ALL_INT
1759
1760	;/*
1761	;* ã³ã³ããã¹ãã®éé¿
1762	;*/
1763	$ifndef TOPPERS_USE_PUSHSP
1764	addi -40, sp, sp
1765	mov sp, ep
1766	sst.w r20, 36[ep]
1767	sst.w r21, 32[ep]
1768	sst.w r22, 28[ep]
1769	sst.w r23, 24[ep]
1770	sst.w r24, 20[ep]
1771	sst.w r25, 16[ep]
1772	sst.w r26, 12[ep]
1773	sst.w r27, 8[ep]
1774	sst.w r28, 4[ep]
1775	sst.w r29, 0[ep]
1776	$else ;/* TOPPERS_USE_PUSHSP */
1777	pushsp r20-r29
1778	$endif ;/* TOPPERS_USE_PUSHSP */
1779
1780	;/* ã¹ã¿ãã¯ã¨æ¬¡ã®èµ·åçªå°ãä¿å */
1781	Lea _p_runtsk, ep
1782	sld.w 0[ep], ep
1783	;/* =begin modified for SC3 */
1784	sst.w sp, TCB_ssp[ep]
1785	;/* =end modified for SC3 */
1786	Lea ret_int_r, r6
1787	sst.w r6, TCB_pc[ep]
1788	br dispatcher
1789
1790	;/*
1791	;* å²è¾¼ã¿ã»ä¾å¤ã§ã³ã³ããã¹ãä¿åããå ´åã®å¾©å¸°ã«ã¼ãã³
1792	;*/
1793	ret_int_r:
1794	;/*
1795	;* ã³ã³ããã¹ãã®å¾©å¸°
1796	;*/
1797	$ifndef TOPPERS_USE_PUSHSP
1798	mov sp, ep
1799	sld.w 36[ep], r20
1800	sld.w 32[ep], r21
1801	sld.w 28[ep], r22
1802	sld.w 24[ep], r23
1803	sld.w 20[ep], r24
1804	sld.w 16[ep], r25
1805	sld.w 12[ep], r26
1806	sld.w 8[ep], r27
1807	sld.w 4[ep], r28
1808	sld.w 0[ep], r29
1809	addi 40, ep, sp
1810	$else ;/* TOPPERS_USE_PUSHSP */
1811	popsp r20-r29
1812	$endif ;/* TOPPERS_USE_PUSHSP */
1813
1814	LOCK_ALL_INT
1815
1816	OUTER_UNLOCK_OS_INT r12, r13
1817	;/*
1818	;* å²è¾¼ã¿ããã®å¾©å¸°ã«ã¼ãã³
1819	;*/
1820	ret_int_1:
1821	;/*
1822	;* ã¬ã¸ã¹ã¿ãå¾©å¸°
1823	;*/
1824	mov sp, ep
1825
1826	;/*
1827	;* å²è¾¼ã¿åªå
1828	åº¦ãã¹ã¯ãå¤ããAPIããªãããï¼
1829	;* ATK2ã§ã¯å²è¾¼ã¿åªå
1830	åº¦ãã¹ã¯ã®å¾©å¸°å¦çã¯ä¸è¦
1831	;*/
1832	;/*
1833	;* PMRãå
1834	ã«æ»ãï¼
1835	;* å²è¾¼ã¿ãã³ãã©å®è¡æã«ã¯ï¼ISPRã§åªå
1836	åº¦ãèªåçã«ä¸ããããï¼
1837	;* PMRã¯å¤æ´ãã¦ããªããï¼å²ãè¾¼ã¿ãã³ãã©å
1838	ã§ x_nested_unlock_os_int() ã
1839	;* å¼ã³åºãã¨PMRãæ¸ãæããããããã§å
1840	ã®å¤ã«æ»ãï¼
1841	;* OUTER_UNLOCK_OS_INT ã¯ nested_lock_os_int_cnt ã0ã«ãããï¼
1842	;* ããã§ã¯æ¢ã«0ã§ããããåé¡ãªãï¼
1843	;*/
1844	OUTER_UNLOCK_OS_INT r1, r6
1845	sld.w 4[ep], r10
1846	ldsr r10, eipc
1847	sld.w 0[ep], r10
1848	ldsr r10, eipsw
1849
1850	;/* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãå¾©å¸° */
1851	INT_EXC_RESTOREREG
1852
1853	stsr eipsw, r2 ;/* r2 = eipsw */
1854	shl PSW_SV, r2 ;/* r2 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
1855	bnc return_from_int ;/* ç¹æ¨©ããã®å²è¾¼ã¿ãªãã°ã¹ããã */
1856	int_to_utask:
1857	Lea _p_runtsk, r2
1858	ld.w 0[r2], r2
1859	ld.w TCB_usp[r2], sp ;/* uspãå¾©å¸° */
1860	return_from_int:
1861	stsr eiwr, r2
1862	eiret
1863
1864	;/*
1865	;* ã¿ã¹ã¯ãã£ã¹ããã
1866	;*/
1867	.extern _dispatch
1868	_dispatch:
1869	;/*
1870	;* ãã®ã«ã¼ãã³ã¯ï¼ã¿ã¹ã¯ã³ã³ããã¹ãã»OSå²è¾¼ã¿ç¦æ¢ç¶æ
1871	ã»ãã£ã¹ããã
1872	;* è¨±å¯ç¶æ
1873	ã»ï¼ã¢ãã«ä¸ã®ï¼å²è¾¼ã¿åªå
1874	åº¦ãã¹ã¯å
1875	¨è§£é¤ç¶æ
1876	ã§å¼ã³åºã
1877	;* ãã
1878	;*/
1879	$ifndef TOPPERS_USE_PUSHSP
1880	addi -48, sp, sp
1881	st.w ep, 0[sp]
1882	mov sp, ep
1883	sst.w r20, 44[ep]
1884	sst.w r21, 40[ep]
1885	sst.w r22, 36[ep]
1886	sst.w r23, 32[ep]
1887	sst.w r24, 28[ep]
1888	sst.w r25, 24[ep]
1889	sst.w r26, 20[ep]
1890	sst.w r27, 16[ep]
1891	sst.w r28, 12[ep]
1892	sst.w r29, 8[ep]
1893	sst.w r31, 4[ep]
1894	$else ;/* TOPPERS_USE_PUSHSP */
1895	pushsp r20-r31
1896	$endif ;/* TOPPERS_USE_PUSHSP */
1897	;/* ã¹ã¿ãã¯ã¨æ¬¡ã®èµ·åçªå°ãä¿å */
1898	Lea _p_runtsk, ep
1899	sld.w 0[ep], ep
1900	;/* =begin modified for SC3 */
1901	sst.w sp, TCB_ssp[ep]
1902	;/* =end modified for SC3 */
1903	Lea dispatch_r, r10
1904	sst.w r10, TCB_pc[ep]
1905	$ifdef CFG_USE_STACKMONITORING
1906	;/*
1907	;* å®è¡ä¸ã¿ã¹ã¯ã®ã¿ã¹ã¯ã¹ã¿ãã¯ã®ãªã¼ãããã¼ãã§ãã¯
1908	;*/
1909	;/*
1910	;* ã¹ã¿ãã¯ãã¤ã³ã¿ãã§ãã¯æ¹å¼
1911	;*/
1912	Lea _p_runtsk, r6 ;/* ç®¡çãããã¯ã®å
1913	é ã¢ãã¬ã¹åå¾ */
1914	ld.w 0[r6], r6
1915	ld.w TCB_p_tinib[r6], r6 ;/* ã¿ã¹ã¯åæåãããã¯å
1916	é ã¢ãã¬ã¹åå¾ */
1917	;/* =begin modified for SC3 */
1918	;/* ã·ã¹ãã ã¹ã¿ãã¯ã¢ãã¿ãªã³ã° */
1919	ld.w TINIB_sstksz[r6], r7 ;/* ã¿ã¹ã¯ã·ã¹ãã ã¹ã¿ãã¯ãµã¤ãºåå¾ */
1920	ld.w TINIB_sstk_bottom[r6], r6 ;/* ã¿ã¹ã¯ã·ã¹ãã ã¹ã¿ãã¯çµç«¯ã¢ãã¬ã¹åå¾ */
1921	sub r7, r6
1922	mov 1, r9
1923	cmp r6, sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ <= ã¹ã¿ãã¯ã®å
1924	é ã®å ´åNG */
1925	Lea dispatcher, lp
1926	;/* =end modified for SC3 */
1927	bnh stack_monitoring_error
1928	;/*
1929	;* ãã¸ãã¯ãã³ãã¼ãã§ãã¯æ¹å¼
1930	;*/
1931	ld.w 0[r6], r6
1932	mov STACK_MAGIC_NUMBER, r7
1933	cmp r7, r6
1934	;/* =begin modified for SC3 */
1935	Lea dispatcher, lp
1936	;/* =end modified for SC3 */
1937	bne stack_monitoring_error
1938	$endif ;/* CFG_USE_STACKMONITORING */
1939	br dispatcher
1940
1941	;/*
1942	;* ãã£ã¹ãããã£ã®å¾©å¸°ã«ã¼ãã³
1943	;*/
1944	dispatch_r:
1945	$ifndef TOPPERS_USE_PUSHSP
1946	mov sp, ep
1947	sld.w 44[ep], r20
1948	sld.w 40[ep], r21
1949	sld.w 36[ep], r22
1950	sld.w 32[ep], r23
1951	sld.w 28[ep], r24
1952	sld.w 24[ep], r25
1953	sld.w 20[ep], r26
1954	sld.w 16[ep], r27
1955	sld.w 12[ep], r28
1956	sld.w 8[ep], r29
1957	sld.w 4[ep], r31
1958	addi 48, ep, sp
1959	ld.w 0[sp], ep
1960	$else ;/* TOPPERS_USE_PUSHSP */
1961	popsp r20-r31
1962	$endif ;/* TOPPERS_USE_PUSHSP */
1963	jmp [lp]
1964
1965	;/*
1966	;* ã¹ã¿ãã¯ãªã¼ãããã¼æã®å¦ç
1967	;*/
1968	$ifdef CFG_USE_STACKMONITORING
1969	;/*
1970	;* ã¹ã¿ãã¯ãªã¼ãããã¼æãããã¯ã·ã§ã³ããã¯ãå¼ã³åºã
1971	;* ã¹ã¿ãã¯ãæ´ã«å£ããªãããï¼å²è¾¼ã¿ã¹ã¿ãã¯ã®åæå¤ãä½¿ç¨ãã
1972	;* r9 = ostkptã®åæå¤ã«åãæ¿ããã?
1973	;*/
1974	stack_monitoring_error:
1975	;/*
1976	;* r9==0ã®å ´åã§ãï¼æ¢ã«_ostkptãä½¿ã£ã¦ããã®ã§ï¼
1977	;* except_nest_cntãã¤ã³ã¯ãªã¡ã³ããã¦ãåé¡ã¯ãªã
1978	;*/
1979	Lea _except_nest_cnt, r12 ;/* _ostkptãä½¿ãå ´åã¯except_nest_cntãã¤ã³ã¯ãªã¡ã³ããã */
1980	ld.w 0[r12], r13
1981	add 1, r13
1982	st.w r13, 0[r12]
1983
1984	;/* =begin modified for SC3 */
1985	cmp r0, r9
1986	be stack_monitoring_error_1
1987	;/* =end modified for SC3 */
1988
1989	Lea __ostkpt, r12 ;/* ã¹ã¿ãã¯ãæ´ã«å£ããªãããï¼å²è¾¼ã¿ã¹ã¿ãã¯ã®åæå¤ãä½¿ç¨ãã */
1990	ld.w 0[r12], r12
1991	mov r12, sp
1992
1993	;/* =begin modified for SC3 */
1994	stack_monitoring_error_1:
1995	;/*
1996	;* ãããã¯ã·ã§ã³ããã¯ã¯OSå²è¾¼ã¿ç¦æ¢ç¶æ
1997	ã§å¼ã³åºã
1998	;*/
1999	NESTED_LOCK_OS_INT r12, r13
2000	;/* =end modified for SC3 */
2001
2002	mov E_OS_STACKFAULT, r6 ;/* ãããã¯ã·ã§ã³ããã¯ã®å¼æ°ãè¨å® */
2003	;/* =begin modified for SC3 */
2004	Lea _pre_protection_supervised, r12
2005	mov 0x01, r13
2006	st.b r13, 0[r12] ;/* pre_protection_supervised = 0x01 */
2007	jr _call_protectionhk_main ;/* ãããã¯ã·ã§ã³ããã¯ãå¼ã³åºã */
2008	;/* ããã«ã¯æ¥ãªã */
2009	stack_monitoring_error_loop:
2010	jr stack_monitoring_error_loop
2011	;/* =end modified for SC3 */
2012	$endif ;/* CFG_USE_STACKMONITORING */
2013
2014
2015	;/*
2016	;* ãã£ã¹ãããã£ã®åä½éå§
2017	;*/
2018	.extern _start_dispatch
2019	_start_dispatch:
2020	;/*
2021	;* ãã®ã«ã¼ãã³ã¯ï¼ã«ã¼ãã«èµ·åæã«ï¼ãã¹ã¦ã®å²è¾¼ã¿ãç¦æ¢ããç¶æ
2022
2023	;* ï¼å
2024	¨å²è¾¼ã¿ç¦æ¢ç¶æ
2025	ã¨åçï¼ã§å¼ã³åºãããï¼ã¾ãï¼å²è¾¼ã¿ã¢ã¼ãï¼é
2026	;* ã¿ã¹ã¯ã³ã³ããã¹ãã¨åçï¼ã§å¼ã³åºããããã¨ãæ³å®ãã¦ãã
2027	;*
2028	;* dispatcherã¯ï¼OSå²è¾¼ã¿ç¦æ¢ç¶æ
2029	ã§å¼ã³åºãï¼
2030	;*/
2031	;/* OSå²è¾¼ã¿ç¦æ¢ç¶æ
2032	*/
2033	OUTER_LOCK_OS_INT r12, r13
2034	;/* å
2035	¨å²è¾¼ã¿ç¦æ¢è§£é¤ç¶æ
2036	ã¸ */
2037	UNLOCK_ALL_INT
2038	br dispatcher_0
2039
2040	;/* =begin modified for SC3 */
2041	.extern _exit_and_dispatch_nohook
2042	;/*
2043	;* ã¿ã¹ã¯å¼·å¶çµäºã®å ´åã¯PostTaskHookãå¼åºããªã
2044	;* ãã®å ´åã®ã¨ã³ããªã§ãã
2045	;*/
2046	_exit_and_dispatch_nohook:
2047
2048	br dispatcher_0
2049	;/* =end modified for SC3 */
2050
2051	;/*
2052	;* ç¾å¨ã®ã³ã³ããã¹ããæ¨ã¦ã¦ãã£ã¹ããã
2053	;*/
2054	.extern _exit_and_dispatch
2055	_exit_and_dispatch:
2056	$ifdef CFG_USE_STACKMONITORING
2057	;/*
2058	;* å®è¡ä¸ã®ã¿ã¹ã¯ã¹ã¿ãã¯ã®ãªã¼ãããã¼ãã§ãã¯
2059	;*/
2060	;/*
2061	;* ã¹ã¿ãã¯ãã¤ã³ã¿ãã§ãã¯æ¹å¼
2062	;*/
2063	Lea _p_runtsk, r6 ;/* ç®¡çãããã¯ã®å
2064	é ã¢ãã¬ã¹åå¾ */
2065	ld.w 0[r6], r6
2066	ld.w TCB_p_tinib[r6], r6 ;/* ã¿ã¹ã¯åæåãããã¯å
2067	é ã¢ãã¬ã¹åå¾ */
2068	;/* =begin modified for SC3 */
2069	;/* ã·ã¹ãã ã¹ã¿ãã¯ã¢ãã¿ãªã³ã° */
2070	ld.w TINIB_sstksz[r6], r7 ;/* ã¿ã¹ã¯ã·ã¹ãã ã¹ã¿ãã¯ãµã¤ãºåå¾ */
2071	ld.w TINIB_sstk_bottom[r6], r6 ;/* ã¿ã¹ã¯ã·ã¹ãã ã¹ã¿ãã¯çµç«¯ã¢ãã¬ã¹åå¾ */
2072	sub r7, r6
2073	mov 1, r9
2074	cmp r6, sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ <= ã¹ã¿ãã¯ã®å
2075	é ã®å ´åNG */
2076	Lea dispatcher, lp
2077	;/* =end modified for SC3 */
2078	bnh stack_monitoring_error
2079	;/*
2080	;* ãã¸ãã¯ãã³ãã¼ãã§ãã¯æ¹å¼
2081	;*/
2082	ld.w 0[r6], r6
2083	mov STACK_MAGIC_NUMBER, r7
2084	cmp r7, r6
2085	;/* =begin modified for SC3 */
2086	Lea dispatcher, lp
2087	;/* =end modified for SC3 */
2088	bne stack_monitoring_error
2089	$endif ;/* CFG_USE_STACKMONITORING */
2090	;/* ãã£ã¹ãããã£æ¬ä½ï¼dispatcherï¼ã¸ */
2091
2092	dispatcher:
2093	;/*
2094	;* PostTaskHookã®å¼ã³åºã
2095	;*/
2096	$ifdef CFG_USE_POSTTASKHOOK
2097	posttaskhook_call:
2098	Lea _call_posttaskhook, r6
2099	jarl _stack_change_and_call_func_1, r31
2100	$endif ;/* CFG_USE_POSTTASKHOOK */
2101
2102	dispatcher_0:
2103	;/*
2104	;* ãã®ã«ã¼ãã³ã¯ï¼ã¿ã¹ã¯ã³ã³ããã¹ãã»OSå²è¾¼ã¿ç¦æ¢ç¶æ
2105	ã»ãã£ã¹ããã
2106	;* è¨±å¯ç¶æ
2107	ã»ï¼ã¢ãã«ä¸ã®ï¼å²è¾¼ã¿åªå
2108	åº¦ãã¹ã¯å
2109	¨è§£é¤ç¶æ
2110	ã§å¼ã³åºã
2111	;* ããï¼å®è¡åéçªå°ã¸ããã®ç¶æ
2112	ã®ã¾ã¾åå²ãã
2113	;*/
2114	$ifdef LOG_DSP_ENTER
2115	Lea _p_runtsk, r21
2116	ld.w 0[r21], r21
2117	cmp r0, r21
2118	be dispatcher_0_1
2119	mov r21, r6 ;/* å¼æ°ã«_p_runtskãæå® */
2120	jarl _log_dsp_enter, r31
2121	dispatcher_0_1:
2122	$endif ;/* LOG_DSP_ENTER */
2123
2124	Lea _callevel_stat, r21
2125	ld.h 0[r21], r22
2126	mov TSYS_DISALLINT, r20
2127	and r22, r20
2128	be dispatcher_1
2129
2130	mov !TSYS_DISALLINT, r20
2131	and r22, r20
2132	st.h r20, 0[r21]
2133	UNLOCK_ALL_INT ;/* å
2134	¨å²è¾¼ã¿ç¦æ¢è§£é¤ç¶æ
2135	ã¸ */
2136
2137	;/*
2138	;* ä¾å¤ï¼å²è¾¼ã¿/CPUä¾å¤ï¼ã®ãã¹ãåæ°ã¯start_dispatchãï¼dispatcher_3:
2139	;* ããæ¥ãå ´åã¯'1'ã¨ãªã£ã¦ããããï¼ã¿ã¹ã¯ã¹ã¿ãã¯ã«åãæãå¾ï¼
2140	;* '0'ã«åæåããï¼
2141	;*/
2142	dispatcher_1:
2143	Lea _p_runtsk, r21
2144	Lea _p_schedtsk, r20
2145	ld.w 0[r20], r22
2146	st.w r22, 0[r21]
2147	cmp r22, r0
2148	be dispatcher_3
2149
2150	mov r22, ep
2151	;/* =begin modified for SC3 */
2152	sld.w TCB_ssp[ep], sp
2153	;/* =end modified for SC3 */
2154	Lea _except_nest_cnt, r20
2155	st.w r0, 0[r20]
2156
2157	;/* =begin modified for SC3 */
2158	sld.w TCB_p_tinib[ep], ep
2159	mov ep, r25 ;/* r25 = p_tinib */
2160	sld.w TINIB_p_osapcb[ep], r26 ;/* r26 = p_osapcb */
2161	Lea _p_runosap, ep ;/* ep = &p_runosap */
2162	sst.w r26, 0[ep] ;/* p_runosap = p_osapcb */
2163	ld.w OSAPCB_p_osapinib[r26], r29 ;/* r29 = p_osapinib */
2164	ld.bu OSAPINIB_osap_trusted[r29], r24 ;/* r24 = trusted? */
2165	Lea _run_trusted, ep
2166	sst.b r24, 0[ep] ;/* run_trusted = trusted? */
2167	cmp r0, r24 ;/* ä¿¡é ¼ãªãã°ã¹ããã */
2168	bne dispatcher_5
2169
2170	$ifdef __v850e2v3__
2171	ori 0x1001, r0, r27
2172	ldsr r27, bsel
2173	;/*
2174	;* ã¦ã¼ã¶ã¹ã¿ãã¯é å
2175	;*/
2176	mov r25, ep
2177	sld.w TINIB_start_ustk[ep], r27 ;/* å
2178	é çªå° */
2179	ori 0x01, r27, r27
2180	sld.w TINIB_limit_ustk[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2181	ori 0x06, r28, r28
2182	ldsr r27, dpa0l
2183	ldsr r28, dpa0u
2184	$else ;/* defined(__v850e3v5__) */
2185	;/*
2186	;* ã¦ã¼ã¶ã¹ã¿ãã¯é å
2187	;*/
2188	mov r25, ep
2189	sld.w TINIB_start_ustk[ep], r27 ;/* å
2190	é çªå° */
2191	sld.w TINIB_limit_ustk[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2192	ldsr r27, 0, 6 ;/* MPLA0 */
2193	ldsr r28, 1, 6 ;/* MPUA0 */
2194
2195	$endif ;/* __v850e2v3__ */
2196
2197	;/*
2198	;* å®è¡ãã¡ã¤ã³ã¨ä¿è·ãã¡ã¤ã³(MPUã®è¨å®)ãåããªãã°ï¼
2199	;* ãã¡ã¤ã³æ¯ã®ã³ã¼ãé åã»ãã¼ã¿é åãMPUã«è¨å®ãç´ãå¿
2200	è¦ã¯ãªã
2201	;*/
2202	Lea _p_ctxosap, ep ;/* ep = &p_ctxosap */
2203	sld.w 0[ep], r27 ;/* r27 = p_ctxosap */
2204	cmp r27, r26 ;/* p_ctxosap == p_runosap ? */
2205	be dispatcher_5 ;/* åããªãdispatcher_5ã¸ */
2206	nop
2207	sst.w r26, 0[ep] ;/* p_ctxosap = p_runosap : ä¿è·ãã¡ã¤ã³ãåæ¿ã */
2208	$ifdef __v850e2v3__
2209	ldsr r26, vmtid ;/* ã¡ã¢ãªä¿è·éåã¿ã¹ã¯èå¥åãp_runosapã¨ãã */
2210	mov r29, ep ;/* ep = p_osapinib */
2211
2212	;/*
2213	;* èªä¿è·ãã¡ã¤ã³å°ç¨ã®romé å
2214	;*/
2215	sld.w OSAPINIB_start_text[ep], r27 ;/* å
2216	é çªå° */
2217	sld.w OSAPINIB_limit_text[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2218	ldsr r27, ipa0l
2219	ldsr r28, ipa0u
2220	;/*
2221	;* èªä¿è·ãã¡ã¤ã³å°ç¨ã®rosdataé å
2222	;*/
2223	sld.w OSAPINIB_start_rosdata[ep], r27 ;/* å
2224	é çªå° */
2225	sld.w OSAPINIB_limit_rosdata[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2226	ldsr r27, ipa1l
2227	ldsr r28, ipa1u
2228	;/*
2229	;* èªä¿è·ãã¡ã¤ã³å°ç¨ã®RWXé å
2230	;*/
2231	sld.w OSAPINIB_start_ram[ep], r27 ;/* å
2232	é çªå° */
2233	sld.w OSAPINIB_limit_ram[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2234	ldsr r27, dpa1l
2235	ldsr r28, dpa1u
2236	;/*
2237	;* èªä¿è·ãã¡ã¤ã³å°ç¨ã®RWXé å(sdata)
2238	;*/
2239	sld.w OSAPINIB_start_sram[ep], r27 ;/* å
2240	é çªå° */
2241	sld.w OSAPINIB_limit_sram[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2242	ldsr r27, dpa2l
2243	ldsr r28, dpa2u
2244	;/*
2245	;* å
2246	±æãªã¼ã/å°ç¨ã©ã¤ãé åã®å°ç¨é å
2247	;*/
2248	sld.w OSAPINIB_start_srpw[ep], r27 ;/* å
2249	é çªå° */
2250	sld.w OSAPINIB_limit_srpw[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2251	ldsr r27, dpa3l
2252	ldsr r28, dpa3u
2253	;/*
2254	;* å
2255	±æãªã¼ã/å°ç¨ã©ã¤ãé åã®å°ç¨é å(sdata)
2256	;*/
2257	sld.w OSAPINIB_start_ssrpw[ep], r27 ;/* å
2258	é çªå° */
2259	sld.w OSAPINIB_limit_ssrpw[ep], r28 ;/* ä¿è·å±æ§ã¨ãµã¤ãº */
2260	ldsr r27, dpa4l
2261	ldsr r28, dpa4u
2262
2263	$else ;/* defined(__v850e3v5__) */
2264	;/*
2265	;* reg1: p_osapinib
2266	;* reg2: tmp1
2267	;* reg3: tmp2
2268	;* reg4: tmp3
2269	;* reg5: tmp4
2270	;* reg6: tmp5
2271	;*/
2272	DISPATCHER_MPU_SETTING r29, r24, r25, r26, r27, r28
2273	$endif ;/* __v850e2v3__ */
2274
2275	dispatcher_5:
2276	$ifdef __v850e2v3__
2277	ldsr r0, bsel ;/* bselãæ»ã */
2278	$endif ;/* __v850e2v3__ */
2279	;/* =end modified for SC3 */
2280
2281	$ifdef LOG_DSP_LEAVE
2282	ld.w 0[r21], r6 ;/* å¼æ°ã«_p_runtskãæå® */
2283	jarl _log_dsp_leave, r31
2284	$endif ;/* LOG_DSP_LEAVE */
2285
2286	$ifdef CFG_USE_PRETASKHOOK
2287	pretaskhook_call:
2288	Lea _call_pretaskhook, r6
2289	jarl _stack_change_and_call_func_1, r31
2290	$endif ;/* CFG_USE_PRETASKHOOK */
2291
2292	dispatcher_2:
2293	Lea _p_runtsk, r20
2294	ld.w 0[r20], r22
2295	mov r22, ep
2296	sld.w TCB_pc[ep], r31
2297	jmp [r31]
2298
2299	dispatcher_3:
2300	;/*
2301	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
2302	ã®è§£é¤ã¨ï¼éã¿ã¹ã¯ã³ã³ããã¹ãå®è¡ç¶æ
2303	ã¸ã®
2304	;* æºåããã
2305	;*
2306	;* ããã§éã¿ã¹ã¯ã³ã³ããã¹ãã«åãæ¿ããï¼spï¼éã¿ã¹ã¯ã³ã³ããã¹
2307	;* ãç¨ã¹ã¿ãã¯ãã¤ã³ã¿ï¼except_nest_cntï¼1)ã®ã¯ï¼OSå²è¾¼ã¿ç¦æ¢è§£
2308	;* é¤å¾ã«çºçããå²è¾¼ã¿å¦çã«ã©ã®ã¹ã¿ãã¯ãä½¿ããã¨ããåé¡ã®è§£æ±º
2309	;* ã¨ï¼å²è¾¼ã¿ãã³ãã©å
2310	ã§ã®ã¿ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ãã2ã¤ã®æ
2311	;* å³ããã
2312	;*/
2313	Lea __ostkpt, r20 ;/* éã¿ã¹ã¯ã³ã³ããã¹ãç¨ã®ã¹ã¿ãã¯ã®èªã¿è¾¼ã¿ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
2314	¥ãæ¿ã */
2315	ld.w 0[r20], r3
2316
2317	Lea _except_nest_cnt, r20
2318	mov 1, r21
2319	st.w r21, 0[r20]
2320
2321	;/*
2322	;* OSå²è¾¼ã¿ç¦æ¢è§£é¤ç¶æ
2323	ã¸
2324	;* å²è¾¼ã¿ãè¨±å¯ãï¼éã¿ã¹ã¯ã³ã³ããã¹ãå®è¡ç¶æ
2325	ã¨ãå²è¾¼ã¿ãå¾
2326	ã¤
2327	;*
2328	;* ããã»ããµãå²è¾¼ã¿å¾
2329	ã¡ã«ç§»è¡ãããå¦çã¨ï¼å²è¾¼ã¿è¨±å¯ã¨ã¯ï¼ä¸å¯
2330	;* åã«è¡ãªãå¿
2331	è¦ããã
2332	;* ãããä¸å¯åã«è¡ãªããªãå ´åï¼å²è¾¼ã¿ãè¨±å¯ããç´å¾ã«å²è¾¼
2333	;* ã¿ãå
2334	¥ãï¼ãã®ä¸ã§ã¿ã¹ã¯ãå®è¡å¯è½ç¶æ
2335	ã«ãªãã¨ï¼å®è¡ãã¹ãã¿ã¹
2336	;* ã¯ãããã«ããããããããã»ããµãå²è¾¼ã¿å¾
2337	ã¡ã«ãªã£ã¦ãã¾ãï¼
2338	;* ä¸å¯åã«è¡ãããï¼diã«ããã³ã¢ã§ã®å²ãè¾¼ã¿ãç¦æ¢ããç¶æ
2339	ã§ï¼
2340	;* INTCã®å²ãè¾¼ã¿åªå
2341	åº¦ãã¹ã¯ãä¸ãã¦ããhaltãå¼ã³åºãï¼
2342	;* å²ãè¾¼ã¿ãçºçããå ´åã¯ï¼haltããå¾©å¸°ãã¦æ¬¡ã®eiã§ãã¯ã¿ã«
2343	;* ã¸ã£ã³ãããï¼
2344	;*
2345	;* å²è¾¼ã¿å¾
2346	ã¡ã®éã¯ï¼p_runtskãNULLï¼ï¼0ï¼ã«è¨å®ããªããã°ãªããªã
2347	;* ãã®ããã«è¨å®ããªãã¨ï¼å²è¾¼ã¿ãã³ãã©ããGetTaskIDãå¼ã³åº
2348	;* ããéã®åä½ãä»æ§ã«åè´ããªããªã
2349	;*/
2350
2351	di
2352	OUTER_UNLOCK_OS_INT r12, r13
2353
2354	#if 0
2355	nop
2356	nop
2357	nop
2358	nop
2359	$else
2360	halt
2361	$endif
2362	ei
2363
2364	;/*
2365	;* OSå²è¾¼ã¿ç¦æ¢ç¶æ
2366	ã¸
2367	;* (ã¢ãã«ä¸ã®)å²è¾¼ã¿åªå
2368	åº¦ãã¹ã¯ã¯0ã§ããããï¼ISR1ä»¥å¤ã®å²è¾¼ã¿ã¯å
2369	¨ã¦ç¦æ¢ãã
2370	;* ã¹ã¿ãã¯ã¯éã¿ã¹ã¯ã³ã³ããã¹ãã®ã¹ã¿ãã¯ãä½¿ç¨ãã¦ããããï¼_except_nest_cntã¯ï¼
2371	;* '1'ã®ã¾ã¾ã¨ãã
2372	;*/
2373	OUTER_LOCK_OS_INT r12, r13
2374	br dispatcher_1
2375
2376
2377	;/*
2378	;* ã¿ã¹ã¯éå§æå¦ç
2379	;*
2380	;* dispatcherããå¼ã³åºããã
2381	;*/
2382	;/* =begin modified for SC3 */
2383	.extern _start_stask_r
2384	_start_stask_r:
2385	Lea _p_runtsk, ep ;/* ep = p_runtsk */
2386	sld.w 0[ep], ep
2387	;/*
2388	;* ã¿ã¹ã¯ãä¸æ£çµäºããå ´åã¯ä¿è·å¦çãè¡ããã
2389	;* æ»ãã¢ãã¬ã¹ã«exit_taskãè¨å®
2390	;*/
2391	Lea __kernel_exit_task, r31
2392	mov r0, r6
2393	br _start_r
2394
2395	.extern _start_utask_r
2396	_start_utask_r:
2397	$ifndef __v850e3v5__
2398	ldsr r0, bsel
2399	$endif
2400	Lea _p_runtsk, ep ;/* ep = p_runtsk */
2401	sld.w 0[ep], ep
2402	clr1 0, TCB_priv_mode[ep] ;/* ç¹æ¨©ã¢ã¼ãå®è¡ãæãã */
2403	sld.w TCB_p_tinib[ep], r20 ;/* ep = p_runtsk->p_tinib */
2404	ld.w TINIB_ustk_bottom[r20], r20 ;/* r20 = ã¦ã¼ã¶ã¹ã¿ãã¯ãã¤ã³ã¿ã®åæå¤ */
2405	mov r20, sp
2406	;/*
2407	;* ã¿ã¹ã¯ãä¸æ£çµäºããå ´åã¯ä¿è·å¦çãè¡ããã
2408	;* æ»ãã¢ãã¬ã¹ã«exit_utaskãè¨å®
2409	;*/
2410	Lea _exit_utask, lp ;/* lp = _exit_utask */
2411	stsr psw, r10
2412
2413	;/*
2414	;* å
2415	¨å²è¾¼ã¿ç¦æ¢ç¶æ
2416	ã¸
2417	;* ã¿ã¹ã¯ã³ã³ããã¹ãã¸ã®ã¸ã£ã³ãã§è§£é¤ããã
2418	;*/
2419	di
2420
2421	;/*
2422	;* éç¹æ¨©ã¢ã¼ãã§åä½ããããæºå
2423	;* ä¿è·æ©è½æå¹ï¼éä¿¡é ¼ã¸ï¼ï¼å²è¾¼ã¿è¨±å¯
2424	;* PP,NPV,DMP,IMP = 1, ID = 0
2425	;*/
2426	$ifdef __v850e2v3__
2427	movhi 0x000f, r0, r7
2428	$else ;/* defined(__v850e3v5__) */
2429	movhi 0x4000, r0, r7
2430	$endif ;/* __v850e2v3__ */
2431	or r7, r10 ;/* psw \|= (PP\|NPV\|DMP\|IMP) */
2432	ldsr r10, eipsw ;/* eipsw = psw */
2433	mov 1, r6
2434
2435	.extern _start_r
2436	_start_r:
2437	ld.w TCB_p_tinib[ep], r22
2438	$ifdef CFG_USE_STACKMONITORING
2439	;/*
2440	;* SC3ã§ã¯ã¿ã¹ã¯å¼·å¶çµäºãããã®ã§ï¼ã¿ã¹ã¯èµ·åæ¯ã«ãã¸ãã¯ãã³ãã¼
2441	;* ãåæåãã
2442	;*/
2443	ld.w TINIB_sstk_bottom[r22], r21
2444	ld.w TINIB_sstksz[r22], r10
2445	sub r10, r21
2446	mov STACK_MAGIC_NUMBER, r10
2447	st.w r10, 0[r21]
2448	$endif ;/* CFG_USE_STACKMONITORING */
2449
2450	;/*
2451	;* OSå²è¾¼ã¿ç¦æ¢è§£é¤åã«ç¾å¨åªå
2452	åº¦(TCB.curpri)ãå®è¡åªå
2453	åº¦(TINIB.exepri)ã«
2454	;* å¤æ´(å
2455	é¨ãªã½ã¼ã¹ãç²å¾)
2456	;*/
2457	ld.b TINIB_exepri[r22], r21 ;/* TINIB.exepri -> TCB.curpri */
2458	st.b r21, TCB_curpri[ep]
2459
2460	;/*
2461	;* OSå²è¾¼ã¿ç¦æ¢è§£é¤ç¶æ
2462	ã¸
2463	;* (ã¢ãã«ä¸ã®)å²è¾¼ã¿åªå
2464	åº¦ãã¹ã¯ã¯0ã§ããããï¼æå¹ãªå²è¾¼ã¿ã¯å
2465	¨ã¦è¨±å¯ãã
2466	;*/
2467
2468	OUTER_UNLOCK_OS_INT r12, r13
2469
2470	ld.w TCB_p_tinib[ep], r22
2471	ld.w TINIB_task[r22], r10
2472	cmp r0, r6
2473	bne _start_r_1 ;/* r6 != 0 ãªãã° _start_r_1 ã¸*/
2474	jmp [r10]
2475
2476	_start_r_1:
2477	ldsr r10, eipc ;/* EIPC = pc */
2478	eiret
2479	;/* =end modified for SC3 */
2480
2481	;/*
2482	;* ext_tskãsvcå½ä»¤ã§å¼ã³åºã
2483	;*/
2484	.cseg text_shared
2485	.align 4
2486	.public _exit_utask
2487	_exit_utask:
2488	mov TFN_EXIT_TASK, r11
2489	syscall NO_SVC
2490	nop
2491
2492	.cseg text_kernel
2493	.extern _stack_change_and_call_func_1
2494	.extern _stack_change_and_call_func_2
2495	_stack_change_and_call_func_1:
2496	_stack_change_and_call_func_2:
2497
2498	Lea _except_nest_cnt, r12
2499	ld.w 0[r12], r13
2500	add 1, r13
2501	st.w r13, 0[r12]
2502	cmp 1, r13
2503	bne _stack_change_and_call_func_1_1
2504
2505	;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿åã¨å
2506	¥ãæ¿ã */
2507	Lea __ostkpt, r12
2508	ld.w 0[r12], r12
2509	add -4, r12
2510	st.w sp, 0[r12] ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
2511	mov r12, sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®åãæ¿ã */
2512
2513
2514	_stack_change_and_call_func_1_1:
2515	push lp
2516	Lea stack_change_and_call_func_r, lp ;/* æ»ãã¢ãã¬ã¹ */
2517	mov r6, r12
2518	mov r7, r6
2519	mov r8, r7
2520	jmp [r12]
2521
2522	stack_change_and_call_func_r:
2523	pop lp
2524	Lea _except_nest_cnt, r12
2525	ld.w 0[r12], r13
2526	add -1, r13
2527	st.w r13, 0[r12]
2528	cmp r0, r13
2529	bne stack_change_and_call_func_r_1
2530
2531	ld.w 0[sp], sp ;/* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å¾©å¸° */
2532	stack_change_and_call_func_r_1:
2533	jmp [lp]
2534
2535
2536	$ifdef ENABLE_RETURN_MAIN
2537	;/*
2538	;* AKTSPç¨ã®main()ã¸ã®ãªã¿ã¼ã³ã³ã¼ã
2539	;*/
2540	.extern _return_main
2541	_return_main:
2542	Lea __ostkpt, sp
2543	ld.w 0[sp],sp
2544	jarl _main, r31
2545	$endif ;/* ENABLE_RETURN_MAIN */
2546
2547	;/* =begin modified for SC3 */
2548	;/*
2549	;* SYSCALLãã¼ãã«
2550	;* syscallå½ä»¤ã¯ãscbp + scbp[x] ã®çªå°ã«ã¸ã£ã³ããã
2551	;*/
2552	.public _syscall_table
2553	.cseg text_kernel
2554	.align 4
2555	_syscall_table:
2556	.dw (_syscall_error_handler - _syscall_table)
2557	.dw (_svc_entry - _syscall_table)
2558
2559	.public _syscall_error_handler
2560	.public _svc_entry
2561	;/*
2562	;* SYSCALLã¨ã©ã¼ãã³ãã©
2563	;*/
2564	_syscall_error_handler:
2565	br _syscall_error_handler
2566	nop
2567
2568	;/*
2569	;* ãµã¼ãã¹ã³ã¼ã«ã®åºå
2570	¥å£
2571	;* PP,NPV,DMP,IMP = 0, ID,EP = 1
2572	;* eipc = pc, eipsw = psw : eiããåã«ä¿å
2573	;* r10 : è¿ãå¤
2574	;* r11ï¼é¢æ°ã³ã¼ã
2575	;* r6 - r9 : å¼æ°ï¼4ã¤ã¾ã§ï¼
2576	;* r20 : ç¬¬5å¼æ°
2577	;* ã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿åæ¸ã¿
2578	;* lpä¿åæ¸ã¿
2579	;*/
2580	_svc_entry:
2581	;/*
2582	;* å¼åºãå
2583	ãç¹æ¨©ã¢ã¼ããï¼
2584	;* eipswããã§ãã¯ãã
2585	;*/
2586	$ifndef __v850e3v5__
2587	ldsr r0, bsel
2588	$endif
2589	stsr eipsw, r13
2590	shl PSW_SV, r13 ;/* r13 << PSW_SV ã«ããä¾å¤çºçæã®ã¢ã¼ãåå¾ */
2591	bnc svc_entry_2 ;/* ç¹æ¨©ã¢ã¼ãããã®å¼åºããªãã°ã¹ããã */
2592
2593	;/*
2594	;* ã¿ã¹ã¯ã³ã³ããã¹ãããã®å¼åºãã®å ´å
2595	;*/
2596	;/*
2597	;* ã¦ã¼ã¶ã¹ã¿ãã¯ã¨ã·ã¹ãã ã¹ã¿ãã¯ãå
2598	¥ãæ¿ãã
2599	;* ã¿ã¹ã¯ã®ç¶æ
2600	ãç¹æ¨©ã¢ã¼ãå®è¡ä¸ã«ç§»è¡ãã
2601	;* æ»ãå
2602	ãéç¹æ¨©ã¢ã¼ãã§éä¿¡é ¼ããã¯å®è¡ä¸ã§ãªããã°ï¼
2603	;* ã¿ã¹ã¯å®è¡ä¸ã§ããã¯ããªã®ã§ï¼p_runtskãNULLãã©ããã®
2604	;* ãã§ãã¯ã¯å¿
2605	è¦ãªãã¯ã
2606	;*/
2607	Lea _p_runtsk, ep
2608	sld.w 0[ep], ep
2609	set1 0, TCB_priv_mode[ep] ;/* p_runtsk->priv_mode \|= 0x01 */
2610	sst.w sp, TCB_usp[ep] ;/* uspãä¿å */
2611	sld.w TCB_p_tinib[ep], ep
2612	sld.w TINIB_sstk_bottom[ep], sp ;/* sspãå¾©å¸° */
2613
2614	svc_entry_2:
2615	;/*
2616	;* eipcã¨eipswï¼syscallå¼åºãå
2617	ã®pcã¨pswï¼ãä¿åãã¦
2618	;* å²è¾¼ã¿ãããªã¿ã¼ã³
2619	;* +--------------+ <- new sp
2620	;* \| eipsw \|
2621	;* +--------------+
2622	;* \| eipc \|
2623	;* +--------------+ <- old sp
2624	;*/
2625	addi -8, sp, sp
2626	mov sp, ep
2627	stsr eipc, r12
2628	sst.w r12, 4[ep]
2629	stsr eipsw, r12
2630	sst.w r12, 0[ep]
2631	;/*
2632	;* eipswã®ä¿è·é¢é£ãããã0ã«ãã
2633	;*/
2634	$ifdef __v850e2v3__
2635	movhi 0x000f, r0, r13
2636	$else ;/* defined(__v850e3v5__) */
2637	movhi 0x4000, r0, r13
2638	$endif ;/* __v850e2v3__ */
2639	not r13, r13
2640	and r13, r12
2641	ldsr r12, eipsw ;/* PP,NPV,DMP,IMP = 0 */
2642	Lea svc_entry_3, r12
2643	ldsr r12, eipc
2644	eiret
2645
2646	svc_entry_3:
2647	;/*
2648	;* æ©è½ã³ã¼ãã®ãã§ãã¯
2649	;*/
2650	mov TMAX_SVCID, r12
2651	cmp r12, r11 ;/* æ©è½ã³ã¼ãã®ä¸éãã§ãã¯(TMAX_SVCID < r11) */
2652	bgt svc_entry_error ;/* ä¸éããªã¼ããã¦ãããªãã°ã¨ã©ã¼ */
2653
2654	;/*
2655	;* ãµã¼ãã¹ã³ã¼ã«ã®ãã¼ãã«ãå¼ãï¼
2656	;* ãµã¼ãã¹ã³ã¼ã«ã®æ¬ä½ãå¼ã¶
2657	;*/
2658	Lea _svc_table, r12
2659	shl 2, r11 ;/* r11 = 4 /
2660	add r11, r12 ;/* r12 = &svc_table[r11] */
2661	ld.w 0[r12], r12 ;/* ãã¼ãã«ãå¼ã */
2662	Lea svc_entry_r, lp ;/* æ»ãçªå°ãè¨å® */
2663	jmp [r12] ;/* ãµã¼ãã¹ã³ã¼ã«å¦çã«ã¼ãã³ãå¼ã¶ */
2664	nop
2665
2666	svc_entry_error:
2667	jarl _no_support_service, lp ;/* no_support_service ãå¼ã¶ */
2668
2669	svc_entry_r:
2670	;/*
2671	;* ãã®æç¹ã§ã®pswãr11ã«ä¿åãã
2672	;* å
2673	¨å²è¾¼ã¿ç¦æ¢ã§æ´æ°ããæã¸ã®å¯¾å¿
2674	;*/
2675	stsr psw, r11
2676
2677	;/*
2678	;* å
2679	¨å²è¾¼ã¿ç¦æ¢ãã¤EPç¶æ
2680	ã¸
2681	;* ããã§EPç¶æ
2682	ã¨ããã®ã¯ï¼ISRããã·ã¹ãã ãµã¼ãã¹ãå¼ã°ãã
2683	;* å ´åã«ï¼eiretã«ãã£ã¦ISPRãæ´æ°ãããã®ãé²ãããã§ãã
2684	;*/
2685	ori 0x60, r11, r12 ;/* psw \|= EP\|ID */
2686	ldsr r12, psw
2687
2688	;/*
2689	;* eipcã¨eipswï¼syscallå¼åºãå
2690	ã®pcã¨pswï¼ãå¾©å¸°
2691	;* ããã§ã¯ï¼å²è¾¼ã¿å¦çä¸ã§ãªãï¼ãµã¼ãã¹ã³ã¼ã«å¼åºãåã«
2692	;* eiretãçºè¡ãã¦ããï¼ãï¼eiretãå©ç¨ãã¦ãªã¿ã¼ã³ãã
2693	;* +--------------+ <- old sp
2694	;* \| eipc \|
2695	;* +--------------+
2696	;* \| eipsw \|
2697	;* +--------------+ <- new sp
2698	;*/
2699	mov sp, ep
2700	sld.w 4[ep], r15
2701	sld.w 0[ep], r16
2702	addi 8, sp, sp
2703
2704	;/*
2705	;* ã¹ã¿ãã¯ãæ»ãããã§ãã¯
2706	;*/
2707	;/*
2708	;* å¼åºãå
2709	ãç¹æ¨©ã¢ã¼ããï¼
2710	;* eipswããã§ãã¯ãã
2711	;*/
2712	$ifdef __v850e2v3__
2713	ldsr r0, bsel
2714	movhi 0x000f, r0, r12
2715	$else ;/* defined(__v850e3v5__) */
2716	movhi 0x4000, r0, r12
2717	$endif ;/* __v850e2v3__ */
2718	tst r16, r12
2719	be svc_prv_r ;/* ç¹æ¨©ã¢ã¼ãããã®å¼åºããªãã°ã¹ããã */
2720
2721	Lea _p_runtsk, ep
2722	sld.w 0[ep], ep
2723	tst1 0, TCB_priv_mode[ep] ;/* uspãä¿åãããï¼ */
2724	be svc_prv_r ;/* uspãä¿åãã¦ããªããªãã°ã¹ããã */
2725
2726	svc_usr_r:
2727	;/*
2728	;* ç¹æ¨©ã¢ã¼ãå®è¡ãæãã
2729	;* sstkã¨ustkãå
2730	¥ãæ¿ãã
2731	;* æ»ãå
2732	ãã¿ã¹ã¯ã³ã³ããã¹ããªãã°ï¼ã¿ã¹ã¯å®è¡ä¸ã§ããã¯ã
2733	;* ãªã®ã§ï¼p_runtskãNULLãã©ããã®ãã§ãã¯ã¯å¿
2734	è¦ãªãã¯ã
2735	;*/
2736	clr1 0, TCB_priv_mode[ep] ;/* p_runtsk->priv_mode &= !0x01 */
2737	sld.w TCB_usp[ep], sp ;/* uspãå¾©å¸° */
2738
2739	svc_prv_r:
2740	;/*
2741	;* ã·ã¹ãã ãµã¼ãã¹ã§ã»ãããããå²è¾¼ã¿åªå
2742	åº¦ãã¹ã¯ãåæ ãã
2743	;*/
2744	mov 0x20, r12
2745	and r12, r11 ;/* PSW.IDä»¥å¤ã0ã« */
2746	not r12, r12 ;/* r12 = !0x20 */
2747	and r12, r16 ;/* eipsw &= !0x20 */
2748	or r11, r16 ;/* eipsw \|= r11 */
2749	ldsr r16, eipsw
2750	ldsr r15, eipc
2751	eiret ;/* å¼åºãå
2752	ã¸ãªã¿ã¼ã³ */
2753	nop
2754
2755	;/*
2756	;* ã¹ã¿ãã¯ãã§ãã¯é¢æ°
2757	;* å
2758	¥å r6 ä½¿ç¨ããã¹ã¿ãã¯é
2759	;* ä½¿ç¨ããã¹ã¿ãã¯éãæ®ã£ã¦ããªãå ´åã¯ã¨ã©ã¼
2760	;*/
2761	.extern _trustedfunc_stack_check
2762	_trustedfunc_stack_check:
2763	Lea _callevel_stat, ep
2764	sld.h 0[ep], r10
2765	addi TCL_ISR2, r0, r11
2766	tst r11, r10
2767	be trustedfunc_stack_check_1 ;/* TCL_TASKã®å ´åã¯ã¹ããã */
2768
2769	;/*
2770	;* _ostkãä½¿ç¨ä¸
2771	;*/
2772	Lea __ostk, ep
2773	sld.w 0[ep], r11
2774	br trustedfunc_stack_check_2
2775
2776	trustedfunc_stack_check_1:
2777	;/*
2778	;* ã¿ã¹ã¯ã®ã·ã¹ãã ã¹ã¿ãã¯ãä½¿ç¨ä¸
2779	;*/
2780	Lea _p_runtsk, ep
2781	sld.w 0[ep], ep
2782	sld.w TCB_p_tinib[ep], ep
2783	sld.w TINIB_sstk_bottom[ep], r11
2784	sld.w TINIB_sstksz[ep], r12
2785	sub r12, r11
2786	trustedfunc_stack_check_2:
2787	;/*
2788	;* ã¹ã¿ãã¯ã®æ®éããã§ãã¯
2789	;* r11 = ã¹ã¿ãã¯ã®å
2790	é
2791	;*/
2792	subr sp, r6 ;/* r6 = ssp - tf_stksz */
2793	bl trustedfunc_stack_check_3 ;/* ssp < tfstksz ãªãã°ã¨ã©ã¼å¦çã¸ */
2794	cmp r11, r6 ;/* r11 < r6 ï¼ */
2795	bnh trustedfunc_stack_check_3 ;/* ããã§ãªããã°ã¨ã©ã¼å¦çã¸ */
2796	addi E_OK, r0, r10
2797	jmp [lp]
2798
2799	trustedfunc_stack_check_3:
2800	addi E_OS_STACKINSUFFICIENT, r0, r10
2801	jmp [lp]
2802
2803	;/* =end modified for SC3 */
2804

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

Context Navigation

source: atk2-sc3-1.4.0-ntisr/arch/v850_gcc/prc_support.asm@ 172

Download in other formats: