[論文レビュー] Optimal Trajectory-Planning of UAVs via B-Splines and Disjunctive Programming

Alireza Babaei, Amir-Hossein Karimi|arXiv (Cornell University)|Jul 9, 2018

Robotic Path Planning Algorithms参考文献 48被引用数 11

ひとこと要約

本論文では、再帰的ホライズンフレームワーク内でのBスプライン曲線と分岐プログラミングを用いて、UAVのリアルタイム最適軌道計画アルゴリズムを提案する。軌道をC2連続なBスプラインとしてモデル化し、非凸制約を分岐プログラミングによって緩和することで、静的・動的障害物、地形、飛行禁止区域を回避する高速で実行可能かつ滑らかな飛行経路を実現した。標準ハードウェア上ではホライズンあたり0.2〜2秒の計算時間であり、リアルタイム性を満たしている。

ABSTRACT

This paper investigates an efficient algorithm for trajectory planning problem of autonomous unmanned aerial vehicles which fly over three-dimensional terrains. The proposed algorithm combines convex optimization with disjunctive programming and receding horizon concept, which has many advantages, such as a high computational speed. Disjunctive programming is applied in order to relax the non-convex constraints of the problem. Moreover, the B-spline curves are employed to represent the trajectories which should be generated in the optimization process.

研究の動機と目的

• 複雑な3次元環境で動作する自律UAV向けに、計算効率が高くリアルタイム性を備えた軌道計画アルゴリズムの開発。
• UAV軌道計画のNP困難性に対処するため、凸最適化と分岐プログラミングを組み合わせ、非凸制約を扱う。
• 4次Bスプライン曲線を用いて少なくともC2連続性を確保することで、軌道の滑らかさと実行可能性を保証する。
• 再帰的ホライズンアプローチによりオンライン運用を可能とし、動的更新と飛行中のウェイポイント調整をサポートする。
• 1つのマルチオブジェクティブ最適化フレームワークに、軌道長、飛行高度、滑らかさの複数の目的を統合する。

提案手法

• C2連続性と滑らかな飛行ダイナミクスを保証するため、軌道を4次Bスプライン曲線でパラメータライズする。
• 非凸制約（例：障害物回避、地形クリアランス）を分岐プログラミングにより緩和し、凸最適化で解ける形に変換する。
• 再帰的ホライズン制御戦略を適用し、有限時間ウィンドウ内で最適化問題を解き、各タイムステップで更新することでリアルタイムの適応性を実現する。
• 最適化問題に複数の目的を統合：経路長の最小化、飛行高度の最小化、アクティブなキーポイント数の最小化（滑らかさの向上）。
• センサーは半径Rの球面五角形検出範囲をモデル化し、定義された視野内での障害物および地形の検出を可能にする。
• 混合整数定式化を用いて、凸最適化ソルバ（例：MOSEK や Gurobi）で問題を解き、計算効率を確保する。

実験結果

リサーチクエスチョン

• RQ1 Bスプラインパラメータライズーションと分岐プログラミングの組み合わせにより、複雑な3次元環境でも高速で滑らかで実行可能なUAV軌道を実現できるか？
• RQ2 再帰的ホライズンアプローチは、未知の障害物を有する動的環境において、どのようにリアルタイムの適応性を向上させるか？
• RQ3 複数の目的（経路長、高度、滑らかさ）を統合することで、計算効率を維持したまま軌道品質をどの程度向上できるか？
• RQ4 本手法は、静的障害物および動的障害物（飛行中の衝突シナリオを含む）の両方に対して、どの程度効果的に回避できるか？
• RQ5 オンラインUAV運用におけるアルゴリズムの計算パフォーマンスは、解法時間の観点からどの程度か？

主な発見

• 提案手法は、標準PC上での再帰的ホライズンステップあたり0.2〜2秒の解法時間を達成し、リアルタイムのオンライン運用を可能にした。
• 4次Bスプラインを用いた軌道は、少なくともC2連続性を示し、UAVのダイナミクスにとって重要な滑らかな速度および加速度プロファイルを保証した。
• 2機のUAVを含むシナリオでは、距離時間プロットにより、最小50mの安全な距離を維持しながら衝突を回避したことが確認された。
• 衝突回避制約を省略した場合、シミュレーションでUAV間の直接的な衝突が発生した。これは、最適化における制約の必要性と有効性を示している。
• 動的障害物が存在する状況では、UAVがそれを上空を飛行して回避したが、動的障害物制約を省略した場合、衝突が発生した。これにより、制約が安全性に果たす役割が検証された。
• 本手法は、地形追従（TF）と地形回避（TA）の併用を効果的に処理でき、複雑な地形上での低高度飛行を可能にした。