Open Source Robotics

高品質なオープンソースロボティクスプロジェクト、ツール、ソフトウェアの厳選コレクション。

Frenet Frame Planning

  • 別名: Frenet planner, Frenet optimal trajectory planning, Frenet-frame trajectory generation
  • カテゴリ: Planning & manipulation › Motion planning
  • タグ: trajectory-generation, autonomous-driving, sampling-based-planning, lane-change

道路に沿った座標、すなわち基準経路に沿った距離とそこからの横方向オフセットで行う軌道計画。通常は滑らかな候補軌道を多数サンプリングし、有効なもののうち最もコストの低いものを選ぶ。

定義

Frenet フレーム計画(Frenet frame planning)は、車両の運動をグローバルな x と y ではなく、基準曲線(通常は車線の中心線)に対して記述する。位置は、曲線に沿った弧長 s と、曲線からの符号付き横方向オフセット d で与えられ、曲線とともに動く接線–法線座標系で測られる。この座標系は Frenet–Serret の公式にちなんで名付けられている。この座標では、車線内にとどまることは d をゼロ付近に保つこと、車線変更は d を隣の車線のオフセットへ移すこと、追従走行は s を時間とともに制御することを意味し、コスト関数や制約を簡単に書ける。

広く使われている定式化は Werling、Ziegler、Kammel、Thrun(ICRA 2010)によるものである。横方向と縦方向の運動を時間の多項式として別々に計画する。横方向オフセットと、追従や停止のように目標位置のある縦方向のタスクには 5 次多項式を、目標速度の維持には 4 次多項式を使う。各多項式は、現在の状態と終端状態の間のジャークを最小化する。プランナーは、異なる横方向オフセット、到着時刻、目標速度など多数の終端状態をサンプリングし、横方向と縦方向の候補を組み合わせ、デカルト座標に戻したうえで、曲率、加速度、速度の制限を超えるものや、予測した障害物と衝突するものを捨てる。有効な候補のうち、ジャーク、時間、目標からのずれを重み付けしたコストが最も低いものが実行され、連続する軌道の一貫性を保つため、前回の計画を起点として高いレートで計画が繰り返される。低速では、横方向オフセットは時間よりも s の関数として計画するほうがよい。

この手法は良い基準線に依存する。曲線は滑らかで曲率が連続していなければならず、横方向オフセットが曲率半径に近づくとデカルト座標への変換が破綻する。これは、オフセットの大きい急カーブで起こる。Frenet フレーム計画は構造化された道路や車線に向いており、駐車場や開けた空間では Hybrid A などのプランナーが代わりに使われる。

重要な理由

道路での走行は本来車線に対して記述されるものであり、Frenet 座標は車線維持、車線変更、合流、追従を単純な一次元の問題に変える。サンプリングによる定式化は実装が容易で、滑らかで快適な軌道を生み、自動運転車の標準的な教材およびベースラインのプランナーになっている。

主な用途

  • 高速道路での車線維持、車線変更、追い越し
  • 市街地走行での追従、合流、停止線での停止
  • 自動運転の研究プラットフォームやシミュレータでのベースラインプランナー
  • 通路、作物の列、軌道に沿って移動するロボットの経路追従
  • コースの中心線に対して計画するレーシングライン

実際の使われ方

高速道路で、自動運転の試験車両は現在の車線の中心に沿った滑らかなスプラインを基準線として作る。各計画周期で、自車線と隣接車線への横方向の終端オフセット、いくつかの操作時間、目標速度の集合をサンプリングする。対応する多項式を生成し、各候補を x、y、方位、曲率に変換し、快適性やタイヤの限界を超えるものや、周囲の車の予測経路に近づきすぎるものを除外して、残った中で最もコストの低い軌道を追従コントローラに渡す。たとえば前の車が減速したときのように、隣の車線で終わる候補が最もコストが低くなると、車線変更が起こる。

よくある誤解

  • Frenet フレーム計画は単一のアルゴリズムである — それは座標の選び方であり、多項式によるサンプリングが一般的な手法だが、最適化ベースのプランナーも Frenet 座標で動作する
  • Frenet フレームで滑らかなので軌道は実行可能である — 曲率と加速度の制限は、デカルト座標に戻した後で確認しなければならない
  • どこでも使える — 滑らかな基準経路が必要で、急カーブや車線のない開けた空間では性能が落ちる
  • 横方向と縦方向の計画は完全に独立している — 便宜上別々に計画するが、組み合わせて一緒に確認しなければならない

知っておくべき人

  • 自動運転の計画エンジニア
  • CARLA などの走行シミュレータを使う研究者
  • 構造化されたルートに沿って走る移動ロボットの開発者
  • 軌道生成を学ぶ学生

関連技術

  • 5 次・4 次多項式軌道(quintic and quartic polynomial trajectories)
  • Frenet–Serret の公式
  • 3 次スプライン基準線(cubic spline reference lines)
  • ステートラティスプランナー(state lattice planner)
  • モデル予測制御(model predictive control)
  • CARLA シミュレータ

関連用語

  • Trajectory Planning
  • Bicycle model
  • Model Predictive Control
  • Obstacle Avoidance
  • Nonholonomic Constraint
  • Hybrid A*

関連プロジェクト

  • Ruckig: Real-time jerk-constrained time-optimal trajectory generation for robots and machines
  • Vision Pilot: Autoware Foundation's open-source L2 ADAS stack from a single camera
  • python_simple_mppi: MPPI control derived and implemented in numpy, with four worked examples
  • NVIDIA Alpamayo: NVIDIA's open driving VLA models that plan a path and explain it, with sim, RL and data

このウェブサイトにはJavaScriptが必要です。オープンソースロボティクスプロジェクトを閲覧するにはJavaScriptを有効にしてください。