コンテンツにスキップ

走行モード(planner)

要点

  • 自動運転の方式は、すべて Planner という同じ形にはめてあり、GUI から切り替えられます。
  • 守る約束は 4 つだけで、新しい方式はファイル 1 つと一覧への 1 行で足せます。
  • 方式ごとの中身は、仕組みの近いものをまとめた 8 つのページで説明します(下の表)。

【設計の説明】

対象: raspi/auto/。確認した版: 上位 2d0a44e(2026-11-09)。各モードの検証の状態は、それぞれのページの冒頭に書いています。

planner の約束

自動運転の走らせ方は、すべて Planner の形にはめてあり、GUI から選べます(base.py)。守る約束は 4 つだけです。

  1. plan() は状態を持ってよいが、reset() で完全に初期化できる。 モードを切り替えたときに前のモードの舵の平滑化が残っていると、engage した瞬間に前回の続きから舵が動き出すため。
  2. 戻り値は AutoState。指令(target_speed / target_steer / brake)と、その理由(reason)を必ず同時に返す。 「なぜ止まったか」が後から分からないのが、デバッグを最も消耗させる。
  3. 走ってよいか分からないときは ready=False。迷ったら止まる。 ready=False は planning_node が制動指令に読み替える。
  4. パラメータは params に宣言する。 GUI のスライダはこの宣言から自動生成されるので、planner を足しても GUI は 1 行も変えなくてよい。

新しい走らせ方を足す手順は 2 つ(raspi/auto/<名前>.py を書く、registry.py の PLANNERS に 1 行足す)だけです。 id は保存キーでもある(config/auto.json と localStorage がこの文字列でパラメータを覚える)ので、後から変えると設定が黙って既定値に戻ります。

単位は SI のまま(距離 [m]、角度 [rad]、車両座標・反時計回りが正)。度に直すのは表示用の *_deg だけです。

計画は入力が来たときだけ回します。LiDAR は 10 Hz、auto/cmd の発行は 50 Hz なので、同じ周で 5 回計算しても答えは変わらないため。

どの planner も「固定距離のハード停止」は持ちません。 近づきすぎたら止める役目は、STM32 の auto_stop (速度に応じて伸びる動的停止距離、自動停止)に任せています。 正面が詰まったときに減速するのは、緊急停止ではなく走行の一部として残してあります。

一覧

id 名前 入力 地図 概要
ftg Follow the Gap LiDAR 不要 最も広く空いている方向へ
de Disparity Extender LiDAR 不要 通れない隙間を先に塞いでから、一番遠い帯を狙う
dp Disparity Pursuit LiDAR 不要 DE の安全マージン + FTG の Pure Pursuit 舵角 + ヒステリシス
ftg_cam Follow the Gap(カメラ) カメラ(擬似 LiDAR) 不要 ftg を擬似 LiDAR(scan/cam)で流用
cam_centerline カメラ中心線 カメラ 不要 走行可能領域の回廊の中心線を追従
cam_e2e カメラ E2E カメラ 不要 画像から操舵を直接回帰(模倣学習)
line_trace ライントレース カメラ 不要 白線を追う
e2e_lidar LiDAR E2E LiDAR 不要 強化学習した方策(ONNX)
e2e_fusion E2E 融合 LiDAR + カメラ + 車両状態 不要 記録から模倣学習し、出した経路点を追う(記録を録ったコース向け)
slam2d_route 経路選択走行 LiDAR + IMU + 車速 作る 地図→道路グラフ→経路→周回
follow_object 対象追従 カメラ + LiDAR 不要 映像上で選んだ対象との車間距離を保つ
park_to_point 駐車 LiDAR 局所のみ 指定位置・向きへ自律的に接近して停止
calib_* 車両の校正 — — 校正専用の試験。自動運転タブには出ない(検証の仕組み)

開発記録(2026-10-14)によれば、GUI の自動運転モードからは slam2d_raceline(レーシングライン)が外され、slam2d_route に一本化されています (コード上は PLANNERS に両方が登録されたままです)。後者は前者の派生で、分岐のあるコースにも対応します(地図と自己位置推定、レーシングライン)。

系統ごとのページ

ページ モード 一言で
LiDAR で空いている方向へ ftg・de・dp 地図なし。点群から毎周期「どこへ向かうか」を決める
カメラで道を見る ftg_cam・cam_centerline・line_trace 走行可能な領域や白線を認識し、地面の座標に直して追う
模倣学習(カメラ E2E) cam_e2e 手本の運転を真似て、画像から舵を直接出す
強化学習(LiDAR E2E) e2e_lidar シミュレータで試行錯誤した方策で、点群から舵と速度を出す
E2E 融合(LiDAR + カメラ) e2e_fusion 点群・画像・車両状態から前方の経路点を出し、推測航法でずらして追う
地図を作って走る slam2d_route 地図・自己位置・走行ライン・経路選択・追い抜き
対象を追う follow_object 映像で選んだ相手との距離を保って付いていく
駐車する park_to_point クリックした位置と向きへ、障害物を避けて入る

自動運転タブのモードとパラメータ

Disparity Extender を選んだところ。12 個のパラメータのスライダは、走行モードの宣言から自動で作られる(シミュレータで撮影)。