【入門】状態空間モデルをPID制御(Scilab)【数値計算】

【入門】状態空間モデルをPID制御(Scilab)【数値計算】 数値計算
【入門】状態空間モデルをPID制御(Scilab)【数値計算】

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

はじめに

の、
MATLAB,Python,Scilab,Julia比較 その79【PID制御⑧】

を書き直したもの。

DCモータの状態空間モデルは作成したが、
そこにPID制御器を追加。
これをScilabで実現する話。

PID制御器のブロック線図と全体構成

PID制御器のブロック線図と全体構成は以下となる。

PID制御器(変形式)ブロック線図、目標値、実値、1/zは前回値保持の意、Ki、Kp、Kd、T1、ΔT、e(t)、u(t)
PID制御器を加味した構成図、指令器0~1の範囲で出力、指令器、制御器、PID制御器、DCモータ、状態空間モデル、target(t)、actual(t)、E(t)、u(t)、ω(t)

Scilabコード

Scilabコードが以下になる。

function [x,y] = statespacemodel(A,B,C,D,u,dt,x) 
    // 状態方程式
    x = x + (A*x + B*u) * dt;
    
    // 出力方程式
    y = C*x + D*u;
endfunction


function [state, u]=PIDController(state, target, actual, Kp, Ki, Kd, dt, t1)
    e_i = target - actual;
    e_p = (t1/dt)*(e_i - state.pzi);
    e_d = (t1/dt)*(e_p - state.dzi);
    u = (dt/t1)*(e_p*Kp + e_i*Ki + e_d*Kd) + state.izi;

    state.pzi = e_i;
    state.dzi = e_p;
    state.izi = u;
endfunction


function [] = statespacemodel_pid()
    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, 1, 10000); // 時間(横)軸
    u = zeros(1,10000);         // 入力信号生成
    u(1,5000:10000)=1;          // 5秒後に0から1へ
    y = zeros(3,length(t));
    x = zeros(3,1);
    
    state.pzi = 0;state.dzi = 0;state.izi = 0;
    ratio = 1/60;
    Kp = 0.80;
    Ki = 0.45;
    Kd = 0.0;
    t1 = 0.005;
    
    omega = 0;
    uPID = zeros(1,10000);
    
    for i = 1:length(t)
        [state,uPID(1,i)] = PIDController( state, u(:,i), omega*ratio, Kp, Ki, Kd, dt, t1 );
        [x,y(:,i)] = statespacemodel(A,B,C,D,uPID(:,i),dt,x);
        omega = y(2,i);
    end
    
    subplot(3,1,1);
    plot(t,uPID,'-r', t, u, '--b');
    p=gca();
    p.tight_limits(:)="on";p.data_bounds(:,2)=[-0.1;1.1];p.data_bounds(:,1)=[0;1];
    subplot(3,1,2);
    plot(t',y(1:2,:)');
    p=gca();
    p.tight_limits(:)="on";p.data_bounds(:,2)=[-5;65];p.data_bounds(:,1)=[0;1];
    subplot(3,1,3);
    plot(t,y(3,:));
    p=gca();p.tight_limits(:)="on";p.data_bounds(:,2)=[-0.1;1];p.data_bounds(:,1)=[0;1];
endfunction

演算の書き方自体はMATLABと同一。
構造体の記載方法も同一。

ただし、
構造体については書き方は一緒だが、
概念は大きく異なる。

Scilabの構造体は連想配列として実装されている。

連想配列(れんそうはいれつ、英語: associative array)とは、コンピュータプログラミングにおいて、添え字にスカラー数値以外のデータ型(文字列型等)も使用できる配列である。抽象データ型のひとつ。連想リスト、連想コンテナ、辞書(あるいはカタカナでディクショナリ 英語: dictionary)、ハッシュ(英語: hash)、マップ(英語: map)とも呼ばれる。

Wikipediaより(https://ja.wikipedia.org/wiki/%E9%80%A3%E6%83%B3%E9%85%8D%E5%88%97)

連想配列は以下のような添え字(キー)が文字列になる書き方になる。

state('pzi')=1

Scilabで以下にようにすると、連想配列である事実はわかる。

-->state.pzi = 1;
 
-->state.dzi = 2;
 
-->state.izi = 3;
 
-->state('pzi')
 ans  =
 
    1.  
 
-->state('dzi')
 ans  =
 
    2.  
 
-->state('izi')
 ans  =
 
    3. 

シミュレーション結果

そしてシミュレーション結果。

DCモータ状態空間モデルをPID制御(Scilab)、target(t)、u(t)、ω(t)、θ(t)、I(t)

MATLAB,Pythonと同じ結果となり、動作としてはOKと言える。

まとめ

  • ScilabでDCモータ状態空間モデルをPID制御シミュレーション実施。
  • コード自体はMATLABと一緒。
    • 構造体の生成の仕方も一緒だが、内部的には連想配列で実現されている。
  • シミュレーション結果もOK。

MATLAB、Python、Scilab、Julia比較ページはこちら

コメント

タイトルとURLをコピーしました