BLT*：信念空間でRRT*を拡張し、点群デジタルツインでも高速に初期解を発見
Informed BLT*は、RRT*とInformed RRT*を2-Wasserstein距離の信念空間へ拡張したサンプリング型プランナーである。点群観測を用いる大規模屋外デジタルツインでも初期解を高速に発見し、一部マップでは競争力のある収束コストを示した。本論文はarXivプレプリントであり、査読済み学会・論文誌への採録は記録されていない。
点群観測に基づく自己位置推定の不確実性を考慮した信念空間計画を、広域デジタルツイン上でどのように効率化しスケールさせるか。
幾何的に短い経路でも観測の乏しい領域を通ると共分散が増大し、確率的な衝突回避や目標到達条件を満たせなくなる。既存のサンプリング型信念空間計画は低次元・解析的な観測モデルで評価されることが多く、点群の局所形状から局在化品質を推定するデジタルツインでは観測伝播の計算負荷が大きい。動的物体、植生、再構成アーチファクトも観測信頼性を低下させる。
BRM、FIRM、CS-BRM、RRBT、IBBTなどは配置空間上のグラフや木で信念を伝播する。Belief-Aなどは信念空間を直接サンプリングするが、2-Wasserstein距離を近接判定に用いるだけで経路目的は別に持つ。B-RRTやB-SSTは制御列をサンプリングし、新たな軌道ごとに観測を毎回伝播するため、点群観測の計算を再利用しにくく、広域デジタルツインでは初期解発見が遅れたり失敗したりする。
等方ガウス信念に限定し、2-Wasserstein距離が等長埋め込み可能なことを利用する。ホロノミック運動モデルの下で閉形式の信念到達可能性条件を導出し、観測伝播を繰り返さずに直接ステアリングとリワイヤリングを行う。点群ICPヘッセ行列を情報行列として用い、一度計算した情報をツリーノードにキャッシュして再利用する。凸ゴール集合に対して単一の超扁長回転楕円体（PHS）でinformed領域を外側近似し、情報付きサンプリングを実現する。さらにSAM3による意味的ラベリングでデジタルツイン前処理パイプラインを構築した。
16環境（カスタム3、ランダム10、デジタルツイン3）で5手法×50試行×2目的、計8000回のプランナー実行を行った。提案手法はNarrowを除く全マップで最速の初期解発見を達成した。ランダム10マップの平均では、Informed BLT*のW2初回解時間は3.30 ms（BLT* 3.27、B-RRT 6.56、B-SST 4.98、RRBT 45.32）、初回コストは99.97 m（B-RRT 124.89、B-SST 120.65、RRBT 93.02）だった。100 s時点のW2コストは66.40 mで、最低はB-SSTの65.52 mだった。OfficeデジタルツインではB-RRTとB-SSTは100 s以内に一度も解けず（success 0/0）、RRBTは24%のみ成功した。Informed BLT*とBLT*は100%成功し、初期解時間3.37 s/3.38 s、100 s W2コスト445.92 m/446.53 m（RRBTは502.70 m）だった。CampusではInformed BLT*が初期解0.09 s、100 s W2コスト102.70 mで、B-RRTの5.71 s/182.30 m、B-SSTの4.28 s/141.86 m、RRBTの2.38 s/144.70 mを上回った。一方Ruralでは100 s W2コストがInformed BLT*の130.80 mに対しRRBTは125.21 mと逆転した。
著者は最適性の理論的保証とinformed領域の包含保証を今後の課題としている。等方ガウス近似、最大尤度観測、部分観測の再パラメータ化、開ループ実行（フィードバック制御なし）、単一積分器・ホロノミックモデルに限定される。点群情報はICPヘッセ行列の局所近似に依存する。Ruralのような観測が極端に疎いマップでは最終コストでRRBTに劣る場合があった。実機実験は報告されておらず、コード公開の有無も論文では報告されていない。
点群観測を使う屋外自律走行（建設、鉱山、物流、農業など）の経路計画に応用できる。デジタルツイン上で自己位置推定の不確実性を考慮した経路を短時間で生成できるため、現場導入前の事前計画や運行中の再計画に利用可能である。ただし実機での閉ループ検証、非等方共分散の扱い、動的環境への対応が条件となる。現時点では研究段階のプレプリントであり、OMPLベースのプランナーとして1〜3年以内に実機実証へ進む可能性がある。
この論文はライセンス上、全文を転載できないため、要約と原文へのリンクのみを掲載しています。