Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: ssp_qb_r5f100le_cs/trunk/arch/rl78_ca78k0r/prc_support.asm@ 93

Last change on this file since 93 was 93, checked in by nmir-saito, 9 years ago
add Combined package of SSP kernel for QB-R5F100LE-TB(RL78 processor)
File size: 8.5 KB

Line
1	;
2	; TOPPERS/SSP Kernel
3	; Smallest Set Profile Kernel
4	;
5	; Copyright (C) 2014 by Naoki Saito
6	; Nagoya Municipal Industrial Research Institute, JAPAN
7	;
8	; ãLì ÒÍCÈºÌ (1)`(4) Ìðð½·êÉÀèC{\tgEF
9	; Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»EüÏE
10	; ÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
11	; (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
12	; \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[X
13	; R[hÉÜÜêÄ¢é±ÆD
14	; (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉgp
15	; Å«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
16	gipÒ}
17	; j
18	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºLÌ³Û
19	; ØKèðfÚ·é±ÆD
20	; (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉgp
21	; Å«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±ÆD
22	; (a) ÄzzÉº¤hL
23	gipÒ}j
24	AÈÇjÉCãLÌì
25	; \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
26	; (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉñ
27	; ·é±ÆD
28	; (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹Q
29	; ©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆDÜ½C
30	; {\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©ÈéRÉîÃ
31	; ¿©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
32	;
33	; {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨æ
34	; ÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚIÉÎ·
35	; éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEFAÌp
36	; Éæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»ÌÓCð
37	; íÈ¢D
38	;
39	;
40
41	;
42	; J[lÀÌvZbTË¶ª
43	;
44
45	;
46	; }Nè`ÌCN[h
47	;
48	$INCLUDE(prc_support_def.inc)
49
50	;
51	; O[oV{
52	;
53	; RpCªgp·é saddrÌæÌWX^
54	extrn _@RTARG0,_@RTARG2,_@RTARG4,_@RTARG6,_@SEGAX,_@SEGDE
55	extrn _@NRARG0,_@NRARG1,_@NRARG2,_@NRARG3
56	extrn _@NRAT00,_@NRAT02,_@NRAT04,_@NRAT06
57	; kernel_cfg.c
58	extrn __kernel_istkpt ; X^bN\|C^Ìúl
59	; prc_config.c
60	extrn _t_lock_cpu ; CPUbNóÔÖÌÚs
61	extrn __kernel_intnest ; ÝÌlXgJE^
62	extrn __kernel_lock_flag ; CPUbNtO
63	; task.c
64	extrn __kernel_dispatcher ; fBXpb`
65	extrn __kernel_reqflg ; fBXpb`vtO
66	extrn __kernel_disdsp ; fBXpb`Ö~óÔ
67	extrn __kernel_search_schedtsk ; ÅDæxÌT[`
68	extrn __kernel_run_task ; ^XNÌJn
69	; startup.c
70	extrn __kernel_exit_kernel ; J[lÌI¹
71
72	; prc_support.asm
73	public __kernel_start_dispatch ; fBXpb`ÌJn
74	public __kernel_call_exit_kernel ; I¹ÌR[
75	public __kernel_interrupt_entry ; ÝÌüû(¤Ê)
76	public __kernel_int_return ; WX^ðAµÄÝ¶³Ö^[
77	public _unused_interrupt ; ¢gpÝÌ
78
79	;
80	; RpCÅgp·ésaddrÌæÌWX^ðÛ¶
81	;
82	restore_saddr_regs macro
83	$if (ALLOC_REGVAR_TO_SADDR) ; -qr IvVðgp·éê
84	pop ax ; WX^A
85	movw _@NRAT06, ax ;
86	pop ax ;
87	movw _@NRAT04, ax ;
88	pop ax ;
89	movw _@NRAT02, ax ;
90	pop ax ;
91	movw _@NRAT00, ax ;
92	pop ax ;
93	movw _@NRARG3, ax ;
94	pop ax ;
95	movw _@NRARG2, ax ;
96	pop ax ;
97	movw _@NRARG1, ax ;
98	pop ax ;
99	movw _@NRARG0, ax ;
100	$endif
101	pop ax ; WX^A
102	movw _@SEGDE, ax ;
103	pop ax ;
104	movw _@SEGAX, ax ;
105	pop ax ;
106	movw _@RTARG6, ax ;
107	pop ax ;
108	movw _@RTARG4, ax ;
109	pop ax ;
110	movw _@RTARG2, ax ;
111	pop ax ;
112	movw _@RTARG0, ax ;
113	endm
114
115	;
116	; X^bN\|C^ðú»
117	;
118	reset_sp macro
119	movw de, #__kernel_istkpt
120	mov es, #00H
121	movw ax, es:[de]
122	movw sp, ax
123	endm
124
125	;
126	; PSW Ì ISP1 = 1, ISP0 = 1 ÉµÄÝÌ}XNðð·é
127	;
128	clear_pswisp_mask macro
129	mov a, psw
130	and a, #0f9h
131	or a, #06h ; PSW.ISP{1,0}=(1,1)
132	mov psw, a
133	endm
134
135	@@CODE CSEG BASE
136
137	;
138	; J[lÌ®ìJnÉKvÆ³êéãnðs¤½ßÌÖ
139	; sta_ker(startup.c) ©çÄÑo³êéD
140	;
141	__kernel_start_dispatch:
142	;
143	; CPUbNóÔÆSÝbNóÔÆðæÊ·éKvª éêC
144	; CPUbNóÔÉµCSÝbNÌóÔðð·éD
145	;
146	call !!_t_lock_cpu
147	$_IF (TMIN_INTPRI_EQU_MINUS4)
148	clear_pswisp_mask
149	$ELSE
150	ei
151	$ENDIF
152	;
153	; X^bN\|C^ðú»·é
154	; sta_ker ©ç start_dispatch ÌÖR[ÉæéX^bNÁïªð
155	; NA·é½ßCX^bN\|C^ðú»·éD
156	;
157	reset_sp
158
159	;
160	; dispatcher (task.c) ÖWv·é
161	; ÖR[ÉµÈ¢ÌÍX^bNðßñ·é½ßD
162	;
163	; dispatcher (kernel/task.c) ÌÄÑoµ
164	br !!__kernel_dispatcher
165
166
167	;
168	; I¹ÌÄÑoµ
169	; X^bN\|C^ðú»µCexit_kernel ðÄÑo·D
170	;
171	__kernel_call_exit_kernel:
172	reset_sp
173	br __kernel_exit_kernel
174
175
176	@@BASE CSEG BASE
177
178	;
179	; Ý/CPUáOÌoüû(¤Ê)
180	; J[lÇÌÝÜ½ÍCPUáOÌêÉWX^Û¶ãCÄÑo³êéD
181	;
182	; Oñð
183	; EPSWWX^ÌIErbg=0, ISPÍót¯½ÝÌISP.
184	; EnhÌAhXª bc Éi[³êÄ¢é.
185	; ECPUáOnhÌüû©ç½êCX^bN\|C^Ì
186	; æªÔn(p_excinf)ª ax Éi[³êÄ¨èC
187	; ±êÍCPUáOnhÌø(p_excinf)ÆµÄ»ÌÜÜn³êéD
188	;
189	; WX^ªX^bNãÉÇÌæ¤ÉÛ¶³êÄ¢é©ðÈºÉ¦·.
190	; }ÍÀÑÌÝð\»µ½àÌÅ èCTCYðl¶µÄ¢È¢±ÆÉÓ·éD
191	; ³mÉÍf[^V[gðQÆÌ±ÆD
192	; ±Ì}ÅÍãªáÊ, ºªÊÌAhXÅ, X^bNÍ}Ìº¤©ç
193	; ãûüÉü©ÁÄÏÝã°çêéàÌÆ·é.
194	;
195	; ¦1 saddrÌæÌ[NGAÍRpCIvV -qr ðwè·éêÉ
196	; Û¶ªKvÅ èCÊíÍÛ¶µÈ¢DÛ¶·éêÍAZuIvV
197	; ÉÄuALLOC_REGVAR_TO_SADDRvðè`·é±ÆD
198	;
199	; ¦2 CPUáOÌüûðoRµ½êÌÝÛ¶³êé
200	;
201	;
202	; ---------------<-- p_excinf(¦)
203	; \| saddrÌæ \|
204	; \|[NpGA\|
205	; \| (16byte)¦1 \|
206	; ---------------<-- p_excinf
207	; \| saddrÌæ \|
208	; \|ZOgîñ\|
209	; \| i[pGA \|
210	; \| (4byte) \|
211	; ---------------
212	; \| saddrÌæ \|
213	; \| ^C \|
214	; \| øGA \|
215	; \| (8byte) \|
216	; ---------------
217	; \| ES,CS(2byte) \|
218	; ---------------
219	; \| HL(2byte) \|
220	; ---------------
221	; \| DE(2byte) \|
222	; ---------------
223	; \| BC(2byte) \|
224	; ---------------
225	; \| AX(2byte) \|
226	; ---------------
227	; \| PC(2byte) \|
228	; ---------------
229	; \| PSW(1byte) \|
230	; ---------------
231	;
232	; nh©ç^[µ½ãÍ, ½dÝÅÈ, ©ÂC
233	; reqflg ª TRUEC©ÂCdisdsp ª FALSE ÌÉCinterrupt_dispatch Öªò·éD
234	;
235	; ½dÝ©Ç¤©ÍÝlXgJE^ÌlÅ»è·é.
236	; intnest > 0 ÈçÎ½dÝÅ éÆ»è·é.
237	;
238
239	__kernel_interrupt_entry:
240	inc !__kernel_intnest ; lXgJE^ðCNg
241	ei ; ÝÂ(IPLÍó¯t¯çê½ÝÌx)
242	call bc ; ÝnhÄÑoµ
243	di ; ÝÖ~
244	dec !__kernel_intnest ; lXgJE^ðfNg
245	bnz $__kernel_int_return ; ßèæªñ^XNReLXg(ñ[)ÈçPÉ^[
246	movw ax,!__kernel_reqflg ; fBXpb`vª é©Ç¤©
247	cmpw ax, #0
248	bz $__kernel_int_return ; È¯êÎCPÉ^[
249	movw ax, #0
250	movw !__kernel_reqflg, ax ; reqflg = FALSE ÉßµÄ¨
251	movw ax, !__kernel_disdsp ; fBXpb`Ö~©Ç¤©
252	cmpw ax, #0
253	bnz $__kernel_int_return ; Ö~ÈçCPÉ^[
254
255	;
256	; ÝÌoû(fBXpb`t«)
257	; CPU bNÌóÔÉÚsµCVK^XNðJn·é
258	;
259	; OñðF
260	; PSWWX^ÌIEtO = 0 (ÝÖ~)
261	; PSWWX^ÌISP{1,0} = ó¯t¯½ÝÌÝx
262	;
263	__kernel_interrupt_dispatch:
264	call !!_t_lock_cpu
265	$_IF (TMIN_INTPRI_EQU_MINUS4)
266	clear_pswisp_mask
267	$ELSE
268	ei
269	$ENDIF
270	call !!__kernel_search_schedtsk
271	movw ax, bc
272	call !!__kernel_run_task
273
274	; run_task ©çÌ^[ãÌóÔ: CPUbNóÔ
275	; __kernel_int_return Ì reti Å PSW Ì IE, ISP Í
276	; Ý¶OÌóÔÉßé½ßClock_flag ¾¯³Éß·D
277	movw ax, #0
278	movw !__kernel_lock_flag, ax ; lock_flag ðNA
279
280	;
281	; WX^AµÄÝ©ç^[
282	;
283	__kernel_int_return:
284	restore_saddr_regs ; saddrÌæÌWX^A
285	pop ax ; ES, CS ÌA
286	mov cs, a ;
287	mov a, x ;
288	mov es, a ;
289	pop hl ; WX^ðA
290	pop de
291	pop bc
292	pop ax
293	reti
294
295	;
296	; ³À[v(OÌ½ß)
297	;
298	_loop:
299	br $_loop
300
301	;
302	; ¢gpÝ
303	;
304	_unused_interrupt:
305	reti
306
307	end

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

Download in other formats: