#include  "trs5-inc.mm"

Real lmtr();

Func Matrix ftrs5(t, x)
     // ftrs5 - 発電機線形化モデルの微分方程式の微分値を表す式
     Real t;
     Matrix x;
{
     Matrix dx;
     /* 平衡点
	dlt= 1.2438351; i.e. 71.2665[deg]
	w=   0.0;
	eqD= 1.19608;
	xgV = 1.90929;
     */

     // 初期化せずに dx(n)=.. で代入すると, 行ベクトルになってしまう?
     dx= Z(x);

//                  dlt         omg      eq'         gV
     dx(1)=                    x(2);
     dx(2)=   -31.0*x(1) -0.28*x(2) -50*x(3);
     dx(3)= ( -0.81*x(1)           -1.9*x(3) + lmtr(x(4),1.0,-99.9) )/TdoD1;
     dx(4)= (  20.0*x(1)          -57.0*x(3)       -x(4) )/TV1;
     
     return dx;
}


Func Real lmtr(xin, U, L)
     Real xin, U, L;
{
     if       (xin>U){
	  return U;
     }else if (xin<L){
	  return L;
     }else{
	  return xin;
     }
}