1 | /*
|
---|
2 | * TOPPERS/ASP Kernel
|
---|
3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
4 | * Advanced Standard Profile Kernel
|
---|
5 | *
|
---|
6 | * Copyright (C) 2008 by Embedded and Real-Time Systems Laboratory
|
---|
7 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
8 | *
|
---|
9 | * ãLì ÒÍCȺÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
|
---|
10 | * Ai{\tgEFAðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»Eü
|
---|
11 | * ÏEÄzziȺCpÆÄÔj·é±Æð³Åø·éD
|
---|
12 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
13 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[
|
---|
14 | * XR[hÉÜÜêÄ¢é±ÆD
|
---|
15 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
|
---|
16 | * pÅ«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
17 | gip
|
---|
18 | * Ò}j
|
---|
19 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL
|
---|
20 | * ̳ÛØKèðfÚ·é±ÆD
|
---|
21 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
|
---|
22 | * pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
|
---|
23 | * ÆD
|
---|
24 | * (a) Äzzɺ¤hL
|
---|
25 | gipÒ}j
|
---|
26 | AÈÇjÉCãLÌ
|
---|
27 | * ì \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
28 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
|
---|
29 | * ñ·é±ÆD
|
---|
30 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹
|
---|
31 | * Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
32 | * ܽC{\tgEFAÌ[UܽÍGh[U©çÌ¢©Èé
|
---|
33 | * RÉîÿ©çàCãLì Ò¨æÑTOPPERSvWFNgð
|
---|
34 | * ÆÓ·é±ÆD
|
---|
35 | *
|
---|
36 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
|
---|
37 | * æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
|
---|
38 | * ÉηéK«àÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEF
|
---|
39 | * AÌpÉæè¼ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»
|
---|
40 | * ÌÓCðíÈ¢D
|
---|
41 | *
|
---|
42 | */
|
---|
43 |
|
---|
44 | NAME core_support
|
---|
45 | /*
|
---|
46 | * vZbT˶W
|
---|
47 | [ AZu¾êiARM-Mpj
|
---|
48 | */
|
---|
49 |
|
---|
50 | #define TOPPERS_MACRO_ONLY
|
---|
51 | #define UINT_C(val) (val) /* uint_t^Ìèðìé}N */
|
---|
52 | #define ULONG_C(val) (val) /* ulong_t^Ìèðìé}N */
|
---|
53 | #define CAST(type, val) (val) /* ^LXgðs¤}N */
|
---|
54 |
|
---|
55 | #include "kernel_impl.h"
|
---|
56 | #include "arm_m.h"
|
---|
57 | #include "offset.h"
|
---|
58 |
|
---|
59 |
|
---|
60 | /*
|
---|
61 | * ^XNfBXpb`
|
---|
62 | */
|
---|
63 | PUBLIC dispatch
|
---|
64 | IMPORT p_runtsk
|
---|
65 |
|
---|
66 | SECTION .text : CODE (2)
|
---|
67 | THUMB
|
---|
68 | dispatch:
|
---|
69 | /*
|
---|
70 | *
|
---|
71 | * ±Ì[`ÍC^XNReLXgECPUbNóÔEfBpb`ÂóÔ
|
---|
72 | * EifãÌjÝDæx}XNSJóÔÅÄÑo³êéD
|
---|
73 | */
|
---|
74 | stmfd sp!,{r4-r11,lr} /* WX^ÌÛ¶ */
|
---|
75 | ldr r0, =p_runtsk /* p_runtskðÇÝÞ */
|
---|
76 | ldr r1, [r0]
|
---|
77 | str sp, [r1,#TCB_sp] /* ^XNX^bNðÛ¶ */
|
---|
78 | ldr lr, =dispatch_r /* ÀsÄJÔnðÛ¶ */
|
---|
79 | str lr, [r1,#TCB_pc]
|
---|
80 | b dispatcher
|
---|
81 |
|
---|
82 | IMPORT call_texrtn
|
---|
83 | IMPORT ipmflg
|
---|
84 |
|
---|
85 | SECTION .text : CODE (2)
|
---|
86 | THUMB
|
---|
87 | dispatch_r:
|
---|
88 | ldmfd sp!,{r4 - r11,lr} /* WX^ÌA */
|
---|
89 | /*
|
---|
90 | * ^XNáO[`ÌN®
|
---|
91 | * dispatcher©çÄÑo³êé½ßCTCBÌAhXÍr1ÉüÁÄ¢é
|
---|
92 | */
|
---|
93 | ldrb r0,[r1,#TCB_enatex]
|
---|
94 | tst r0,#TCB_enatex_mask
|
---|
95 | beq dispatch_r_1 /* enatex ª false Èç^[ */
|
---|
96 | ldr r0,[r1,#TCB_texptn] /* texptn ª0ÅȯêÎ */
|
---|
97 | tst r0,r0
|
---|
98 | beq dispatch_r_1 /* ^XNáO[`ÌÄÑoµ */
|
---|
99 | ldr r1, =ipmflg /* ipmflgª false Èç^[ */
|
---|
100 | ldr r0, [r1]
|
---|
101 | tst r0,r0
|
---|
102 | /*bne call_texrtn /* ^XNáO[`ÌÄÑoµ */
|
---|
103 | beq dispatch_r_1
|
---|
104 | ldr r0, =call_texrtn /* ^XNáO[`ÌÄÑoµ */
|
---|
105 | bx r0
|
---|
106 | dispatch_r_1: /* ^XNÖÌcall_textn©çßé */
|
---|
107 | /*mov pc,lr*/
|
---|
108 | bx lr
|
---|
109 |
|
---|
110 |
|
---|
111 | /*
|
---|
112 | * CPUáOGg
|
---|
113 | *
|
---|
114 | * ÝGgÆÌàeͯ¾ªCOÌíÞªÙÈé½ßC
|
---|
115 | * ª¯Ä¢éD
|
---|
116 | */
|
---|
117 | PUBLIC core_exc_entry
|
---|
118 |
|
---|
119 | SECTION .text : CODE (2)
|
---|
120 | THUMB
|
---|
121 | core_exc_entry:
|
---|
122 | /*
|
---|
123 | * áO/ݪ¶·éÆC¶ÉANeBuÈX^bNÉXN
|
---|
124 | * b`WX^ªÛ¶³êéD
|
---|
125 | * ±ÌàeÉÁ¦ÄCCPUáOnhÖÌîñƵÄCbasepri ÌlÆC
|
---|
126 | * EXC_RETURNÌîñðÁ¦ÄÛ¶·éDbasepriÌlÍCCPUáO©çÌ
|
---|
127 | * ^[ÉÝDæx}XNÌlð³Éß·½ßÉàp¢çêéD
|
---|
128 | *
|
---|
129 | * -----------
|
---|
130 | * | EXC_RETURN|
|
---|
131 | * -----------
|
---|
132 | * | basepri |
|
---|
133 | * -----------
|
---|
134 | * | R0 |
|
---|
135 | * -----------
|
---|
136 | * | R1 |
|
---|
137 | * -----------
|
---|
138 | * | R2 |
|
---|
139 | * -----------
|
---|
140 | * | R3 |
|
---|
141 | * -----------
|
---|
142 | * | R12 |
|
---|
143 | * -----------
|
---|
144 | * | LR |
|
---|
145 | * -----------
|
---|
146 | * | PC |
|
---|
147 | * -----------
|
---|
148 | * | xPSR |
|
---|
149 | * -----------
|
---|
150 | *
|
---|
151 | */
|
---|
152 | /*¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤¤*/
|
---|
153 | /*
|
---|
154 | * ݶÌÝDæx}XNðX^bNÉÛ¶·é½ßæ¾
|
---|
155 | */
|
---|
156 | /*mrs r2, basepri /* baepriÌlðæ¾ */
|
---|
157 |
|
---|
158 | /*
|
---|
159 | * J[lÇOÌáO©`FbN
|
---|
160 | * J[làÌNeBJZNVÌÀsCSÝbNóÔC
|
---|
161 | * CPUbNóÔCJ[lÇOÌÝnhÀsÌ¢¸ê©Å
|
---|
162 | * ¶µ½CPUáOðCJ[lÇOÌCPUáOÆÄÔ
|
---|
163 | * CPUbNóÔÍbasepriªIIPM_LOCKÅ»f·éD
|
---|
164 | * SÝbNóÔÍFAULTMASKª'1'Ìê
|
---|
165 | */
|
---|
166 | /*cmp r2, #IIPM_LOCK /* CPUbNóÔÈçJ[lÇOáOÖ */
|
---|
167 | /*beq prc_nonkernel_exc_entry*/
|
---|
168 | /*mrs r2, FAULTMASK /* SÝbNóÔÈçJ[lÇOáOÖ */
|
---|
169 | /*cbnz r2, prc_nonkernel_exc_entry*/
|
---|
170 | /*¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢¢*/
|
---|
171 | /*
|
---|
172 | * J[lÇOÌáO©`FbN
|
---|
173 | * J[làÌNeBJZNVÌÀsCSÝbNóÔC
|
---|
174 | * CPUbNóÔCJ[lÇOÌÝnhÀsÌ¢¸ê©Å
|
---|
175 | * ¶µ½CPUáOðCJ[lÇOÌCPUáOÆÄÔ
|
---|
176 | * SÝbNóÔÍFAULTMASKª'1'Ìê
|
---|
177 | * CPUbNóÔÍbasepriªIIPM_LOCK©Å»f·éD
|
---|
178 | */
|
---|
179 | mrs r2, FAULTMASK /* SÝbNóÔÈçJ[lÇOáOÖ */
|
---|
180 | cbnz r2, core_nonkernel_exc_entry
|
---|
181 |
|
---|
182 | mrs r2, basepri /* baepriÌlðæ¾ */
|
---|
183 | cmp r2, #IIPM_LOCK /* CPUbNóÔÈçJ[lÇOáOÖ */
|
---|
184 | beq core_nonkernel_exc_entry
|
---|
185 |
|
---|
186 |
|
---|
187 |
|
---|
188 | /*
|
---|
189 | * X^bNðÏX·éKvª é©`FbN
|
---|
190 | * EXC_RETURNiÝÉLRÉÝè³êéljð`FbNµÄCáO¶É
|
---|
191 | * ANeBuÈX^bNðÁè·é±ÆŽdÝ©»è·éD
|
---|
192 | */
|
---|
193 | tst lr, #EXC_RETURN_PSP /* ݳªMSPÈç½dÝ */
|
---|
194 | beq core_exc_entry_1 /* ½dÝÈçcore_exc_entry_1Ö */
|
---|
195 | mrs r0, psp /* êiÚÌÝÌêÍPSPãÉ */
|
---|
196 | #ifdef OLD_STMFD_INST
|
---|
197 | stmfd r0!,{r2} /* ݶÌÝDæx}XNðÏÞ */
|
---|
198 | stmfd r0!,{lr} /* EXC_RETURN ðÏÞ */
|
---|
199 | #else
|
---|
200 | str r2, [r0, #-0x04]!
|
---|
201 | str lr, [r0, #-0x04]!
|
---|
202 | endif
|
---|
203 | msr psp, r0 /* CPUáOnhÖÌøÆÈé */
|
---|
204 | push {lr} /* MSPãÉàEXC_RETURN ðÏÞ */
|
---|
205 | b core_exc_entry_2
|
---|
206 | core_exc_entry_1: /* ½dÝÌê */
|
---|
207 | push {r2} /* ݶÌÝDæx}XNðÏÞ */
|
---|
208 | push {lr} /* EXC_RETURN ðÏÞ */
|
---|
209 | mov r0, sp /* CPUáOnhÖÌøÆÈé */
|
---|
210 |
|
---|
211 | /*
|
---|
212 | * ¤Ê
|
---|
213 | */
|
---|
214 | core_exc_entry_2:
|
---|
215 | mrs r3, ipsr /* nhAhXðæ¾ */
|
---|
216 | ldr r1, =_kernel_exc_tbl
|
---|
217 | ldr r2, [r1, r3, lsl #2]
|
---|
218 |
|
---|
219 | #ifdef LOG_EXC_ENTER
|
---|
220 | push {r0,r2,r3}
|
---|
221 | mov r0, r3 /* áOÔðp[^É */
|
---|
222 | bl log_exc_enter /* log_exc_enterðÄÑo· */
|
---|
223 | pop {r0,r2,r3}
|
---|
224 | push {r3} /* áOÔðX^bNÖ */
|
---|
225 | #endif /* LOG_EXC_ENTER */
|
---|
226 |
|
---|
227 | /*
|
---|
228 | * CPUáOnhÌÄÑoµ
|
---|
229 | */
|
---|
230 | blx r2
|
---|
231 |
|
---|
232 | #ifdef LOG_EXC_ENTER
|
---|
233 | pop {r0} /* áOÔðøÉ */
|
---|
234 | bl log_exc_leave /* log_exc_leaveðÄÑo· */
|
---|
235 | #endif /* LOG_EXC_ENTER */
|
---|
236 |
|
---|
237 | b ret_exc
|
---|
238 |
|
---|
239 | /*
|
---|
240 | * J[lÇOÌCPUáOÌoüû
|
---|
241 | */
|
---|
242 | core_nonkernel_exc_entry:
|
---|
243 | tst lr, #EXC_RETURN_PSP /* ݳªMSPÈç½dÝ */
|
---|
244 | beq core_nonkernel_exc_entry_1 /* ½dÝÈç */
|
---|
245 | mrs r0, psp /* êiÚÌÝÌêÍPSPãÉ */
|
---|
246 | #ifdef OLD_STMFD_INST
|
---|
247 | stmfd r0!,{r2} /* ݶÌÝDæx}XNðÏÞ */
|
---|
248 | stmfd r0!,{lr} /* EXC_RETURN ðÏÞ */
|
---|
249 | #else
|
---|
250 | str r2, [r0, #-0x04]!
|
---|
251 | str lr, [r0, #-0x04]!
|
---|
252 | #endif
|
---|
253 | msr psp, r0 /* CPUáOnhÖÌøÆÈé */
|
---|
254 | push {lr} /* MSPãÉàEXC_RETURN ðÏÞ */
|
---|
255 | b core_nonkernel_exc_entry_2
|
---|
256 | core_nonkernel_exc_entry_1: /* ½dÝÌê */
|
---|
257 | push {r2} /* ݶÌÝDæx}XNðÏÞ */
|
---|
258 | push {lr} /* EXC_RETURN ðÏÞ */
|
---|
259 | mov r0, sp /* CPUáOnhÖÌøÆÈé */
|
---|
260 |
|
---|
261 | core_nonkernel_exc_entry_2:
|
---|
262 | mrs r3, ipsr /* CPUáOnhÌAhXðæ¾ */
|
---|
263 | ldr r1, =_kernel_exc_tbl
|
---|
264 | ldr r2, [r1, r3, lsl #2]
|
---|
265 |
|
---|
266 | /*
|
---|
267 | * CPUáOnhÌÄÑoµ
|
---|
268 | */
|
---|
269 | blx r2
|
---|
270 |
|
---|
271 | /*
|
---|
272 | * ÝbNóÔÆ·éD
|
---|
273 | */
|
---|
274 | cpsid f
|
---|
275 |
|
---|
276 | /*
|
---|
277 | * ßèæÌReLXgÌ»è
|
---|
278 | *
|
---|
279 | * ÝnhÀsÉLRÉZbg³êéEXC_RETURNð`FbNµÄCßè
|
---|
280 | * æÅMSPªgíêÄ¢êÎCÝæªñ^XNReLXgÆ»è·éD
|
---|
281 | */
|
---|
282 | pop {r3} /* lrðX^bN©çæ¾ */
|
---|
283 | tst r3, #EXC_RETURN_PSP /* ßèæªPSPÈç */
|
---|
284 | bne nonkernel_ret_exc_1
|
---|
285 | pop {r1} /* ³ÌÝDæx}XN(basepri) */
|
---|
286 | b nonkernel_ret_exc_2 /* ÌlðMSP©çæ¾ */
|
---|
287 |
|
---|
288 | nonkernel_ret_exc_1:
|
---|
289 | /*
|
---|
290 | * PSPã©çEXC_RETURNðí
|
---|
291 | */
|
---|
292 | mrs r2, psp
|
---|
293 | add r2, r2, #4
|
---|
294 | /*
|
---|
295 | * ³ÌÝDæx}XN(basepri)ÌlðPSP©çæ¾
|
---|
296 | */
|
---|
297 | ldmfd r2!, {r1}
|
---|
298 | msr psp, r2
|
---|
299 |
|
---|
300 | nonkernel_ret_exc_2:
|
---|
301 | msr basepri, r1 /* ÝDæx}XNðÝOÉóÔÖ */
|
---|
302 | bx r3 /* ^[ */
|
---|
303 |
|
---|
304 | /*
|
---|
305 | * ÝGg
|
---|
306 | */
|
---|
307 | PUBLIC core_int_entry
|
---|
308 | IMPORT _kernel_exc_tbl
|
---|
309 | IMPORT log_inh_enter
|
---|
310 | IMPORT log_exc_leave
|
---|
311 | IMPORT reqflg
|
---|
312 | IMPORT lock_flag
|
---|
313 | IMPORT saved_iipm
|
---|
314 | IMPORT p_runtsk
|
---|
315 | IMPORT dspflg
|
---|
316 | IMPORT p_schedtsk
|
---|
317 | IMPORT _kernel_int_iipm_tbl
|
---|
318 | SECTION .text : CODE (2)
|
---|
319 | THUMB
|
---|
320 | core_int_entry:
|
---|
321 | /*
|
---|
322 | * ݶÌÝDæx}XNðX^bNÉÛ¶·é½ßæ¾
|
---|
323 | */
|
---|
324 | mrs r2, basepri /* baepriÌlðæ¾ */
|
---|
325 |
|
---|
326 | /*
|
---|
327 | * ½dÝ©`FbN
|
---|
328 | * EXC_RETURNiÝÉLRÉÝè³êéljð`FbNµÄCáO¶É
|
---|
329 | * ANeBuÈX^bNðÁè·é±ÆŽdÝ©»è·éD
|
---|
330 | */
|
---|
331 | tst lr, #EXC_RETURN_PSP /* ݳªMSPÈç½dÝ */
|
---|
332 | beq core_int_entry_1 /* ½dÝÈçcore_int_entry_1Ö */
|
---|
333 | mrs r0, psp /* êiÚÌÝÌêÍPSPãÉ */
|
---|
334 | #ifdef OLD_STMFD_INST
|
---|
335 | stmfd r0!,{r2} /* ݶÌÝDæx}XNðÏÞ */
|
---|
336 | stmfd r0!,{lr} /* EXC_RETURN ðÏÞ */
|
---|
337 | #else
|
---|
338 | str r2, [r0, #-0x04]!
|
---|
339 | str lr, [r0, #-0x04]!
|
---|
340 | #endif
|
---|
341 | msr psp, r0 /* CPUáOnhÖÌøÆÈé */
|
---|
342 | push {lr} /* MSPãÉàEXC_RETURN ðÏÞ */
|
---|
343 | b core_int_entry_2
|
---|
344 | core_int_entry_1: /* ½dÝÌê */
|
---|
345 | push {r2} /* ݶÌÝDæx}XNðÏÞ */
|
---|
346 | push {lr} /* EXC_RETURN ðÏÞ */
|
---|
347 | mov r0, sp /* ¢è`Ìݪ¶µ½êÌîñÆ·é */
|
---|
348 |
|
---|
349 | /*
|
---|
350 | * ¤Ê
|
---|
351 | */
|
---|
352 | core_int_entry_2:
|
---|
353 | mrs r3, ipsr /* nhAhXðæ¾ */
|
---|
354 | ldr r1, =_kernel_exc_tbl
|
---|
355 | ldr r2, [r1, r3, lsl #2]
|
---|
356 |
|
---|
357 | /*
|
---|
358 | * basepriÌÝè
|
---|
359 | * NVICDæx}XNª©®IÉÝè³êé½ßDæx}XNÌ_ÅÍKvÈ
|
---|
360 | * ¢ªCx_get_ipm()ªbasepriðQÆ·é½ßCbasepriàXV·éD
|
---|
361 | */
|
---|
362 | ldr r1, =_kernel_int_iipm_tbl
|
---|
363 | ldr lr, [r1, r3, lsl #2]
|
---|
364 | msr basepri, lr
|
---|
365 |
|
---|
366 | #ifdef LOG_INH_ENTER
|
---|
367 | push {r0,r2,r3}
|
---|
368 | mov r0, r3 /* áOÔðp[^É */
|
---|
369 | bl log_inh_enter /* log_exc_enterðÄÑo· */
|
---|
370 | pop {r0,r2,r3}
|
---|
371 | push {r3} /* áOÔðX^bNÖ */
|
---|
372 | #endif /* LOG_INH_ENTER */
|
---|
373 |
|
---|
374 | /*
|
---|
375 | * ÝnhÌÄÑoµ
|
---|
376 | */
|
---|
377 | blx r2
|
---|
378 |
|
---|
379 | #ifdef LOG_INH_LEAVE
|
---|
380 | pop {r0} /* áOÔðøÉ */
|
---|
381 | bl log_exc_leave /* log_exc_leaveðÄÑo· */
|
---|
382 | #endif /* LOG_INH_LEAVE */
|
---|
383 |
|
---|
384 |
|
---|
385 |
|
---|
386 | /*
|
---|
387 | * Ý/áOoû
|
---|
388 | *
|
---|
389 | * ret_exc/ret_intÍCCPUáO/Ýnh©çßÁ½¼ãÉÀs·é
|
---|
390 | * [`Å éD
|
---|
391 | */
|
---|
392 | ret_exc:
|
---|
393 | ret_int:
|
---|
394 | /*
|
---|
395 | * ÝbNóÔÆ·éD±Ì_ÅÍCCPUbNóÔÉÍÈçÈ¢
|
---|
396 | * ibasepriÆlock_flagÆsaved_iipmÍXVµÈ¢jD
|
---|
397 | *
|
---|
398 | * ÝbNóÔÆ·éÌÍCßèæÌReLXgÌ`FbNÆC
|
---|
399 | * ßèæªñ^XNReLXgÅ Á½êÌ^[ðAg~bN
|
---|
400 | * És¤½ßÅ éDbsepriðCPUbNÌlÉ·é±ÆÅàAg~b
|
---|
401 | * NÈ`FbNÆAÍÂ\Å éªCÝ©ç^[µÄàC
|
---|
402 | * basepri ÌÝèàeͳÉßçÈ¢½ßCgp·é±ÆªÅ«È¢D
|
---|
403 | * êûCFAULTMASKÍCÝ©çÌ^[ÉæÁÄC'0'ÉN
|
---|
404 | * A³êéD
|
---|
405 | */
|
---|
406 | cpsid f
|
---|
407 |
|
---|
408 | /*
|
---|
409 | * ßèæÌReLXgÌ»è
|
---|
410 | *
|
---|
411 | * ÝnhÀsÉLRÉZbg³êéEXC_RETURNð`FbNµÄCßè
|
---|
412 | * æÅMSPªgíêÄ¢êÎCÝæªñ^XNReLXgÆ»è·éD
|
---|
413 | */
|
---|
414 | pop {r3} /* lrðX^bN©çæ¾ */
|
---|
415 | tst r3, #EXC_RETURN_PSP /* ßèæªPSPÈç ret_int_1 Ö */
|
---|
416 | bne ret_int_1
|
---|
417 | pop {r1} /* ³ÌÝDæx}XN(basepri)ðr1Ö */
|
---|
418 | b ret_int_2 /* ÌlðMSP©çæ¾ */
|
---|
419 |
|
---|
420 | /*
|
---|
421 | * êiÚÌÝÌoû
|
---|
422 | */
|
---|
423 | ret_int_1:
|
---|
424 | /*
|
---|
425 | * PSPã©çCEXC_RETURN(r0)ƳÌÝDæx}XN(basepri)(r1)
|
---|
426 | * ðæ¾
|
---|
427 | */
|
---|
428 | mrs r2, psp
|
---|
429 | ldmfd r2!, {r0,r1}
|
---|
430 | msr psp, r2
|
---|
431 |
|
---|
432 | /*
|
---|
433 | * reqflgð`FbN·é
|
---|
434 | *
|
---|
435 | * J[lÇàÌÝÍÖ~µ½óÔÅÀs·éKvª é½ßC
|
---|
436 | * FAULTMASKð'1'ɵ½óÔÅÀs·éD
|
---|
437 | * reqflgð`FbN·éOÉÝðÖ~·éÌÍCreqflgð`FbN
|
---|
438 | * µ½¼ãÉÝnhªN®³êC»ÌÅfBXpb`ªv
|
---|
439 | * ³ê½êÉC·®ÉfBXpb`³êȢƢ¤â誶¶é½ß
|
---|
440 | * Å éD
|
---|
441 | */
|
---|
442 | ldr r0, =reqflg /* reqflgªfalseÈç»ÌÜÜßé */
|
---|
443 | ldr r2, [r0]
|
---|
444 | cbnz r2, ret_int_3 /* trueÈçret_int_3Ö */
|
---|
445 |
|
---|
446 | ret_int_2:
|
---|
447 | /*
|
---|
448 | * ±±ÉÍÝbNóÔiFAULTMASKªZbgj³ê½óÔÅéD
|
---|
449 | * Thread[h©çÌ^[Éæè©®IÉÝbNðóÔÉÈéD
|
---|
450 | * ÝDæx}XNÍÝOÉóÔÉß·D
|
---|
451 | */
|
---|
452 | msr basepri, r1 /* ÝDæx}XNðÝOÉóÔÖ */
|
---|
453 | bx r3 /* ^[ */
|
---|
454 |
|
---|
455 |
|
---|
456 | ret_int_3:
|
---|
457 | /*
|
---|
458 | * ±±ÅÍCßèæª^XNÅ èCPSPãÉXNb`WX^Æ
|
---|
459 | * ÝDæx}XN(basepri)ªÛ¶³ê½óÔÉÈÁÄ¢éDܽC
|
---|
460 | * vZbTÍCHandler[hEÝbNóÔÆÈÁÄ¢éD
|
---|
461 | * ܽCr0ÉÍCreqflgÌAhXCr3ÉÍÝótÌlrÌlªÛ
|
---|
462 | * ³êÄ¢éD
|
---|
463 | */
|
---|
464 | /*
|
---|
465 | * ^XNáOnhâfBXpb`ð·éÛÉThread[hÖJÚ·é
|
---|
466 | * _~[ÌX^bNt[ð쬵ÄCbx½ßÅHandler[h©ç
|
---|
467 | * ^[·éDܽCxfBXpb`·éêàCÄÑèñ¾^X
|
---|
468 | * NÉßéÛÉÍCsvc½ßÅCsvc_handlerðÄÑo·D
|
---|
469 | * X^bNt[ÍCConfigureation and Control Register(CCR)Ì
|
---|
470 | * STKALIGNª'1'ÌêÍC8byte«EÉAC³êéD
|
---|
471 | * Ql : DDI0403B_arm_architecture_v7m_reference_manual(P.220)
|
---|
472 | * »Ì½ßC±Ì_ÌX^bNÍÝâáO¶É쬳ê½
|
---|
473 | * X^bNt[©çC8byte«EÌTCYɵĨÆCsvc_handler
|
---|
474 | * ÅX^bNt[ÌACgÌL³ÌmFðȪūéD
|
---|
475 | * ½¾µCVXeN®ãÍC®IÉCCRÌSTKALIGNÌÝèðÏX·éÌÍ
|
---|
476 | * Ö~Æ·éD
|
---|
477 | * ±Ì_ÍWÌX^bNt[ÍCÝEáO¶Æ¯Å
|
---|
478 | * é½ßC^XNX^bN(PSP)Í8byte«EÉÈÁÄ¢éD
|
---|
479 | */
|
---|
480 | mov r1, #0 /* reqflgðfalseÉ */
|
---|
481 | str r1, [r0]
|
---|
482 |
|
---|
483 | /*
|
---|
484 | * CPUbNóÔÉÚs·éD
|
---|
485 | *
|
---|
486 | * J[lÌÇàÌÝðÖ~·éæ¤ÉbasepriðÝèµC
|
---|
487 | * lock_flag Æ saved_iipm ðXV·éDsaved_iipmÍCßèæÌÝ
|
---|
488 | * Dæx}XNiÌà\»jÉÝè·éD
|
---|
489 | * ±Ì_ÅCPUbNóÔÆ·éÌÍCdispatcherÖªò·éÆC
|
---|
490 | * call_texrtnðÄÑo·ÉCCPUbNóÔÉÈÁÄ¢éKvª é
|
---|
491 | * ½ßÅ éD
|
---|
492 | * ȨC±ÌÌãCThread[hÖÌÚsðsȤ½ßCÝ
|
---|
493 | * bNóÔ(FAULTMASKð"1")ÍÛ·éD
|
---|
494 | */
|
---|
495 | ldr r1, =IIPM_LOCK /* CPUbNóÔ */
|
---|
496 | msr basepri, r1
|
---|
497 | mov r1, #0x01 /* lock_flag ð trueÉ */
|
---|
498 | ldr r0, =lock_flag
|
---|
499 | str r1, [r0]
|
---|
500 |
|
---|
501 | /*
|
---|
502 | * ÝDæx}XNðCSðóÔiTIPM_ENAALLjÉÝè·é
|
---|
503 | * ·ÅÉCPUbNóÔÈÌÅCsaved_iipmðIIPM_ENAALLÆ·éD
|
---|
504 | */
|
---|
505 | ldr r1, =IIPM_ENAALL
|
---|
506 | ldr r0, =saved_iipm /* saved_iipmÉÛ¶ */
|
---|
507 | str r1, [r0]
|
---|
508 |
|
---|
509 | /*
|
---|
510 | * Thread[hÖÚs·éD
|
---|
511 | *
|
---|
512 | * dispatcherâcall_texrnðÄÑo·êÍCThread[hÅ éK
|
---|
513 | * vª é½ßCPSPX^bNãÉ_~[ÌáOt[ðu¢ÄC
|
---|
514 | * [IÉÝnh©ç^[·éD
|
---|
515 | * ^[ƯÉFAULTMASKª©®IÉNA³êCJ[lÇOÌ
|
---|
516 | * ݪ³êéD
|
---|
517 | */
|
---|
518 | ldr r0, =ret_int_4 /* PC */
|
---|
519 | ldr r1, =EPSR_T /* xPSR(Trbgª'1'Å éKvª é) */
|
---|
520 | mrs r2, psp
|
---|
521 | stmfd r2!, {r0-r1} /* _~[t[ðX^bNãÉÏÞ */
|
---|
522 | /*sub r2, r2, #(EXC_FRAME_SIZE - (4*2)) /* r0-r3,r12,lrÌàeÍÝè·éKvªÈ¢ */
|
---|
523 | subs r2, #(EXC_FRAME_SIZE - (4*2)) /* r0-r3,r12,lrÌàeÍÝè·éKvªÈ¢ */
|
---|
524 | msr psp,r2
|
---|
525 | bx r3 /* Thread[hÖÚs */
|
---|
526 |
|
---|
527 | ret_int_4:
|
---|
528 | /*
|
---|
529 | * ãLÌÉæèCThread[hÅÀs³êéD
|
---|
530 | * dspflgªfalseÅ éêÆCp_runtskÆp_schedtskª¯¶êÉÍC
|
---|
531 | * fBXpb`ðsíÈ¢D±Ì`FbNªKvÈÌÍC^XNáO
|
---|
532 | * [`ÌÄoµªKvÈêÉCfBXpb`ªKvÈÄàC
|
---|
533 | * reqflgðtrueÉ·é½ßÅ éD
|
---|
534 | */
|
---|
535 | ldr r0, =p_runtsk /* fBXpb`ðsíÈ¢êÅàCr1Ép_runtsk Ìl(TCB) */
|
---|
536 | ldr r1, [r0] /* ªüÁÄ¢éKvª éÌÅCæÉÇÝÞ */
|
---|
537 | ldr r0, =dspflg
|
---|
538 | ldr r2, [r0]
|
---|
539 | cbz r2, ret_int_r_1 /* dspflgªfalseÈçret_int_r_1Ö */
|
---|
540 | ldr r0, =p_schedtsk
|
---|
541 | ldr r2, [r0]
|
---|
542 | cmp r1, r2 /* p_runtskÆp_schedtskª¯¶Èç */
|
---|
543 | beq ret_int_r_1 /* ret_int_r_1Ö */
|
---|
544 | stmfd sp!, {r4-r11} /* cèÌWX^ðÛ¶ */
|
---|
545 | str sp, [r1,#TCB_sp] /* ^XNX^bNðÛ¶ */
|
---|
546 | ldr lr, =ret_int_r /* ÀsÄJÔnðÛ¶ */
|
---|
547 | str lr, [r1,#TCB_pc]
|
---|
548 | b dispatcher /* fBXpb`Ö */
|
---|
549 |
|
---|
550 | /*
|
---|
551 | * ÝÉæèvGvg³ê½^XNÖÌ^[
|
---|
552 | *
|
---|
553 | * Thread[hÅCfBXpb`âÝÌoû©çÄÑo³êéD
|
---|
554 | * ÝÉæèvGvg³ê½^XNÖ^[·éÉÍC¢Á½ñ
|
---|
555 | * Handler[hÉÚsµCPCÉ0xfffffffdðãüµÄ^[·éKv
|
---|
556 | * ª éD»Ì½ßCSVCÉæèCSVCnhðÄÑoµCHandler[
|
---|
557 | * hÖÚs·éD
|
---|
558 | */
|
---|
559 | SECTION .text : CODE (2)
|
---|
560 | THUMB
|
---|
561 | ret_int_r:
|
---|
562 | pop {r4-r11} /* WX^ÌA */
|
---|
563 | ret_int_r_1:
|
---|
564 | /*
|
---|
565 | * enatexªtrueÅCtexptnª0ÅȯêÎC^XNáO[`ð
|
---|
566 | * ÄÑo·D
|
---|
567 | * dispatcher©çÄÑo³êé½ßCTCBÌAhXÍr1ÉüÁÄ¢é
|
---|
568 | */
|
---|
569 | ldrb r0, [r1,#TCB_enatex]
|
---|
570 | tst r0, #TCB_enatex_mask
|
---|
571 | beq ret_int_r_2 /* enatex ª false Èç ret_int_r_2Ö */
|
---|
572 | ldr r0, [r1,#TCB_texptn] /* texptnð[h */
|
---|
573 | cbz r0, ret_int_r_2 /* '0'Èç^[ */
|
---|
574 | ldr r1, =ipmflg /* ipmflgª false Èç^[ */
|
---|
575 | ldr r0, [r1]
|
---|
576 | cbz r0, ret_int_r_2
|
---|
577 | bl call_texrtn /* ^XNáO[`ÌÄÑoµ */
|
---|
578 | ret_int_r_2:
|
---|
579 | svc 0 /* SVCÌÄÑoµ */
|
---|
580 |
|
---|
581 | /*
|
---|
582 | * SVCnh
|
---|
583 | */
|
---|
584 | PUBLIC svc_handler
|
---|
585 | IMPORT lock_flag
|
---|
586 |
|
---|
587 | SECTION .text : CODE (2)
|
---|
588 | THUMB
|
---|
589 | svc_handler:
|
---|
590 | /*
|
---|
591 | * Ý©çÌ^[ÉæèCCPUbNðóÔÉÚs·éæ
|
---|
592 | * ¤õ·éD
|
---|
593 | */
|
---|
594 | cpsid f /* ÝbNóÔÖ */
|
---|
595 | mrs r0, psp
|
---|
596 | /*add r0, r0, #EXC_FRAME_SIZE /* X^bNðÌÄé */
|
---|
597 | adds r0, #EXC_FRAME_SIZE /* X^bNðÌÄé */
|
---|
598 | msr psp, r0
|
---|
599 | mov r0, #0
|
---|
600 | ldr r1, =lock_flag /* CPUbNðóÔÖ */
|
---|
601 | str r0, [r1]
|
---|
602 | ldr r1, =IIPM_ENAALL /* ÝDæx}XNðSðóÔÉÝè */
|
---|
603 | msr basepri, r1 /* ÝDæx}XNðÝè */
|
---|
604 | bx lr /* ^[ */
|
---|
605 |
|
---|
606 | /*
|
---|
607 | * fBXpb`Ì®ìJn
|
---|
608 | */
|
---|
609 | PUBLIC start_dispatch
|
---|
610 | IMPORT istkpt
|
---|
611 |
|
---|
612 | PUBLIC exit_and_dispatch
|
---|
613 | IMPORT p_runtsk
|
---|
614 | IMPORT log_dsp_enter
|
---|
615 | IMPORT p_schedtsk
|
---|
616 | IMPORT log_dsp_leave
|
---|
617 | IMPORT reqflg
|
---|
618 | IMPORT lock_flag
|
---|
619 | IMPORT saved_iipm
|
---|
620 |
|
---|
621 | SECTION .text : CODE (2)
|
---|
622 | THUMB
|
---|
623 | start_dispatch:
|
---|
624 | /*
|
---|
625 | * ±Ì[`ÍCJ[lN®ÉC·×ÄÌÝðÖ~µ½óÔ
|
---|
626 | * iÝbNóÔƯjÅÄÑo³êéDܽCÝ[hiñ
|
---|
627 | * ^XNReLXgƯjÅÄÑo³êé±ÆðzèµÄ¢éD
|
---|
628 | *
|
---|
629 | * prc_initializeÅClock_flagðtrueÉCsaved_iipmðIIPM_ENAALLÉ
|
---|
630 | * ú»µÄ¢é½ßCJ[lÇOÌÝð·é±ÆÅC
|
---|
631 | * CPUbNóÔEifãÌjÝDæx}XNSðóÔÉÈéD
|
---|
632 | * ܽCtask_initializeÅdisdspðfalseÉú»µÄ¢é½ßCfB
|
---|
633 | * Xpb`ÂóÔÉÈÁÄ¢éD
|
---|
634 | */
|
---|
635 | ldr r0,=istkpt /* MSPðú» */
|
---|
636 | ldr r1,[r0] /* start_dispatchÄÑoµÉÄÑoµpÉ */
|
---|
637 | msr msp, r1 /* gpµÄ¢é½ßú»·é */
|
---|
638 | ldr r1, =IIPM_LOCK /* J[lÇàÌÝðÖ~ */
|
---|
639 | msr basepri, r1
|
---|
640 | cpsie f /* J[lÇOÌÝð */
|
---|
641 | mov r0, #CONTROL_PSP /* PSPðLøÉ */
|
---|
642 | msr control, r0
|
---|
643 | isb /* control ÌìãÉKv */
|
---|
644 |
|
---|
645 | /*
|
---|
646 | * »ÝÌReLXgðÌÄÄfBXpb`
|
---|
647 | */
|
---|
648 | exit_and_dispatch:
|
---|
649 | /* fBXpb`{ÌidispatcherjÖ */
|
---|
650 |
|
---|
651 |
|
---|
652 | /*
|
---|
653 | * fBXpb`{Ì
|
---|
654 | */
|
---|
655 | dispatcher:
|
---|
656 | /*
|
---|
657 | * ±Ì[`ÍC^XNReLXgECPUbNóÔEfBXpb`
|
---|
658 | * ÂóÔEifãÌjÝDæx}XNSðóÔÅÄÑo³
|
---|
659 | * êéD
|
---|
660 | *
|
---|
661 | * ·Èí¿CThread[hElock_flagªtrueEdisdspªfalseEdspflg
|
---|
662 | * ªtrueEsaved_iipmªIIPM_ENAALLÆÈÁÄ¢éDÀsÄJÔnÖà±
|
---|
663 | * ÌóÔÌÜܪò·éD
|
---|
664 | */
|
---|
665 | #ifdef LOG_DSP_ENTER
|
---|
666 | ldr r1, =p_runtsk /* p_runtskðp[^É */
|
---|
667 | ldr r0, [r1]
|
---|
668 | bl log_dsp_enter
|
---|
669 | #endif /* LOG_DSP_ENTER */
|
---|
670 | dispatcher_0:
|
---|
671 | ldr r0, =p_schedtsk /* p_schedtskðp_runtskÉ */
|
---|
672 | ldr r1, [r0]
|
---|
673 | ldr r2, =p_runtsk
|
---|
674 | str r1, [r2]
|
---|
675 | cbz r1, dispatcher_1 /* p_runtsk¤¬NULL¤Ê¤édispatcher_1¤Ø */
|
---|
676 | ldr sp, [r1,#TCB_sp] /* ^XNX^bNðA */
|
---|
677 | #ifdef LOG_DSP_LEAVE
|
---|
678 | mov r0, r1 /* p_runtskðp[^É */
|
---|
679 | mov r4, r1 /* r1ÍXNb`WX^ÈÌÅÛ¶ */
|
---|
680 | bl log_dsp_leave
|
---|
681 | mov r1, r4
|
---|
682 | #endif /* LOG_DSP_LEAVE */
|
---|
683 | ldr pc, [r1,#TCB_pc] /* ÀsÄJÔnðA */
|
---|
684 | dispatcher_1:
|
---|
685 | /*
|
---|
686 | * CPUbNóÔÌðÆCñ^XNReLXgÀsóÔÖÌ
|
---|
687 | * õð·é
|
---|
688 | */
|
---|
689 | mov r0, #CONTROL_MSP /* MSPðLøÉ */
|
---|
690 | msr control, r0
|
---|
691 | isb /* control ÌìãÉKv */
|
---|
692 | /*--> ldr r2, =reqflg /* r2 <- reqflg */
|
---|
693 | /*--> ldr r1, =IIPM_LOCK /* ÝbNóÔÌÝDæx}XNÌl */
|
---|
694 | /*--> mov r0, #0 */
|
---|
695 | /*--> ldr r4, =lock_flag /* CPUbNðóÔÖ */
|
---|
696 | /*--> str r0, [r4] */
|
---|
697 | mov r4, #0 /* r4 <- '0' */
|
---|
698 | ldr r5, =IIPM_LOCK /* r5 <- ÝbNóÔÌÝDæx}XNÌl */
|
---|
699 | ldr r6, =reqflg /* r6 <- reqflg */
|
---|
700 | ldr r7, =lock_flag /* r7 <- lock_flg */
|
---|
701 | str r4, [r7] /* CPUbNðóÔÖ */
|
---|
702 | dispatcher_2:
|
---|
703 | /*
|
---|
704 | * ÝðµCñ^XNReLXgÀsóÔƵÝðÒÂD
|
---|
705 | *
|
---|
706 | * ±±Åñ^XNReLXgÀsóÔÉØè·¦éÌÍC±±Å¶
|
---|
707 | * ·éÝÉÇÌX^bNðg¤©Æ¢¤âèÌðÆCÝ
|
---|
708 | * nhàÅÌ^XNfBXpb`Ìh~Æ¢¤2ÂÌÓ¡ª éD
|
---|
709 | *
|
---|
710 | * vZbTðÝÒ¿ÉÚs³¹éÆCÝÂÆÍCsÂ
|
---|
711 | * ªÉsȤKvª éD
|
---|
712 | * ±êðsªÉsÈíÈ¢êCÝðµ½¼ãÉ
|
---|
713 | * ݪüèC»ÌÅ^XNªÀsÂ\óÔÉÈéÆCÀs·×«^X
|
---|
714 | * Nª éÉà©©íç¸vZbTªÝÒ¿ÉÈÁĵܤD
|
---|
715 | * ARM-MÅÍCPRIMASKðZbgµ½óÔÅWFIðÄÑo·±ÆÅÀ»Å«éD
|
---|
716 | * ±ÌóÔÅݪüéÆCÝÍÀs³ê¸CWFI©ç^[·
|
---|
717 | * é±ÆÉÈéÌÅCêUÝðµÄÝnhðÀs·éD
|
---|
718 | *
|
---|
719 | * ÝÒ¿ÌÔÍCp_runtskðNULLi0jÉÝèµÈ¯êÎÈçÈ
|
---|
720 | * ¢D±Ìæ¤ÉÝèµÈ¢ÆCÝnh©çiget_tidðÄÑo
|
---|
721 | * µ½ÛÌ®ìªdlÉvµÈÈéD
|
---|
722 | *
|
---|
723 | */
|
---|
724 | #ifdef TOPPERS_CUSTOM_IDLE
|
---|
725 | toppers_asm_custom_idle
|
---|
726 | #else
|
---|
727 | cpsid i /* PRIMASK ðZbg */
|
---|
728 | /*--> msr basepri, r0 /* SÝÂ */
|
---|
729 | /*--> wfi */
|
---|
730 | /*--> cpsie i /* PRIMASK ðNAiÝðó¯t¯éj */
|
---|
731 | /*--> msr basepri, r1 /* CPUbNóÔÖ */
|
---|
732 | msr basepri, r4 /* SÝÂ */
|
---|
733 | wfi
|
---|
734 | cpsie i /* PRIMASK ðNAiÝðó¯t¯éj */
|
---|
735 | msr basepri, r5 /* CPUbNóÔÖ */
|
---|
736 |
|
---|
737 | #endif /* TOPPERS_CUSTOM_IDLE */
|
---|
738 |
|
---|
739 | /*--> ldr r6, [r2] /* reqflgªfalseÈçdispatcher_2Ö */
|
---|
740 | /*--> cmp r6, #0 */
|
---|
741 | /*--> beq dispatcher_2 */
|
---|
742 | /*--> str r0, [r2] /* reqflgðfalseÉ */
|
---|
743 | ldr r0, [r6] /* reqflgªfalseÈçdispatcher_2Ö */
|
---|
744 | cmp r0, #0
|
---|
745 | beq dispatcher_2
|
---|
746 | str r4, [r6] /* reqflgðfalseÉ */
|
---|
747 |
|
---|
748 | /*
|
---|
749 | * CPUbNóÔÉß·DÝÒ¿ÌÔÉÀsµ½ÝnhÉæ
|
---|
750 | * èCsaved_iipmª«·¦çêéÂ\«ª é½ßC³ÌlÉß·K
|
---|
751 | * vª éDdispatcherªÀs³êéÍCsaved_iipmªIIPM_ENAALL
|
---|
752 | * ÆÈÁÄ¢é½ßC±±ÅÍsaved_iipmðIIPM_ENAALLi0jÉß¹
|
---|
753 | * 뾢D
|
---|
754 | */
|
---|
755 | mov r0, #CONTROL_PSP /* PSPðLøÉ */
|
---|
756 | msr control, r0
|
---|
757 | isb /* control ÌìãÉKv */
|
---|
758 | /*--> mov r2, #1 /* lock_flagðtrueÖ */
|
---|
759 | /*--> ldr r4, =lock_flag
|
---|
760 | /*--> str r2, [r4]
|
---|
761 | /*--> ldr r4, =saved_iipm /* saved_iipm ð0É */
|
---|
762 | /*--> mov r0, #0
|
---|
763 | /*--> str r0, [r4]
|
---|
764 | /*--> b dispatcher_0 */
|
---|
765 | mov r2, #1 /* lock_flagðtrueÖ */
|
---|
766 | str r2, [r7]
|
---|
767 | ldr r0, =saved_iipm /* saved_iipm ð0É */
|
---|
768 | str r4, [r0]
|
---|
769 | b dispatcher_0
|
---|
770 |
|
---|
771 |
|
---|
772 | /*
|
---|
773 | * J[lÌI¹ÌÄoµ
|
---|
774 | *
|
---|
775 | * X^bNðñ^XNReLXgpÉØèÖ¦D
|
---|
776 | *
|
---|
777 | */
|
---|
778 | PUBLIC call_exit_kernel
|
---|
779 | IMPORT exit_kernel
|
---|
780 |
|
---|
781 | SECTION .text : CODE (2)
|
---|
782 | THUMB
|
---|
783 | call_exit_kernel:
|
---|
784 | mov r0, #CONTROL_MSP
|
---|
785 | msr control, r0 /* MSPðLøÉ */
|
---|
786 | isb /* control ÌìãÉKv */
|
---|
787 | /*--> b exit_kernel /* J[lÌI¹ðÄÔ */
|
---|
788 | ldr r0, =exit_kernel /* J[lÌI¹ðÄÔ */
|
---|
789 | bx r0
|
---|
790 |
|
---|
791 | /*
|
---|
792 | * ^XNN®
|
---|
793 | *
|
---|
794 | * dispatcher©çÄÑo³êé½ßCTCBÌAhXÍr1ÉüÁÄ¢é
|
---|
795 | *
|
---|
796 | */
|
---|
797 | PUBLIC start_r
|
---|
798 | IMPORT lock_flag
|
---|
799 | IMPORT ext_tsk
|
---|
800 |
|
---|
801 | SECTION .text : CODE (2)
|
---|
802 | THUMB
|
---|
803 | start_r:
|
---|
804 | mov r0, #0
|
---|
805 | ldr r4, =lock_flag /* CPUbNðóÔÖ */
|
---|
806 | str r0, [r4]
|
---|
807 | msr basepri, r0 /* ÝÂ */
|
---|
808 | ldr lr, =ext_tsk /* ßèÔnÝè */
|
---|
809 | ldr r2, [r1, #TCB_p_tinib] /* p_runtsk->p_tinibðr2É */
|
---|
810 | ldr r0, [r2, #TINIB_exinf] /* exinfðøWX^r0É */
|
---|
811 | ldr r1, [r2, #TINIB_task] /* ^XNN®ÔnÉWv */
|
---|
812 | /*mov pc, r1 */
|
---|
813 | bx r1
|
---|
814 |
|
---|
815 | /*
|
---|
816 | * ÷ÔÒ¿
|
---|
817 | */
|
---|
818 | PUBLIC sil_dly_nse
|
---|
819 |
|
---|
820 | SECTION .text : CODE (2)
|
---|
821 | THUMB
|
---|
822 | sil_dly_nse:
|
---|
823 | sub r0, r0, #SIL_DLY_TIM1
|
---|
824 | cmp r0, #0
|
---|
825 | bgt sil_dly_nse1
|
---|
826 | /*mov pc, lr*/
|
---|
827 | bx lr
|
---|
828 | sil_dly_nse1:
|
---|
829 | sub r0, r0, #SIL_DLY_TIM2
|
---|
830 | cmp r0, #0
|
---|
831 | bgt sil_dly_nse1
|
---|
832 | /*mov pc, lr*/
|
---|
833 | bx lr
|
---|
834 |
|
---|
835 | END
|
---|
836 |
|
---|