倒立振子のシステム構成と状態フィードバック制御

Posted at 2025-08-18

[この記事は制御工学ブログで2024年2月14日に公開されたものを少し修正したものです。]

倒立振子について

この記事では倒立振子についてまとめます。制御工学で倒立振子は、制御が難しい対象として実験で広く利用されています。本記事では、倒立振子のシステム構成の説明と状態フィードバックによる制御について説明を行います。倒立振子の安定化制御について説明した動画や関連記事リンクは最下部に置いています。

倒立振子の構造

まず、倒立振子の構造について説明します。倒立振子は不安定、かつ不安定零点も有する難しいシステムです。そのため、各種制御手法の検証を行うためのターゲットとして広く利用されています。

さらに、大きな動作領域で動かす場合には、倒立振子システムの非線形性を考えた設計が重要になってきます。ここでは、回転型倒立振子を用いたシステムについての説明を行います。

2つのセンサーの情報に基づいて台の中心にあるモーターを動かして倒立状態をキープする制御を行います。中心の台の回転をうまく制御すると安定化制御だけでなく角度追従制御も可能です。目標位置（目標角度）が変わっても追従し安定化することが可能な制御対象であります。状態フィードバック制御では、振子の角度と角速度、台の角度と角速度の計４つの状態を用いて状態フィードバック制御を施します。

エンコーダによる角度センシング

まず、倒立振子システムに付加されるセンサーであるエンコーダについて測定原理の説明を行います。エンコーダーでは、角度情報を計測するスリットを通過する光のパルス数をカウントします。パルス数のカウントにより各時刻での角度を計測します。

光源から光が放たれ、それが受光素子で受け取られることになります。そして、このスリットの空いている円盤を回転させることで受光素子が光を受け取ったり受け取らなかったりします。その受光の有無を電圧値として得た結果、回転させると図の右にあるような電圧波形を得ます。受光の有無を電圧値として読み取ることによって、どれだけ角度が変化したかを計測することができます。

その一方、実際に光を受け取った数だけをカウントしても向きは計測できませんが、2つの受光素子の配置関係を利用する（半周期ずらして配置）ことによって、それにより向きを判断することが可能になります。

このセンサーの分解能はスリットの数に依存しておりスリットの数が多ければ多いほどより正確な角度を計測できることになります。そのため、どのような制御をするかに依存してどんなエンコーダを用いるかを適切に選定する必要があります。倒立振子には2つのエンコーダーが軸と振子にそれぞれ1つずつついており、角度を計測することができます。

そして、2つのエンコーダーから得られる振子の角度に加えて、それぞれの角速度情報を用いることで4つの状態量を取得できるため、これによって、4状態の状態フィードバック制御実現できます。エンコーダの角速度は数値微分(YouTube)によって得ます。このとき、角度情報にも量子化誤差があることから角速度にも量子化誤差が乗ることになりますその程度が小さければ問題なく制御できるということになります