From Crash Prone Gap Following to Robust Safety via Nonlinear Control Barrier Functions

技術要約：クラッシュしやすいギャップ追従から、非線形制御バリア関数による堅牢な安全性へ

問題提起
本論文は、自律走行車両（AV）が敵対的な追い越しシナリオで動作する際の、標準的なギャップ追従ナビゲーション手法（特にFollow-the-Gap: FTGアルゴリズム）の安全性の限界に対処している。FTGとその派生手法は、マップレスナビゲーションにおいて効率的であるが、ギャップ構成が急速に変化する場合や、先行車両が攻撃的な操舵を行う場合に失敗することが多い。これらの失敗は、追従車両がトラックの境界を外れて通路の壁に衝突する「境界クラッシュ（border crashes）」として現れる。核心となる課題は、通常条件下では安全に見えるコントローラー（線形制御バリア関数など）と、真の堅牢性を提供するコントローラーをどのように区別するかである。

手法
本研究では、Viconモーションキャプチャシステムによって監視された直線通路（幅1m、長さ10m）環境において、Agilex Limo自律走行車両プラットフォームを使用している。研究では、敵対的なジグザグ走行を実行する主要な「先行車両」と、追い越しを試みる二次的な「追従車両」を含む、4つの異なるシナリオを比較している。

1. システムモデリング: 車両ダイナミクスは、一次速度追従を用いた運動学的ユニサイクルモデルを使用してモデル化されている。トラックの安全性は、横方向の位置制約（$y \in [-W/2, W/2]$）によって定義される。
2. コントローラー設計:
   • ベースライン・コントローラー: 標準的なFTG（最も広いギャップの外縁に向かってステアリングを切る）および、よりタイトなレート制限を持つ保守的なFTG派生型。
   • 安全フィルター: 著者らは、トラックの不変性を強制するために制御バリア関数（CBF）を実装している。ここでは、線形CBF（純粋に位置に基づくもの）と、提案されている非線形かつ速度を考慮したCBFを比較している。
   • 非線形CBFの定式化: 提案された関数 $h(y, \dot{y}) = \frac{W^2}{4} - (1+\gamma)y^2 - \beta\sqrt{\dot{y}^2 + \epsilon}$ は、横方向の位置（$y$）と横方向の速度（$\dot{y}$）を統合している。この定式化には、センタリング項と、横方向の速度が増加するにつれて許容帯域を狭める速度依存のタイトニング項が含まれており、境界付近での早期の修正行動を強制する。
3. 敵対的セットアップ: 先行車両は、追従車両のギャップ検出を撹乱するために、制御入力によるマイクロ振動（微小振動）と、境界によってトリガーされるマクロ振動（大きな振動）を伴う「ジグザグ走行」を行うようプログラムされている。
4. 実装: 安全制約は、公称ステアリング指令からの偏差を最小化しつつ、CBF不等式 $\dot{h} + \kappa h \geq 0$ を満たす二次計画法（QP）を介してリアルタイムで適用される。

主な貢献
本論文は、主に4つの貢献を行っている：

1. 敵対的操舵のデザイン: 制御入力によるマイクロ振動と、CBFによる境界トリガーの修正によるマクロ振動を特徴とする、再現可能なジグザグ走行の作成。
2. 非線形CBFの定式化: 横方向のトラック包含のための、速度を考慮したゼロイングCBFの開発。これは、攻撃的な走行によって引き起こされる激しい横方向の逸脱に対する堅牢性を高める、速度依存の安全集合を定義する。
3. 統合: FTGコントローラーと非線形CBFを統合し、より安全な追い越し戦略を作成することに成功した。
4. 実験的検証: Agilex Limoプラットフォーム上での実証実験により、FTGおよび線形CBFは敵対的条件下で失敗する一方で、非線形CBFは性能への影響を最小限に抑えつつ安全性を維持することを示した。

実験結果
著者らは4つのシナリオを評価した：

• シナリオ1（単一車両）: 非線形CBFは、最大速度での単一車両に対してトラックの不変性を維持し、境界付近の小さな逸脱を修正することに成功した。
• シナリオ2（FTG 対 敵対的先行車両）: 標準的なFTG追従車両は、急速なギャップの切り替えと攻撃的なステアリングにより、柔軟なダクトの境界に繰り返し衝突した。
• シナリオ3（保守的FTG 対 敵対的先行車両）: 横方向の逸脱を抑え、より滑らかな旋回を実現したにもかかわらず、保守的な派生型も、繰り返されるギャップの再構成によってコントローラーが圧倒され、すべての7回の試行において衝突を防ぐことができなかった。
• シナリオ4（FTG と 線形 vs 非線形 CBF）:
  • 線形CBF: 不安全な状態を確実に捉えることができなかった。初期条件を変えた5回の試行のうち1回において、追従車両は外側へ逸脱し、衝突した。線形制約には、駆動制限に達した際に境界違反を防ぐために必要なセンタリング効果が欠けていた。
  • 非線形CBF: 10回すべての実験において、追従車両はレーン内に留まった。速度を考慮した制約のタイトニングにより、より早い段階での内側へのステアリングが促され、境界越えの衝突を回避することに成功した。

意義と主張
本論文は、標準的なギャップ追従手法は、たとえ保守的なマージンや線形安全フィルターで補強されていたとしても、敵対的な追い越しシナリオには不十分であることを主張している。主な意義は、非線形性と速度への配慮が、堅牢な安全性にとって極めて重要であることを示した点にある。提案された非線形CBFは、横方向の速度に基づいて安全集合を動的に調整することで、「より堅牢な安全の概念」を提供し、コントローラーが衝突前に回復できなくなるような状態への進入を防いでいる。著者らは、このアプローチがラップタイムへのペナルティを最小限に抑えつつ安全性を維持し、複雑で予測不可能な走行環境におけるリアルタイムの安全性のための原理的な枠組みを提供すると結論付けている。

著者らは、今後の研究として、タイヤのスリップ、センシング遅延、曲線トラック、および意図推論をフレームワークに拡張することを述べているが、現在の研究は、運動学的モデルとテストされた特定の敵対的追い越しシナリオに厳密に限定されている。