sfun_eulerupd.tlc

来自「这也是一个关于导弹目标的Matlab程序」· TLC 代码 · 共 73 行

%%
%% Abstract: Derivative block target file.

%implements sfun_eulerupd "C"

%% Function: InitializeConditions =============================================
%% Abstract:
%%      RWork(TimeStamp) = rtInf
%%
%function InitializeConditions(block, system) Output
  /* %<Type> Block: '%<Name>' */
  
  %assign x0  = LibBlockContinuousState("", "", 0)
  %assign x1  = LibBlockContinuousState("", "", 1)
  %assign x2  = LibBlockContinuousState("", "", 2)
    
  %assign p0 = LibBlockParameter(fi0, "", "", 0)
  %assign p1 = LibBlockParameter(theta0, "", "", 1)
  %assign p2 = LibBlockParameter(psi0, "", "", 2)

  %<x0> = %<p0>;
  %<x1> = %<p1>;
  %<x2> = %<p2>;

%endfunction

 
%% Function: Outputs ==========================================================
%% Abstract:
%%
%function Outputs(block, system) Output
  /* %<Type> Block: '%<Name>' */

  %assign x0  = LibBlockContinuousState("", "", 0)
  %assign x1  = LibBlockContinuousState("", "", 1)
  %assign x2  = LibBlockContinuousState("", "", 2)
  
  %assign y0 = LibBlockOutputSignal(0, "", "", 0)
  %assign y1 = LibBlockOutputSignal(0, "", "", 1)
  %assign y2 = LibBlockOutputSignal(0, "", "", 2)

  %<y0> = %<x0>;
  %<y1> = %<x1>;
  %<y2> = %<x2>;
  

%endfunction


%% Function: Derivatives ===========================================================
%% Abstract:
%%      Update the oldest bank of last inputs
%%
%function Derivatives(block, system) Output

  /* %<Type> Block: '%<Name>' */
  %assign x0  = LibBlockContinuousState("", "", 0)
  %assign x1  = LibBlockContinuousState("", "", 1)
  %assign x2  = LibBlockContinuousState("", "", 2)

  %assign u0 = LibBlockInputSignal(0, "", "", 0)
  %assign u1 = LibBlockInputSignal(0, "", "", 1)
  %assign u2 = LibBlockInputSignal(0, "", "", 2)

  %<LibBlockContinuousStateDerivative("","",0)> = %<u0>+sin(%<x0>)*tan(%<x1>)*%<u1>+cos(%<x0>)*tan(%<x1>)*%<u2>;
  %<LibBlockContinuousStateDerivative("","",1)> = cos(%<x0>)*%<u1>-sin(%<x0>)*%<u2>;
  %<LibBlockContinuousStateDerivative("","",2)> = sin(%<x0>)/cos(%<x1>)*%<u1>+cos(%<x0>)/cos(%<x1>)*%<u2>;
   
  
%endfunction

%% [EOF] deriv.tlc