source: asp_wo_cfg/trunk/kernel/task_except.c@ 49

Last change on this file since 49 was 49, checked in by ertl-hiro, 12 years ago

asp_wo_kernelをコミット。
  • Property svn:keywords set to Id
File size: 7.0 KB
Line 
1/*
2 * TOPPERS/ASP Kernel
3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Advanced Standard Profile Kernel
5 *
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2005-2012 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
12 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
13 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
14 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
15 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
16 * スコード中に含まれていること．
17 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
18 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
19 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
20 * の無保証規定を掲載すること．
21 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
22 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
23 * と．
24 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
25 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
26 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
27 * 報告すること．
28 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
29 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
30 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
31 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
32 * 免責すること．
33 *
34 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
35 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
36 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
37 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
38 * の責任を負わない．
39 *
40 * $Id: task_except.c 49 2012-09-06 04:41:53Z ertl-hiro $
41 */
42
43/*
44 * タスク例外処理機能
45 */
46
47#include "kernel_impl.h"
48#include "check.h"
49#include "task.h"
50
51/*
52 * トレースログマクロのデフォルト定義
53 */
54#ifndef LOG_DEF_TEX_ENTER
55#define LOG_DEF_TEX_ENTER(tskid, pk_dtex)
56#endif /* LOG_DEF_TEX_ENTER */
57
58#ifndef LOG_DEF_TEX_LEAVE
59#define LOG_DEF_TEX_LEAVE(ercd)
60#endif /* LOG_DEF_TEX_LEAVE */
61
62#ifndef LOG_RAS_TEX_ENTER
63#define LOG_RAS_TEX_ENTER(tskid, rasptn)
64#endif /* LOG_RAS_TEX_ENTER */
65
66#ifndef LOG_RAS_TEX_LEAVE
67#define LOG_RAS_TEX_LEAVE(ercd)
68#endif /* LOG_RAS_TEX_LEAVE */
69
70#ifndef LOG_IRAS_TEX_ENTER
71#define LOG_IRAS_TEX_ENTER(tskid, rasptn)
72#endif /* LOG_IRAS_TEX_ENTER */
73
74#ifndef LOG_IRAS_TEX_LEAVE
75#define LOG_IRAS_TEX_LEAVE(ercd)
76#endif /* LOG_IRAS_TEX_LEAVE */
77
78#ifndef LOG_DIS_TEX_ENTER
79#define LOG_DIS_TEX_ENTER()
80#endif /* LOG_DIS_TEX_ENTER */
81
82#ifndef LOG_DIS_TEX_LEAVE
83#define LOG_DIS_TEX_LEAVE(ercd)
84#endif /* LOG_DIS_TEX_LEAVE */
85
86#ifndef LOG_ENA_TEX_ENTER
87#define LOG_ENA_TEX_ENTER()
88#endif /* LOG_ENA_TEX_ENTER */
89
90#ifndef LOG_ENA_TEX_LEAVE
91#define LOG_ENA_TEX_LEAVE(ercd)
92#endif /* LOG_ENA_TEX_LEAVE */
93
94#ifndef LOG_SNS_TEX_ENTER
95#define LOG_SNS_TEX_ENTER()
96#endif /* LOG_SNS_TEX_ENTER */
97
98#ifndef LOG_SNS_TEX_LEAVE
99#define LOG_SNS_TEX_LEAVE(state)
100#endif /* LOG_SNS_TEX_LEAVE */
101
102#ifndef LOG_REF_TEX_ENTER
103#define LOG_REF_TEX_ENTER(tskid, pk_rtex)
104#endif /* LOG_REF_TEX_ENTER */
105
106#ifndef LOG_REF_TEX_LEAVE
107#define LOG_REF_TEX_LEAVE(ercd, pk_rtex)
108#endif /* LOG_REF_TEX_LEAVE */
109
110/*
111 * タスク例外処理ルーチンの定義
112 */
113#ifdef TOPPERS_def_tex
114
115ER_UINT
116def_tex(ID tskid, const T_DTEX *pk_dtex)
117{
118 TCB *p_tcb;
119 TINIB *p_tinib;
120 ER ercd;
121
122 LOG_DEF_TEX_ENTER(tskid, pk_dtex);
123 CHECK_INIRTN();
124 CHECK_TSKID_SELF(tskid);
125 CHECK_RSATR(pk_dtex->texatr, TA_NULL);
126 CHECK_NOSPT(pk_dtex->texrtn != NULL);
127 CHECK_ALIGN_FUNC(pk_dtex->texrtn);
128 CHECK_NONNULL_FUNC(pk_dtex->texrtn);
129 p_tcb = get_tcb_self(tskid);
130 p_tinib = (TINIB *)(p_tcb->p_tinib);
131
132 if (p_tinib->texrtn != NULL) {
133 ercd = E_OBJ;
134 }
135 else {
136 p_tinib->texatr = pk_dtex->texatr;
137 p_tinib->texrtn = pk_dtex->texrtn;
138 ercd = E_OK;
139 }
140
141 error_exit:
142 LOG_DEF_TEX_LEAVE(ercd);
143 return(ercd);
144}
145
146#endif /* TOPPERS_def_tex */
147
148/*
149 * タスク例外処理の要求
150 */
151#ifdef TOPPERS_ras_tex
152
153ER
154ras_tex(ID tskid, TEXPTN rasptn)
155{
156 TCB *p_tcb;
157 ER ercd;
158
159 LOG_RAS_TEX_ENTER(tskid, rasptn);
160 CHECK_TSKCTX_UNL();
161 CHECK_TSKID_SELF(tskid);
162 CHECK_PAR(rasptn != 0U);
163 p_tcb = get_tcb_self(tskid);
164 CHECK_NOEXS(p_tcb->p_tinib->tskatr);
165
166 t_lock_cpu();
167 if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
168 ercd = E_OBJ;
169 }
170 else {
171 p_tcb->texptn |= rasptn;
172 if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
173 call_texrtn();
174 }
175 ercd = E_OK;
176 }
177 t_unlock_cpu();
178
179 error_exit:
180 LOG_RAS_TEX_LEAVE(ercd);
181 return(ercd);
182}
183
184#endif /* TOPPERS_ras_tex */
185
186/*
187 * タスク例外処理の要求（非タスクコンテキスト用）
188 */
189#ifdef TOPPERS_iras_tex
190
191ER
192iras_tex(ID tskid, TEXPTN rasptn)
193{
194 TCB *p_tcb;
195 ER ercd;
196
197 LOG_IRAS_TEX_ENTER(tskid, rasptn);
198 CHECK_INTCTX_UNL();
199 CHECK_TSKID(tskid);
200 CHECK_PAR(rasptn != 0U);
201 p_tcb = get_tcb(tskid);
202 CHECK_NOEXS(p_tcb->p_tinib->tskatr);
203
204 i_lock_cpu();
205 if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
206 ercd = E_OBJ;
207 }
208 else {
209 p_tcb->texptn |= rasptn;
210 if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
211 reqflg = true;
212 }
213 ercd = E_OK;
214 }
215 i_unlock_cpu();
216
217 error_exit:
218 LOG_IRAS_TEX_LEAVE(ercd);
219 return(ercd);
220}
221
222#endif /* TOPPERS_iras_tex */
223
224/*
225 * タスク例外処理の禁止
226 */
227#ifdef TOPPERS_dis_tex
228
229ER
230dis_tex(void)
231{
232 ER ercd;
233
234 LOG_DIS_TEX_ENTER();
235 CHECK_TSKCTX_UNL();
236
237 t_lock_cpu();
238 if (p_runtsk->p_tinib->texrtn == NULL) {
239 ercd = E_OBJ;
240 }
241 else {
242 p_runtsk->enatex = false;
243 ercd = E_OK;
244 }
245 t_unlock_cpu();
246
247 error_exit:
248 LOG_DIS_TEX_LEAVE(ercd);
249 return(ercd);
250}
251
252#endif /* TOPPERS_dis_tex */
253
254/*
255 * タスク例外処理の許可
256 */
257#ifdef TOPPERS_ena_tex
258
259ER
260ena_tex(void)
261{
262 ER ercd;
263
264 LOG_ENA_TEX_ENTER();
265 CHECK_TSKCTX_UNL();
266
267 t_lock_cpu();
268 if (p_runtsk->p_tinib->texrtn == NULL) {
269 ercd = E_OBJ;
270 }
271 else {
272 p_runtsk->enatex = true;
273 if (p_runtsk->texptn != 0U && ipmflg) {
274 call_texrtn();
275 }
276 ercd = E_OK;
277 }
278 t_unlock_cpu();
279
280 error_exit:
281 LOG_ENA_TEX_LEAVE(ercd);
282 return(ercd);
283}
284
285#endif /* TOPPERS_ena_tex */
286
287/*
288 * タスク例外処理禁止状態の参照
289 */
290#ifdef TOPPERS_sns_tex
291
292bool_t
293sns_tex(void)
294{
295 bool_t state;
296
297 LOG_SNS_TEX_ENTER();
298 state = (p_runtsk != NULL && p_runtsk->enatex) ? false : true;
299 LOG_SNS_TEX_LEAVE(state);
300 return(state);
301}
302
303#endif /* TOPPERS_sns_tex */
304
305/*
306 * タスク例外処理の状態参照
307 */
308#ifdef TOPPERS_ref_tex
309
310ER
311ref_tex(ID tskid, T_RTEX *pk_rtex)
312{
313 TCB *p_tcb;
314 ER ercd;
315
316 LOG_REF_TEX_ENTER(tskid, pk_rtex);
317 CHECK_TSKCTX_UNL();
318 CHECK_TSKID_SELF(tskid);
319 p_tcb = get_tcb_self(tskid);
320 CHECK_NOEXS(p_tcb->p_tinib->tskatr);
321
322 t_lock_cpu();
323 if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
324 ercd = E_OBJ;
325 }
326 else {
327 pk_rtex->texstat = (p_tcb->enatex) ? TTEX_ENA : TTEX_DIS;
328 pk_rtex->pndptn = p_tcb->texptn;
329 ercd = E_OK;
330 }
331 t_unlock_cpu();
332
333 error_exit:
334 LOG_REF_TEX_LEAVE(ercd, pk_rtex);
335 return(ercd);
336}
337
338#endif /* TOPPERS_ref_tex */
Note: See TracBrowser for help on using the repository browser.