【入門】状態空間モデル(DCモータ)MATLAB【数値計算】

MATLAB、Python、Scilab、Julia比較ページはこちら
https://www.simulationroom999.com/blog/comparison-of-matlab-python-scilab/

はじめに
DCモータ状態空間モデル
MATLABコード
シミュレーション
まとめ

はじめに

の、
MATLAB,Python,Scilab,Julia比較その68【状態空間モデル㉖】

を書き直したもの。

DCモータ状態空間モデルをMATLABでシミュレーションする。

DCモータ状態空間モデル

以下の状態空間モデルをMATLABでシミュレーションする。

状態方程式

\(
\begin{bmatrix}
\dot{\theta}(t) \\
\dot{\omega}(t) \\
\dot{I}(t)
\end{bmatrix}=
\begin{bmatrix}
0 && 1 && 0 \\
0 && 0 && K/J \\
0 && -K/L && -R/L
\end{bmatrix}
\begin{bmatrix}
\theta(t) \\
\omega(t) \\
I(t)
\end{bmatrix}+
\begin{bmatrix}
0 \\
0 \\
1/L
\end{bmatrix}
E(t)
\)

出力方程式

\(
\boldsymbol{y}=
\begin{bmatrix}
1 && 0 && 0 \\
0 && 1 && 0 \\
0 && 0 && 1 \\
\end{bmatrix}
\begin{bmatrix}
\theta(t) \\
\omega(t) \\
I(t)
\end{bmatrix}+
\begin{bmatrix}
0 \\
0 \\
0
\end{bmatrix}
E(t)
\)

MATLABコード

MATLABコードとしては以下になる。
(パラメータ等は割と本物のパラメータを採用している)

% [statespacemodel.m]
function [x,y] = statespacemodel(A, B, C, D, u, dt, x)
    % 様態方程式
    x = x + (A*x + B*u) * dt;
    
    % 出力方程式
    y = C*x + D*u;
end

% [statespacemodel_motor.m]
K=0.016;
J=0.000000919;
R=1.34;
L=0.00012;

A=[0,1,0 ; 0,0,K/J ; 0,-K/L,-R/L];
B=[0 ; 0; 1/L];
C=[1,0,0;0,1,0;0,0,1];
D=[0;0;0];

dt = 0.0001;
t = linspace(0, 10, 100000); % 時間(横)軸
u = zeros(1,100000);          % 入力信号生成
u(1,50000:100000)=1;          % 5秒後に0から1へ
y = zeros(3,numel(t));
x = zeros(3,1);

for i = 1:numel(t)
    [x,y(:,i)] = statespacemodel(A,B,C,D,u(:,i),dt,x);
end
subplot(3,1,1);
plot(t,u);
ylim([-0.05,1.1]);
xlim([4.95,5.25]);
subplot(3,1,2);
plot(t,y(1:2,:));
xlim([4.95,5.25]);
subplot(3,1,3);
plot(t,y(3,:));
xlim([4.95,5.25]);

状態空間モデルを演算する関数は、以前の運動方程式で使用したものと同一となる。