制御工学ブログ

制御工学の研究者を20年やっている国立大学教員が制御工学の基礎から専門まで広く説明します。記事内では、動画やMATLABコードを交えながらわかりやすく解説します。伝達関数・状態方程式に基づく制御,制御理論など。制御工学チャンネル(YouTube,動画ポータル)を運営しています。

MATLABによる制御シミュレーションのアニメーション実装6選(倒立振子・最適制御・状態推定)

この記事では、MATLABによる制御シミュレーションのアニメーション実装について紹介します。制御工学の理論を視覚的に理解するためには、シミュレーション結果をアニメーションとして表現することが非常に効果的です。ここでは、MATLAB File Exchangeで公開している6つの制御シミュレーションとアニメーション実装について解説します。

なお、状態フィードバック制御やオブザーバ設計の基礎については次の記事でまとめています。

状態フィードバック制御・状態方程式に基づく制御のまとめ

MATLABによる制御シミュレーション

制御システムの設計や解析において、シミュレーションは理論の妥当性を確認する重要なツールです。特に、時間的な推移をアニメーションとして可視化することで、システムの挙動を直感的に理解することができます。

MATLABは制御工学分野で広く利用されているツールであり、アニメーション機能を使うことで、シミュレーション結果を動画やGIFアニメーションとして出力できます。これにより、研究発表や教育現場で視覚的に分かりやすい資料を作成することが可能になります。

アニメーション実装の基本手順

MATLABでアニメーションを実装する際の基本的な手順は以下の通りです。

1. 数値シミュレーション: 状態方程式を数値積分し、時系列データを取得します。MATLABode45などの関数を使用します。

2. 描画処理: 各時刻でのシステムの状態を図として描画します。plot関数やrectanglelineなどの関数を組み合わせて使用します。

3. フレーム更新: drawnowコマンドで図を更新し、アニメーション効果を実現します。

4. 動画出力: VideoWriterを使ってMP4形式で保存したり、getframeimwriteを使ってGIFアニメーションとして保存できます。

公開しているシミュレーションの紹介

ここでは、MATLAB File Exchangeで公開している6つの制御シミュレーションについて紹介します。各シミュレーションには対応する研究論文や解説動画があります。

その他、アップしているファイルは以下から見れます。(ただし、Mathworksアカウントが必要です。)

jp.mathworks.com

1. 倒立振子のシミュレーションとアニメーション

倒立振子(Inverted Pendulum)は制御工学における代表的なベンチマーク問題です。このシミュレーションでは、台車上の倒立振子を安定化する制御系の動作をアニメーションで可視化します。

システムは以下の状態方程式で表現されます。状態ベクトル xは、台車の位置、台車の速度、振子の角度、振子の角速度で構成されます。アニメーションでは、ステップ目標値を用いており、倒立状態からスタートし、目標位置を時刻 t=1で変更するものとなっています。

主な機能:

・状態フィードバック制御による倒立振子の安定化
・リアルタイムアニメーション表示
・MP4動画およびJPG画像の出力機能
・パラメータ調整による挙動の変化確認

このシミュレーションは教育用途に最適であり、制御理論の学習において視覚的な理解を助けます。

MATLAB File Exchange: Inverted pendulum simulation and animation

倒立振子シミュレーションの動画

以下は、倒立振子のシミュレーションとアニメーションに関する動画になります。

youtu.be

倒立振子については以下の記事で詳しく解説しています。

blog.control-theory.com

 

2. 最適レギュレータのアニメーション(重みと性能の関係)

最適レギュレータ(LQ制御・LQR)は、状態フィードバック制御における代表的な設計手法です。このシミュレーションでは、重み行列 Q Rを変更した際の制御性能の変化をアニメーションで可視化します。

最適レギュレータでは、以下の評価関数を最小化する制御ゲインを求めます。

評価関数

ここで、 Qは状態の重み行列、 Rは入力の重み行列です。これらの重みを調整することで、以下のトレードオフを制御できます:

収束速度 vs エネルギー消費
状態の振幅 vs 入力の大きさ

アニメーションの主な機能:

・重み行列 Q,  Rの変更による応答の比較
・状態応答と入力信号の同時表示
・評価関数値のリアルタイム表示
・MP4形式でのアニメーション出力
・複数の重み設定での比較アニメーション

MATLAB File ExchangeOptimal control animation (weights and performance, MP4)

このシミュレーションは、最適制御理論における重み行列の役割を理解するのに非常に有用です。 Qを大きくすると状態の収束が速くなる一方で入力エネルギーが増加し、 Rを大きくすると入力が抑制される代わりに収束が遅くなります。アニメーションでこのトレードオフを視覚的に確認できます。

最適レギュレータの理論については次の記事で詳しく解説しています。

blog.control-theory.com

最適レギュレータアニメーションの動画

以下は、最適レギュレータのアニメーションに関する動画になります。

youtu.be

 

3. 車両モデルを用いたアダプティブクルーズ制御

アダプティブクルーズコントロール(Adaptive Cruise Control, ACC)は、自動車の先進運転支援システム(ADAS)の一つです。前方車両との車間距離を一定に保ちながら、自車の速度を自動的に調整する機能を実現します。

このシミュレーションでは、以下の要素を含む車両追従制御系を実装しています:

先行車両のモデル: 速度変化や加減速の挙動
自車両のモデル: 車両の動力学特性
ACCコントローラ: 車間距離制御アルゴリズム
安全制約: 最小車間距離の確保

制御目標は以下の通りです:

1. 目標車間距離の維持:  d_{\text{desired}}
2. 速度追従性能: 先行車両が減速/加速した場合の応答
3. 乗り心地の確保: 急激な加減速の抑制

主な機能:

・2台の車両の動きをアニメーション表示
・車間距離の時間変化をグラフ表示
・速度プロファイルの比較
・様々な走行シナリオ(加速、減速、定速走行)の検証

アニメーションでは、先行車両が加速・減速した際に、自車両がどのように追従するかを俯瞰視点で確認できます。車間距離と速度の時系列データも同時に表示され、制御性能を定量的に評価できます。

MATLAB File ExchangeAdaptive Cruise Control Simulator with Vehicle Following

アダプティブクルーズコントロールの動画

youtu.be

以下は、アダプティブクルーズコントロールシミュレータに関する動画になります。

ACCについては次の記事で詳しく解説しています。

blog.control-theory.com

4. モデル誤差補償器(MEC)によるロバスト制御

モデル誤差補償器(Model Error Compensator, MEC)は、制御対象のモデル化誤差に対してロバスト性を付加する手法です。実際の制御対象は、設計時に想定したモデルと完全には一致しません。このようなモデル誤差が存在する状況でも、安定性と性能を保証するのがMECの役割です。

MECの基本的な考え方は、ノミナルモデル(設計に用いた理想的なモデル)と実際のプラントとの差をモデル誤差として扱い、これを補償する補償器を追加することです。

主な機能:

・モデル誤差環境化でのMEC性能の可視化
・パラメータ変動に対する応答のアニメーション表示
・MECあり/なしでの性能比較
・様々な参照信号シナリオでの検証

このシミュレーションでは、システムパラメータが変動した場合でも制御性能を維持できることを視覚的に確認できます。

MATLAB File ExchangeModel Error Compensator (MEC) for Add Robustness for System

モデル誤差補償器の動画

以下は、モデル誤差補償器に関する動画になります。

youtu.be

モデル誤差抑制補償器については次の記事で詳しく解説しています。関連研究へのリンクもこちらから参照可能です。

blog.control-theory.com

 

