コンテンツにスキップ

上位(Raspberry Pi)の安全設計

要点

  • Raspberry Pi 側は、「走ってよい条件」を独立した複数の場所で別々に確かめる作りです。
  • 指令の経路は 1 本に絞り、操縦者が離れたら止まる仕組み(デッドマン)を 3 段で持ちます。
  • 制御の API は既定で外に開かず、Pi が落ちたときは STM32 側が車を止めます。

【設計の説明】

対象: io_node.py、telemetry_node.py、planning_node.py、vehicle.toml の [safety]。 確認した版: 上位 2d0a44e。再 ARM ラッチ(2026-10-14 の修正)は 【未検証】(検証状況)。

STM32 側の安全層(安全層とフェイルセーフ)に対して、Pi 側は 「走ってよい条件を、独立した複数の場所で別々に確かめる」作りです。どれか 1 つが壊れても走り出さないことを狙っています。

モータが回るための条件

io_node が STM32 へ ARM を送る前に、次の条件がすべてそろっている必要があります。判断は io_node の 1 か所に閉じています (「判断が 2 箇所にあると、どこかで解禁されていた、が起きる」)。

  1. --allow-arm を付けて起動している。付けなければ DISARM 固定。 GUI・WebSocket・バスに何が流れていても、ここで断つ。
  2. STM32 と話が合っている(_arm_block_reason):
    • protocol_version が一致している(不一致・未確認なら不可)
    • STM32 の LIMITS(速度・舵角の上限)を受信している
    • STM32 が GPIO6 のハートビートを検出している(検出していなければ E-Stop が効かないので封印する。--no-heartbeat で動かすときを除く)
    • vehicle.toml の [control](ステアのリンク換算を含む)が STM32 に入っている(同期の仕組み)
  3. 人が GUI で ARM を保持している。
  4. 再 ARM ラッチが掛かっていない(下記)。

telemetry_node は diag/link.arm_inhibited を GUI に中継するだけで、自分では解禁できません。

再 ARM ラッチ【未検証】

E-Stop・駆動電源のラッチ・STM32 の再起動のあと、および STM32 が ARM を受け付けなかったと知らせてきたあとは、人が ARM を一度外して入れ直すまで ARM を通しません(_update_rearm_latch)。 STM32 は E-Stop を解除した次の周期から指令をそのまま実行するため、ARM 付きの指令を流し続けていると、 車のそばでボタン 2 を押した瞬間に走り出すからです。

指令の経路は 1 本

flowchart LR
    GUI["ブラウザ GUI<br/>(50 Hz)"] -- "cmd(ARM・灯火・手動操縦)" --> TEL[telemetry_node]
    PLAN[planning_node] -- "auto/cmd<br/>(速度・舵・ブレーキ)" --> TEL
    TEL -- "cmd" --> IO[io_node]
    IO -- "COMMAND 100 Hz" --> STM[STM32]

cmd を publish するのは telemetry_node だけです。planning_node が直接 cmd に出すと、telemetry_node が誰も操縦していないときに 流している DISARM と、購読側からは区別できないまま 50 Hz で交互に上書きし合います。 「勝手にハンドルが戻る」という再現困難な症状になり、しかも止める側が負けることがあるので、経路を 1 本に保ちます。

telemetry_node は engage されている間だけ auto/cmd を cmd へ中継し、速度・舵・ブレーキだけを差し替えます。 灯火・ホーン・auto_stop・制動トルク・レート制限は GUI が送ってきた値のままです。

この形にすると、自律走行中も人間の安全網がそのまま生きます:

  • ARM は人間が GUI で保持する。 planning_node は ARM を立てられない。
  • GUI が 50 Hz で送り続けている限りだけ走る。途絶は DISARM に落とす。
  • E-Stop(GUI・STM32 のどちらでも)、操縦権の解放、接続断、デッドマンは、いずれも engage も同時に落とす。再開は人の engage から。
  • auto/cmd が 200 ms 途絶したら、engage したままでも制動に読み替える(auto_cmd_stale_ms)。

デッドマンは 3 段

