8000 VirtualDriver: 交差点直進ルート設定時にTraj予測が直進/左折を高速交互誤判定し不要な減速が発生 · Issue #31 · GT-karny/esmini · GitHub
[go: up one dir, main page]

Skip to content

VirtualDriver: 交差点直進ルート設定時にTraj予測が直進/左折を高速交互誤判定し不要な減速が発生 #31

Closed

Description

@GT-karny

症状

VirtualDriver で交差点直進ルートが設定されているにも関わらず、軌跡(Traj)予測が直進と左折を高速に交互誤判定し、その結果、本来減速しない交差点で減速する(ユーザー実走行報告 2026-07-16)。

期待挙動: ルートが直進で確定しているなら、ジャンクション内パス予測は直進コネクションに安定して張り付き、減速要求は発生しない。

再現手順

再現条件未特定(発生は確認済み)。直進ルート設定の交差点シナリオで発生。

切り分けメモ:

  • 「直進と左折を交互に」という振動は、ジャンクション内コネクション選択が毎フレーム再評価で不安定になっている示唆。LHTタスクB で特定した connection_idx=0(XODR記載順先頭)無条件採用の系譜と関係する可能性あり(先頭コネクションが左折なら、ルート参照が効くフレームと効かないフレームで直進/左折が交互になるという仮説が立つ)。
  • 減速自体は ConflictPointResolver / 交差点減速系ポリシーが誤予測パスに反応した二次症状の可能性。ActivePolicyPanel またはテレメトリの policy constraints で減速要求元を特定できる。
  • VDのジャンクション内パス選択がルート(OnRoute)を参照しているか、位置ベース推定に落ちているかの確認が第一歩。

やること

  • 発生シナリオの特定と記録(交差点形状、ルート定義、LHT/RHT)
  • テレメトリで減速要求元ポリシーと予測パスの時系列を取得(直進/左折の交互周期を確認)
  • ジャンクションパス選択のルート参照有無をコードで確認(タスクB修正の適用範囲か)
  • 再現シナリオを Phase3 系バッチに固化

関連ID(名前空間付き)

feature:F2 feature:F3 policy:conflict policy:junction_priority vd-phase:Phase3e openx:Domain#Junction commit:ee9d825b

検出できるはずのゲート

regression (behavioral batch) — 「減速しないはず」のmatcher(min_speed_above)で表現可能

