source: azure_iot_hub_f767zi/trunk/asp_baseplatform/kernel/task_except.c@ 457

Last change on this file since 457 was 457, checked in by coas-nagasima, 4 years ago

ファイルを追加
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 8.3 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-2014 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$
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_TSKCTX_UNL();
124 CHECK_TSKID_SELF(tskid);
125 CHECK_RSATR(pk_dtex->texatr, TA_NULL);
126 if (pk_dtex->texrtn != NULL) {
127 CHECK_ALIGN_FUNC(pk_dtex->texrtn);
128 CHECK_NONNULL_FUNC(pk_dtex->texrtn);
129 }
130 p_tcb = get_tcb_self(tskid);
131 p_tinib = (TINIB *)(p_tcb->p_tinib);
132
133 t_lock_cpu();
134 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
135 ercd = E_NOEXS;
136 }
137 else if (TSKID(p_tcb) > tmax_stskid) {
138 if (pk_dtex->texrtn != NULL) {
139 if (p_tinib->texrtn != NULL) {
140 ercd = E_OBJ;
141 }
142 else {
143 p_tinib->texatr = pk_dtex->texatr;
144 p_tinib->texrtn = pk_dtex->texrtn;
145 ercd = E_OK;
146 }
147 }
148 else {
149 if (p_tinib->texrtn != NULL) {
150 p_tinib->texrtn = NULL;
151 p_tcb->enatex = false;
152 p_tcb->texptn = 0U;
153 ercd = E_OK;
154 }
155 else {
156 ercd = E_OBJ;
157 }
158 }
159 }
160 else {
161 ercd = E_OBJ;
162 }
163 t_unlock_cpu();
164
165 error_exit:
166 LOG_DEF_TEX_LEAVE(ercd);
167 return(ercd);
168}
169
170#endif /* TOPPERS_def_tex */
171
172/*
173 * タスク例外処理の要求
174 */
175#ifdef TOPPERS_ras_tex
176
177ER
178ras_tex(ID tskid, TEXPTN rasptn)
179{
180 TCB *p_tcb;
181 ER ercd;
182
183 LOG_RAS_TEX_ENTER(tskid, rasptn);
184 CHECK_TSKCTX_UNL();
185 CHECK_TSKID_SELF(tskid);
186 CHECK_PAR(rasptn != 0U);
187 p_tcb = get_tcb_self(tskid);
188
189 t_lock_cpu();
190 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
191 ercd = E_NOEXS;
192 }
193 else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
194 ercd = E_OBJ;
195 }
196 else {
197 p_tcb->texptn |= rasptn;
198 if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
199 call_texrtn();
200 }
201 ercd = E_OK;
202 }
203 t_unlock_cpu();
204
205 error_exit:
206 LOG_RAS_TEX_LEAVE(ercd);
207 return(ercd);
208}
209
210#endif /* TOPPERS_ras_tex */
211
212/*
213 * タスク例外処理の要求（非タスクコンテキスト用）
214 */
215#ifdef TOPPERS_iras_tex
216
217ER
218iras_tex(ID tskid, TEXPTN rasptn)
219{
220 TCB *p_tcb;
221 ER ercd;
222
223 LOG_IRAS_TEX_ENTER(tskid, rasptn);
224 CHECK_INTCTX_UNL();
225 CHECK_TSKID(tskid);
226 CHECK_PAR(rasptn != 0U);
227 p_tcb = get_tcb(tskid);
228
229 i_lock_cpu();
230 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
231 ercd = E_NOEXS;
232 }
233 else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
234 ercd = E_OBJ;
235 }
236 else {
237 p_tcb->texptn |= rasptn;
238 if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
239 reqflg = true;
240 }
241 ercd = E_OK;
242 }
243 i_unlock_cpu();
244
245 error_exit:
246 LOG_IRAS_TEX_LEAVE(ercd);
247 return(ercd);
248}
249
250#endif /* TOPPERS_iras_tex */
251
252/*
253 * タスク例外処理の禁止
254 */
255#ifdef TOPPERS_dis_tex
256
257ER
258dis_tex(void)
259{
260 ER ercd;
261
262 LOG_DIS_TEX_ENTER();
263 CHECK_TSKCTX_UNL();
264
265 t_lock_cpu();
266 if (p_runtsk->p_tinib->texrtn == NULL) {
267 ercd = E_OBJ;
268 }
269 else {
270 p_runtsk->enatex = false;
271 ercd = E_OK;
272 }
273 t_unlock_cpu();
274
275 error_exit:
276 LOG_DIS_TEX_LEAVE(ercd);
277 return(ercd);
278}
279
280#endif /* TOPPERS_dis_tex */
281
282/*
283 * タスク例外処理の許可
284 */
285#ifdef TOPPERS_ena_tex
286
287ER
288ena_tex(void)
289{
290 ER ercd;
291
292 LOG_ENA_TEX_ENTER();
293 CHECK_TSKCTX_UNL();
294
295 t_lock_cpu();
296 if (p_runtsk->p_tinib->texrtn == NULL) {
297 ercd = E_OBJ;
298 }
299 else {
300 p_runtsk->enatex = true;
301 if (p_runtsk->texptn != 0U && ipmflg) {
302 call_texrtn();
303 }
304 ercd = E_OK;
305 }
306 t_unlock_cpu();
307
308 error_exit:
309 LOG_ENA_TEX_LEAVE(ercd);
310 return(ercd);
311}
312
313#endif /* TOPPERS_ena_tex */
314
315/*
316 * タスク例外処理禁止状態の参照
317 */
318#ifdef TOPPERS_sns_tex
319
320bool_t
321sns_tex(void)
322{
323 bool_t state;
324
325 LOG_SNS_TEX_ENTER();
326 state = (p_runtsk != NULL && p_runtsk->enatex) ? false : true;
327 LOG_SNS_TEX_LEAVE(state);
328 return(state);
329}
330
331#endif /* TOPPERS_sns_tex */
332
333/*
334 * タスク例外処理の状態参照
335 */
336#ifdef TOPPERS_ref_tex
337
338ER
339ref_tex(ID tskid, T_RTEX *pk_rtex)
340{
341 TCB *p_tcb;
342 ER ercd;
343
344 LOG_REF_TEX_ENTER(tskid, pk_rtex);
345 CHECK_TSKCTX_UNL();
346 CHECK_TSKID_SELF(tskid);
347 p_tcb = get_tcb_self(tskid);
348
349 t_lock_cpu();
350 if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
351 ercd = E_NOEXS;
352 }
353 else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
354 ercd = E_OBJ;
355 }
356 else {
357 pk_rtex->texstat = (p_tcb->enatex) ? TTEX_ENA : TTEX_DIS;
358 pk_rtex->pndptn = p_tcb->texptn;
359 ercd = E_OK;
360 }
361 t_unlock_cpu();
362
363 error_exit:
364 LOG_REF_TEX_LEAVE(ercd, pk_rtex);
365 return(ercd);
366}
367
368#endif /* TOPPERS_ref_tex */
Note: See TracBrowser for help on using the repository browser.