Double Integrator

• カテゴリ: Control › Feedback control
• タグ: dynamics, linear-systems, state-space, control-theory, point-mass

最も単純な 2 次の動的システム。制御入力が加速度で、位置と速度が状態である。指令された力のもとで動く質点をモデル化する。

定義

二重積分器（double integrator）は、入力を 2 回積分して出力が得られるシステムである。1 次元ではダイナミクスは ẍ = u であり、制御入力 u は加速度、速度はその積分、位置は速度の積分である。状態を [p; v] とする状態空間表現では、システムは ẋ = A x + B u、A = [[0, 1], [0, 0]]、B = [0; 1] となる。より高次元の場合は軸ごとにこの組を 1 つずつ積み重ねるので、3D 空間を動く質点は 3 つの独立した二重積分器になる。物理的には、力で駆動される摩擦のない質量を表し、入力は力を質量で割ったものである。

二重積分器は線形かつ可制御であり、制御とプランニングの標準的な例題となっている。位置と速度に対する比例・微分（PD）フィードバックで安定化でき、ゲインは閉ループの固有振動数と減衰に直接対応する。二重積分器の線形二次レギュレータは小さなリカッチ方程式から得られ、加速度に上限がある場合の最短時間問題には、位相平面上に切り替え曲線が 1 本だけあるバンバン解がよく知られている。刻み幅 Δt で各ステップ内の入力を一定とする離散時間では、更新式は p ← p + v Δt + ½ u Δt² および v ← v + u Δt となり、モデル予測制御や軌道最適化に容易に組み込める。

多くの実システムは、変換を施すと二重積分器に帰着する。計算トルク制御は全駆動マニピュレータの非線形ダイナミクスを打ち消し、各関節が指令加速度で駆動される二重積分器のように振る舞うようにする。クアッドロータの並進運動は指令加速度に関して二重積分器に近く、これが微分平坦性とミニマムスナップ軌道がドローンでうまく機能する理由の 1 つである。プランニングの論文では、ダイナミクスを単純に保ちながら運動量と加速度の制限を表現できるため、シミュレーションで二重積分器のロボットがよく使われる。その単純さの代償として、摩擦、アクチュエータのダイナミクス、非ホロノミック拘束、飽和が欠けているため、二重積分器で得られた結果が実際のプラットフォームにそのまま移行するとは限らない。

重要な理由

二重積分器は、ロボットが速度を瞬時には変えられないという慣性を表現できる最も単純なモデルである。フィードバック制御、軌道生成、キノダイナミック計画を理解する出発点であり、実用的なコントローラの多くは、まずロボットをこの形に帰着させてから設計される。

主な用途

• モーションプランニングと制御の研究におけるベンチマーク用ダイナミクス
• クアッドロータの並進運動や質点として扱う車両の簡略化モデル
• 計算トルクによる線形化の後の関節レベルのモデル
• PD 制御、LQR、最短時間制御の教育
• 2 次系エージェントによるマルチエージェントの合意制御と編隊制御

実際の使われ方

地上ロボットのチームのための反応型プランナーを試作するチームが、まず加速度と速度に上限のある二重積分器エージェントを使ってシミュレーションで試験し、プランナーが停止距離を考慮しなければならないようにする。プランナーが機能するようになると、計画された加速度に追従する下位コントローラと、追従誤差を吸収するための加速度制限の余裕を使って、実際の差動駆動ロボットに展開する。実機ロボットが旋回で行き過ぎると、チームは問題の原因をモデル化されていない非ホロノミック拘束に突き止め、それをプランナーに加えるか、加速度の上限を厳しくする。

よくある誤解

• 二重積分器は教科書の中のおもちゃにすぎない — 多くの制御対象はフィードバック線形化の後に二重積分器に帰着し、ドローンやマニピュレータの制御で広く使われている
• 二重積分器での結果は実ロボットにそのまま移行できる — 摩擦、アクチュエータの制限、遅延、非ホロノミック拘束はモデルに含まれておらず、振る舞いを変えうる
• 二重積分器は単積分器と同じである — 単積分器は速度を入力とし速度を瞬時に変えられるが、二重積分器は加速度を入力とし運動量をもつ

知っておくべき人

• 制御エンジニアと学生
• 新しいアルゴリズムを試すモーションプランニングの研究者
• ドローンと移動ロボットの開発者
• マルチロボットシステムの研究者

関連技術

• PD 制御（PD Control）
• 計算トルク制御（Computed-Torque Control）
• バンバン制御（Bang-Bang Control）
• 状態空間モデル（State-Space Models）
• モデル予測制御（Model Predictive Control）

関連用語

• Linear-Quadratic Regulator
• PID Controller
• Model Predictive Control
• Feedback Linearization
• Minimum-Snap Trajectory
• Kinodynamic Planning

関連プロジェクト

• Drake: MIT robotics toolbox for model-based dynamics, optimization, and control system design
• DART: C++ physics engine for articulated rigid body dynamics and robotics simulation
• frax: JAX library for fast, differentiable robot kinematics, dynamics and inverse kinematics