軌道最適化iLQRの計算を平方根形式で安定化する
Square Root Gauss-Newton iLQR
この論文をやさしく読む
ひとことで言うと
ロボットなどの軌道計算で使うiLQRを、行列の平方根に相当する因子で計算し、数値的に扱いやすくする方法です。
何に役立つ？
制約のペナルティが大きくなり、数値計算が不安定になりやすい軌道最適化の実装に役立つ可能性があります。
この研究の面白いところ
コスト関数の重み付き最小二乗構造を使うと、後退計算の一段階を一度のQR分解にまとめ、制御ゲインも同時に取り出せると示しています。
どこまで分かった？
簡潔な定式化を可能にするのはガウス・ニュートン型の構造と半正定値性です。要旨には実行時間や誤差の比較数値、実機制御の結果は記載されていません。
v1のアブストラクトに基づくAI解説。日本語訳とは別に、用途の解釈を含みます。
アブストラクトの日本語訳
反復線形二次レギュレータ（iLQR）は、非線形の軌道最適化に広く用いられるアルゴリズムである。各反復では、二次の残余コスト関数を伝播させながら、動的計画法によって問題の局所的な線形二次近似を解く。残余コスト近似のヘッセ行列が半正定値なら、その代わりにコレスキー因子を伝播させる平方根形式のiLQRを導ける。 これは、平方根カルマンフィルタが通常の形式を改善するのと同様に、数値計算上の大きな利点を持つ。特に、制約を扱うためにiLQRを拡張ラグランジュ法の枠組みで用いる場合、大きなペナルティが条件数を悪化させるため有用である。iLQRと関連アルゴリズムの平方根形式はすでに存在するが、数値的に最善でないか、アルゴリズムが複雑であるか、その両方だった。 本論文では、効果的な平方根形式の鍵が、コスト関数のガウス・ニュートン型、すなわち重み付き最小二乗の構造にあることを示す。この構造により、半正定値性はヘッセ行列だけでなく、拡大された残余コスト行列全体にも及ぶ。その結果、後退計算が非常に簡潔になり、各ステップは一度のQR分解に帰着する。そこからフィードバックゲインと伝播するコレスキー因子を直接取り出せる。
v1の要旨から自動生成。本文の精読・人による確認は未実施。
- 初稿
- 2026-09-17（UTC）
- 最新改訂
- 2026-09-17 · v1
- 査読・掲載
- 査読状況未確認
更新履歴
- v1 2026-09-17 この版を読む
取得できた版を表示。版の更新は査読済みを意味しません。過去版の本文差分は未解析です。
原文の要旨
The iterative Linear Quadratic Regulator (iLQR) is a widely used algorithm for nonlinear trajectory optimization. At each iteration, it solves a local linear-quadratic approximation of the problem via dynamic programming, propagating a quadratic cost-to-go function. If the Hessian of the cost-to-go approximation is positive-semidefinite, one can derive a square root formulation of iLQR that propagates its Cholesky factor instead. This offers significant numerical advantages - much as square root Kalman filters improve upon their conventional counterparts - particularly when iLQR is used within an augmented Lagrangian framework for handling constraints, where large penalties degrade conditioning. Previous square root formulations of iLQR and related algorithms exist, but they are either numerically suboptimal, algorithmically complex, or both. In this paper, we show that the key to an effective square root formulation lies in the Gauss-Newton (weighted least-squares) structure of the cost function: this yields a positive semidefiniteness property that extends beyond the Hessian to the full augmented cost-to-go matrix, and enables a backward pass of remarkable simplicity in which each step reduces to a single QR-decomposition, from which the feedback gain and propagated Cholesky factor are extracted directly.
著者のコメント
16 pages, 2 figures, ISRR 2026
arXiv ID: 2609.21053 ／ 要約の誤りについて