段 どこで 時間 動作
1 ブラウザ フォーカスを失う/キーを離す 送信を止める
2 telemetry_node GUI からの cmd が 150 ms 途絶 DISARM をバスに流す
3 io_node バスの cmd が 150 ms 途絶 止める(下記)

telemetry_node は誰も操縦していなくても 50 Hz で cmd を流し続けます(操縦者がいなければ DISARM を明示的に)。 「沈黙」ではなく「明示的な DISARM」を流すことで、io_node の途絶判定を「telemetry_node が死んだか」だけに絞れます。

遅れて届いた「走れ」は捨てます(_cmd_lateness_ms)。Wi-Fi が詰まると GUI の指令はブラウザと TCP に溜まり、復帰した瞬間にまとめて届きます。 受信時刻だけで鮮度を見ると、何十秒も前の ARM でデッドマンが生き返り、人の操作なしに走り出すからです。止める指令は遅れていても通します。 捨て続けて 2 秒経ったら(CMD_LATE_RELEASE_NS)、操縦権を外して人に取り直させます。

自律走行中だけは、GUI からの cmd の途絶を 5 秒まで待ちます(auto_link_grace_ms = 5000)。 車は planner の指令で走っているので、Wi-Fi の瞬断で止める理由がありません (2026-10-06、メッシュ Wi-Fi の中継機の切り替えで走行中に DISARM した、と vehicle.toml のコメントにあります)。 その間は GUI から止められません。 止まるのは planner 自身の判断(見失い等)、auto_cmd_stale_ms、物理の電源遮断だけです。

「止める」の順序

io_node は cmd が途絶えたとき、走っていたなら、まず最大制動を送り、止まってから DISARM に落とします(_failsafe_packet)。 いきなり DISARM を送ると、STM32 は駆動電源を切り、MD ごと落ちて制動できずに惰行するからです。

走行中に自律を解除したとき

解除は「人の手動の指令に切り替わる」ことです。何も操作していない手動の指令は舵 0・速度 0(トルク制御ならトルク 0 = 惰行)なので、 そのまま切り替えると旋回中に舵が直進へ戻り、トルク制御なら惰行で進み続けます。2026-11-06 の走行では、左旋回中(2.6 m/s)に解除した 0.55 秒後に外側の壁へ 2.15 m/s で当たりました。

そこで telemetry_node は、自律の指令を送っていた直後に自律でなくなり、車が走っていたら(解除の理由は問わない)、 止まるか人がアクセルを入れるまで止める指令を送ります(_handover)。GUI の運転の設定には依りません。人が舵を切れば舵はその値です。

ただし、舵を固定したまま最大制動すると、後輪だけの制動で 3.8〜4.0 m/s からスピンして壁に当たりました(2026-11-08 の試走、5 本中 3 本)。 そこで地図を使うモード(slam2d_raceline・slam2d_route)が周回中(RACE)に経路を追っていたときは、planning_node が解除の後も 経路に沿って舵を取りながら、目標車速 0 へ減速する指令を出し続けます(release stop、_release_cmd)。減速度は今の走りの減速の上限 × 0.7 (RELEASE_DECEL_USE)で、周回中にコーナーの手前で使っている減速と同じ種類なので滑りません。telemetry_node はこの指令の舵と減速度だけを借ります (_handover_cmd)。解除が planning_node に届くまでの最長 0.2 秒は、普段の自律の指令の舵で 2 m/s² の減速にします。 借りられる指令が無いとき(他のモード・指令が古い・0.3 m/s より遅い)は、従来どおり舵を自律の最後の値に保って最大制動します。 この変更(2026-11-09)は実機では確かめていません(開発記録)。

舵が指令に追従しないとき

STM32 は舵の位置制御が追従しなくても何も報告しません。2026-10-31 の会場の試走では、起動後の最初の操舵で舵が動かず (指令 −0.15 rad に実舵角 0.00、ステア MD の電流は上限の約 4.8 A)、そのまま 1.4 秒まっすぐ走って壁に当たりました。

io_node は TELEMETRY ごとに見張り(raspi/core/steer_guard.py)、ARM 中に「|指令 − 実舵角| > 0.08 rad」かつ 「ステア MD の電流 ≥ 3.5 A」かつ「|車速| ≥ 0.3 m/s」が 0.25 秒続いたら、ARM のまま最大制動で止め、舵の指令を 見つけた時の値で据え置きます。実舵角がそれに 0.3 秒追従したら通常の指令へ戻し、走行を続けます (2026-11-02 の試走では舵が後で正常に戻りました。本番で DISARM すると人が ARM を入れ直すまで走れません)。 5 秒待っても戻らない、または 1 回の ARM で 3 回目のときは、最大制動 → 止まったら DISARM で止め、人が ARM を入れ直すまで通しません。 停車中は判定しません(据え切りは床との摩擦で上限電流のまま届かないことがあり、止まっていれば舵が動かなくても危なくない)。 16 本の記録では、正常な走行でこの状態が続いたのは最長 0.04 秒でした。

駆動電池の電圧低下

地図を使うモードでは、STM32 の駆動電池の電圧低下の警告が 2 秒続いたら(batt_low_s)、線を追いながら止まり、解除して入れ直すまで走りません。 実機では警告から約 7 秒で MD が落ちて舵が効かなくなった、とパラメータの説明にあります。

公開面の守り方

telemetry_node は制御 API を持つサーバなので、既定は安全側に倒してあります。

層 何を止めるか
--host の既定が 127.0.0.1 「打ち忘れ」で外に開くのを止める。外へ出すなら --host 0.0.0.0 を明示する
Origin 検査 クロスサイト WebSocket ハイジャック。操縦中に別タブで開いた悪意あるページが /ws/control を張るのを弾く
共有トークン(--token) 同一ネットワーク上の第三者。実際には隣の班の PC の誤接続を止める意味が大きい(トークンは .gitignore 済みのファイルか環境変数から読む)
engage に操縦権を要求 操縦権を持たない接続が自律走行を開始するのを止める
書き込みにトークン、車に効く書き込みは操縦者だけ 設定・記録・地図の変更にはトークンが要る。TC/ABS などの車の設定、カメラ、モデルの選択、記録・地図の削除、シャットダウンは、操縦者がいる間は操縦者だけが変えられる(OPERATOR_ONLY_KINDS)。地図の取り込みは ARM 中は断る

engage 中は、操縦者以外の接続は自律走行の設定(パラメータ・駐車目標・経路・地図)を変えられません(解除だけできる)。 ARM 中のシャットダウンも受け付けません。操縦権は同時に 1 人だけです(2 つのブラウザから舵を切ると、最後に届いた方が勝つ形になり、再現しにくい症状になるため)。

止める操作には条件をつけない

E-Stop・操縦権の解放・engage の解除は、トークンも操縦権も要求しません。 止める指令に条件を足すと、一番止めたい状況で止まらない設計になります。

また、受信が止まったクライアントは SEND_TIMEOUT_S(0.5 秒)で切ります。待ち続けると、スリープした PC 1 台のせいで ほかのクライアントへの配信と操縦者の操作の処理まで止まるためです(PROGRESS.md 2026-10-14)。

Pi が落ちたとき

surge-io を止める、または Pi が落ちると、GPIO6 のハートビートが止まり、STM32 が緊急停止をラッチします (install_services.sh のコメント。偶発的な実機での観測が PROGRESS.md にあります)。 STM32 が止まる側に倒れる設計なので、Pi 側の不具合の多くは「停止」として現れます。

設計の要点

  • 走行許可は「全部の条件が独立に成り立つ」ときだけ。許可を出す場所は 1 つ。
  • 指令の発行元は 1 つ。中継点で差し替える範囲(速度・舵・ブレーキ)を限る。
  • 止める操作は無条件、走り出す操作は何重にも条件付き。
  • 走行中に止めるときは、制動してから DISARM。電源を先に切らない。
  • 通信が途絶えた側が止まる(Pi → STM32 も、GUI → Pi も)。