[論文レビュー] Optimization-Based On-Road Path Planning for Articulated Vehicles

Rui Oliveira, Oskar Ljungqvist+2 more|arXiv (Cornell University)|Jan 19, 2020

Robotic Path Planning Algorithms参考文献 16被引用数 6

ひとこと要約

本稿では、トラクター・トレーラーなどのアーチケイテッド車両のための最適化ベースのパスプランニングアルゴリズムを提案する。道路に沿った座標系と逐次二次計画法（SQP）を用いて、オフトラッキングを最小限に抑えつつ障害物回避を確保する。主な貢献は、車両本体のスイープパスを短縮するように調整された最適化目的関数であり、Uターンや450度の円環交差点を含む複雑な道路上シナリオにおいて、安全で人間らしいナビゲーションを、高い計算精度で実現可能にする。

ABSTRACT

Maneuvering an articulated vehicle on narrow road stretches is often a challenging task for a human driver. Unless the vehicle is accurately steered, parts of the vehicle's bodies may exceed its assigned drive lane, resulting in an increased risk of collision with surrounding traffic. In this work, an optimization-based path-planning algorithm is proposed targeting on-road driving scenarios for articulated vehicles composed of a tractor and a trailer. To this end, we model the tractor-trailer vehicle in a road-aligned coordinate frame suited for on-road planning. Based on driving heuristics, a set of different optimization objectives is proposed, with the overall goal of designing a path planner that computes paths which minimize the off-track of the vehicle bodies swept area, while remaining on the road and avoiding collision with obstacles. The proposed optimization-based path-planning algorithm, together with the different optimization objectives, is evaluated and analyzed in simulations on a set of complicated and practically relevant on-road planning scenarios using the most challenging tractor-trailer dimensions.

研究の動機と目的

• 狭く複雑な環境における大型アーチケイテッド車両（特にトラクター・トレーラー）の道路上パスプランニングの課題に対処すること。
• 車両本体のオフトラッキングを最小限に抑えつつ衝突回避と道路中央への位置合わせを保証するパスプランナの開発。
• 標準の乗用車用目的関数では、アーチケイテッド車両の運動学的挙動に不適切であるため、それらに特化した最適化目的関数の設計。
• 急カーブや障害物を含む現実的で高難易度の道路上シナリオにおけるプランナの性能評価。
• 再帰的ホライズン実装と効率的な数値手法を用いて、リアルタイム実行可能性の確保。

提案手法

• 道路上のパスプランニングを簡素化し、標準の自律走行フレームワークと整合させるために、トラクター・トレーラーを道路に沿った座標系でモデル化する。
• 衝突防止パスの計算のための非線形最適化問題を定式化し、車両の運動学的制約、障害物制約、およびカスタム目的関数を組み込む。
• 非線形最適制御問題を繰り返し解くために逐次二次計画法（SQP）を用い、妥当で滑らかなパスへの収束を保証する。
• トレーラーおよびトレーラー本体上の各点のオフトラッキングを逐次的に計算する手法を開発し、数値最適化に必要な近似偏微分を算出する。
• 再帰的ホライズンアプローチを採用し、各タイムステップで更新された車両状態と環境観測に基づいて再プランニングを行う。
• ドライビングヒューリスティクスに基づいて最適化目的関数を導出しており、最大オフトラックを最小化し、スイープ領域を道路中央線に一致させることが焦点である。

実験結果

リサーチクエスチョン

• RQ1 最適化ベースのパスプランニングは、複雑な道路上走行においてアーチケイテッド車両のオフトラッキングを効果的に低減できるか？
• RQ2 異なる最適化目的関数は、パス品質、障害物回避、道路中央への位置合わせにどのような影響を及ぼすか？
• RQ3 提案されたSQPベースのアプローチは、高曲率シナリオにおいて滑らかで実行可能かつ衝突のないパスをどれほど確実に得られるか？
• RQ4 車両寸法は、現実の道路上環境における計算時間とプランナの性能にどの程度影響を及ぼすか？
• RQ5 Uターンや450度の円環交差点を含む困難な都市部シナリオにおいて、プランナは人間らしい安全で効率的なパスを生成できるか？

主な発見

• 提案されたパスプランナは、2つの障害物を伴うUターンシナリオにおいて、戦略的なスウィービングを用いて効果的な障害物回避を実現し、衝突のないパスを正常に計算した。
• Uターンシナリオでは、車両寸法が大きく、曲率が高いため（0.065 m⁻¹）、計算時間が108.41秒にのぼり、車両サイズに敏感であることが示された。
• 小型車両構成では計算時間が29.89秒に低下し、車両サイズが計算負荷に顕著に影響することを示した。
• プランナは、ターン後のトラクターおよびトレーラー本体を道路中央に保つ安全で滑らかで人間らしい軌道を達成した。
• 特化した最適化目的関数の使用により、オフトラッキングが低減され、標準的な目的関数と比較して、より予測可能で侵入性の低い車両挙動が実現された。
• SQPベースのアプローチは、非線形運動学的モデルに限りなく近い解に収束したため、線形化の影響を受けてもその正確性が裏付けられた。