trx305/kernel/kernel/wait.c

   1 /*
   2  *  TOPPERS/JSP Kernel
   3  *      Toyohashi Open Platform for Embedded Real-Time Systems/
   4  *      Just Standard Profile Kernel
   5  *
   6  *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
   7  *                              Toyohashi Univ. of Technology, JAPAN
   8  *
   9  *  上記著作権者は，以下の (1)〜(4) の条件か，Free Software Foundation
  10  *  によって公表されている GNU General Public License の Version 2 に記
  11  *  述されている条件を満たす場合に限り，本ソフトウェア（本ソフトウェア
  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  *  本ソフトウェアは，無保証で提供されているものである．上記著作権者お
  32  *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
  33  *  含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
  34  *  接的または間接的に生じたいかなる損害に関しても，その責任を負わない．
  35  *
  36  *  @(#) $Id: wait.c,v 1.1 2009/01/31 05:27:37 suikan Exp $
  37  */
  38
  39 /*
  40  *  待ち状態管理モジュール
  41  */
  42
  43 #include "jsp_kernel.h"
  44 #include "wait.h"
  45
  46 /*
  47  *  待ち状態への移行（タイムアウト指定）
  48  *
  49  */
  50 #ifdef __waimake
  51
  52 void
  53 make_wait_tmout(WINFO *winfo, TMEVTB *tmevtb, TMO tmout)
  54 {
  55     make_non_runnable(runtsk);
  56     runtsk->winfo = winfo;
  57     if (tmout > 0) {
  58         winfo->tmevtb = tmevtb;
  59         tmevtb_enqueue(tmevtb, (RELTIM) tmout,
  60                     (CBACK) wait_tmout, (VP) runtsk);
  61     }
  62     else {
  63         assert(tmout == TMO_FEVR);
  64         winfo->tmevtb = NULL;
  65     }
  66 }
  67
  68 #endif /* __waimake */
  69
  70 /*
  71  *  待ち解除のためのタスク状態の更新
  72  *
  73  *  tcb で指定されるタスクを，待ち解除するようタスク状態を更新する．待
  74  *  ち解除するタスクが実行できる状態になる場合は，レディキューにつなぐ．
  75  *  また，ディスパッチが必要な場合には TRUE を返す．
  76  */
  77 Inline BOOL
  78 make_non_wait(TCB *tcb)
  79 {
  80     assert(TSTAT_WAITING(tcb->tstat));
  81
  82     if (!(TSTAT_SUSPENDED(tcb->tstat))) {
  83         /*
  84          *  待ち状態から実行できる状態への遷移
  85          */
  86         return(make_runnable(tcb));
  87     }
  88     else {
  89         /*
  90          *  二重待ち状態から強制待ち状態への遷移
  91          */
  92         tcb->tstat = TS_SUSPENDED;
  93         LOG_TSKSTAT(tcb);
  94         return(FALSE);
  95     }
  96 }
  97
  98 /*
  99  *  待ち解除
 100  */
 101 #ifdef __waicmp
 102
 103 BOOL
 104 wait_complete(TCB *tcb)
 105 {
 106     if (tcb->winfo->tmevtb != NULL) {
 107         tmevtb_dequeue(tcb->winfo->tmevtb);
 108     }
 109     tcb->winfo->wercd = E_OK;
 110     return(make_non_wait(tcb));
 111 }
 112
 113 #endif /* __waicmp */
 114
 115 /*
 116  *  タイムアウトに伴う待ち解除
 117  */
 118 #ifdef __waitmo
 119
 120 void
 121 wait_tmout(TCB *tcb)
 122 {
 123     if ((tcb->tstat & TS_WAIT_WOBJ) != 0) {
 124         queue_delete(&(tcb->task_queue));
 125     }
 126     tcb->winfo->wercd = E_TMOUT;
 127     if (make_non_wait(tcb)) {
 128         reqflg = TRUE;
 129     }
 130 }
 131
 132 #endif /* __waitmo */
 133 #ifdef __waitmook
 134
 135 void
 136 wait_tmout_ok(TCB *tcb)
 137 {
 138     tcb->winfo->wercd = E_OK;
 139     if (make_non_wait(tcb)) {
 140         reqflg = TRUE;
 141     }
 142 }
 143
 144 #endif /* __waitmook */
 145
 146 /*
 147  *  待ち状態の強制解除
 148  */
 149 #ifdef __waican
 150
 151 void
 152 wait_cancel(TCB *tcb)
 153 {
 154     if (tcb->winfo->tmevtb != NULL) {
 155         tmevtb_dequeue(tcb->winfo->tmevtb);
 156     }
 157     if ((tcb->tstat & TS_WAIT_WOBJ) != 0) {
 158         queue_delete(&(tcb->task_queue));
 159     }
 160 }
 161
 162 #endif /* __waican */
 163 #ifdef __wairel
 164
 165 BOOL
 166 wait_release(TCB *tcb)
 167 {
 168     wait_cancel(tcb);
 169     tcb->winfo->wercd = E_RLWAI;
 170     return(make_non_wait(tcb));
 171 }
 172
 173 #endif /* __wairel */
 174
 175 /*
 176  *  タスクの優先度順の待ちキューへの挿入
 177  */
 178 Inline void
 179 queue_insert_tpri(TCB *tcb, QUEUE *queue)
 180 {
 181     QUEUE   *entry;
 182     UINT    priority = tcb->priority;
 183
 184     for (entry = queue->next; entry != queue; entry = entry->next) {
 185         if (priority < ((TCB *) entry)->priority) {
 186             break;
 187         }
 188     }
 189     queue_insert_prev(entry, &(tcb->task_queue));
 190 }
 191
 192 /*
 193  *  実行中のタスクの同期・通信オブジェクトの待ちキューへの挿入
 194  */
 195 Inline void
 196 wobj_queue_insert(WOBJCB *wobjcb)
 197 {
 198     if ((wobjcb->wobjinib->wobjatr & TA_TPRI) != 0) {
 199         queue_insert_tpri(runtsk, &(wobjcb->wait_queue));
 200     }
 201     else {
 202         queue_insert_prev(&(wobjcb->wait_queue),
 203                     &(runtsk->task_queue));
 204     }
 205 }
 206
 207 /*
 208  *  同期・通信オブジェクトに対する待ち状態への移行
 209  */
 210 #ifdef __wobjwai
 211
 212 void
 213 wobj_make_wait(WOBJCB *wobjcb, WINFO_WOBJ *winfo)
 214 {
 215     runtsk->tstat = (TS_WAITING | TS_WAIT_WOBJ | TS_WAIT_WOBJCB);
 216     make_wait(&(winfo->winfo));
 217     wobj_queue_insert(wobjcb);
 218     winfo->wobjcb = wobjcb;
 219     LOG_TSKSTAT(runtsk);
 220 }
 221
 222 #endif /* __wobjwai */
 223 #ifdef __wobjwaitmo
 224
 225 void
 226 wobj_make_wait_tmout(WOBJCB *wobjcb, WINFO_WOBJ *winfo,
 227                     TMEVTB *tmevtb, TMO tmout)
 228 {
 229     runtsk->tstat = (TS_WAITING | TS_WAIT_WOBJ | TS_WAIT_WOBJCB);
 230     make_wait_tmout(&(winfo->winfo), tmevtb, tmout);
 231     wobj_queue_insert(wobjcb);
 232     winfo->wobjcb = wobjcb;
 233     LOG_TSKSTAT(runtsk);
 234 }
 235
 236 #endif /* __wobjwaitmo */
 237 /*
 238  *  タスクの優先度変更時の処理
 239  */
 240 #ifdef __wobjpri
 241
 242 void
 243 wobj_change_priority(WOBJCB *wobjcb, TCB *tcb)
 244 {
 245     if ((wobjcb->wobjinib->wobjatr & TA_TPRI) != 0) {
 246         queue_delete(&(tcb->task_queue));
 247         queue_insert_tpri(tcb, &(wobjcb->wait_queue));
 248     }
 249 }
 250
 251 #endif /* __wobjpri */