Context Navigation

prc_support.asm

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

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

Context Navigation

source: atk2-sc3-1.4.0-ntisr/arch/v850_ccrh/prc_support.asm

Download in other formats: