trx305/kernel/kernel/cyclic.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  *  Copyright (C) 2006 by Embedded and Real-Time Systems Laboratory
   9  *              Graduate School of Information Science, Nagoya Univ., JAPAN
  10  *
  11  *  上記著作権者は，以下の (1)〜(4) の条件か，Free Software Foundation
  12  *  によって公表されている GNU General Public License の Version 2 に記
  13  *  述されている条件を満たす場合に限り，本ソフトウェア（本ソフトウェア
  14  *  を改変したものを含む．以下同じ）を使用・複製・改変・再配布（以下，
  15  *  利用と呼ぶ）することを無償で許諾する．
  16  *  (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
  17  *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
  18  *      スコード中に含まれていること．
  19  *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
  20  *      用できる形で再配布する場合には，再配布に伴うドキュメント（利用
  21  *      者マニュアルなど）に，上記の著作権表示，この利用条件および下記
  22  *      の無保証規定を掲載すること．
  23  *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
  24  *      用できない形で再配布する場合には，次のいずれかの条件を満たすこ
  25  *      と．
  26  *    (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
  27  *        作権表示，この利用条件および下記の無保証規定を掲載すること．
  28  *    (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
  29  *        報告すること．
  30  *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
  31  *      害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
  32  *
  33  *  本ソフトウェアは，無保証で提供されているものである．上記著作権者お
  34  *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
  35  *  含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
  36  *  接的または間接的に生じたいかなる損害に関しても，その責任を負わない．
  37  *
  38  *  @(#) $Id: cyclic.c,v 1.1 2009/01/31 05:27:37 suikan Exp $
  39  */
  40
  41 /*
  42  *  周期ハンドラ機能
  43  */
  44
  45 #include "jsp_kernel.h"
  46 #include "check.h"
  47 #include "cyclic.h"
  48
  49 /*
  50  *  周期ハンドラIDの最大値（kernel_cfg.c）
  51  */
  52 extern const ID tmax_cycid;
  53
  54 /*
  55  *  周期ハンドラ初期化ブロックのエリア（kernel_cfg.c）
  56  */
  57 extern const CYCINIB    cycinib_table[];
  58
  59 /*
  60  *  周期ハンドラ管理ブロックのエリア（kernel_cfg.c）
  61  */
  62 extern CYCCB    cyccb_table[];
  63
  64 /*
  65  *  周期ハンドラの数
  66  */
  67 #define TNUM_CYC    ((UINT)(tmax_cycid - TMIN_CYCID + 1))
  68
  69 /*
  70  *  周期ハンドラIDから周期ハンドラ管理ブロックを取り出すためのマクロ
  71  */
  72 #define INDEX_CYC(cycid)    ((UINT)((cycid) - TMIN_CYCID))
  73 #define get_cyccb(cycid)    (&(cyccb_table[INDEX_CYC(cycid)]))
  74
  75 /*
  76  *  引数まで定義した周期ハンドラの型
  77  */
  78 typedef void    (*CYCHDR)(VP_INT exinf);
  79
  80 /*
  81  *  周期ハンドラ機能の初期化
  82  */
  83 #ifdef __cycini
  84
  85 void
  86 cyclic_initialize()
  87 {
  88     UINT    i;
  89     CYCCB   *cyccb;
  90
  91     for (cyccb = cyccb_table, i = 0; i < TNUM_CYC; cyccb++, i++) {
  92         cyccb->cycinib = &(cycinib_table[i]);
  93         if ((cyccb->cycinib->cycatr & TA_STA) != 0) {
  94             cyccb->cycsta = TRUE;
  95             tmevtb_enqueue_cyc(cyccb,
  96                     (EVTTIM)(cyccb->cycinib->cycphs));
  97         }
  98         else {
  99             cyccb->cycsta = FALSE;
 100         }
 101     }
 102 }
 103
 104 #endif /* __cycini */
 105
 106 /*
 107  *  周期ハンドラ起動のためのタイムイベントブロックの登録
 108  */
 109 #ifdef __cycenq
 110
 111 void
 112 tmevtb_enqueue_cyc(CYCCB *cyccb, EVTTIM evttim)
 113 {
 114     tmevtb_enqueue_evttim(&(cyccb->tmevtb), evttim,
 115                 (CBACK) call_cychdr, (VP) cyccb);
 116     cyccb->evttim = evttim;
 117 }
 118
 119 #endif /* __cycenq */
 120
 121 /*
 122  *  周期ハンドラの動作開始
 123  */
 124 #ifdef __sta_cyc
 125
 126 SYSCALL ER
 127 sta_cyc(ID cycid)
 128 {
 129     CYCCB   *cyccb;
 130     ER  ercd;
 131
 132     LOG_STA_CYC_ENTER(cycid);
 133     CHECK_TSKCTX_UNL();
 134     CHECK_CYCID(cycid);
 135     cyccb = get_cyccb(cycid);
 136
 137     t_lock_cpu();
 138     if (cyccb->cycsta) {
 139         tmevtb_dequeue(&(cyccb->tmevtb));
 140     }
 141     else {
 142         cyccb->cycsta = TRUE;
 143     }
 144     tmevtb_enqueue_cyc(cyccb, base_time + cyccb->cycinib->cyctim);
 145     ercd = E_OK;
 146     t_unlock_cpu();
 147
 148     exit:
 149     LOG_STA_CYC_LEAVE(ercd);
 150     return(ercd);
 151 }
 152
 153 #endif /* __sta_cyc */
 154
 155 /*
 156  *  周期ハンドラの動作停止
 157  */
 158 #ifdef __stp_cyc
 159
 160 SYSCALL ER
 161 stp_cyc(ID cycid)
 162 {
 163     CYCCB   *cyccb;
 164     ER  ercd;
 165
 166     LOG_STP_CYC_ENTER(cycid);
 167     CHECK_TSKCTX_UNL();
 168     CHECK_CYCID(cycid);
 169     cyccb = get_cyccb(cycid);
 170
 171     t_lock_cpu();
 172     if (cyccb->cycsta) {
 173         cyccb->cycsta = FALSE;
 174         tmevtb_dequeue(&(cyccb->tmevtb));
 175     }
 176     ercd = E_OK;
 177     t_unlock_cpu();
 178
 179     exit:
 180     LOG_STP_CYC_LEAVE(ercd);
 181     return(ercd);
 182 }
 183
 184 #endif /* __stp_cyc */
 185
 186 /*
 187  *  周期ハンドラ起動ルーチン
 188  */
 189 #ifdef __cyccal
 190
 191 void
 192 call_cychdr(CYCCB *cyccb)
 193 {
 194     /*
 195      *  次回の起動のためのタイムイベントブロックを登録する．
 196      *
 197      *  同じタイムティックで周期ハンドラを再度起動すべき場合には，
 198      *  この関数から isig_tim に戻った後に，再度この関数が呼ばれる
 199      *  ことになる．
 200      */
 201     tmevtb_enqueue_cyc(cyccb, cyccb->evttim + cyccb->cycinib->cyctim);
 202
 203     /*
 204      *  周期ハンドラを，CPUロック解除状態で呼び出す．
 205      */
 206     i_unlock_cpu();
 207     LOG_CYC_ENTER(cyccb);
 208     (*((CYCHDR)(cyccb->cycinib->cychdr)))(cyccb->cycinib->exinf);
 209     LOG_CYC_LEAVE(cyccb);
 210     i_lock_cpu();
 211 }
 212
 213 #endif /* __cyccal */