[論文レビュー] Fast UAV Trajectory Optimization using Bilevel Optimization with Analytical Gradients

Weidong Sun, Gao Tang+1 more|arXiv (Cornell University)|Nov 27, 2018

Robotic Path Planning Algorithms参考文献 32被引用数 8

ひとこと要約

本稿では、UAVの軌道計画を空間（状態）変数と時間（タイミング）変数に分離する二段階最適化フレームワークを提案する。これにより、効率的かつグローバルに最適な軌道生成が可能となる。QPの双対性から導出された解析的勾配を用いることで、有限差分法に比べて収束を加速し、精度を向上させ、リアクティブなターゲット追跡タスクにおいて実時間性能を達成し、速度と信頼性の面で顕著な向上を実現する。

ABSTRACT

We present an efficient optimization framework that solves trajectory optimization problems by decoupling state variables from timing variables, thereby decomposing a challenging nonlinear programming (NLP) problem into two easier subproblems. With timing fixed, the state variables can be optimized efficiently using convex optimization, and the timing variables can be optimized in a separate NLP, which forms a bilevel optimization problem. The challenge of obtaining the gradient of the timing variables is solved by sensitivity analysis of parametric NLPs. The exact analytic gradient is computed from the dual solution as a by-product, whereas existing finite-difference techniques require additional optimization. The bilevel optimization framework efficiently optimizes both timing and state variables which is demonstrated on generating trajectories for an unmanned aerial vehicle. Numerical experiments demonstrate that bilevel optimization converges significantly more reliably than a standard NLP solver, and analytical gradients outperform finite differences in terms of computation speed and accuracy. Physical experiments demonstrate its real-time applicability for reactive target tracking tasks.

研究の動機と目的

• UAV軌道最適化における非効率的で信頼性の低い時間パrametrizationの課題に対処すること。これは、高次のジャerkとエネルギー消費の増加を引き起こすことがある。
• 空間的経路とタイミング変数を同時に最適化するスケーラブルで実時間対応の軌道最適化フレームワークの開発。
• 二段階軌道最適化における有限差分勾配推定の計算および精度の制限を克服すること。
• 効率的な勾配計算により、リアクティブなUAVタスク（例：ターゲット追跡）における実時間適用を可能にすること。
• 滑らかでない状態でも、最適化のすべての段階で収束性と妥当性を保証すること。

提案手法

• 軌道最適化問題を二段階に分解する：下位レベルでは、固定されたタイミングのもとで空間変数（位置、速度、加速度）のための凸QP問題を解き、上位レベルではタイミング変数のためのNLP問題を最適化する。
• パラメトリックQPの感度解析を用い、双対解（ラグランジュ乗数）からタイミング変数に関する目的関数の正確な解析的勾配を計算する。
• 上位レベル問題において勾配降下法にラインサーチと射影を組み合わせ、滑らかでない領域では部分勾配を処理する。
• 多項式スプラインの零空間構造を活用して妥当性を保証し、フルランク制約行列を確保することで、強い2次十分条件（SSOSC）を満たす。
• 標準的なNLPソルバとの性能比較のため、ヘルミート＝シンプソン離散化を用いた直接コロケーションベースラインを実装する。
• 合計ジャerkと時間の両方をバランスさせる目的関数を採用し、重み付き和の目的関数により滑らかで高速な軌道を促進する。

(a) Trajectories flying through a point cloud environment with the initial trajectory (red) and optimized trajectory using our method (black). The 12 boxes indicate the safe corridor in which the UAV is constrained.

実験結果

リサーチクエスチョン

• RQ1 解析的勾配を用いた二段階最適化は、UAV軌道計画において、標準的なNLPソルバーよりも収束速度と信頼性が優れているか？
• RQ2 QPの双対性から得られる解析的勾配は、有限差分近似に比べて精度を向上させるとともに、計算時間を短縮できるか？
• RQ3 二段階フレームワークは、ターゲット追跡のようなリアクティブなUAVタスクにおいて実時間性能を達成できるか？
• RQ4 制約適合条件が満たされない場合に生じる上位レベル目的関数の滑らかでない性質は、本手法がどのように処理できるか？
• RQ5 空間的および時間的最適化の分離が、特にジャerkとエネルギー効率性の観点から、軌道品質にどのような影響を与えるか？

主な発見

• 二段階最適化フレームワークは、高次元かつ非凸な軌道問題においても、標準的なNLPソルバーよりもはるかに信頼性の高い収束を示す。
• 双対解から得られる解析的勾配は、有限差分法に比べて計算時間を短縮し、精度を向上させる。有限差分法は1回の勾配ステップあたり複数回のQP解法を必要とする。
• 本手法は物理実験において実時間性能を達成し、低ジャック、エネルギー効率の高い軌道を用いて、リアクティブなターゲット追跡を成功裏に実現した。
• 最適化のすべての段階で妥当性が保証されており、任意の時点で停止しても解の品質が損なわれない。
• 数値実験の結果、本手法はヒューリスティックな時間パrametrization手法に比べて、軌道のジャックと時間コストをより効果的に低減していることが示された。
• 理論的解析により、標準的なUAV制約のもとで、本手法が強い2次十分条件（SSOSC）を維持することが確認され、局所最適性と収束性が保証された。

(b) Velocity profiles of the trajectories in along the $x$ and $y$ direction.