[論文レビュー] Safe Interval Path Planning With Kinodynamic Constraints

Zain Alabedeen Ali, Konstantin Yakovlev|arXiv (Cornell University)|Feb 1, 2023

Robotic Path Planning Algorithms被引用数 4

ひとこと要約

本稿では、非即時の加速および減速を扱うために、安全区間パスプランニング（SIPP）の完全かつ最適な拡張版であるSIPP-IPを提案する。SIPP-IPは、停止までの時間と加速までの時間を推論するために区間射影を導入し、運動力学的制約を処理する。元のSIPPや単純な変種とは異なり、動的整合性を考慮した安全区間のモデル化により不完全性を回避し、A*と比較して100倍の高速化を達成するとともに、完全性と解の質の両面で不完全なSIPP変種を上回る性能を発揮する。

ABSTRACT

Safe Interval Path Planning (SIPP) is a powerful algorithm for solving single-agent pathfinding problem when the agent is confined to a graph and certain vertices/edges of this graph are blocked at certain time intervals due to dynamic obstacles that populate the environment. Original SIPP algorithm relies on the assumption that the agent is able to stop instantaneously. However, this assumption often does not hold in practice, e.g. a mobile robot moving with a cruising speed is not able to stop immediately but rather requires gradual deceleration to a full stop that takes time. In other words, the robot is subject to kinodynamic constraints. Unfortunately, as we show in this work, in such a case original SIPP is incomplete. To this end, we introduce a novel variant of SIPP that is provably complete and optimal for planning with acceleration/deceleration. In the experimental evaluation we show that the key property of the original SIPP still holds for the modified version -- it performs much less expansions compared to A* and, as a result, is notably faster.

研究の動機と目的

• 非即時の加速および減速を有するエージェントに適用した際の元のSIPPの不完全性を解消すること。
• 動的環境における時間変動型障害物を考慮した運動力学的制約を満たす、証明可能に完全かつ最適なパスプランニングアルゴリズムの開発。
• 現実的な運動ダイナミクス下でも正しさを保証しつつ、ノード展開を最小限に抑えることでSIPPの効率性を維持すること。
• SIPP-IPがA*および不完全なSIPP変種と比較して、成功確率、解のコスト、実行時間の面で優れていることを実験的に検証すること。

提案手法

• 運動力学的制約に基づき、エージェントが安全に停止または加速できる時間区間を表すために区間射影を導入する。
• SIPPの安全区間伝搬を、停止までの時間と加速までの時間を考慮するように変更し、動的整合性のある遷移のみを扱うようにする。
• 移動障害物で部分的に重複する場合でも、ブロッキング区間を予約する保守的な衝突検査を採用し、非整数時間制限を安全のための整数に丸める。
• 探索木内の異なる地点での待機行動を推論できる新しいノード展開戦略を導入し、非整合なパスに過剰にコミットするのを回避する。
• SIPPwRTの技術を活用してSIPP-IPを実装し、非整合パスの再展開と pruning を効率的に行う。
• 動的障害物を有するさまざまなマップ上で実験を行い、SIPP-IPをA*、SIPP1（運動力学的制約付きSIPP）、SIPP2（再展開強化SIPP）と比較する。

実験結果

リサーチクエスチョン

• RQ1 SIPPは、非即時の加速および減速といった運動力学的制約を扱えるように拡張可能であり、完全性と最適性を保ったままか？
• RQ2 標準的なSIPP拡張が運動力学的制約を導入した際に失敗する理由は何か？完全性を回復させるために必要な構造的変更は何か？
• RQ3 追加の運動力学的整合性の複雑さにもかかわらず、SIPP-IPはノード展開数と実行時間の面でSIPPの効率性を維持できるか？
• RQ4 多様な環境において、SIPP-IPはA*および不完全なSIPP変種と比較して、成功確率、解のコスト、計算効率の面で優れているか？

主な発見

• SIPP-IPは全テストマップで100％の成功確率を達成したが、A*は多くの実行でノード制限に達し、SIPP1/SIPP2は不完全性のため低い成功確率を示した。
• 平均して、SIPP1およびSIPP2が解けなかったすべてのインスタンスをSIPP-IPが解けることから、運動力学的制約下でも完全性を保証していることが示された。
• コスト比較において、SIPP1とSIPP2の解はSIPP-IPより高いコストを示した。特に『room』マップでは、SIPP1の42％、SIPP2の22％がSIPP-IPのコストを50％以上上回った。
• SIPP-IPはA*と比較して実行時間を2桁減少させ、全マップ（最大のマップを除く）で平均0.1秒未満の実行時間となった。
• より保守的であるにもかかわらず、SIPP-2より実行時間が短く、区間射影戦略が不要な展開を削減していることが示された。
• 平均実行時間が全マップ（最大のマップを除く）で0.1秒未満であるため、リアルタイムロボットアプリケーションに適している。