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
|
---|