source: EcnlProtoTool/trunk/asp3_dcre/kernel/task.c@ 429

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

ASP3, TINET, mbed を更新

  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 12.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-2017 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 "task.h"
49#include "taskhook.h"
50#include "wait.h"
51
52#ifdef TOPPERS_tskini
53
54/*
55 * 実行状態のタスク
56 */
57TCB *p_runtsk;
58
59/*
60 * 実行すべきタスク
61 */
62TCB *p_schedtsk;
63
64/*
65 * ディスパッチ許可状態
66 */
67bool_t enadsp;
68
69/*
70 * タスクディスパッチ可能状態
71 */
72bool_t dspflg;
73
74/*
75 * レディキュー
76 */
77QUEUE ready_queue[TNUM_TPRI];
78
79/*
80 * レディキューサーチのためのビットマップ
81 */
82uint16_t ready_primap;
83
84/*
85 * 使用していないTCBのリスト
86 */
87QUEUE free_tcb;
88
89/*
90 * タスク管理モジュールの初期化
91 */
92void
93initialize_task(void)
94{
95 uint_t i, j;
96 TCB *p_tcb;
97 TINIB *p_tinib;
98
99 p_runtsk = NULL;
100 p_schedtsk = NULL;
101 enadsp = true;
102 dspflg = true;
103
104 for (i = 0; i < TNUM_TPRI; i++) {
105 queue_initialize(&(ready_queue[i]));
106 }
107 ready_primap = 0U;
108
109 for (i = 0; i < tnum_stsk; i++) {
110 j = INDEX_TSK(torder_table[i]);
111 p_tcb = &(tcb_table[j]);
112 p_tcb->p_tinib = &(tinib_table[j]);
113 p_tcb->actque = false;
114 make_dormant(p_tcb);
115 p_tcb->p_lastmtx = NULL;
116 if ((p_tcb->p_tinib->tskatr & TA_ACT) != 0U) {
117 make_active(p_tcb);
118 }
119 }
120 queue_initialize(&free_tcb);
121 for (j = 0; i < tnum_tsk; i++, j++) {
122 p_tcb = &(tcb_table[i]);
123 p_tinib = &(atinib_table[j]);
124 p_tinib->tskatr = TA_NOEXS;
125 p_tcb->p_tinib = ((const TINIB *) p_tinib);
126 queue_insert_prev(&free_tcb, &(p_tcb->task_queue));
127 }
128}
129
130#endif /* TOPPERS_tskini */
131
132/*
133 * ビットマップサーチ関数
134 *
135 * bitmap内の1のビットの内,最も下位(右)のものをサーチし,そのビッ
136 * ト番号を返す.ビット番号は,最下位ビットを0とする.bitmapに0を指定
137 * してはならない.この関数では,bitmapが16ビットであることを仮定し,
138 * uint16_t型としている.
139 *
140 * ビットサーチ命令を持つプロセッサでは,ビットサーチ命令を使うように
141 * 書き直した方が効率が良い場合がある.このような場合には,ターゲット
142 * 依存部でビットサーチ命令を使ったbitmap_searchを定義し,
143 * OMIT_BITMAP_SEARCHをマクロ定義すればよい.また,ビットサーチ命令の
144 * サーチ方向が逆などの理由で優先度とビットとの対応を変更したい場合に
145 * は,PRIMAP_BITをマクロ定義すればよい.
146 *
147 * また,ライブラリにffsがあるなら,次のように定義してライブラリ関数を
148 * 使った方が効率が良い可能性もある.
149 * #define bitmap_search(bitmap) (ffs(bitmap) - 1)
150 */
151#ifndef PRIMAP_BIT
152#define PRIMAP_BIT(pri) (1U << (pri))
153#endif /* PRIMAP_BIT */
154
155#ifndef OMIT_BITMAP_SEARCH
156
157static const unsigned char bitmap_search_table[] = { 0, 1, 0, 2, 0, 1, 0,
158 3, 0, 1, 0, 2, 0, 1, 0 };
159
160Inline uint_t
161bitmap_search(uint16_t bitmap)
162{
163 uint_t n = 0U;
164
165 assert(bitmap != 0U);
166 if ((bitmap & 0x00ffU) == 0U) {
167 bitmap >>= 8;
168 n += 8;
169 }
170 if ((bitmap & 0x0fU) == 0U) {
171 bitmap >>= 4;
172 n += 4;
173 }
174 return(n + bitmap_search_table[(bitmap & 0x0fU) - 1]);
175}
176
177#endif /* OMIT_BITMAP_SEARCH */
178
179/*
180 * 優先度ビットマップが空かのチェック
181 */
182Inline bool_t
183primap_empty(void)
184{
185 return(ready_primap == 0U);
186}
187
188/*
189 * 優先度ビットマップのサーチ
190 */
191Inline uint_t
192primap_search(void)
193{
194 return(bitmap_search(ready_primap));
195}
196
197/*
198 * 優先度ビットマップのセット
199 */
200Inline void
201primap_set(uint_t pri)
202{
203 ready_primap |= PRIMAP_BIT(pri);
204}
205
206/*
207 * 優先度ビットマップのクリア
208 */
209Inline void
210primap_clear(uint_t pri)
211{
212 ready_primap &= ~PRIMAP_BIT(pri);
213}
214
215/*
216 * 最高優先順位タスクのサーチ
217 */
218#ifdef TOPPERS_tsksched
219
220TCB *
221search_schedtsk(void)
222{
223 uint_t schedpri;
224
225 schedpri = primap_search();
226 return((TCB *)(ready_queue[schedpri].p_next));
227}
228
229#endif /* TOPPERS_tsksched */
230
231/*
232 * 実行できる状態への遷移
233 *
234 * 実行すべきタスクを更新するのは,実行できるタスクがなかった場合と,
235 * p_tcbで指定されるタスクの優先度が実行すべきタスクの優先度よりも高
236 * い場合である.
237 */
238#ifdef TOPPERS_tskrun
239
240void
241make_runnable(TCB *p_tcb)
242{
243 uint_t pri = p_tcb->priority;
244
245 queue_insert_prev(&(ready_queue[pri]), &(p_tcb->task_queue));
246 primap_set(pri);
247
248 if (dspflg) {
249 if (p_schedtsk == (TCB *) NULL || pri < p_schedtsk->priority) {
250 p_schedtsk = p_tcb;
251 }
252 }
253}
254
255#endif /* TOPPERS_tskrun */
256
257/*
258 * 実行できる状態から他の状態への遷移
259 *
260 * 実行すべきタスクを更新するのは,p_tcbで指定されるタスクが実行すべ
261 * きタスクであった場合である.p_tcbで指定されるタスクと同じ優先度の
262 * タスクが他にある場合は,そのタスクの次のタスクが実行すべきタスクに
263 * なる.そうでない場合は,レディキューをサーチする必要がある.
264 *
265 * 自タスクに対してこの関数が呼ばれるのは,タスクディスパッチ可能状態
266 * に限られる.またこの関数は,非タスクコンテキストから呼ばれることは
267 * ないため,p_runtskとp_schedtskは必ず一致している.そのため,p_tcb
268 * とp_schedtskが一致するときは,必ずタスクディスパッチ可能状態である.
269 */
270#ifdef TOPPERS_tsknrun
271
272void
273make_non_runnable(TCB *p_tcb)
274{
275 uint_t pri = p_tcb->priority;
276 QUEUE *p_queue = &(ready_queue[pri]);
277
278 queue_delete(&(p_tcb->task_queue));
279 if (queue_empty(p_queue)) {
280 primap_clear(pri);
281 if (p_schedtsk == p_tcb) {
282 assert(dspflg);
283 p_schedtsk = primap_empty() ? (TCB *) NULL : search_schedtsk();
284 }
285 }
286 else {
287 if (p_schedtsk == p_tcb) {
288 assert(dspflg);
289 p_schedtsk = (TCB *)(p_queue->p_next);
290 }
291 }
292}
293
294#endif /* TOPPERS_tsknrun */
295
296/*
297 * 休止状態への遷移
298 */
299#ifdef TOPPERS_tskdmt
300
301void
302make_dormant(TCB *p_tcb)
303{
304 p_tcb->tstat = TS_DORMANT;
305 p_tcb->bpriority = p_tcb->p_tinib->ipriority;
306 p_tcb->priority = p_tcb->p_tinib->ipriority;
307 p_tcb->wupque = false;
308 p_tcb->raster = false;
309 p_tcb->enater = true;
310 LOG_TSKSTAT(p_tcb);
311}
312
313#endif /* TOPPERS_tskdmt */
314
315/*
316 * 休止状態から実行できる状態への遷移
317 */
318#ifdef TOPPERS_tskact
319
320void
321make_active(TCB *p_tcb)
322{
323 activate_context(p_tcb);
324 p_tcb->tstat = TS_RUNNABLE;
325 LOG_TSKSTAT(p_tcb);
326 make_runnable(p_tcb);
327}
328
329#endif /* TOPPERS_tskact */
330
331/*
332 * タスクの優先度の変更
333 *
334 * p_tcbで指定されるタスクが実行できる状態の場合には,レディキューの
335 * 中での位置を変更する.オブジェクトの待ちキューの中で待ち状態になっ
336 * ている場合には,待ちキューの中での位置を変更する.
337 *
338 * 実行すべきタスクを更新するのは,(1) p_tcbで指定されるタスクが実行
339 * すべきタスクであった場合には,優先度を下げた(または優先度が変わら
340 * なかった)時,(2) p_tcbで指定されるタスクが実行すべきタスクでなかっ
341 * た場合には,変更後の優先度が実行すべきタスクの優先度よりも高いか同
342 * じ時(同じ場合に更新が必要になるのは,実際には,mtxmodeがtrueの場
343 * 合のみ)である.(1)の場合には,レディキューをサーチする必要がある.
344 */
345#ifdef TOPPERS_tskpri
346
347void
348change_priority(TCB *p_tcb, uint_t newpri, bool_t mtxmode)
349{
350 uint_t oldpri;
351
352 oldpri = p_tcb->priority;
353 p_tcb->priority = newpri;
354
355 if (TSTAT_RUNNABLE(p_tcb->tstat)) {
356 /*
357 * タスクが実行できる状態の場合
358 */
359 queue_delete(&(p_tcb->task_queue));
360 if (queue_empty(&(ready_queue[oldpri]))) {
361 primap_clear(oldpri);
362 }
363 if (mtxmode) {
364 queue_insert_next(&(ready_queue[newpri]), &(p_tcb->task_queue));
365 }
366 else {
367 queue_insert_prev(&(ready_queue[newpri]), &(p_tcb->task_queue));
368 }
369 primap_set(newpri);
370
371 if (dspflg) {
372 if (p_schedtsk == p_tcb) {
373 if (newpri >= oldpri) {
374 p_schedtsk = search_schedtsk();
375 }
376 }
377 else {
378 if (newpri <= p_schedtsk->priority) {
379 p_schedtsk = (TCB *)(ready_queue[newpri].p_next);
380 }
381 }
382 }
383 }
384 else {
385 if (TSTAT_WAIT_WOBJCB(p_tcb->tstat)) {
386 /*
387 * タスクが,同期・通信オブジェクトの管理ブロックの共通部
388 * 分(WOBJCB)の待ちキューにつながれている場合
389 */
390 wobj_change_priority(((WINFO_WOBJ *)(p_tcb->p_winfo))->p_wobjcb,
391 p_tcb);
392 }
393 }
394}
395
396#endif /* TOPPERS_tskpri */
397
398/*
399 * レディキューの回転
400 *
401 * 実行すべきタスクを更新するのは,実行すべきタスクがタスクキューの末
402 * 尾に移動した場合である.
403 */
404#ifdef TOPPERS_tskrot
405
406void
407rotate_ready_queue(QUEUE *p_queue)
408{
409 QUEUE *p_entry;
410
411 if (!queue_empty(p_queue) && p_queue->p_next->p_next != p_queue) {
412 p_entry = queue_delete_next(p_queue);
413 queue_insert_prev(p_queue, p_entry);
414 if (dspflg) {
415 if (p_schedtsk == (TCB *) p_entry) {
416 p_schedtsk = (TCB *)(p_queue->p_next);
417 }
418 }
419 }
420}
421
422#endif /* TOPPERS_tskrot */
423
424/*
425 * タスクの終了処理
426 */
427#ifdef TOPPERS_tskterm
428
429void
430task_terminate(TCB *p_tcb)
431{
432 if (TSTAT_RUNNABLE(p_tcb->tstat)) {
433 make_non_runnable(p_tcb);
434 }
435 else if (TSTAT_WAITING(p_tcb->tstat)) {
436 wait_dequeue_wobj(p_tcb);
437 wait_dequeue_tmevtb(p_tcb);
438 }
439 if (p_tcb->p_lastmtx != NULL) {
440 (*mtxhook_release_all)(p_tcb);
441 }
442 make_dormant(p_tcb);
443 if (p_tcb->actque) {
444 p_tcb->actque = false;
445 make_active(p_tcb);
446 }
447}
448
449#endif /* TOPPERS_tskterm */
Note: See TracBrowser for help on using the repository browser.