1 | /*
|
---|
2 | * TOPPERS/ASP Kernel
|
---|
3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
4 | * Advanced Standard Profile Kernel
|
---|
5 | *
|
---|
6 | * Copyright (C) 2006-2015 by Embedded and Real-Time Systems Laboratory
|
---|
7 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
8 | *
|
---|
9 | * ä¸è¨èä½æ¨©è
|
---|
10 | ã¯ï¼ä»¥ä¸ã®(1)ã(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
|
---|
11 | * ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹
|
---|
12 | * å¤ã»åé
|
---|
13 | å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
14 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
15 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
16 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
17 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
18 | * ç¨ã§ããå½¢ã§åé
|
---|
19 | å¸ããå ´åã«ã¯ï¼åé
|
---|
20 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
21 | * è
|
---|
22 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
23 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
24 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
25 | * ç¨ã§ããªãå½¢ã§åé
|
---|
26 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
27 | * ã¨ï¼
|
---|
28 | * (a) åé
|
---|
29 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
30 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
31 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
32 | * (b) åé
|
---|
33 | å¸ã®å½¢æ
|
---|
34 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
35 | * å ±åãããã¨ï¼
|
---|
36 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
37 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
38 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
39 | 責ãããã¨ï¼
|
---|
40 | * ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãç
|
---|
41 | * ç±ã«åºã¥ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
|
---|
42 | ããã³TOPPERSããã¸ã§ã¯ãã
|
---|
43 | * å
|
---|
44 | 責ãããã¨ï¼
|
---|
45 | *
|
---|
46 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
47 | ã
|
---|
48 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç
|
---|
49 | * ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§
|
---|
50 | * ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ã
|
---|
51 | * ã®è²¬ä»»ãè² ããªãï¼
|
---|
52 | *
|
---|
53 | * $Id: target_kernel_impl.h 479 2016-01-03 07:28:41Z ertl-hiro $
|
---|
54 | */
|
---|
55 |
|
---|
56 | /*
|
---|
57 | * ã«ã¼ãã«ã®ã¿ã¼ã²ããä¾åé¨ï¼Mac OS Xç¨ï¼
|
---|
58 | *
|
---|
59 | * ã«ã¼ãã«ã®ã¿ã¼ã²ããä¾åé¨ã®ããããã¡ã¤ã«ï¼kernel_impl.hã®ã¿ã¼ã²ã
|
---|
60 | * ãä¾åé¨ã®ä½ç½®ä»ãã¨ãªãï¼
|
---|
61 | */
|
---|
62 |
|
---|
63 | #ifndef TOPPERS_TARGET_KERNEL_IMPL_H
|
---|
64 | #define TOPPERS_TARGET_KERNEL_IMPL_H
|
---|
65 |
|
---|
66 | /*
|
---|
67 | * æ¨æºã®ã¤ã³ã¯ã«ã¼ããã¡ã¤ã«
|
---|
68 | */
|
---|
69 | #ifndef TOPPERS_MACRO_ONLY
|
---|
70 | #include <sys/types.h>
|
---|
71 | #include <stdlib.h>
|
---|
72 | #include <setjmp.h>
|
---|
73 | #include <signal.h>
|
---|
74 | #include <stdio.h>
|
---|
75 |
|
---|
76 | #include <kernel.h>
|
---|
77 | #include <t_syslog.h>
|
---|
78 | #ifdef TOPPERS_SUPPORT_OVRHDR
|
---|
79 | #include "overrun.h"
|
---|
80 | #endif /* TOPPERS_SUPPORT_OVRHDR */
|
---|
81 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
82 |
|
---|
83 | /*
|
---|
84 | * ã¿ã¼ã²ããã·ã¹ãã ã®OSä¾åã®å®ç¾©
|
---|
85 | */
|
---|
86 | #include "macosx.h"
|
---|
87 |
|
---|
88 | /*
|
---|
89 | * ã¿ã¼ã²ããå®ç¾©ã®ãªãã¸ã§ã¯ãå±æ§
|
---|
90 | */
|
---|
91 | #define TARGET_INHATR TA_NONKERNEL /* ã«ã¼ãã«ç®¡çå¤ã®å²è¾¼ã¿ */
|
---|
92 |
|
---|
93 | /*
|
---|
94 | * ã¨ã©ã¼ãã§ãã¯æ¹æ³ã®æå®
|
---|
95 | */
|
---|
96 | #define CHECK_STKSZ_ALIGN 16 /* ã¹ã¿ãã¯ãµã¤ãºã®ã¢ã©ã¤ã³åä½ */
|
---|
97 | #define CHECK_INTPTR_ALIGN 4 /* intptr_tåã®å¤æ°ã®ã¢ã©ã¤ã³åä½ */
|
---|
98 | #define CHECK_INTPTR_NONNULL /* intptr_tåã®å¤æ°ã®éNULLãã§ã㯠*/
|
---|
99 | #define CHECK_FUNC_ALIGN 4 /* é¢æ°ã®ã¢ã©ã¤ã³åä½ */
|
---|
100 | #define CHECK_FUNC_NONNULL /* é¢æ°ã®éNULLãã§ã㯠*/
|
---|
101 | #define CHECK_STACK_ALIGN 16 /* ã¹ã¿ãã¯é åã®ã¢ã©ã¤ã³åä½ */
|
---|
102 | #define CHECK_STACK_NONNULL /* ã¹ã¿ãã¯é åã®éNULLãã§ã㯠*/
|
---|
103 | #define CHECK_MPF_ALIGN 4 /* åºå®é·ã¡ã¢ãªãã¼ã«é åã®ã¢ã©ã¤ã³åä½ */
|
---|
104 | #define CHECK_MPF_NONNULL /* åºå®é·ã¡ã¢ãªãã¼ã«é åã®éNULLãã§ã㯠*/
|
---|
105 | #define CHECK_MB_ALIGN 4 /* 管çé åã®ã¢ã©ã¤ã³åä½ */
|
---|
106 |
|
---|
107 | /*
|
---|
108 | * ãã¬ã¼ã¹ãã°ã«é¢ããè¨å®
|
---|
109 | */
|
---|
110 | #ifdef TOPPERS_ENABLE_TRACE
|
---|
111 | #include "arch/logtrace/trace_config.h"
|
---|
112 | #endif /* TOPPERS_ENABLE_TRACE */
|
---|
113 |
|
---|
114 | /*
|
---|
115 | * ãã¬ã¼ã¹ãã°ãã¯ãã®ããã©ã«ãå®ç¾©
|
---|
116 | */
|
---|
117 | #ifndef LOG_INH_ENTER
|
---|
118 | #define LOG_INH_ENTER(inhno)
|
---|
119 | #endif /* LOG_INH_ENTER */
|
---|
120 |
|
---|
121 | #ifndef LOG_INH_LEAVE
|
---|
122 | #define LOG_INH_LEAVE(inhno)
|
---|
123 | #endif /* LOG_INH_LEAVE */
|
---|
124 |
|
---|
125 | #ifndef LOG_EXC_ENTER
|
---|
126 | #define LOG_EXC_ENTER(excno)
|
---|
127 | #endif /* LOG_EXC_ENTER */
|
---|
128 |
|
---|
129 | #ifndef LOG_EXC_LEAVE
|
---|
130 | #define LOG_EXC_LEAVE(excno)
|
---|
131 | #endif /* LOG_EXC_LEAVE */
|
---|
132 |
|
---|
133 | /*
|
---|
134 | * ã¢ã¼ããã¯ãã£ï¼ããã»ããµï¼ä¾åã®å®ç¾©
|
---|
135 | */
|
---|
136 | #if defined(__ppc__)
|
---|
137 |
|
---|
138 | #define JMPBUF_PC 21 /* jmp_bufä¸ã§ã®PCã®ä½ç½® */
|
---|
139 | #define JMPBUF_SP 0 /* jmp_bufä¸ã§ã®SPã®ä½ç½® */
|
---|
140 | #define TASK_STACK_MERGIN 4U
|
---|
141 | #define DEFAULT_ISTKSZ SIGSTKSZ /* ã·ã°ãã«ã¹ã¿ãã¯ã®ãµã¤ãº */
|
---|
142 |
|
---|
143 | #elif defined(__i386__)
|
---|
144 |
|
---|
145 | #define JMPBUF_PC 12 /* jmp_bufä¸ã§ã®PCã®ä½ç½® */
|
---|
146 | #define JMPBUF_SP 9 /* jmp_bufä¸ã§ã®SPã®ä½ç½® */
|
---|
147 | #define TASK_STACK_MERGIN 4U
|
---|
148 | #define DEFAULT_ISTKSZ SIGSTKSZ /* ã·ã°ãã«ã¹ã¿ãã¯ã®ãµã¤ãº */
|
---|
149 |
|
---|
150 | #elif defined(__x86_64__)
|
---|
151 |
|
---|
152 | #error architecture not supported
|
---|
153 | #define JMPBUF_PC 7 /* jmp_bufä¸ã§ã®PCã®ä½ç½® */
|
---|
154 | #define JMPBUF_SP 2 /* jmp_bufä¸ã§ã®SPã®ä½ç½® */
|
---|
155 | #define TASK_STACK_MERGIN 8U
|
---|
156 | #define DEFAULT_ISTKSZ SIGSTKSZ /* ã·ã°ãã«ã¹ã¿ãã¯ã®ãµã¤ãº */
|
---|
157 |
|
---|
158 | #else
|
---|
159 | #error architecture not supported
|
---|
160 | #endif
|
---|
161 |
|
---|
162 | /*
|
---|
163 | * æ¨æºã®å²è¾¼ã¿ç®¡çæ©è½ã®åæåãè¡ããªãããã®å®ç¾©
|
---|
164 | */
|
---|
165 | #define OMIT_INITIALIZE_INTERRUPT
|
---|
166 |
|
---|
167 | #ifndef TOPPERS_MACRO_ONLY
|
---|
168 |
|
---|
169 | /*
|
---|
170 | * ã¿ã¹ã¯ã³ã³ããã¹ããããã¯ã®å®ç¾©
|
---|
171 | */
|
---|
172 | typedef struct task_context_block {
|
---|
173 | jmp_buf env; /* ã³ã³ããã¹ãæ
|
---|
174 | å ± */
|
---|
175 | } TSKCTXB;
|
---|
176 |
|
---|
177 | /*
|
---|
178 | * å²è¾¼ã¿ãã³ãã©åæåãããã¯
|
---|
179 | *
|
---|
180 | * æ¨æºã®å²è¾¼ã¿ãã³ãã©åæåãããã¯ã«ï¼å²è¾¼ã¿åªå
|
---|
181 | 度ã追å ãããã®ï¼
|
---|
182 | */
|
---|
183 | typedef struct interrupt_handler_initialization_block {
|
---|
184 | INHNO inhno; /* å²è¾¼ã¿ãã³ãã©çªå· */
|
---|
185 | ATR inhatr; /* å²è¾¼ã¿ãã³ãã©å±æ§ */
|
---|
186 | FP int_entry; /* å²è¾¼ã¿ãã³ãã©ã®åºå
|
---|
187 | ¥å£å¦çã®çªå° */
|
---|
188 | PRI intpri; /* å²è¾¼ã¿åªå
|
---|
189 | 度 */
|
---|
190 | } INHINIB;
|
---|
191 |
|
---|
192 | /*
|
---|
193 | * å²è¾¼ã¿ãã³ãã©çªå·ã®æ°ï¼kernel_cfg.cï¼
|
---|
194 | */
|
---|
195 | extern const uint_t tnum_def_inhno;
|
---|
196 |
|
---|
197 | /*
|
---|
198 | * å²è¾¼ã¿ãã³ãã©åæåãããã¯ã®ã¨ãªã¢ï¼kernel_cfg.cï¼
|
---|
199 | */
|
---|
200 | extern const INHINIB inhinib_table[];
|
---|
201 |
|
---|
202 | /*
|
---|
203 | * ã·ã°ãã«ã»ããæä½ãã¯ã
|
---|
204 | */
|
---|
205 | #define sigequalset(set1, set2) (*(set1) == *(set2))
|
---|
206 | #define sigassignset(set1, set2) (*(set1) = *(set2))
|
---|
207 | #define sigjoinset(set1, set2) (*(set1) |= *(set2))
|
---|
208 |
|
---|
209 | /*
|
---|
210 | * å²è¾¼ã¿åªå
|
---|
211 | 度ãã¹ã¯ã«ããã·ã°ãã«ãã¹ã¯ï¼kernel_cfg.cï¼
|
---|
212 | *
|
---|
213 | * å²è¾¼ã¿åªå
|
---|
214 | 度ãã¹ã¯ã«ãã£ã¦ãã¹ã¯ããã¦ããå²è¾¼ã¿ã¨ï¼å²è¾¼ã¿å±æ§ãè¨
|
---|
215 | * å®ããã¦ããªãå²è¾¼ã¿ã«å¯¾å¿ããã·ã°ãã«ããã¹ã¯ããããã®ã·ã°ãã«ã
|
---|
216 | * ã¹ã¯ãä¿æããé
|
---|
217 | åï¼é
|
---|
218 | åã®ã¤ã³ããã¯ã¹ã¯ï¼å²è¾¼ã¿åªå
|
---|
219 | 度ãã¹ã¯ã®ç¬¦å·
|
---|
220 | * ãå転ãããã®ï¼
|
---|
221 | *
|
---|
222 | * sigmask_table[0]ï¼å²è¾¼ã¿å±æ§ãè¨å®ããã¦ããªãå²è¾¼ã¿ã«å¯¾å¿ããã·ã°
|
---|
223 | * ãã«ã®ã¿ããã¹ã¯ããã·ã°ãã«ãã¹ã¯
|
---|
224 | * sigmask_table[-TMIN_INTPRI]ï¼ã«ã¼ãã«ç®¡çã®å²è¾¼ã¿ãã¹ã¦ã¨ï¼å²è¾¼ã¿å±
|
---|
225 | * æ§ãè¨å®ããã¦ããªãå²è¾¼ã¿ã«å¯¾å¿ããã·ã°ãã«ãã
|
---|
226 | * ã¹ã¯ããã·ã°ãã«ãã¹ã¯
|
---|
227 | * sigmask_table[6]ï¼NMIã¨SIGUSR2ãé¤ããã¹ã¦ã®å²è¾¼ã¿ã¨ï¼å²è¾¼ã¿å±æ§ãè¨
|
---|
228 | * å®ããã¦ããªãå²è¾¼ã¿ã«å¯¾å¿ããã·ã°ãã«ããã¹ã¯ãã
|
---|
229 | * ã·ã°ãã«ãã¹ã¯
|
---|
230 | * sigmask_table[7]ï¼sigmask_table[6]ã¨åãå¤
|
---|
231 | */
|
---|
232 | extern const sigset_t sigmask_table[8];
|
---|
233 |
|
---|
234 | /*
|
---|
235 | * å²è¾¼ã¿è¦æ±ç¦æ¢ãã©ã°å®ç¾ã®ããã®å¤æ°ã®åæå¤ï¼kernel_cfg.cï¼
|
---|
236 | */
|
---|
237 | extern const sigset_t sigmask_disint_init;
|
---|
238 |
|
---|
239 | /*
|
---|
240 | * å²è¾¼ã¿ããã¯ï¼CPUããã¯ã¸ã®ç§»è¡ã§ãã¹ã¯ããã·ã°ãã«ãä¿æããå¤æ°
|
---|
241 | */
|
---|
242 | extern sigset_t sigmask_intlock; /* å²è¾¼ã¿ããã¯ã§ãã¹ã¯ããã·ã°ãã« */
|
---|
243 | extern sigset_t sigmask_cpulock; /* CPUããã¯ã§ãã¹ã¯ããã·ã°ãã« */
|
---|
244 |
|
---|
245 | /*
|
---|
246 | * ã³ã³ããã¹ãã®åç
|
---|
247 | §
|
---|
248 | */
|
---|
249 | Inline bool_t
|
---|
250 | sense_context(void)
|
---|
251 | {
|
---|
252 | stack_t ss;
|
---|
253 |
|
---|
254 | sigaltstack(NULL, &ss);
|
---|
255 | return((ss.ss_flags & SA_ONSTACK) != 0);
|
---|
256 | }
|
---|
257 |
|
---|
258 | /*
|
---|
259 | * CPUããã¯ãã©ã°å®ç¾ã®ããã®å¤æ°
|
---|
260 | */
|
---|
261 | extern volatile bool_t lock_flag; /* CPUããã¯ãã©ã°ã表ãå¤æ° */
|
---|
262 | extern volatile sigset_t saved_sigmask; /* ã·ã°ãã«ãã¹ã¯ãä¿åããå¤æ° */
|
---|
263 |
|
---|
264 | /*
|
---|
265 | * å²è¾¼ã¿åªå
|
---|
266 | 度ãã¹ã¯å®ç¾ã®ããã®å¤æ°
|
---|
267 | */
|
---|
268 | extern volatile PRI intpri_value; /* å²è¾¼ã¿åªå
|
---|
269 | 度ãã¹ã¯ã表ãå¤æ° */
|
---|
270 |
|
---|
271 | /*
|
---|
272 | * å²è¾¼ã¿è¦æ±ç¦æ¢ãã©ã°å®ç¾ã®ããã®å¤æ°
|
---|
273 | */
|
---|
274 | extern volatile sigset_t sigmask_disint; /* åå¥ã«ãã¹ã¯ãã¦ããã·ã°ãã« */
|
---|
275 |
|
---|
276 | /*
|
---|
277 | * ã·ã°ãã«ãã¹ã¯ã®è¨å®
|
---|
278 | *
|
---|
279 | * ç¾å¨ã®ç¶æ
|
---|
280 | ï¼ã³ã³ããã¹ãï¼CPUããã¯ãã©ã°ï¼å²è¾¼ã¿åªå
|
---|
281 | 度ãã¹ã¯ï¼å²è¾¼
|
---|
282 | * ã¿ç¦æ¢ãã©ã°ï¼ãåç
|
---|
283 | §ãã¦ï¼ç¾å¨ã®ã·ã°ãã«ãã¹ã¯ã¨saved_sigmaskãé©å
|
---|
284 | * ãªå¤ã«è¨å®ããï¼
|
---|
285 | */
|
---|
286 | Inline void
|
---|
287 | set_sigmask(void)
|
---|
288 | {
|
---|
289 | sigset_t sigmask;
|
---|
290 |
|
---|
291 | sigassignset(&sigmask, &(sigmask_table[-intpri_value]));
|
---|
292 | sigjoinset(&sigmask, &sigmask_disint);
|
---|
293 | if (sense_context()) {
|
---|
294 | sigaddset(&sigmask, SIGUSR2);
|
---|
295 | }
|
---|
296 | if (lock_flag) {
|
---|
297 | sigassignset(&saved_sigmask, &sigmask);
|
---|
298 | sigjoinset(&sigmask, &sigmask_cpulock);
|
---|
299 | }
|
---|
300 | sigprocmask(SIG_SETMASK, &sigmask, NULL);
|
---|
301 | }
|
---|
302 |
|
---|
303 | /*
|
---|
304 | * CPUããã¯ç¶æ
|
---|
305 | ã¸ã®ç§»è¡
|
---|
306 | */
|
---|
307 | Inline void
|
---|
308 | lock_cpu(void)
|
---|
309 | {
|
---|
310 | assert(!lock_flag);
|
---|
311 | sigprocmask(SIG_BLOCK, &sigmask_cpulock, (sigset_t *) &saved_sigmask);
|
---|
312 | lock_flag = true;
|
---|
313 | }
|
---|
314 |
|
---|
315 | /*
|
---|
316 | * CPUããã¯ç¶æ
|
---|
317 | ã¸ã®ç§»è¡ï¼ãã£ã¹ãããã§ããç¶æ
|
---|
318 | ï¼
|
---|
319 | */
|
---|
320 | #define lock_cpu_dsp() lock_cpu()
|
---|
321 |
|
---|
322 | /*
|
---|
323 | * CPUããã¯ç¶æ
|
---|
324 | ã®è§£é¤
|
---|
325 | */
|
---|
326 | Inline void
|
---|
327 | unlock_cpu(void)
|
---|
328 | {
|
---|
329 | assert(lock_flag);
|
---|
330 | lock_flag = false;
|
---|
331 | sigprocmask(SIG_SETMASK, (sigset_t *) &saved_sigmask, NULL);
|
---|
332 | }
|
---|
333 |
|
---|
334 | /*
|
---|
335 | * CPUããã¯ç¶æ
|
---|
336 | ã®è§£é¤ï¼ãã£ã¹ãããã§ããç¶æ
|
---|
337 | ï¼
|
---|
338 | */
|
---|
339 | #define unlock_cpu_dsp() unlock_cpu()
|
---|
340 |
|
---|
341 | /*
|
---|
342 | * CPUããã¯ç¶æ
|
---|
343 | ã®åç
|
---|
344 | §
|
---|
345 | */
|
---|
346 | Inline bool_t
|
---|
347 | sense_lock(void)
|
---|
348 | {
|
---|
349 | return(lock_flag);
|
---|
350 | }
|
---|
351 |
|
---|
352 | /*
|
---|
353 | * å²è¾¼ã¿ãåãä»ããããã®é
|
---|
354 | 延å¦ç
|
---|
355 | */
|
---|
356 | Inline void
|
---|
357 | delay_for_interrupt(void)
|
---|
358 | {
|
---|
359 | }
|
---|
360 |
|
---|
361 | /*
|
---|
362 | * å²è¾¼ã¿åªå
|
---|
363 | 度ãã¹ã¯ã®è¨å®
|
---|
364 | */
|
---|
365 | Inline void
|
---|
366 | t_set_ipm(PRI intpri)
|
---|
367 | {
|
---|
368 | intpri_value = intpri;
|
---|
369 | set_sigmask();
|
---|
370 | }
|
---|
371 |
|
---|
372 | /*
|
---|
373 | * å²è¾¼ã¿åªå
|
---|
374 | 度ãã¹ã¯ã®åç
|
---|
375 | §
|
---|
376 | */
|
---|
377 | Inline PRI
|
---|
378 | t_get_ipm(void)
|
---|
379 | {
|
---|
380 | return(intpri_value);
|
---|
381 | }
|
---|
382 |
|
---|
383 | /*
|
---|
384 | * å²è¾¼ã¿çªå·ã®ç¯å²ã®å¤å®
|
---|
385 | */
|
---|
386 | #define VALID_INTNO(intno) (1 <= (intno) && (intno) <= 30 \
|
---|
387 | && (intno) != SIGKILL && (intno) != SIGSTOP)
|
---|
388 |
|
---|
389 | /*
|
---|
390 | * å²è¾¼ã¿è¦æ±ç¦æ¢ãã©ã°ã®ã»ãã
|
---|
391 | *
|
---|
392 | * å²è¾¼ã¿å±æ§ãè¨å®ããã¦ããªãå²è¾¼ã¿è¦æ±ã©ã¤ã³ã«å¯¾ãã¦å²è¾¼ã¿è¦æ±ç¦æ¢
|
---|
393 | * ãã©ã°ãã»ãããããã¨ããå ´åã«ã¯ï¼falseãè¿ãï¼
|
---|
394 | */
|
---|
395 | Inline bool_t
|
---|
396 | disable_int(INTNO intno)
|
---|
397 | {
|
---|
398 | if (sigismember(&(sigmask_table[0]), intno)
|
---|
399 | || !sigismember(&(sigmask_table[7]), intno)) {
|
---|
400 | return(false);
|
---|
401 | }
|
---|
402 | sigaddset(&sigmask_disint, intno);
|
---|
403 | set_sigmask();
|
---|
404 | return(true);
|
---|
405 | }
|
---|
406 |
|
---|
407 | /*
|
---|
408 | * å²è¾¼ã¿è¦æ±ç¦æ¢ãã©ã°ã®ã¯ãªã¢
|
---|
409 | *
|
---|
410 | * å²è¾¼ã¿å±æ§ãè¨å®ããã¦ããªãå²è¾¼ã¿è¦æ±ã©ã¤ã³ã«å¯¾ãã¦å²è¾¼ã¿è¦æ±ç¦æ¢
|
---|
411 | * ãã©ã°ãã¯ãªã¢ãããã¨ããå ´åã«ã¯ï¼falseãè¿ãï¼
|
---|
412 | */
|
---|
413 | Inline bool_t
|
---|
414 | enable_int(INTNO intno)
|
---|
415 | {
|
---|
416 | if (sigismember(&(sigmask_table[0]), intno)
|
---|
417 | || !sigismember(&(sigmask_table[7]), intno)) {
|
---|
418 | return(false);
|
---|
419 | }
|
---|
420 | sigdelset(&sigmask_disint, intno);
|
---|
421 | set_sigmask();
|
---|
422 | return(true);
|
---|
423 | }
|
---|
424 |
|
---|
425 | /*
|
---|
426 | * å²è¾¼ã¿è¦æ±ã®ã¯ãªã¢
|
---|
427 | */
|
---|
428 | Inline void
|
---|
429 | clear_int(INTNO intno)
|
---|
430 | {
|
---|
431 | }
|
---|
432 |
|
---|
433 | /*
|
---|
434 | * å²è¾¼ã¿è¦æ±ã®ãã§ãã¯
|
---|
435 | */
|
---|
436 | Inline bool_t
|
---|
437 | probe_int(INTNO intno)
|
---|
438 | {
|
---|
439 | sigset_t sigmask;
|
---|
440 |
|
---|
441 | sigpending(&sigmask);
|
---|
442 | return(sigismember(&sigmask, intno));
|
---|
443 | }
|
---|
444 |
|
---|
445 | /*
|
---|
446 | * æé«åªå
|
---|
447 | é ä½ã¿ã¹ã¯ã¸ã®ãã£ã¹ããã
|
---|
448 | *
|
---|
449 | * dispatchã¯ï¼ã¿ã¹ã¯ã³ã³ããã¹ãããå¼ã³åºããããµã¼ãã¹ã³ã¼ã«å¦çã
|
---|
450 | * ãå¼ã³åºãã¹ããã®ã§ï¼ã¿ã¹ã¯ã³ã³ããã¹ãã»CPUããã¯ç¶æ
|
---|
451 | ã»ãã£ã¹ãã
|
---|
452 | * ã許å¯ç¶æ
|
---|
453 | ã»ï¼ã¢ãã«ä¸ã®ï¼å²è¾¼ã¿åªå
|
---|
454 | 度ãã¹ã¯å
|
---|
455 | ¨è§£é¤ç¶æ
|
---|
456 | ã§å¼ã³åºããª
|
---|
457 | * ããã°ãªããªãï¼
|
---|
458 | */
|
---|
459 | extern void dispatch(void);
|
---|
460 |
|
---|
461 | /*
|
---|
462 | * éã¿ã¹ã¯ã³ã³ããã¹ãããã®ãã£ã¹ãããè¦æ±
|
---|
463 | */
|
---|
464 | #define request_dispatch()
|
---|
465 |
|
---|
466 | /*
|
---|
467 | * ãã£ã¹ãããã£ã®åä½éå§
|
---|
468 | *
|
---|
469 | * start_dispatchãreturnã«ãã¯ãå®ç¾©ãããã¨ã§ï¼ã«ã¼ãã«ã®åæåå®äº
|
---|
470 | * å¾ã«sta_kerããmainã«ãªã¿ã¼ã³ããï¼ã·ã°ãã«ã¹ã¿ãã¯ããå
|
---|
471 | ã®ã¹ã¿ãã¯
|
---|
472 | * ã«æ»ãï¼
|
---|
473 | */
|
---|
474 | #define start_dispatch() return
|
---|
475 |
|
---|
476 | /*
|
---|
477 | * ç¾å¨ã®ã³ã³ããã¹ããæ¨ã¦ã¦ãã£ã¹ããã
|
---|
478 | *
|
---|
479 | * exit_and_dispatchã¯ï¼ext_tskããå¼ã³åºãã¹ããã®ã§ï¼ã¿ã¹ã¯ã³ã³ãã
|
---|
480 | * ã¹ãã»CPUããã¯ç¶æ
|
---|
481 | ã»ãã£ã¹ããã許å¯ç¶æ
|
---|
482 | ã»ï¼ã¢ãã«ä¸ã®ï¼å²è¾¼ã¿åªå
|
---|
483 |
|
---|
484 | * 度ãã¹ã¯å
|
---|
485 | ¨è§£é¤ç¶æ
|
---|
486 | ã§å¼ã³åºããªããã°ãªããªãï¼
|
---|
487 | */
|
---|
488 | extern void exit_and_dispatch(void);
|
---|
489 |
|
---|
490 | /*
|
---|
491 | * å²è¾¼ã¿ãã³ãã©åºå£å¦ç
|
---|
492 | */
|
---|
493 | extern void ret_int(void);
|
---|
494 |
|
---|
495 | /*
|
---|
496 | * CPUä¾å¤ãã³ãã©åºå£å¦ç
|
---|
497 | */
|
---|
498 | extern void ret_exc(void);
|
---|
499 |
|
---|
500 | /*
|
---|
501 | * ã«ã¼ãã«ã®çµäºå¦çã®å¼åºã
|
---|
502 | *
|
---|
503 | * call_exit_kernelã¯ï¼ã«ã¼ãã«ã®çµäºæã«å¼ã³åºãã¹ããã®ã§ï¼éã¿ã¹ã¯
|
---|
504 | * ã³ã³ããã¹ãã«åãæãã¦ï¼ã«ã¼ãã«ã®çµäºå¦çï¼exit_kernelï¼ãå¼ã³åº
|
---|
505 | * ãï¼
|
---|
506 | */
|
---|
507 | extern void call_exit_kernel(void) NoReturn;
|
---|
508 |
|
---|
509 | /*
|
---|
510 | * ã¿ã¹ã¯ã³ã³ããã¹ãã®åæå
|
---|
511 | *
|
---|
512 | * ã¿ã¹ã¯ãä¼æ¢ç¶æ
|
---|
513 | ããå®è¡ã§ããç¶æ
|
---|
514 | ã«ç§»è¡ããæã«å¼ã°ããï¼ãã®æç¹
|
---|
515 | * ã§ã¹ã¿ãã¯é åã使ã£ã¦ã¯ãªããªãï¼
|
---|
516 | *
|
---|
517 | * activate_contextãï¼ã¤ã³ã©ã¤ã³é¢æ°ã§ã¯ãªããã¯ãå®ç¾©ã¨ãã¦ããã®ã¯ï¼
|
---|
518 | * ãã®æç¹ã§ã¯TCBãå®ç¾©ããã¦ããªãããã§ããï¼
|
---|
519 | */
|
---|
520 | extern void start_r(void);
|
---|
521 |
|
---|
522 | #define activate_context(p_tcb) \
|
---|
523 | { \
|
---|
524 | ((intptr_t *) &((p_tcb)->tskctxb.env))[JMPBUF_PC] \
|
---|
525 | = (intptr_t) start_r; \
|
---|
526 | ((intptr_t *) &((p_tcb)->tskctxb.env))[JMPBUF_SP] \
|
---|
527 | = (intptr_t)((char *)((p_tcb)->p_tinib->stk) \
|
---|
528 | + (p_tcb)->p_tinib->stksz \
|
---|
529 | - TASK_STACK_MERGIN); \
|
---|
530 | }
|
---|
531 |
|
---|
532 | /*
|
---|
533 | * å²è¾¼ã¿ãã³ãã©çªå·ã¨CPUä¾å¤ãã³ãã©çªå·ã®ç¯å²ã®å¤å®
|
---|
534 | */
|
---|
535 | #define VALID_INHNO(inhno) VALID_INTNO((INTNO)(inhno))
|
---|
536 | #define VALID_EXCNO(excno) VALID_INTNO((INTNO)(excno))
|
---|
537 |
|
---|
538 | /*
|
---|
539 | * å²è¾¼ã¿ãã³ãã©ã®è¨å®
|
---|
540 | *
|
---|
541 | * ãã¯ãã«çªå·inhnoã®å²è¾¼ã¿ãã³ãã©ã®åºå
|
---|
542 | ¥å£å¦çã®çªå°ãint_entryã«ï¼
|
---|
543 | * å²è¾¼ã¿åªå
|
---|
544 | 度ãintpriã«è¨å®ããï¼
|
---|
545 | */
|
---|
546 | Inline void
|
---|
547 | define_inh(INHNO inhno, FP int_entry, PRI intpri)
|
---|
548 | {
|
---|
549 | struct sigaction sigact;
|
---|
550 |
|
---|
551 | assert(VALID_INHNO(inhno));
|
---|
552 | sigact.sa_sigaction =
|
---|
553 | (void (*)(int, struct __siginfo *, void *))(int_entry);
|
---|
554 | sigact.sa_flags = (SA_ONSTACK | SA_SIGINFO);
|
---|
555 | sigassignset(&(sigact.sa_mask), &(sigmask_table[-intpri]));
|
---|
556 | sigaddset(&(sigact.sa_mask), SIGUSR2);
|
---|
557 | sigaction(inhno, &sigact, NULL);
|
---|
558 | }
|
---|
559 |
|
---|
560 | /*
|
---|
561 | * CPUä¾å¤ãã³ãã©ã®è¨å®
|
---|
562 | *
|
---|
563 | * ãã¯ãã«çªå·excnoã®CPUä¾å¤ãã³ãã©ã®åºå
|
---|
564 | ¥å£å¦çã®çªå°ãexc_entryã«è¨
|
---|
565 | * å®ããï¼
|
---|
566 | *
|
---|
567 | * SA_NODEFERã«ããï¼ã·ã°ãã«ãã³ãã©ã®èµ·åæã«ï¼ãã®ã·ã°ãã«ããã¹ã¯
|
---|
568 | * ããã®ãææ¢ãã¦ããï¼
|
---|
569 | */
|
---|
570 | Inline void
|
---|
571 | define_exc(EXCNO excno, FP exc_entry)
|
---|
572 | {
|
---|
573 | struct sigaction sigact;
|
---|
574 |
|
---|
575 | assert(VALID_EXCNO(excno));
|
---|
576 | sigact.sa_sigaction =
|
---|
577 | (void (*)(int, struct __siginfo *, void *))(exc_entry);
|
---|
578 | sigact.sa_flags = (SA_ONSTACK | SA_SIGINFO | SA_NODEFER);
|
---|
579 | sigemptyset(&(sigact.sa_mask));
|
---|
580 | sigaddset(&(sigact.sa_mask), SIGUSR2);
|
---|
581 | sigaction(excno, &sigact, NULL);
|
---|
582 | }
|
---|
583 |
|
---|
584 | /*
|
---|
585 | * ãªã¼ãã©ã³ãã³ãã©åä½éå§ï¼åæ¢ã®ããã®ãã¯ã
|
---|
586 | */
|
---|
587 | #ifdef TOPPERS_SUPPORT_OVRHDR
|
---|
588 |
|
---|
589 | #define OVRTIMER_START() do { \
|
---|
590 | if (_kernel_p_runtsk != NULL) { \
|
---|
591 | _kernel_ovrtimer_start(); \
|
---|
592 | } \
|
---|
593 | } while (0)
|
---|
594 |
|
---|
595 | #define OVRTIMER_STOP() _kernel_ovrtimer_stop()
|
---|
596 |
|
---|
597 | #else /* TOPPERS_SUPPORT_OVRHDR */
|
---|
598 |
|
---|
599 | #define OVRTIMER_START() ((void) 0)
|
---|
600 | #define OVRTIMER_STOP() ((void) 0)
|
---|
601 |
|
---|
602 | #endif /* TOPPERS_SUPPORT_OVRHDR */
|
---|
603 |
|
---|
604 | /*
|
---|
605 | * å²è¾¼ã¿ãã³ãã©ã®å
|
---|
606 | ¥å£å¦çã®çæãã¯ã
|
---|
607 | */
|
---|
608 | #define INT_ENTRY(inhno, inthdr) _kernel_##inthdr##_##inhno
|
---|
609 |
|
---|
610 | #define INTHDR_ENTRY(inhno, inthdr, intpri) \
|
---|
611 | void _kernel_##inthdr##_##inhno(int sig, \
|
---|
612 | struct __siginfo *p_info, void *p_ctx) \
|
---|
613 | { \
|
---|
614 | PRI saved_intpri; \
|
---|
615 | \
|
---|
616 | lock_cpu(); \
|
---|
617 | saved_intpri = _kernel_intpri_value; \
|
---|
618 | _kernel_intpri_value = intpri; \
|
---|
619 | if (((ucontext_t *) p_ctx)->uc_onstack == 0) { \
|
---|
620 | OVRTIMER_STOP(); \
|
---|
621 | } \
|
---|
622 | unlock_cpu(); \
|
---|
623 | \
|
---|
624 | LOG_INH_ENTER(inhno); \
|
---|
625 | inthdr(); /* å²è¾¼ã¿ãã³ãã©ãå¼ã³åºã */ \
|
---|
626 | LOG_INH_LEAVE(inhno); \
|
---|
627 | \
|
---|
628 | if (!sense_lock()) { \
|
---|
629 | lock_cpu(); \
|
---|
630 | } \
|
---|
631 | if (((ucontext_t *) p_ctx)->uc_onstack == 0) { \
|
---|
632 | if (_kernel_p_runtsk != _kernel_p_schedtsk) { \
|
---|
633 | raise(SIGUSR2); /* ãã£ã¹ãããã£ã®èµ·åãè¦æ±ãã */ \
|
---|
634 | } \
|
---|
635 | else { \
|
---|
636 | OVRTIMER_START(); \
|
---|
637 | } \
|
---|
638 | } \
|
---|
639 | _kernel_intpri_value = saved_intpri; \
|
---|
640 | unlock_cpu(); \
|
---|
641 | }
|
---|
642 |
|
---|
643 | /*
|
---|
644 | * CPUä¾å¤ãã³ãã©ã®å
|
---|
645 | ¥å£å¦çã®çæãã¯ã
|
---|
646 | */
|
---|
647 | #define EXC_ENTRY(excno, exchdr) _kernel_##exchdr##_##excno
|
---|
648 |
|
---|
649 | #define EXCHDR_ENTRY(excno, excno_num, exchdr) \
|
---|
650 | void _kernel_##exchdr##_##excno(int sig, \
|
---|
651 | struct __siginfo *p_info, void *p_ctx) \
|
---|
652 | { \
|
---|
653 | if (exc_sense_nonkernel(p_ctx)) { \
|
---|
654 | bool_t saved_lock_flag; \
|
---|
655 | \
|
---|
656 | /* ã«ã¼ãã«ç®¡çå¤ã®CPUä¾å¤ãã³ãã©ã®å ´å */ \
|
---|
657 | saved_lock_flag = _kernel_lock_flag; \
|
---|
658 | exchdr(p_ctx); /* CPUä¾å¤ãã³ãã©ãå¼ã³åºã */ \
|
---|
659 | _kernel_lock_flag = saved_lock_flag; \
|
---|
660 | } \
|
---|
661 | else { \
|
---|
662 | /* ã«ã¼ãã«ç®¡çã®CPUä¾å¤ãã³ãã©ã®å ´å */ \
|
---|
663 | lock_cpu(); \
|
---|
664 | if (((ucontext_t *) p_ctx)->uc_onstack == 0) { \
|
---|
665 | OVRTIMER_STOP(); \
|
---|
666 | } \
|
---|
667 | unlock_cpu(); \
|
---|
668 | \
|
---|
669 | LOG_EXC_ENTER(excno); \
|
---|
670 | exchdr(p_ctx); /* CPUä¾å¤ãã³ãã©ãå¼ã³åºã */ \
|
---|
671 | LOG_EXC_LEAVE(excno); \
|
---|
672 | \
|
---|
673 | if (!sense_lock()) { \
|
---|
674 | lock_cpu(); \
|
---|
675 | } \
|
---|
676 | if (((ucontext_t *) p_ctx)->uc_onstack == 0) { \
|
---|
677 | if (_kernel_p_runtsk != _kernel_p_schedtsk) { \
|
---|
678 | raise(SIGUSR2); /* ãã£ã¹ãããã£ã®èµ·åãè¦æ±ãã */ \
|
---|
679 | } \
|
---|
680 | else { \
|
---|
681 | OVRTIMER_START(); \
|
---|
682 | } \
|
---|
683 | } \
|
---|
684 | unlock_cpu(); \
|
---|
685 | } \
|
---|
686 | }
|
---|
687 |
|
---|
688 | /*
|
---|
689 | * CPUä¾å¤ã®çºçããæã®ã³ã³ããã¹ãã®åç
|
---|
690 | §
|
---|
691 | *
|
---|
692 | * CPUä¾å¤ã®çºçããæã®ã³ã³ããã¹ããï¼ã¿ã¹ã¯ã³ã³ããã¹ãã®æã«falseï¼
|
---|
693 | * ããã§ãªãæã«trueãè¿ãï¼
|
---|
694 | */
|
---|
695 | Inline bool_t
|
---|
696 | exc_sense_context(void *p_excinf)
|
---|
697 | {
|
---|
698 | return(((ucontext_t *) p_excinf)->uc_onstack != 0);
|
---|
699 | }
|
---|
700 |
|
---|
701 | /*
|
---|
702 | * ã«ã¼ãã«ç®¡çå¤ã®CPUä¾å¤ã®å¤å¥
|
---|
703 | *
|
---|
704 | * ã«ã¼ãã«ç®¡çå¤ã®CPUä¾å¤ã®æã«trueï¼ããã§ãªãæã«falseãè¿ãï¼
|
---|
705 | */
|
---|
706 | Inline bool_t
|
---|
707 | exc_sense_nonkernel(void *p_excinf)
|
---|
708 | {
|
---|
709 | sigset_t sigmask;
|
---|
710 |
|
---|
711 | sigassignset(&sigmask, &(((ucontext_t *) p_excinf)->uc_sigmask));
|
---|
712 | return(sigismember(&sigmask, SIGUSR2));
|
---|
713 | }
|
---|
714 |
|
---|
715 | /*
|
---|
716 | * CPUä¾å¤ã®çºçããæã®ã³ã³ããã¹ãã¨å²è¾¼ã¿ã®ãã¹ã¯ç¶æ
|
---|
717 | ã®åç
|
---|
718 | §
|
---|
719 | *
|
---|
720 | * CPUä¾å¤ã®çºçããæã®ã·ã¹ãã ç¶æ
|
---|
721 | ãï¼ã«ã¼ãã«å
|
---|
722 | ã®ã¯ãªãã£ã«ã«ã»ã¯ã·ã§
|
---|
723 | * ã³ã®å®è¡ä¸ã§ãªãï¼å
|
---|
724 | ¨å²è¾¼ã¿ããã¯ç¶æ
|
---|
725 | ã§ãªãï¼CPUããã¯ç¶æ
|
---|
726 | ã§ãªãï¼ã«ã¼
|
---|
727 | * ãã«ç®¡çå¤ã®å²è¾¼ã¿ãã³ãã©å®è¡ä¸ã§ãªãï¼ã«ã¼ãã«ç®¡çå¤ã®CPUä¾å¤ãã³
|
---|
728 | * ãã©å®è¡ä¸ã§ãªãï¼ã¿ã¹ã¯ã³ã³ããã¹ãã§ããï¼å²è¾¼ã¿åªå
|
---|
729 | 度ãã¹ã¯ãå
|
---|
730 | ¨
|
---|
731 | * 解é¤ã§ããæã«trueï¼ããã§ãªãæã«falseãè¿ãï¼
|
---|
732 | */
|
---|
733 | Inline bool_t
|
---|
734 | exc_sense_intmask(void *p_excinf)
|
---|
735 | {
|
---|
736 | return(!exc_sense_context(p_excinf) && !exc_sense_nonkernel(p_excinf)
|
---|
737 | && intpri_value == TIPM_ENAALL);
|
---|
738 | }
|
---|
739 |
|
---|
740 | /*
|
---|
741 | * ã¿ã¼ã²ããã·ã¹ãã ä¾åã®åæå
|
---|
742 | */
|
---|
743 | extern void target_initialize(void);
|
---|
744 |
|
---|
745 | /*
|
---|
746 | * ã¿ã¼ã²ããã·ã¹ãã ã®çµäº
|
---|
747 | *
|
---|
748 | * ã·ã¹ãã ãçµäºããæã«ä½¿ãï¼
|
---|
749 | */
|
---|
750 | extern void target_exit(void) NoReturn;
|
---|
751 |
|
---|
752 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
753 |
|
---|
754 | /*
|
---|
755 | * ã«ã¼ãã«ã®å²ãä»ããã¡ã¢ãªé åã®ç®¡ç
|
---|
756 | *
|
---|
757 | * target_kernel_impl.cã«ï¼TLSFï¼ãªã¼ãã³ã½ã¼ã¹ã®ã¡ã¢ãªç®¡çã©ã¤ãã©ãªï¼
|
---|
758 | * ãç¨ããã¡ã¢ãªç®¡çã«ã¼ãã³ãå«ãã¦ããï¼
|
---|
759 | */
|
---|
760 | #define OMIT_KMM_ALLOCONLY
|
---|
761 |
|
---|
762 | #endif /* TOPPERS_TARGET_KERNEL_IMPL_H */
|
---|