[270] | 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
|
---|
[429] | 8 | * Copyright (C) 2005-2018 by Embedded and Real-Time Systems Laboratory
|
---|
[270] | 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 "wait.h"
|
---|
| 49 |
|
---|
| 50 | /*
|
---|
| 51 | * 待ち状態への遷移(タイムアウト指定)
|
---|
| 52 | */
|
---|
| 53 | #ifdef TOPPERS_waimake
|
---|
| 54 |
|
---|
| 55 | void
|
---|
[429] | 56 | make_wait_tmout(uint_t tstat, WINFO *p_winfo, TMEVTB *p_tmevtb, TMO tmout)
|
---|
[270] | 57 | {
|
---|
[429] | 58 | p_runtsk->tstat = tstat;
|
---|
[270] | 59 | make_non_runnable(p_runtsk);
|
---|
| 60 | p_runtsk->p_winfo = p_winfo;
|
---|
| 61 | if (tmout == TMO_FEVR) {
|
---|
| 62 | p_winfo->p_tmevtb = NULL;
|
---|
| 63 | }
|
---|
| 64 | else {
|
---|
| 65 | assert(tmout <= TMAX_RELTIM);
|
---|
| 66 | p_winfo->p_tmevtb = p_tmevtb;
|
---|
| 67 | p_tmevtb->callback = (CBACK) wait_tmout;
|
---|
| 68 | p_tmevtb->arg = (void *) p_runtsk;
|
---|
[429] | 69 | tmevtb_enqueue_reltim(p_tmevtb, (RELTIM) tmout);
|
---|
[270] | 70 | }
|
---|
| 71 | }
|
---|
| 72 |
|
---|
| 73 | #endif /* TOPPERS_waimake */
|
---|
| 74 |
|
---|
| 75 | /*
|
---|
| 76 | * 待ち解除
|
---|
| 77 | */
|
---|
| 78 | #ifdef TOPPERS_waicmp
|
---|
| 79 |
|
---|
| 80 | void
|
---|
| 81 | wait_complete(TCB *p_tcb)
|
---|
| 82 | {
|
---|
| 83 | wait_dequeue_tmevtb(p_tcb);
|
---|
| 84 | p_tcb->p_winfo->wercd = E_OK;
|
---|
| 85 | make_non_wait(p_tcb);
|
---|
| 86 | }
|
---|
| 87 |
|
---|
| 88 | #endif /* TOPPERS_waicmp */
|
---|
| 89 |
|
---|
| 90 | /*
|
---|
| 91 | * タイムアウトに伴う待ち解除
|
---|
| 92 | */
|
---|
| 93 | #ifdef TOPPERS_waitmo
|
---|
| 94 |
|
---|
| 95 | void
|
---|
| 96 | wait_tmout(TCB *p_tcb)
|
---|
| 97 | {
|
---|
| 98 | wait_dequeue_wobj(p_tcb);
|
---|
| 99 | p_tcb->p_winfo->wercd = E_TMOUT;
|
---|
| 100 | make_non_wait(p_tcb);
|
---|
| 101 | if (p_runtsk != p_schedtsk) {
|
---|
[429] | 102 | request_dispatch_retint();
|
---|
[270] | 103 | }
|
---|
| 104 |
|
---|
| 105 | /*
|
---|
| 106 | * ここで優先度の高い割込みを受け付ける.
|
---|
| 107 | */
|
---|
| 108 | unlock_cpu();
|
---|
| 109 | delay_for_interrupt();
|
---|
| 110 | lock_cpu();
|
---|
| 111 | }
|
---|
| 112 |
|
---|
| 113 | #endif /* TOPPERS_waitmo */
|
---|
| 114 | #ifdef TOPPERS_waitmook
|
---|
| 115 |
|
---|
| 116 | void
|
---|
| 117 | wait_tmout_ok(TCB *p_tcb)
|
---|
| 118 | {
|
---|
| 119 | p_tcb->p_winfo->wercd = E_OK;
|
---|
| 120 | make_non_wait(p_tcb);
|
---|
| 121 | if (p_runtsk != p_schedtsk) {
|
---|
[429] | 122 | request_dispatch_retint();
|
---|
[270] | 123 | }
|
---|
| 124 |
|
---|
| 125 | /*
|
---|
| 126 | * ここで優先度の高い割込みを受け付ける.
|
---|
| 127 | */
|
---|
| 128 | unlock_cpu();
|
---|
| 129 | delay_for_interrupt();
|
---|
| 130 | lock_cpu();
|
---|
| 131 | }
|
---|
| 132 |
|
---|
| 133 | #endif /* TOPPERS_waitmook */
|
---|
| 134 |
|
---|
| 135 | /*
|
---|
| 136 | * 実行中のタスクの同期・通信オブジェクトの待ちキューへの挿入
|
---|
| 137 | *
|
---|
| 138 | * 実行中のタスクを,同期・通信オブジェクトの待ちキューへ挿入する.オ
|
---|
| 139 | * ブジェクトの属性に応じて,FIFO順またはタスク優先度順で挿入する.
|
---|
| 140 | */
|
---|
| 141 | Inline void
|
---|
| 142 | wobj_queue_insert(WOBJCB *p_wobjcb)
|
---|
| 143 | {
|
---|
| 144 | if ((p_wobjcb->p_wobjinib->wobjatr & TA_TPRI) != 0U) {
|
---|
| 145 | queue_insert_tpri(&(p_wobjcb->wait_queue), p_runtsk);
|
---|
| 146 | }
|
---|
| 147 | else {
|
---|
| 148 | queue_insert_prev(&(p_wobjcb->wait_queue), &(p_runtsk->task_queue));
|
---|
| 149 | }
|
---|
| 150 | }
|
---|
| 151 |
|
---|
| 152 | /*
|
---|
| 153 | * 同期・通信オブジェクトに対する待ち状態への遷移
|
---|
| 154 | */
|
---|
| 155 | #ifdef TOPPERS_wobjwai
|
---|
| 156 |
|
---|
| 157 | void
|
---|
[429] | 158 | wobj_make_wait(WOBJCB *p_wobjcb, uint_t tstat, WINFO_WOBJ *p_winfo_wobj)
|
---|
[270] | 159 | {
|
---|
[429] | 160 | make_wait(tstat, &(p_winfo_wobj->winfo));
|
---|
[270] | 161 | wobj_queue_insert(p_wobjcb);
|
---|
| 162 | p_winfo_wobj->p_wobjcb = p_wobjcb;
|
---|
| 163 | LOG_TSKSTAT(p_runtsk);
|
---|
| 164 | }
|
---|
| 165 |
|
---|
| 166 | #endif /* TOPPERS_wobjwai */
|
---|
| 167 | #ifdef TOPPERS_wobjwaitmo
|
---|
| 168 |
|
---|
| 169 | void
|
---|
[429] | 170 | wobj_make_wait_tmout(WOBJCB *p_wobjcb, uint_t tstat,
|
---|
| 171 | WINFO_WOBJ *p_winfo_wobj, TMEVTB *p_tmevtb, TMO tmout)
|
---|
[270] | 172 | {
|
---|
[429] | 173 | make_wait_tmout(tstat, &(p_winfo_wobj->winfo), p_tmevtb, tmout);
|
---|
[270] | 174 | wobj_queue_insert(p_wobjcb);
|
---|
| 175 | p_winfo_wobj->p_wobjcb = p_wobjcb;
|
---|
| 176 | LOG_TSKSTAT(p_runtsk);
|
---|
| 177 | }
|
---|
| 178 |
|
---|
| 179 | #endif /* TOPPERS_wobjwaitmo */
|
---|
| 180 |
|
---|
| 181 | /*
|
---|
| 182 | * 待ちキューの初期化
|
---|
| 183 | */
|
---|
| 184 | #ifdef TOPPERS_iniwque
|
---|
| 185 |
|
---|
| 186 | void
|
---|
| 187 | init_wait_queue(QUEUE *p_wait_queue)
|
---|
| 188 | {
|
---|
| 189 | TCB *p_tcb;
|
---|
| 190 |
|
---|
| 191 | while (!queue_empty(p_wait_queue)) {
|
---|
| 192 | p_tcb = (TCB *) queue_delete_next(p_wait_queue);
|
---|
| 193 | wait_dequeue_tmevtb(p_tcb);
|
---|
| 194 | p_tcb->p_winfo->wercd = E_DLT;
|
---|
| 195 | make_non_wait(p_tcb);
|
---|
| 196 | }
|
---|
| 197 | }
|
---|
| 198 |
|
---|
| 199 | #endif /* TOPPERS_iniwque */
|
---|