5. マルチレート制御システムの状態推定(IEEE ACCESS

マルチレート制御システム(Multi-Rate Sampled Systems)は、複数の異なるサンプリング周期を持つセンサから情報するシステムです。この研究成果はIEEE ACCESSに掲載されています。

IEEE ACCESS Paper

実際の制御システムでは、以下のような状況がよく発生します:

・高速センサ(例: 加速度センサ、ジャイロ): 高いサンプリング周期
・低速センサ(例: GPSセンサ、カメラ): 低いサンプリング周期

これらの異なるサンプリング周期を持つセンサ情報を統合して、システムの状態を正確に推定することが本研究の目的です。

提案手法の特徴:

・マルチレート系のl2誘導ノルム評価
・各センサのサンプリング周期に応じたゲインの設計
・周期時変リアプノフ行列の利用による保守性のないLMI条件

主な機能:

・複数のサンプリング周期を持つセンサのシミュレーション
・各センサの測定タイミングの可視化
・推定精度をアニメーション表示

アニメーションでは、各センサがどのタイミングで測定値を取得し、それに応じて状態推定値がどのように更新されるかを視覚的に理解できます。

MATLAB File ExchangeState Estimation for Multi-Rate Sampled Systems: IEEE ACCESS

マルチレート状態推定の動画

以下は、マルチレート制御システムの状態推定に関する動画になります。

youtu.be

6. 外れ値ロバスト状態推定器(JCMSI 2021)

外れ値ロバスト状態推定器(Outlier-Robust State Estimator)は、センサ測定値に外れ値(異常値)が含まれる場合でも、正確な状態推定を実現する手法です。この研究成果はJCMSI(Journal of Control, Measurement, and System Integration)2021に掲載されています。

JCMSI Paper 2021

従来のカルマンフィルタは、観測ノイズがガウス分布に従うことを仮定しています。しかし、実際のシステムでは、センサの一時的な故障やノイズスパイクなどにより、外れ値が発生することがあります。これらの外れ値は推定精度を大きく低下させる原因となります。

本手法では、外れ値の影響を抑制するために、以下のアプローチを採用しています:

・複数の状態推定値の候補を毎時刻計算

・メディアンに基づく除去

ロバスト不変楕円を用いた複数オブザーバゲインの設計

・リアルタイム処理が可能な計算アルゴリズム

主な機能:

・外れ値を含む観測データからの状態推定
・推定された状態の表示,外れ値を含む観測値の表示
・外れ値検出と外れ値を含まない推定値選択の可視化
・推定誤差の時間変化のプロット

シミュレーションでは、外れ値が発生するタイミングと、提案手法がどのように外れ値の影響を除去するかをアニメーションで確認できます。

MATLAB File ExchangeOutlier-Robust State Estimator :JCMSI 2021

外れ値ロバスト状態推定器の動画

以下は、外れ値ロバスト状態推定器に関する動画になります。

youtu.be

シミュレーションの活用方法

これらのシミュレーションは以下のような場面で活用できます:

教育・学習用途

制御理論の理解: 理論式だけでは理解しにくい制御系の動作を視覚的に確認
パラメータの影響: ゲインや重み行列を変更した際の応答の変化を体験
比較検討: 異なる制御手法の性能を直接比較

研究・開発用途

アルゴリズムの検証: 提案手法の有効性を視覚的に示す
プレゼンテーション資料: 学会発表や報告会での説明資料として利用
デモンストレーション: 研究成果を分かりやすく伝える

実装のカスタマイズ

公開されているコードは、以下のような変更が可能です:

・システムパラメータの変更
・制御器ゲインの調整
・アニメーション速度の変更
・出力形式(MP4、静止画)
・グラフの表示内容の追加

MATLABアニメーション実装のコツ

描画速度の最適化

アニメーションをスムーズに動作させるためには、描画処理の最適化が重要です:

図の再利用: 毎回新しい図を作成せず、既存の図を更新する
描画範囲の固定:  \text{axis}コマンドで表示範囲を事前に設定
不要な更新の削減: 変化しない要素は一度だけ描画

動画出力の設定

MP4動画として出力する際の推奨設定:

フレームレート: 30 fpsが標準的
解像度: 1280×720(HD)以上を推奨
品質設定: VideoWriterの'Quality'パラメータで調整

まとめ

本記事では、MATLABを用いた6つの制御シミュレーションとそのアニメーション実装について紹介しました。それぞれのシミュレーションは、制御工学の重要なトピックを扱っており、視覚的な理解を助けるツールとなっています。

紹介したシミュレーション:

1. 倒立振子: 制御理論の基礎を学ぶ代表的な例題
2. 最適レギュレータ: 重み行列と制御性能の関係を可視化
3. アダプティブクルーズコントロール: 自動車制御への応用
4. モデル誤差補償器: ロバスト制御の実践的なアプローチ
5. マルチレート状態推定: 異なるサンプリング周期への対応
6. 外れ値ロバスト状態推定器: 外れ値に強い推定手法

これらのシミュレーションは、MATLAB File Exchangeで公開されており、自由にダウンロードして使用・改変することができます。制御工学の学習や研究にぜひご活用ください。

関連記事

blog.control-theory.com

blog.control-theory.com

関連ページ

>>制御工学チャンネル:500本以上の制御動画ポータルサイト Control Engineering Channel - 01-Prof.Okajima (control-theory.com)

>>MATLAB File Exchange - 岡島寛のプロフィール

人工知能・AIランキング
人工知能・AIランキング

自己紹介

岡島 寛 (熊本大学工学部情報電気工学科准教授)

制御工学の研究をしています。モデル誤差抑制補償器,状態推定,量子化制御など

研究室HP

岡島研究室(システム制御 control-theory.com)

制御動画ポータルサイト

制御工学チャンネル(伝達関数・状態方程式・MATLABなど)

電気動画ポータルサイト

電気電子チャンネル (半導体・電気・電子工作など)

YouTube

制御工学チャンネル (制御YouTubeチャンネル)

本記事をお読みいただきありがとうございます。役に立った、と思われましたら、ブックマーク・シェア等のアクションをしていただければ嬉しいです。