STM32 ファームウェアの構成¶
要点
- STM32F446RE の上で、500 µs 周期(2 kHz)のメインループがセンサの取り込みから制御・通信までを回します。RTOS は使っていません。
- 機能はモジュールの層に分かれ、調整パラメータは Raspberry Pi から送られてきます(ファームに既定値を持たない)。
- 起動時のボタン操作でステアの中心を記録し、中心が未較正の間は走りません。
【設計の説明】
確認した版: ファーム fc6956c(2026-11-15、ブランチ main)、上位 7c7054e。6b5bdb3 からのファームの変更はウィンカーの点滅の仕方とステレオの自動停止だけで、このページの範囲は変わっていない。
書き込みの記録があるのは fb65b6f(2026-11-01)までで、それより後の変更(自動停止の予想進路、TC の作り直しなど)は実機に入っていません(上位の PROGRESS.md「現在の状態」)。
リポジトリの既定ブランチ main は基板の履歴で、ファームの最新ではありません。
STM32F446RE(Cortex-M4F、180 MHz)の上で、500 µs 周期(2 kHz)のメインループが全部を回します。 RTOS は使わず、割り込み(DMA を含む)はセンサの取り込みと UART まわりが中心です。
メインループ¶
app.c の MainApp() が毎周期、次の順に呼びます。
flowchart LR
A[Watchdog_Refresh] --> B[Power・灯火・センサ更新]
B --> C[Motors_Receive<br/>MD の状態]
C --> D[RasLink_Receive<br/>Pi の COMMAND]
D --> E[Vehicle_Update<br/>指令と安全の調停]
E --> F[Drive_Update<br/>車速 PI・TC・TV]
F --> G[Motors_Transmit<br/>MD へトルク指令]
G --> H[Telemetry・RasLink_Update<br/>送信]
H --> I{500 µs 経過まで待つ}
I --> A
受信を先にして、指令の計算をその後に置くのが肝です。MD の状態も Pi の COMMAND も、
計算の前に取り込まなければ 1 周期古い値で制御することになります。送信(RasLink_Update)は最後です。
- 周期は
CONTROL_INTERVAL_US 500で固定。Driveのローパスは時定数(DRIVE_LPF_TAU_*)で持ち、係数を 実際の経過時間から毎周期求めるので、周期を変えても時定数は変わりません(app.cのコメント)。 - 独立ウォッチドッグ(IWDG)は
WATCHDOG_TIMEOUT_MS 500(内部発振器 LSI のばらつきで、実際は 340〜940 ms に振れる)。一度起動すると止められないので、 ブロッキングする初期化(IMU の静止較正、起動時のハザード点滅、ステアの中心点記録)が すべて終わってから最後に起動します。裏を返すとSetup()中のハングは検出できません。 - ループの先頭で無条件に
Watchdog_Refresh()を叩きます。「ループが回っていること自体が生存の証拠」で、 個々のモジュールの異常は別のフォールトとして扱います(IWDG を異常時の停止手段に流用すると、 リセットで状態が消えて原因が追えなくなる、とコードのコメントにあります)。 - ウォッチドッグのリセットで起動し直したときは、起動の演出(ブザーとハザード、合計約 2.5 秒)を飛ばしてメインループへ早く入り、
LOGで上位へ知らせます。走行中のハングから戻ったのかもしれないためです。 - 起動時には、ビルドした git のコミットとビルド時刻を
LOGに出します(build_info.c)。VERSIONパケットのbuild_epochもビルド時刻で、 どのファームが書き込まれているかを上位の記録から確かめられます。
モジュールの層¶
flowchart TB
app["app/(コンポジションルート)<br/>インスタンスの宣言・初期化・呼び出しだけ"]
subgraph L2["上位層"]
vehicle["vehicle/<br/>指令・緊急停止・フェイルセーフの調停、自動停止"]
hmi["hmi/<br/>状態表示"]
comm["comm/<br/>RasLink・Heartbeat・Telemetry・BuildInfo"]
end
subgraph L3["機能層"]
control["control/<br/>Motors・Steering・Drive・SpeedKf・EncoderDirection<br/>TorqueVectoring・AutoStopPath・ControlParams"]
sensing["sensing/<br/>Encoder・Imu・Lidar・RangeSensor"]
power["power/<br/>電圧・電流・DRIVE_POWER/LIDAR_POWER"]
lighting["lighting/"]
end
lib["lib/(車両に依存しない汎用ライブラリ)<br/>pid・filter・ahrs・bldc_motor・crc・serial・timer ほか"]
app --> L2 --> L3 --> lib
依存は 一方向(上から下)に限ります(CLAUDE.md の規約)。
app.cは配線だけで、制御ロジックを書かない。- 各モジュールは「struct +
Module_Init()で依存を渡す +Module_Update()」の形で、グローバル変数を参照しない。 lib/は特定の車両を知らない。
この分け方のおかげで、src/control(Drive・SpeedKf・TorqueVectoring・自動停止の予想進路など)は ホスト(Mac/Linux)でそのままコンパイルして
閉ループ試験に使えます(検証の仕組み)。
調整パラメータの扱い¶
TC・ABS・TV・車速 PI のゲインなどは、ファームに値を持たせません。
control_params.hのCONTROL_PARAM_TABLEが名前・param_id・仮置き値・範囲の唯一の定義です。- 上位(Pi)が接続のたびに全項目を
CONFIG_SETで送り、CONFIG_ACKが返す「実際に適用された値」と突き合わせます。 - Flash には保存しないので、電源を入れ直すと仮置き値(各範囲の下限=「何もしない値」)に戻ります。
例外は前輪エンコーダの校正と車速のカルマンフィルタの調整値で、上位が送る前でも車速と走行距離が出るよう、
「校正なし」と
speed_kf.hの既定と同じ値を仮置きにしています(ステアのリンクの換算は恒等の 1 と 0)。 - 値の正は Pi 側の
vehicle.tomlの[control]で、Pi は全項目が揃って確認できるまで ARM(走行許可)を通しません。
「調整値をファームに焼き込むと、書き換えと再書き込みが面倒で、車ごとの違いも持てない」ことへの対策です。 一方で、Pi が送らない限りファームは仮置き値で動くことになるため、ARM の許可側で守っています (上位の安全設計)。
起動時の動作¶
| 操作 | 動作 |
|---|---|
| 通常起動 | 駆動電源・LiDAR 電源とも OFF。Pi が ARM するまで入れない |
| ボタン 1 を押しながら起動 | 現在のステア角を「直進の中心」として記録し Flash に保存。このときだけ駆動電源を一時的に入れる |
| ボタン 2 を押しながら起動 | IMU の静止較正をやり直して Flash に保存(数秒) |
| 緊急停止の解除 | 緊急停止がラッチされている間にボタン 2 を押す(ハートビートが戻っていること)。解除しても、上位が ARM を一度下ろして入れ直すまで走らない |
ステアの中心が未較正の間は、駆動電源を入れず、舵角指令も送りません(絶対角が信用できないため)。
主な仕様値¶
| 項目 | 値 | 出どころ |
|---|---|---|
| メインループ | 500 µs(2 kHz) | app.c |
| Pi との UART | USART1、1 Mbps(誤差 0 %) | app.c のコメント |
| MD との UART | USART2(ステア)・USART3(左後輪)・UART4(右後輪)、1 Mbps | CLAUDE.md |
| LiDAR | USART6、230400 bps | app.c |
| 1 輪の最大トルク | 0.15 N·m | drive.h の DRIVE_MAX_TORQUE_NM |
| 指令できる最高車速 | 5.0 m/s | drive.h の DRIVE_MAX_SPEED_M_S |
| 正トルクを切る車速(暴走時の防壁) | 5.5 m/s(指令の上限の 1.1 倍) | drive.h の DRIVE_OVERSPEED_GUARD_M_S |
| ハートビート断の判定 | 50 ms | heartbeat.h |
| COMMAND 途絶の判定 | 100 ms | ras_link.h の RAS_COMMAND_TIMEOUT_US |
次に読む¶
- 駆動制御(車速 PI) — 目標車速からトルクまで
- スリップ制御(TC・ABS)
- トルクベクタリング
- 安全層とフェイルセーフ