Activity

  1. GT-karny commented on Jul 17, 2026

    @GT-karny
    OwnerAuthor

    真因(root cause)の追記 — 症状は VD ではなく esmini の経路解決(RoadPath)にある

    調査の結果、本 Issue の症状(直進ルートなのに直進Traj/左折Trajが高速交互→不要減速)の**真の原因は VirtualDriver ではなく、esmini の経路解決(RoadPath)**であることが判明しました。

    症状の連鎖

    1. AssignRouteAction の waypoint が交差点(特に右折レーンを間に挟む構成)を跨ぐと、RoadPath::Calculate(dist, false) が接続を見つけられない。この探索は ①前方一方向のみ(bothDirections=false)②各ホップで GetConnectingLaneId≠0(レーン単位接続)を要求する Dijkstra(GT_esmini/src/road/GT_RoadManager.cpp — CheckRoad:6261 / Calculate:6415 / AddWaypoint:15341)。
    2. 接続失敗 → その waypoint は minimal_waypoints_ に追加されず skip され、警告 "Route::AddWaypoint Skip waypoint for scenario routes since path not found"(同 15326)が出る → ルートが交差点手前で truncate(不完全化)。
    3. ego は切れた所まで走り、交差点以降は off-route(on_route_ = false)。
    4. VD の前方パス予測 walker(TrajectoryShortPlanner の preview=「Traj」本体, ConflictPointResolver::PredictPath, ManeuverAwareSpeedPlanner, RouteSignalScan 等)は MoveAlongS(ds) 便利版(junctionSelectorAngle = -1.0)で歩くため、off-route フレームで Position::MoveToConnectingRoad の else // randomize 分岐に落ち、接続路を毎フレームランダム選択 → 直進コネクタ/左折コネクタが交互=「直進Traj/左折Traj交互」→ 交差点減速系ポリシーが誤反応。

    実証

    予測 walker と同一 idiom(Duplicate + CopyRoute + MoveAlongS)を fabriksgatan / 4way / 斜め2車線 / LHT で掃引した結果、on-route の routed ego は常に決定的(randomize しない)、off-route フレームでのみ randomize。斜め・曲線コネクタ・2車線左レーン・LHT・ステアリング誤差(横±1.6m / ヘディング±0.15rad, 756サンプル)を入れても on-route では deviating=0。→ ジオメトリは trigger ではなく、「ルート未解決による off-route」が trigger。

    回避策(確認済)

    右折コネクタ上に waypoint を置き、road 単位で隣接する waypoint を設置すると、各ホップが1ホップで解決して経路が完全化 → ego が on-route を維持 → 症状消滅。

    対応状況

    • 部分修正(コミット e01ed4f, refs #31): 予測 walker 6箇所を junctionSelectorAngle = 0.0(決定的な最直進)に変更。ルートが不完全でも VD が flicker しない堅牢化。全259ユニット緑・回帰ゲート deviations=0。ただしこれは症状対策であり root ではない。既修正の兄弟 RouteCrosswalkScan / ConflictPointResolver::FindUpcomingConnectingRoad と方針を揃えたもの。
    • 未対応(本 Issue を open のまま残す理由): RoadPath の経路探索が右折レーン経由の非隣接 waypoint を自動解決できない点。修正候補:
      • (A) RoadPath 強化(bothDirections 探索 / レーン→道路レベルのフォールバック)。核ルーティング改修のため回帰リスク高・upstream 乖離 → upstream-candidate として検討。
      • (B) ルート作成側バリデーション(scenario_authoring / validate_catalog で「path not found」skip を検出し CI で弾く)。

    関連ID: feature:F2 policy:conflict commit:ee9d825b(Task B route-exhaustion 系譜) commit:e01ed4f2

  2. GT-karny commented on Aug 2, 2026

    @GT-karny
    OwnerAuthor

    真因確定(起票時仮説の訂正)

    調査の結果、真因は RoadPath の経路探索欠陥ではなく、シナリオ側の Route Waypoint 記述の欠落だった。

    恒久ルール(GT_esmini/docs/virtualdriver/design/scenario_authoring_foundation.md §10 に明文化): ルートが junction を跨ぐとき、元Arm → ConnectingRoad → 行先Arm の連続する各 Road に Waypoint を置く必要がある。ConnectingRoad を飛ばして行先 Arm に直接 Waypoint を置くと、RoadManager::Route::AddWaypoint のパス解決が Route::AddWaypoint Skip waypoint for scenario routes since path not found(WARN のみ、呼び出し側への伝播なし)で静かに失敗し、ルートが truncate される。以降 ego は off-route になり、junction 内パス予測が位置ベース推定に落ちて振動する。

    確認済みの実例: resources/xosc/verification/05_anticipation/decelerate_for_right_turn.xosc — WP は road3(lane -1, s=11) と road2(lane 1, s=200) の2本のみで、fabriksgatan_traffic_lights.xodr junction 4 の connecting road 13(predecessor=road3, successor=road2, lane -1→1)を素通りしていた。同じ road ペア (3,2) には逆方向専用の connecting road 16(lane -1→1 だが predecessor=road2/successor=road3)も存在し、road id ペアだけで連想すると誤った connecting road を選んでしまう — lane id を含めた exact match が必要な理由。

    訂正: 起票時・調査中に立てた仮説はいずれも誤り

    • 起票時仮説「LHTタスクBで特定した connection_idx=0(XODR記載順先頭)無条件採用の系譜」— 不成立。実際は Route 自体が junction 手前で truncate されており、junction 内コネクション選択ロジック(connection_idx)に到達する前の問題だった。
    • capability_model.md FUNC-049 に記載されていた「issue VirtualDriver: 交差点直進ルート設定時にTraj予測が直進/左折を高速交互誤判定し不要な減速が発生 #31 で右折レーン接続失敗」— 誤り。RoadPath 自体は正しく動作しており、シナリオ記述側の Waypoint 欠落が原因。該当 note は訂正済み(function_catalog_vd_ad.yaml FUNC-049 も同様)。

    対応

    • resources/xosc/** を全数棚卸しし、同型の Waypoint 欠落を機械検出(scripts/check_route_waypoints.py、junction connecting road を lane 単位で directional に照合)。16 ファイル・17 箇所で発見、全件を Waypoint 追加のみで修正(ルートの意図は変更なし)。
    • resources/scenario_authoring/scenario_templates/generated/ の生成カタログ(Phase 3d/3e 用、gen_07/gen_08)にも同型の欠落を発見(36ファイル中複数)。生成器 authoring_common.make_route(..., xodr_path=...) に自動補完ロジックを追加し、カタログを再生成して修正。
    • resources/scenario_authoring/validate_catalog.py の静的チェックに (e) として組み込み、生成カタログでの再発を機械的に防止。
    • 恒久ルールを scenario_authoring_foundation.md §10 に明文化。virtual junction(p6_virtual_junction/)は異なるルーティング機構(アンカー方式)を意図的に検証しているため対象外と明記。

    残課題(別 Issue に切り出し)

    RoadManager::Route::AddWaypoint がパス解決失敗を WARN ログ1行のみで静かにフォールバックし、呼び出し側が検知できない構造そのもの(今回の真因特定が長期化した根本原因)は、本 Issue のスコープ(シナリオ記述側の恒久ルール明文化・棚卸し修正)の外なので、#42 として切り出した。

    ゲート確認

    • scripts/check_route_waypoints.py — resources/xosc/ 全169ファイル、FAIL 0件(p6_virtual_junction の2件は仕様上の除外として info 表示)
    • resources/scenario_authoring/validate_catalog.py(実行チェック込み)— 56/56 PASS
    • 回帰ゲート(run_regression_gate.ps1)— 確認中

    関連ID: feature:F2 feature:F3 policy:conflict policy:junction_priority vd-phase:Phase3e openx:Domain#Junction

    Closing — 恒久ルール明文化・既存資産の全数修正・再発防止(validate_catalog 組み込み)が完了。

  3. GT-karny commented on Aug 2, 2026

    @GT-karny
    OwnerAuthor

    ゲート確認完了: 回帰ゲート REGRESSION GATE: PASS (behavioral 27/27)。commit 27c7eec でクローズ。

  4. added 2 commits that reference this issue on Aug 3, 2026
    27c7eec
    153947f
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Metadata

Metadata

Assignees

No one assigned

    Labels

    bugSomething isn't working

    Projects

    No projects

      Milestone

      No milestone

      Relationships

      None yet

      Development

      No branches or pull requests

      Issue actions

      0