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 | /*
|
---|
45 | * vZbT˶W
|
---|
46 | [iARM-Mpj
|
---|
47 | *
|
---|
48 | * ±ÌCN[ht@CÍCtarget_config.hiܽÍC»±©çCN
|
---|
49 | * [h³êét@CjÌÝ©çCN[h³êéD¼Ìt@C©ç
|
---|
50 | * ¼ÚCN[hµÄÍÈçÈ¢D
|
---|
51 | */
|
---|
52 |
|
---|
53 | #ifndef TOPPERS_PRC_CONFIG_H
|
---|
54 | #define TOPPERS_PRC_CONFIG_H
|
---|
55 |
|
---|
56 | #ifndef TOPPERS_MACRO_ONLY
|
---|
57 |
|
---|
58 | /*
|
---|
59 | * vZbTÌÁê½ßÌCCÖè`
|
---|
60 | */
|
---|
61 | #include "prc_insn.h"
|
---|
62 |
|
---|
63 |
|
---|
64 | #define TOPPERS_EMPTY_LABEL(x,y) x y[1]
|
---|
65 |
|
---|
66 |
|
---|
67 | /*
|
---|
68 | * ^[Qbg˶ÌIuWFNg®«
|
---|
69 | */
|
---|
70 | #define TARGET_INHATR TA_NONKERNEL /* ^[Qbgè`ÌÝnh®« */
|
---|
71 |
|
---|
72 | /*
|
---|
73 | * G[`FbNû@Ìwè
|
---|
74 | */
|
---|
75 | #define CHECK_STKSZ_ALIGN 8 /* X^bNTCYÌACPÊ */
|
---|
76 | #define CHECK_FUNC_ALIGN 1 /* ÖÌACPÊ */
|
---|
77 | #define CHECK_FUNC_NONNULL /* ÖÌñNULL`FbN */
|
---|
78 | #define CHECK_STACK_ALIGN 8 /* X^bNÌæÌACPÊ */
|
---|
79 | #define CHECK_STACK_NONNULL /* X^bNÌæÌñNULL`FbN */
|
---|
80 | #define CHECK_MPF_ALIGN 4 /* Åè·v[ÌæÌACPÊ */
|
---|
81 | #define CHECK_MPF_NONNULL /* Åè·v[ÌæÌñNULL`FbN */
|
---|
82 | #define CHECK_MB_ALIGN 4 /* ÇÌæÌACPÊ */
|
---|
83 |
|
---|
84 | /*
|
---|
85 | * ñ^XNReLXgpÌX^bNúl
|
---|
86 | */
|
---|
87 | #define TOPPERS_ISTKPT(istk, istksz) ((STK_T *)((char_t *)(istk) + (istksz)))
|
---|
88 |
|
---|
89 | /*
|
---|
90 | * ^XNReLXgubNÌè`
|
---|
91 | */
|
---|
92 | typedef struct task_context_block {
|
---|
93 | void *sp; /* X^bN|C^ */
|
---|
94 | FP pc; /* vOJE^ */
|
---|
95 | } TSKCTXB;
|
---|
96 |
|
---|
97 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
98 |
|
---|
99 | #ifndef TOPPERS_MACRO_ONLY
|
---|
100 | /*
|
---|
101 | * ReLXgÌQÆ
|
---|
102 | *
|
---|
103 | */
|
---|
104 | #pragma inline
|
---|
105 | bool_t
|
---|
106 | sense_context(void)
|
---|
107 | {
|
---|
108 | /*
|
---|
109 | * PSPªLøÈç^XNReLXgCMSPªLøÈçñ^XNReLXg
|
---|
110 | * Æ·éD
|
---|
111 | */
|
---|
112 | if ((get_control() & CONTROL_PSP) == CONTROL_PSP){
|
---|
113 | return false;
|
---|
114 | }
|
---|
115 | else {
|
---|
116 | return true;
|
---|
117 | }
|
---|
118 | }
|
---|
119 |
|
---|
120 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
121 |
|
---|
122 | /*
|
---|
123 | * TOPPERSWÝfÌÀ»
|
---|
124 | *
|
---|
125 | * ÝDæx}XNƵÄÍCBASEPRIðp¢éDSÝðÖ~·é
|
---|
126 | * @\ƵÄCFAULTMASKâPRIMASKª éªCJ[lÇOÌÝð
|
---|
127 | * T|[g·é½ßC±êçÍCPUbN̽ßÉp¢È¢D
|
---|
128 | * »Ì½ßCBASEPRIðp¢Ä[IÉCPUbNtOðÀ»·éD
|
---|
129 | *
|
---|
130 | * ܸCCPUbNóÔðÇ·½ßÌÏ(lock_flag)ðpÓ·éD
|
---|
131 | *
|
---|
132 | * CPUbNtOªNA³êÄ¢éÔÍCBASEPRIðfãÌÝ
|
---|
133 | * Dæx}XNÌlÉÝè·éD±ÌÔÍCfãÌÝDæx}X
|
---|
134 | * NÍCBASEPRIðp¢éD
|
---|
135 | *
|
---|
136 | * »êÉεÄCPUbNtOªZbg³ê¢éÔÍCBASEPRIðCJ[l
|
---|
137 | * ÇOÌàÌð·×ÄÌÝvð}XN·él(TIPM_LOCK)ÆC
|
---|
138 | * fãÌÝDæx}XNÆÌ¢ûÉÝè·éD±ÌÔÌfã
|
---|
139 | * ÌÝDæx}XNÍC»Ì½ßÌÏ(saved_iipm, à\»ÅÛ)
|
---|
140 | * ðpÓµÄÛ·éD
|
---|
141 | */
|
---|
142 |
|
---|
143 | /*
|
---|
144 | * ÝDæx}XNÌO\»Æà\»ÌÏ·
|
---|
145 | *
|
---|
146 | * AZu¾êÌ\[Xt@C©çCN[h·éê̽ßÉC
|
---|
147 | * CASTðgp
|
---|
148 | * ÝDæxÌrbg(TBITW_IPRI)ª 8 ÌêÍCàDæx 255
|
---|
149 | * ÍCODæx -1 ÉηéD
|
---|
150 | */
|
---|
151 | #define EXT_IPM(iipm) (CAST(PRI,((iipm >> (8 - TBITW_IPRI)) - (1 << TBITW_IPRI)))) /* à\»ðO\»É */
|
---|
152 | #define INT_IPM(ipm) (((1 << TBITW_IPRI) - CAST(uint8_t, -(ipm))) << (8 - TBITW_IPRI)) /* O\»ðà\»É */
|
---|
153 |
|
---|
154 | /*
|
---|
155 | * CPUbNóÔÅÌÝDæx}XN
|
---|
156 | */
|
---|
157 | #define TIPM_LOCK TMIN_INTPRI
|
---|
158 |
|
---|
159 | /*
|
---|
160 | * CPUbNóÔÅÌÝDæx}XNÌà\»
|
---|
161 | *
|
---|
162 | * TIPM_LOCKÍCCPUbNóÔÅÌBASEPRIÌlDJ[lÇOÌàÌð
|
---|
163 | * ·×ÄÌÝð}XN·élÉè`·éD
|
---|
164 | */
|
---|
165 | #define IIPM_LOCK INT_IPM(TIPM_LOCK)
|
---|
166 |
|
---|
167 | /*
|
---|
168 | * TIPM_ENAALLiÝDæx}XNSðjÌà\»
|
---|
169 | *
|
---|
170 | * BASEPRIÉ '0' ðÝè·é±ÆÅCSÝð·éD
|
---|
171 | */
|
---|
172 | #define IIPM_ENAALL (0)
|
---|
173 |
|
---|
174 | #define _kernel_vector_table __vector_table
|
---|
175 |
|
---|
176 | #ifndef TOPPERS_MACRO_ONLY
|
---|
177 |
|
---|
178 | /*
|
---|
179 | * CPUbNtOÀ»Ì½ßÌÏ
|
---|
180 | *
|
---|
181 | * ±êçÌÏÍCCPUbNóÔÌÌÝ«·¦Äàæ¢Æ·éD
|
---|
182 | * CCÖÅCANZX̪ϻµÈ¢æ¤Cvolatile ðwèD
|
---|
183 | */
|
---|
184 | extern volatile bool_t lock_flag; /* CPUbNtOÌlðÛ·éÏ */
|
---|
185 | extern volatile uint32_t saved_iipm; /* ÝDæxð}XN·éÏ */
|
---|
186 |
|
---|
187 | /*
|
---|
188 | * CPUbNóÔÖÌÚs
|
---|
189 | *
|
---|
190 | * BASEPRIin[hEFAÌÝDæx}XNjðCsaved_iipmÉÛ¶µC
|
---|
191 | * J[lÇOÌàÌð·×ÄÌÝð}XN·éliTIPM_LOCKj
|
---|
192 | * ÉÝè·éDܽClock_flagðtrueÉ·éD
|
---|
193 | *
|
---|
194 | * BASEPRIªCÅ©çTIPM_LOCKƯ¶©»êæè¢êÉÍC»êð
|
---|
195 | * saved_iipmÉÛ¶·éÌÝÅCTIPM_LOCKÉÍÝèµÈ¢D±êÍCf
|
---|
196 | * ãÌÝDæx}XNªCTIPM_LOCKƯ¶©»êæè¢xÉÝè
|
---|
197 | * ³êÄ¢éóÔÉ ½éD
|
---|
198 | *
|
---|
199 | * ±ÌÖÍCCPUbNóÔilock_flagªtrueÌóÔjÅÄÎêé±ÆÍ
|
---|
200 | * È¢àÌÆzèµÄ¢éD
|
---|
201 | */
|
---|
202 | #pragma inline
|
---|
203 | void
|
---|
204 | x_lock_cpu(void)
|
---|
205 | {
|
---|
206 | uint32_t iipm;
|
---|
207 |
|
---|
208 | /*
|
---|
209 | * current_iipm()ÌÔèlð¼Úsaved_iipmÉÛ¶¹¸CêÏiipm
|
---|
210 | * ðp¢Ä¢éÌÍCcurrent_iipm()ðÄñ¾¼ãÉݪ¶µC
|
---|
211 | * N®³ê½ÝÅsaved_iipmªÏX³êéÂ\«ª é½ßÅ
|
---|
212 | * éD
|
---|
213 | */
|
---|
214 | iipm = get_basepri();
|
---|
215 | if ((IIPM_LOCK < iipm) || (IIPM_ENAALL == iipm)) {
|
---|
216 | set_basepri(IIPM_LOCK);
|
---|
217 | }
|
---|
218 | saved_iipm = iipm;
|
---|
219 | lock_flag = true;
|
---|
220 | /* NeBJZNVÌOãŪ«·íéÂ\«ª é */
|
---|
221 | Asm("":::"memory");
|
---|
222 | }
|
---|
223 |
|
---|
224 | #define t_lock_cpu() x_lock_cpu()
|
---|
225 | #define i_lock_cpu() x_lock_cpu()
|
---|
226 |
|
---|
227 | /*
|
---|
228 | * CPUbNóÔÌð
|
---|
229 | *
|
---|
230 | * lock_flagðfalseɵCIPMin[hEFAÌÝDæx}XNjðC
|
---|
231 | * saved_iipmÉÛ¶µ½lÉß·D
|
---|
232 | *
|
---|
233 | * ±ÌÖÍCCPUbNóÔilock_flagªtrueÌóÔjÅÌÝÄÎêéà
|
---|
234 | * ÌÆzèµÄ¢éD
|
---|
235 | */
|
---|
236 | #pragma inline
|
---|
237 | void
|
---|
238 | x_unlock_cpu(void)
|
---|
239 | {
|
---|
240 | /* NeBJZNVÌOãŪ«·íéÂ\«ª é */
|
---|
241 | Asm("":::"memory");
|
---|
242 | lock_flag = false;
|
---|
243 | set_basepri(saved_iipm);
|
---|
244 | }
|
---|
245 |
|
---|
246 | #define t_unlock_cpu() x_unlock_cpu()
|
---|
247 | #define i_unlock_cpu() x_unlock_cpu()
|
---|
248 |
|
---|
249 | /*
|
---|
250 | * CPUbNóÔÌQÆ
|
---|
251 | */
|
---|
252 | #pragma inline
|
---|
253 | bool_t
|
---|
254 | x_sense_lock(void)
|
---|
255 | {
|
---|
256 | return(lock_flag);
|
---|
257 | }
|
---|
258 |
|
---|
259 | #define t_sense_lock() x_sense_lock()
|
---|
260 | #define i_sense_lock() x_sense_lock()
|
---|
261 |
|
---|
262 | /*
|
---|
263 | * chg_ipmÅLøÈÝDæxÌÍÍÌ»è
|
---|
264 | *
|
---|
265 | * TMIN_INTPRIÌlÉæç¸Cchg_ipmÅÍC-(1 << TBITW_IPRI)`TIPM_ENAALLi0j
|
---|
266 | * ÌÍÍÉÝèÅ«é±ÆÆ·éi^[Qbgè`Ìg£jD
|
---|
267 | * ÝDæxÌrbg(TBITW_IPRI)ª 8 ÌêÍC-256 ` 0 ªwèÂ\Å éD
|
---|
268 | *
|
---|
269 | */
|
---|
270 | #define VALID_INTPRI_CHGIPM(intpri) \
|
---|
271 | ((-((1 << TBITW_IPRI) - 1) <= (intpri) && (intpri) <= TIPM_ENAALL))
|
---|
272 |
|
---|
273 | /*
|
---|
274 | * ifãÌjÝDæx}XNÌÝè
|
---|
275 | *
|
---|
276 | * CPUbNtOªNA³êÄ¢éÍCn[hEFAÌÝDæx}
|
---|
277 | * XNðÝè·éDCPUbNtOªZbg³êÄ¢éÍCsaved_iipm
|
---|
278 | * ðÝèµC³çÉCn[hEFAÌÝDæx}XNðCÝèµæ¤Æ
|
---|
279 | * µ½ifãÌjÝDæx}XNÆTIPM_LOCKÌ¢ûÉÝè·éD
|
---|
280 | */
|
---|
281 | #pragma inline
|
---|
282 | void
|
---|
283 | x_set_ipm(PRI intpri)
|
---|
284 | {
|
---|
285 | uint8_t iipm = INT_IPM(intpri);
|
---|
286 |
|
---|
287 | if (intpri == TIPM_ENAALL){
|
---|
288 | iipm = IIPM_ENAALL;
|
---|
289 | }
|
---|
290 |
|
---|
291 | if (!lock_flag) {
|
---|
292 | set_basepri(iipm);
|
---|
293 | }
|
---|
294 | else {
|
---|
295 | saved_iipm = iipm;
|
---|
296 | set_basepri(iipm < IIPM_LOCK ? iipm : IIPM_LOCK);
|
---|
297 | }
|
---|
298 | }
|
---|
299 |
|
---|
300 | #define t_set_ipm(intpri) x_set_ipm(intpri)
|
---|
301 | #define i_set_ipm(intpri) x_set_ipm(intpri)
|
---|
302 |
|
---|
303 | /*
|
---|
304 | * ifãÌjÝDæx}XNÌQÆ
|
---|
305 | *
|
---|
306 | * CPUbNtOªNA³êÄ¢éÍn[hEFAÌÝDæx}
|
---|
307 | * XNðCZbg³êÄ¢éÍsaved_iipmðQÆ·éD
|
---|
308 | */
|
---|
309 | #pragma inline
|
---|
310 | PRI
|
---|
311 | x_get_ipm(void)
|
---|
312 | {
|
---|
313 | uint8_t iipm;
|
---|
314 |
|
---|
315 | if (!lock_flag) {
|
---|
316 | iipm = get_basepri();
|
---|
317 | }
|
---|
318 | else {
|
---|
319 | iipm = saved_iipm;
|
---|
320 | }
|
---|
321 |
|
---|
322 | if (iipm == IIPM_ENAALL) {
|
---|
323 | return(TIPM_ENAALL);
|
---|
324 | }
|
---|
325 | else {
|
---|
326 | return(EXT_IPM(iipm));
|
---|
327 | }
|
---|
328 | }
|
---|
329 |
|
---|
330 | #define t_get_ipm() x_get_ipm()
|
---|
331 | #define i_get_ipm() x_get_ipm()
|
---|
332 |
|
---|
333 | /*
|
---|
334 | * SVCnhiprc_support.Sj
|
---|
335 | */
|
---|
336 | extern void svc_handler(void);
|
---|
337 |
|
---|
338 | /*
|
---|
339 | * X^[gAbv[`istart.Sj
|
---|
340 | */
|
---|
341 | extern void _start(void);
|
---|
342 |
|
---|
343 | /*
|
---|
344 | * ÅDæÊ^XNÖÌfBXpb`iprc_support.Sj
|
---|
345 | *
|
---|
346 | * dispatchÍC^XNReLXg©çÄÑo³ê½T[rXR[©
|
---|
347 | * çÄÑo·×«àÌÅC^XNReLXgECPUbNóÔEfBXpb
|
---|
348 | * `ÂóÔEifãÌjÝDæx}XNSðóÔÅÄÑo³È
|
---|
349 | * ¯êÎÈçÈ¢D
|
---|
350 | */
|
---|
351 | extern void dispatch(void);
|
---|
352 |
|
---|
353 | /*
|
---|
354 | * fBXpb`Ì®ìJniprc_support.Sj
|
---|
355 | *
|
---|
356 | * start_dispatchÍCJ[lN®ÉÄÑo·×«àÌÅC·×ÄÌ
|
---|
357 | * ÝðÖ~µ½óÔiÝbNóÔƯÌóÔjÅÄÑo³È¯êÎ
|
---|
358 | * ÈçÈ¢D
|
---|
359 | */
|
---|
360 | extern NoReturn void start_dispatch(void);
|
---|
361 |
|
---|
362 | /*
|
---|
363 | * »ÝÌReLXgðÌÄÄfBXpb`iprc_support.Sj
|
---|
364 | *
|
---|
365 | * exit_and_dispatchÍCext_tsk©çÄÑo·×«àÌÅC^XNReL
|
---|
366 | * XgECPUbNóÔEfBXpb`ÂóÔEifãÌjÝDæ
|
---|
367 | * x}XNSðóÔÅÄÑo³È¯êÎÈçÈ¢D
|
---|
368 | */
|
---|
369 | extern NoReturn void exit_and_dispatch(void);
|
---|
370 |
|
---|
371 | /*
|
---|
372 | * J[lÌI¹ÌÄoµiprc_support.Sj
|
---|
373 | *
|
---|
374 | * call_exit_kernelÍCJ[lÌI¹ÉÄÑo·×«àÌÅCñ^XN
|
---|
375 | * ReLXgÉØè·¦ÄCJ[lÌI¹iexit_kerneljðÄÑo
|
---|
376 | * ·D
|
---|
377 | */
|
---|
378 | extern NoReturn void call_exit_kernel(void);
|
---|
379 |
|
---|
380 | /*
|
---|
381 | * ^XNReLXgÌú»
|
---|
382 | *
|
---|
383 | * ^XNªx~óÔ©çÀsÅ«éóÔÉÚs·éÉÄÎêéD±Ì_
|
---|
384 | * ÅX^bNÌæðgÁÄÍÈçÈ¢D
|
---|
385 | *
|
---|
386 | * activate_contextðCCCÖÅÍÈ}Nè`ƵĢéÌÍC
|
---|
387 | * ±Ì_ÅÍTCBªè`³êĢȢ½ßÅ éD
|
---|
388 | */
|
---|
389 | extern void start_r(void);
|
---|
390 |
|
---|
391 | #define activate_context(p_tcb) \
|
---|
392 | { \
|
---|
393 | (p_tcb)->tskctxb.sp = (void *)((char_t *)((p_tcb)->p_tinib->stk) \
|
---|
394 | + (p_tcb)->p_tinib->stksz); \
|
---|
395 | (p_tcb)->tskctxb.pc = (FP) start_r; \
|
---|
396 | }
|
---|
397 |
|
---|
398 | /*
|
---|
399 | * calltexÍgpµÈ¢
|
---|
400 | */
|
---|
401 | #define OMIT_CALLTEX
|
---|
402 |
|
---|
403 | /*
|
---|
404 | * ÝÔEÝnhÔ
|
---|
405 | *
|
---|
406 | * ÝnhÔ(inhno)ÆÝÔ(intno)ÍCèݶÉ
|
---|
407 | * EPSRÉÝè³êéáOÔÆ·éD
|
---|
408 | */
|
---|
409 |
|
---|
410 | /*
|
---|
411 | * ÝÔÌÍÍÌ»è
|
---|
412 | */
|
---|
413 | #define VALID_INTNO(intno) ((TMIN_INTNO <= (intno)) && ((intno) <= TMAX_INTNO))
|
---|
414 | #define VALID_INTNO_DISINT(intno) VALID_INTNO(intno)
|
---|
415 | #define VALID_INTNO_CFGINT(intno) VALID_INTNO(intno)
|
---|
416 |
|
---|
417 | /*
|
---|
418 | * ÝnhÌÝè
|
---|
419 | *
|
---|
420 | * xNgÔinhnoÌÝnhÌN®Ônint_entryÉÝè·éDÝ
|
---|
421 | * nhe[u
|
---|
422 | */
|
---|
423 | #pragma inline
|
---|
424 | void
|
---|
425 | x_define_inh(INHNO inhno, FP int_entry)
|
---|
426 | {
|
---|
427 |
|
---|
428 | }
|
---|
429 |
|
---|
430 | /*
|
---|
431 | * ÝnhÌoüû̶¬}N
|
---|
432 | *
|
---|
433 | */
|
---|
434 | #define INT_ENTRY(inhno, inthdr) inthdr
|
---|
435 | #define INTHDR_ENTRY(inhno, inhno_num, inthdr) extern void inthdr(void);
|
---|
436 |
|
---|
437 | /*
|
---|
438 | * ÝvÖ~tO
|
---|
439 | */
|
---|
440 |
|
---|
441 | /*
|
---|
442 | * Ý®«ªÝè³êÄ¢é©ð»Ê·é½ßÌÏikernel_cfg.cj
|
---|
443 | */
|
---|
444 | extern const uint32_t bitpat_cfgint[];
|
---|
445 |
|
---|
446 | /*
|
---|
447 | * ÝvÖ~tOÌZbg
|
---|
448 | *
|
---|
449 | * Ý®«ªÝè³êĢȢÝvCÉεÄÝvÖ~
|
---|
450 | * tOðNAµæ¤Æµ½êÉÍCfalseðÔ·D
|
---|
451 | */
|
---|
452 | #pragma inline
|
---|
453 | bool_t
|
---|
454 | x_disable_int(INTNO intno)
|
---|
455 | {
|
---|
456 | uint32_t tmp;
|
---|
457 |
|
---|
458 | /*
|
---|
459 | * Ý®«ªÝè³êĢȢê
|
---|
460 | */
|
---|
461 | if ((bitpat_cfgint[intno >> 5] & (1 << (intno & 0x1f))) == 0x00) {
|
---|
462 | return(false);
|
---|
463 | }
|
---|
464 |
|
---|
465 | if (intno == IRQNO_SYSTICK) {
|
---|
466 | tmp = sil_rew_mem((void *)SYSTIC_CONTROL_STATUS);
|
---|
467 | tmp &= ~SYSTIC_TICINT;
|
---|
468 | sil_wrw_mem((void *)SYSTIC_CONTROL_STATUS, tmp);
|
---|
469 | }else {
|
---|
470 | tmp = intno - 16;
|
---|
471 | sil_wrw_mem((void *)((uint32_t *)NVIC_CLRENA0 + (tmp >> 5)),
|
---|
472 | (1 << (tmp & 0x1f)));
|
---|
473 | }
|
---|
474 |
|
---|
475 | return(true);
|
---|
476 | }
|
---|
477 |
|
---|
478 | #define t_disable_int(intno) x_disable_int(intno)
|
---|
479 | #define i_disable_int(intno) x_disable_int(intno)
|
---|
480 |
|
---|
481 | /*
|
---|
482 | * ÝvÖ~tOÌð
|
---|
483 | *
|
---|
484 | * Ý®«ªÝè³êĢȢÝvCÉεÄÝvÖ~
|
---|
485 | * tOðNAµæ¤Æµ½êÉÍCfalseðÔ·D
|
---|
486 | */
|
---|
487 | #pragma inline
|
---|
488 | bool_t
|
---|
489 | x_enable_int(INTNO intno)
|
---|
490 | {
|
---|
491 | uint32_t tmp;
|
---|
492 |
|
---|
493 | /*
|
---|
494 | * Ý®«ªÝè³êĢȢê
|
---|
495 | */
|
---|
496 | if ((bitpat_cfgint[intno >> 5] & (1 << (intno & 0x1f))) == 0x00) {
|
---|
497 | return(false);
|
---|
498 | }
|
---|
499 |
|
---|
500 | if (intno == IRQNO_SYSTICK) {
|
---|
501 | tmp = sil_rew_mem((void *)SYSTIC_CONTROL_STATUS);
|
---|
502 | tmp |= SYSTIC_TICINT;
|
---|
503 | sil_wrw_mem((void *)SYSTIC_CONTROL_STATUS, tmp);
|
---|
504 | }else {
|
---|
505 | tmp = intno - 16;
|
---|
506 | sil_wrw_mem((void *)((uint32_t *)NVIC_SETENA0 + (tmp >> 5)),
|
---|
507 | (1 << (tmp & 0x1f)));
|
---|
508 | }
|
---|
509 |
|
---|
510 | return(true);
|
---|
511 | }
|
---|
512 |
|
---|
513 | #define t_enable_int(intno) x_enable_int(intno)
|
---|
514 | #define i_enable_int(intno) x_enable_int(intno)
|
---|
515 |
|
---|
516 | /*
|
---|
517 | * ÝvCÌ®«ÌÝè
|
---|
518 | */
|
---|
519 | extern void x_config_int(INTNO intno, ATR intatr, PRI intpri);
|
---|
520 |
|
---|
521 | /*
|
---|
522 | * ÝnhüûÅKvÈIRCì
|
---|
523 | */
|
---|
524 | #pragma inline
|
---|
525 | void
|
---|
526 | i_begin_int(INTNO intno)
|
---|
527 | {
|
---|
528 | }
|
---|
529 |
|
---|
530 | /*
|
---|
531 | * ÝnhÌoûÅKvÈIRCì
|
---|
532 | */
|
---|
533 | #pragma inline
|
---|
534 | void
|
---|
535 | i_end_int(INTNO intno)
|
---|
536 | {
|
---|
537 | }
|
---|
538 |
|
---|
539 | /*
|
---|
540 | * CPUáOnhÖW
|
---|
541 | */
|
---|
542 |
|
---|
543 | /*
|
---|
544 | * CPUáOnhÔ
|
---|
545 | */
|
---|
546 | #define VALID_EXCNO_DEFEXC(excno) (TMIN_EXCNO <= (excno) && (excno) <= TMAX_EXCNO)
|
---|
547 |
|
---|
548 | /*
|
---|
549 | * CPUáOnhÌÂ
|
---|
550 | */
|
---|
551 | extern void enable_exc(EXCNO excno);
|
---|
552 |
|
---|
553 | /*
|
---|
554 | * CPUáOnhÌÖ~
|
---|
555 | */
|
---|
556 | extern void disable_exc(EXCNO excno);
|
---|
557 |
|
---|
558 | /*
|
---|
559 | * CPUáOnhÌÝè
|
---|
560 | */
|
---|
561 | #pragma inline
|
---|
562 | void
|
---|
563 | x_define_exc(EXCNO excno, FP exc_entry)
|
---|
564 | {
|
---|
565 | /*
|
---|
566 | * êÌáOÍÂðs¤Kvª é
|
---|
567 | */
|
---|
568 | enable_exc(excno);
|
---|
569 | }
|
---|
570 |
|
---|
571 | /*
|
---|
572 | * CPUáOnhÌüû̶¬}N
|
---|
573 | */
|
---|
574 | #define EXC_ENTRY(excno, exchdr) exchdr
|
---|
575 | #define EXCHDR_ENTRY(excno, excno_num, exchdr) extern void exchdr(void *p_excinf);
|
---|
576 |
|
---|
577 | /*
|
---|
578 | * CPUáO̶µ½ÌReLXgÌQÆ
|
---|
579 | *
|
---|
580 | * CPUáO̶µ½ÌReLXgªC^XNReLXgÌÉfalseC
|
---|
581 | * »¤ÅÈ¢ÉtrueðÔ·D
|
---|
582 | */
|
---|
583 | #pragma inline
|
---|
584 | bool_t
|
---|
585 | exc_sense_context(void *p_excinf)
|
---|
586 | {
|
---|
587 | uint32_t exc_return;
|
---|
588 |
|
---|
589 | exc_return = *((uint32_t *)p_excinf + P_EXCINF_OFFSET_EXC_RETURN);
|
---|
590 | if ((exc_return & EXC_RETURN_PSP) == EXC_RETURN_PSP){
|
---|
591 | return false;
|
---|
592 | }
|
---|
593 | else {
|
---|
594 | return true;
|
---|
595 | }
|
---|
596 | }
|
---|
597 |
|
---|
598 | /*
|
---|
599 | * CPUáO̶µ½ÌIPMin[hEFAÌÝDæx}XNCà\
|
---|
600 | * »jÌQÆ
|
---|
601 | */
|
---|
602 | #pragma inline
|
---|
603 | uint32_t
|
---|
604 | exc_get_iipm(void *p_excinf)
|
---|
605 | {
|
---|
606 | return(*((uint32_t *)p_excinf + P_EXCINF_OFFSET_BASEPRI));
|
---|
607 | }
|
---|
608 |
|
---|
609 | /*
|
---|
610 | * CPUáO̶µ½ÌReLXgÆÝÌ}XNóÔÌQÆ
|
---|
611 | *
|
---|
612 | * CPUáO̶µ½ÌVXeóÔªCJ[lÀsÅÈC^XNR
|
---|
613 | * eLXgÅ èCÝbNóÔÅÈCCPUbNóÔÅÈCi
|
---|
614 | * fãÌjÝDæx}XNSðóÔÅ éÉtrueC»¤ÅÈ¢
|
---|
615 | * ÉfalseðÔ·iCPUáOªJ[lÇOÌÝŶµ½ê
|
---|
616 | * ÉàfalseðÔ·jD
|
---|
617 | *
|
---|
618 | * PUáO̶µ½ÌBASEPRIin[hEFAÌÝDæx}XNj
|
---|
619 | * ª·×ÄÌÝð·éóÔÅ é±Æð`FbN·é±ÆÅCJ[
|
---|
620 | * lÀsÅÈ¢±ÆCÝbNóÔÅÈ¢±ÆCCPUbNóÔÅÈ
|
---|
621 | * ¢±ÆCifãÌjÝDæx}XNSðóÔÅ é±ÆÌ4ÂÌ
|
---|
622 | * ðð`FbN·é±ÆªÅ«éiCPUáOª¶µ½Ìlock_flagðQ
|
---|
623 | * Æ·éKvÍÈ¢jD
|
---|
624 | */
|
---|
625 | #pragma inline
|
---|
626 | bool_t
|
---|
627 | exc_sense_intmask(void *p_excinf)
|
---|
628 | {
|
---|
629 | return(!exc_sense_context(p_excinf)
|
---|
630 | && (exc_get_iipm(p_excinf) == IIPM_ENAALL));
|
---|
631 | }
|
---|
632 |
|
---|
633 | /*
|
---|
634 | * CPUáOGgiprc_support.Sj
|
---|
635 | */
|
---|
636 | extern void core_exc_entry(void);
|
---|
637 |
|
---|
638 | /*
|
---|
639 | * ÝGgiprc_support.Sj
|
---|
640 | */
|
---|
641 | extern void core_int_entry(void);
|
---|
642 |
|
---|
643 | /*
|
---|
644 | * vZbT˶Ìú»
|
---|
645 | */
|
---|
646 | extern void core_initialize(void);
|
---|
647 |
|
---|
648 | /*
|
---|
649 | * vZbT˶ÌI¹
|
---|
650 | */
|
---|
651 | extern void core_terminate(void);
|
---|
652 |
|
---|
653 | /*
|
---|
654 | * o^³êĢȢáOª¶·éÆÄÑo³êé
|
---|
655 | */
|
---|
656 | extern void default_exc_handler(void *p_excinf);
|
---|
657 |
|
---|
658 | /*
|
---|
659 | * ¢o^Ìݪ¶µ½êÉÄÑo³êé
|
---|
660 | */
|
---|
661 | extern void default_int_handler(void *p_excinf);
|
---|
662 |
|
---|
663 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
664 | #endif /* TOPPERS_PRC_CONFIG_H */
|
---|