1 | /*
|
---|
2 | *
|
---|
3 | * TOPPERS/JSP Kernel
|
---|
4 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
5 | * Just Standard Profile Kernel
|
---|
6 | *
|
---|
7 | * Copyright (C) 2004 by Embedded and Real-Time Systems Laboratory
|
---|
8 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
9 | *
|
---|
10 | * ä¸è¨è使¨©è
|
---|
11 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãï¼Free Software Foundation
|
---|
12 | * ã«ãã£ã¦å
|
---|
13 | ¬è¡¨ããã¦ãã GNU General Public License ã® Version 2 ã«è¨
|
---|
14 | * è¿°ããã¦ããæ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§ã¢
|
---|
15 | * ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
---|
16 | å¸ï¼ä»¥ä¸ï¼
|
---|
17 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
18 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
19 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
20 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
21 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
22 | * ç¨ã§ããå½¢ã§åé
|
---|
23 | å¸ããå ´åã«ã¯ï¼åé
|
---|
24 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
25 | * è
|
---|
26 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è使¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
27 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
28 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
29 | * ç¨ã§ããªãå½¢ã§åé
|
---|
30 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
31 | * ã¨ï¼
|
---|
32 | * (a) åé
|
---|
33 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
34 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
35 | * 使¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
36 | * (b) åé
|
---|
37 | å¸ã®å½¢æ
|
---|
38 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
39 | * å ±åãããã¨ï¼
|
---|
40 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
41 | * 害ãããï¼ä¸è¨è使¨©è
|
---|
42 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
43 | 責ãããã¨ï¼
|
---|
44 | *
|
---|
45 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨è使¨©è
|
---|
46 | ã
|
---|
47 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ã
|
---|
48 | * å«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´
|
---|
49 | * æ¥çã¾ãã¯éæ¥çã«çãããããªãæå®³ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
---|
50 | *
|
---|
51 | * @(#) $Id: cpu_support.S,v 1.4 2005/07/06 01:48:21 honda Exp $
|
---|
52 | */
|
---|
53 |
|
---|
54 | #define _MACRO_ONLY
|
---|
55 |
|
---|
56 | /*
|
---|
57 | * ã¢ããªã±ã¼ã·ã§ã³ã¨å
|
---|
58 | ±éã®ã¤ã³ã¯ã«ã¼ããã¡ã¤ã«
|
---|
59 | */
|
---|
60 | #include <kernel.h>
|
---|
61 | /*
|
---|
62 | * ã¿ã¼ã²ããä¾åæ
|
---|
63 | å ±ã®å®ç¾©
|
---|
64 | */
|
---|
65 | #include <t_config.h>
|
---|
66 |
|
---|
67 | #include "jsp_kernel.h"
|
---|
68 | #include "offset.h"
|
---|
69 | #include <nios2.h>
|
---|
70 |
|
---|
71 | .set noat
|
---|
72 | .section .exceptions, "xa"
|
---|
73 | .align 2
|
---|
74 | .global _irq_entry
|
---|
75 | .type _irq_entry, @function
|
---|
76 | _irq_entry:
|
---|
77 | /*
|
---|
78 | * ä¾å¤è¦å ã®å¤å®
|
---|
79 | */
|
---|
80 | rdctl et, estatus
|
---|
81 | andi et, et, 1
|
---|
82 | beq et, zero, _check_trap
|
---|
83 | rdctl et, ipending
|
---|
84 | beq et, zero, _check_trap
|
---|
85 |
|
---|
86 |
|
---|
87 | /*
|
---|
88 | * ä¾å¤è¦å ã¯å²è¾¼ã¿
|
---|
89 | */
|
---|
90 | addi ea, ea, -4 /* æ»ãçªå°ããã¯ãªã¡ã³ã */
|
---|
91 |
|
---|
92 | addi sp, sp, -76 /* ã¬ã¸ã¹ã¿ã®ä¿å */
|
---|
93 | rdctl et, estatus
|
---|
94 | stw et, 0(sp)
|
---|
95 | stw at, 4(sp)
|
---|
96 | stw r2, 8(sp)
|
---|
97 | stw r3, 12(sp)
|
---|
98 | stw r4, 16(sp)
|
---|
99 | stw r5, 20(sp)
|
---|
100 | stw r6, 24(sp)
|
---|
101 | stw r7, 28(sp)
|
---|
102 | stw r8, 32(sp)
|
---|
103 | stw r9, 36(sp)
|
---|
104 | stw r10, 40(sp)
|
---|
105 | stw r11, 44(sp)
|
---|
106 | stw r12, 48(sp)
|
---|
107 | stw r13, 52(sp)
|
---|
108 | stw r14, 56(sp)
|
---|
109 | stw r15, 60(sp)
|
---|
110 | stw fp, 64(sp)
|
---|
111 | stw ra, 68(sp)
|
---|
112 | stw ea, 72(sp)
|
---|
113 |
|
---|
114 | /*
|
---|
115 | * å¤éå²è¾¼ã¿ãå¤å®
|
---|
116 | */
|
---|
117 | ldw r3, %gprel(interrupt_count)(gp) /* ãã¹ãåæ°ã®ãã§ã㯠*/
|
---|
118 | bltu zero, r3, nest_int
|
---|
119 |
|
---|
120 | movhi r2, %hiadj(STACKTOP-4)
|
---|
121 | addi r2, r2, %lo(STACKTOP-4)
|
---|
122 | stw sp, 0(r2) /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
|
---|
123 | mov sp, r2 /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
|
---|
124 | ¥ãæ¿ã */
|
---|
125 | nest_int:
|
---|
126 | /*
|
---|
127 | * å²è¾¼ã¿è¦å ã®å¤å®ã¨å¼ã³åºã
|
---|
128 | */
|
---|
129 | call int_handler_call
|
---|
130 |
|
---|
131 | ret_from_int:
|
---|
132 | ldw r3, %gprel(interrupt_count)(gp)
|
---|
133 | bltu zero, r3, res_reg_and_ret /* ãã¹ãåæ°ã1以ä¸ãªãæ»ã */
|
---|
134 |
|
---|
135 | ldw r2, 0(sp) /* ã¹ã¿ãã¯ãã¤ã³ã¿ãæ»ã */
|
---|
136 | mov sp, r2 /* ã¹ã¿ãã¯ãã¤ã³ã¿ãæ»ã */
|
---|
137 |
|
---|
138 | ldw r3, %gprel(reqflg)(gp) /* reqflgã®ãã§ã㯠*/
|
---|
139 | beq r3, zero, res_reg_and_ret
|
---|
140 | br ret_int
|
---|
141 |
|
---|
142 | res_reg_and_ret:
|
---|
143 | ldw et, 0(sp) /* ã¬ã¸ã¹ã¿ã®å¾©å¸° */
|
---|
144 | wrctl estatus, et
|
---|
145 | ldw at, 4(sp)
|
---|
146 | ldw r2, 8(sp)
|
---|
147 | ldw r3, 12(sp)
|
---|
148 | ldw r4, 16(sp)
|
---|
149 | ldw r5, 20(sp)
|
---|
150 | ldw r6, 24(sp)
|
---|
151 | ldw r7, 28(sp)
|
---|
152 | ldw r8, 32(sp)
|
---|
153 | ldw r9, 36(sp)
|
---|
154 | ldw r10, 40(sp)
|
---|
155 | ldw r11, 44(sp)
|
---|
156 | ldw r12, 48(sp)
|
---|
157 | ldw r13, 52(sp)
|
---|
158 | ldw r14, 56(sp)
|
---|
159 | ldw r15, 60(sp)
|
---|
160 | ldw fp, 64(sp)
|
---|
161 | ldw ra, 68(sp)
|
---|
162 | ldw ea, 72(sp)
|
---|
163 | addi sp, sp, 76
|
---|
164 | eret
|
---|
165 |
|
---|
166 |
|
---|
167 | _check_trap:
|
---|
168 | /*
|
---|
169 | * Trapãå¤å®
|
---|
170 | */
|
---|
171 | ldw et, -4(ea) /* ä¾å¤ãåºããå½ä»¤ãåå¾ */
|
---|
172 | xorhi et, et, 0x003b /* ä¸ä½16bit */
|
---|
173 | xori et, et, 0x683a /* ä¸ä½16bit */
|
---|
174 | beq et, zero, trap_handler
|
---|
175 |
|
---|
176 | _check_exc:
|
---|
177 | addi sp, sp, -76
|
---|
178 | rdctl et, estatus
|
---|
179 | stw et, 0(sp)
|
---|
180 | stw at, 4(sp)
|
---|
181 | stw r2, 8(sp)
|
---|
182 | stw r3, 12(sp)
|
---|
183 | stw r4, 16(sp)
|
---|
184 | stw r5, 20(sp)
|
---|
185 | stw r6, 24(sp)
|
---|
186 | stw r7, 28(sp)
|
---|
187 | stw r8, 32(sp)
|
---|
188 | stw r9, 36(sp)
|
---|
189 | stw r10, 40(sp)
|
---|
190 | stw r11, 44(sp)
|
---|
191 | stw r12, 48(sp)
|
---|
192 | stw r13, 52(sp)
|
---|
193 | stw r14, 56(sp)
|
---|
194 | stw r15, 60(sp)
|
---|
195 | stw fp, 64(sp)
|
---|
196 | stw ra, 68(sp)
|
---|
197 | stw ea, 72(sp)
|
---|
198 | mov r4, sp /* ãã³ãã©ã®å¼æ° */
|
---|
199 |
|
---|
200 | /*
|
---|
201 | * å¤éå²è¾¼ã¿ãå¤å®
|
---|
202 | */
|
---|
203 | ldw r3, %gprel(interrupt_count)(gp) /* ãã¹ãåæ°ã®ãã§ã㯠*/
|
---|
204 | bltu zero, r3, nest_int_exc
|
---|
205 |
|
---|
206 | movhi r2, %hiadj(STACKTOP-4)
|
---|
207 | addi r2, r2, %lo(STACKTOP-4)
|
---|
208 | stw sp, 0(r2) /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
|
---|
209 | mov sp, r2 /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
|
---|
210 | ¥ãæ¿ã */
|
---|
211 | nest_int_exc:
|
---|
212 |
|
---|
213 | call exc_handler_call /* CPUä¾å¤ãã³ãã©å¼ã³åºãã«ã¼ãã³ã®å®è¡ */
|
---|
214 |
|
---|
215 | br ret_from_int /* ãªã¿ã¼ã³å¦ç */
|
---|
216 |
|
---|
217 |
|
---|
218 | trap_handler:
|
---|
219 | /*
|
---|
220 | * Trapãã³ãã©ã¼
|
---|
221 | */
|
---|
222 | eret
|
---|
223 |
|
---|
224 |
|
---|
225 |
|
---|
226 | .set noat
|
---|
227 | .align 2
|
---|
228 | .global ret_int
|
---|
229 | .global ret_exc
|
---|
230 | ret_int:
|
---|
231 | ret_exc:
|
---|
232 | stw zero, %gprel(reqflg)(gp) /* reqflg ã FALSEã« */
|
---|
233 | ldw r5, %gprel(runtsk)(gp) /* r5 <- runtsk */
|
---|
234 | ldw r6, %gprel(enadsp)(gp) /* r6 <- enadsp */
|
---|
235 | beq r6, zero, ret_int_1 /* enadsp ã FALSE ãªã ret_int_1 㸠*/
|
---|
236 | ldw r4, %gprel(schedtsk)(gp) /* r4 <- schedtsk */
|
---|
237 | beq r4, r5, ret_int_1 /* runtsk 㨠schedtskãåããªãret_int_1㸠*/
|
---|
238 | addi sp, sp, -32 /* æ®ãã®ã¬ã¸ã¹ã¿ãä¿å */
|
---|
239 | stw r16, 0(sp)
|
---|
240 | stw r17, 4(sp)
|
---|
241 | stw r18, 8(sp)
|
---|
242 | stw r19, 12(sp)
|
---|
243 | stw r20, 16(sp)
|
---|
244 | stw r21, 20(sp)
|
---|
245 | stw r22, 24(sp)
|
---|
246 | stw r23, 28(sp)
|
---|
247 | stw sp, TCB_sp(r5) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãTCBã«ä¿å */
|
---|
248 | movhi r2, %hiadj(ret_int_r) /* å®è¡éå§çªå°ãä¿å */
|
---|
249 | addi r2, r2, %lo(ret_int_r)
|
---|
250 | stw r2, TCB_pc(r5) /* å®è¡åéçªå°ãTCBã«ä¿å */
|
---|
251 | br dispatcher
|
---|
252 |
|
---|
253 | ret_int_r:
|
---|
254 | ldw r16, 0(sp) /* ã¬ã¸ã¹ã¿ã復帰 */
|
---|
255 | ldw r17, 4(sp)
|
---|
256 | ldw r18, 8(sp)
|
---|
257 | ldw r19, 12(sp)
|
---|
258 | ldw r20, 16(sp)
|
---|
259 | ldw r21, 20(sp)
|
---|
260 | ldw r22, 24(sp)
|
---|
261 | ldw r23, 28(sp)
|
---|
262 | addi sp, sp, 32
|
---|
263 | ret_int_1:
|
---|
264 | /*
|
---|
265 | * ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®èµ·å
|
---|
266 | * ret_int_r 㯠dispatcher ããå¼ã³åºãããããï¼
|
---|
267 | * tcbã®ã¢ãã¬ã¹ã¯ r4 ã«å
|
---|
268 | ¥ã£ã¦ãã
|
---|
269 | */
|
---|
270 | ldw r5, TCB_enatex(r4) /* r5 <- enatex */
|
---|
271 | #if TCB_enatex_mask > 0xffff
|
---|
272 | andhi r6, r5, %hi(TCB_enatex_mask)
|
---|
273 | #else
|
---|
274 | andi r6, r5, %lo(TCB_enatex_mask)
|
---|
275 | #endif /* TCB_enatex_mask > 0xffff */
|
---|
276 | andhi r6, r5, 4
|
---|
277 | beq r6, zero, ret_int_2 /* enatex ã FALSE ãªããªã¿ã¼ã³ */
|
---|
278 | ldw r7, TCB_texptn(r4) /* r7 <- texptn, texptnã0ã§ãªããã° */
|
---|
279 | beq zero, r7, ret_int_2
|
---|
280 | call call_texrtn /* ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®å¼ã³åºã */
|
---|
281 |
|
---|
282 | ret_int_2:
|
---|
283 | ldw et, 0(sp) /* ã¬ã¸ã¹ã¿ã復帰 */
|
---|
284 | wrctl estatus, et
|
---|
285 | ldw at, 4(sp)
|
---|
286 | ldw r2, 8(sp)
|
---|
287 | ldw r3, 12(sp)
|
---|
288 | ldw r4, 16(sp)
|
---|
289 | ldw r5, 20(sp)
|
---|
290 | ldw r6, 24(sp)
|
---|
291 | ldw r7, 28(sp)
|
---|
292 | ldw r8, 32(sp)
|
---|
293 | ldw r9, 36(sp)
|
---|
294 | ldw r10, 40(sp)
|
---|
295 | ldw r11, 44(sp)
|
---|
296 | ldw r12, 48(sp)
|
---|
297 | ldw r13, 52(sp)
|
---|
298 | ldw r14, 56(sp)
|
---|
299 | ldw r15, 60(sp)
|
---|
300 | ldw fp, 64(sp)
|
---|
301 | ldw ra, 68(sp)
|
---|
302 | ldw ea, 72(sp)
|
---|
303 | addi sp, sp, 76
|
---|
304 | eret
|
---|
305 |
|
---|
306 |
|
---|
307 |
|
---|
308 |
|
---|
309 | .global dispatch
|
---|
310 | .align 2
|
---|
311 | dispatch:
|
---|
312 | addi sp, sp, -40 /* ã¬ã¸ã¹ã¿ãä¿å */
|
---|
313 | stw r16, 0(sp)
|
---|
314 | stw r17, 4(sp)
|
---|
315 | stw r18, 8(sp)
|
---|
316 | stw r19, 12(sp)
|
---|
317 | stw r20, 16(sp)
|
---|
318 | stw r21, 20(sp)
|
---|
319 | stw r22, 24(sp)
|
---|
320 | stw r23, 28(sp)
|
---|
321 | stw fp, 32(sp)
|
---|
322 | stw ra, 36(sp)
|
---|
323 | ldw r4, %gprel(runtsk)(gp) /* r4 <- runtsk */
|
---|
324 | stw sp, TCB_sp(r4) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãTCBã«ä¿å */
|
---|
325 | movhi r5, %hiadj(dispatch_r) /* å®è¡éå§çªå°ãä¿å */
|
---|
326 | addi r5, r5, %lo(dispatch_r)
|
---|
327 | stw r5, TCB_pc(r4) /* å®è¡åéçªå°ãTCBã«ä¿å */
|
---|
328 | br dispatcher
|
---|
329 |
|
---|
330 | dispatch_r:
|
---|
331 | ldw r16, 0(sp) /* ã¬ã¸ã¹ã¿ã復帰 */
|
---|
332 | ldw r17, 4(sp)
|
---|
333 | ldw r18, 8(sp)
|
---|
334 | ldw r19, 12(sp)
|
---|
335 | ldw r20, 16(sp)
|
---|
336 | ldw r21, 20(sp)
|
---|
337 | ldw r22, 24(sp)
|
---|
338 | ldw r23, 28(sp)
|
---|
339 | ldw fp, 32(sp)
|
---|
340 | /*
|
---|
341 | * ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®èµ·å
|
---|
342 | * dispatch_r 㯠dispatcher ããå¼ã³åºãããããï¼
|
---|
343 | * tcb ã®ã¢ãã¬ã¹ã¯ r4 ã«å
|
---|
344 | ¥ã£ã¦ãã
|
---|
345 | */
|
---|
346 | ldw r5, TCB_enatex(r4) /* r5 <- enatex */
|
---|
347 | #if TCB_enatex_mask > 0xffff
|
---|
348 | andhi r6, r5, %hi(TCB_enatex_mask)
|
---|
349 | #else
|
---|
350 | andi r6, r5, %lo(TCB_enatex_mask)
|
---|
351 | #endif /* TCB_enatex_mask > 0xffff */
|
---|
352 | beq r6, zero, dispatch_r_1 /* enatex ã FALSE ãªããªã¿ã¼ã³ */
|
---|
353 | ldw r7, TCB_texptn(r4) /* r7 <- texptn, texptnã0ã§ãªããã° */
|
---|
354 | beq r7, zero, dispatch_r_1
|
---|
355 | call call_texrtn /* ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®å¼ã³åºã */
|
---|
356 |
|
---|
357 | dispatch_r_1:
|
---|
358 | ldw ra, 36(sp) /* æ®ãã®ã¬ã¸ã¹ã¿ã復帰 */
|
---|
359 | addi sp, sp, 40
|
---|
360 | ret
|
---|
361 |
|
---|
362 |
|
---|
363 |
|
---|
364 | .global exit_and_dispatch
|
---|
365 | exit_and_dispatch:
|
---|
366 | stw zero, %gprel(interrupt_count)(gp) /* interrupt_count ãã¯ãªã¢ */
|
---|
367 | dispatcher:
|
---|
368 | /*
|
---|
369 | * ããã¯å²è¾¼ã¿ç¦æ¢ã§æ¥ããã¨
|
---|
370 | */
|
---|
371 | ldw r4, %gprel(schedtsk)(gp) /* r4 <- schedtsk */
|
---|
372 | stw r4, %gprel(runtsk)(gp) /* schedtsk ã runtskã« */
|
---|
373 | beq r4, zero, dispatcher_1 /* schedtskãããã */
|
---|
374 | ldw sp, TCB_sp(r4) /* TCBããã¿ã¹ã¯ã¹ã¿ãã¯ã復帰 */
|
---|
375 | ldw r5, TCB_pc(r4) /* TCBããå®è¡åéçªå°ã復帰 */
|
---|
376 | jmp r5
|
---|
377 | dispatcher_1:
|
---|
378 | /*
|
---|
379 | * ããã§å²è¾¼ã¿ã¢ã¼ãã«åãæ¿ããã®ã¯ï¼ããã§çºçããå²è¾¼ã¿å¦ç
|
---|
380 | * ã«ã©ã®ã¹ã¿ãã¯ã使ããã¨ããåé¡ã®è§£æ±ºã¨ï¼å²è¾¼ã¿ãã³ãã©å
|
---|
381 | ã§
|
---|
382 | * ã®ã¿ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ãã2ã¤ã®æå³ãããï¼
|
---|
383 | */
|
---|
384 | movhi sp, %hiadj(STACKTOP) /* å²è¾¼ã¿ã¹ã¿ãã¯ã«å¤æ´ */
|
---|
385 | addi sp, sp, %lo(STACKTOP)
|
---|
386 | movi r5, 1 /* interrupt_count ã1ã« */
|
---|
387 | stw r5, %gprel(interrupt_count)(gp)
|
---|
388 | dispatcher_2:
|
---|
389 | wrctl status, r5 /* å²è¾¼ã¿ã®è¨±å¯ */
|
---|
390 | nop
|
---|
391 | nop
|
---|
392 | nop
|
---|
393 | nop
|
---|
394 | wrctl status, zero /* å²è¾¼ã¿ã®ç¦æ¢ */
|
---|
395 | ldw r6, %gprel(reqflg)(gp) /* r6 <- reqflg */
|
---|
396 | beq r6, zero, dispatcher_2 /* reqflg ã FALSE ãªã */
|
---|
397 | stw zero, %gprel(interrupt_count)(gp) /* interrupt_count ãã¯ãªã¢ */
|
---|
398 | stw zero, %gprel(reqflg)(gp) /* reqflg ã FALSE ã« */
|
---|
399 | br dispatcher
|
---|
400 |
|
---|
401 |
|
---|
402 | .text
|
---|
403 | .global activate_r
|
---|
404 | .align 2
|
---|
405 | activate_r:
|
---|
406 | movi r2, 1
|
---|
407 | wrctl status, r2 /* å²è¾¼ã¿è¨±å¯ */
|
---|
408 | ldw r4, 4(sp) /* 弿°(exinf) */
|
---|
409 | ldw r2, 0(sp) /* ã¿ã¹ã¯ã®å®è¡çªå° */
|
---|
410 | addi sp, sp, 8
|
---|
411 | movhi ra, %hiadj(ext_tsk)
|
---|
412 | addi ra, ra, %lo(ext_tsk)
|
---|
413 | jmp r2 /* ã¿ã¹ã¯ã®å®è¡éå§ */
|
---|
414 |
|
---|
415 |
|
---|