ESP32-S3上でLoRa地上局コマンドをCANへ中継し、CANテレメトリとGNSSを39 byteの
PayloadにまとめてLoRa送信し、同じテレメトリをSDへCSV記録する通信基板です。
シーケンスおよび制御基板の実状態は、CAN ID 0x200 の制御基板ステータスからのみ
決定します。LoRaコマンドは要求、CAN送信成功はバスへ送れたことを示すだけです。
いずれも実状態やPayload.status、シーケンス連動のGNSS/SD状態を直接変更しません。
CAN 2.0の11-bit標準IDを使用し、通信速度は125 kbpsです。拡張IDのフレーム、未定義ID、 および表と異なるDLCは受理しません。コマンドは通信基板から各制御基板へ送信し、 テレメトリとステータスは各制御基板から通信基板が受信します。
すべてDLC 1で、data[0]にはLoRaコマンドと同じASCII byteを格納します。残りのbyteは
CANフレームへ含めません。g / hは通信基板内のGNSS操作専用で、CANへは送信しません。
| CAN ID | data[0] | コマンド |
|---|---|---|
0x001 |
0x45 (E) |
fin control stop |
0x003 |
0x7a (z) |
parachute emergency stop |
0x005 |
0x73 (s) |
sequence start |
0x00a |
0x71 (q) |
sequence stop |
0x011 |
0x6c (l) |
logging start |
0x01e |
0x6d (m) |
logging stop |
0x30d |
0x6f (o) |
parachute open |
0x30e |
0x63 (c) |
parachute close |
CANのIDが小さいほどバス調停上の優先度は高くなります。0x30d / 0x30eは現在の
指定値であり、緊急停止0x003より低い優先度です。
| CAN ID | DLC | data形式 | 通信基板での扱い |
|---|---|---|---|
0x10a |
3 | [pressure0, pressure1, pressure2] (u8 × 3) |
Payload air_pressure[0..3]へコピー |
0x11a |
6 | X, Y, Z: i16 |
Payload accelerationへコピー |
0x120 |
6 | X, Y, Z: i16 |
Payload angle_speedへコピー |
0x13a |
6 | X, Y, Z: i16 |
Payloadとの対応が未定義のため破棄数のみ記録 |
0x14a |
6 | X, Y, Z: i16 |
Payload integrated_angleへコピー |
0x200 |
1 | status bitfield | 制御基板の実状態およびPayload statusへ反映 |
3軸のi16値は符号付きbig endianです。data[0..2]がX、data[2..4]がY、
data[4..6]がZで、各軸は上位byte、下位byteの順です。例として
[0x00, 0x01, 0xff, 0xff, 0x7f, 0xff]は[1, -1, 32767]になります。
AirPressureの3 byteは数値へ結合せず、そのままPayloadへ保持します。物理単位、倍率、
送信周期は現時点のコードでは定義していません。
制御基板から通信基板への標準ID、DLC 1の受信専用メッセージです。1 byteをphaseと flagsに分割する根拠は確認できておらず、現在確認できる仕様は次のbitfieldだけです。 通信基板の送信型にはこのIDが存在しないため、復旧probeとして送ることもできません。
| bit | 意味 | 1の意味 |
|---|---|---|
| 0 | TOP | 検出済み |
| 1 | main power | ON |
| 2 | emergency power | ON |
| 3 | control active | active |
| 4 | reserved | 未知bitとしてrawに保持 |
| 5 | sequence active | active |
| 6 | liftoff | 検出済み |
| 7 | parachute motor | open |
byte内はLSBをbit 0とします。複数byte値はありません。独立したphase値、fault flags、 送信周期、起動時の送信値、状態ラッチ仕様は未確定です。未知bitはrawに保持しつつ、 既知bitは常に解釈します。
ControllerLinkStateは起動時Unknown、有効な受信後Onlineです。周期が未確定のため
実機のstale timeoutは現在無効です。純粋判定関数は設定可能ですが、推測した時間を
組込み設定へ入れていません。周期確認後、周期の3倍等の根拠ある値を設定してください。
CAN controllerのTEC/REC/Bus Off healthとは別の状態です。
UARTアップリンクは固定3 byteフレームです。旧1 byteコマンドは受理しません。
[0] Header = 0x55
[1] Command
[2] Checksum = Header ^ Command
Headerまたはchecksumが一致しないフレームは破棄します。UARTの分割受信と連続フレームに 対応し、正常なフレームのCommandだけを次の表に従って処理します。
機体側は設定された周期でテレメトリを送信し、TOP立上りによる即時送信は行いません。 UARTはRX/TXへ分割し、RXは送信処理やAUX待機と独立したタスクで常時読み出します。 TXは書き込み直前にAUX Highを必須確認し、補助対策としてchecksumが正常なフレームの 最終受信から60 ms待機した後にもAUXを再確認します。未知コマンドも通信活動として 待機対象にします。不正フレームおよびUART受信エラー発生時は組み立て途中のフレームを 破棄し、次のHeaderから再同期します。延期中に失効した周期送信は連続実行しません。
| byte | 要求 |
|---|---|
s / q |
sequence start / stop |
z |
parachute emergency stop |
l / m |
CAN logging start / stop command |
E |
fin control stop |
o / c |
parachute open / close |
g / h |
GNSS manual on / off |
未知byteは無視します。s、qはqueued → transmitted → confirmed/failedへ進み、
confirmedはそれぞれ0x200のsequence bit ON、OFFで成立します。要求時点ですでに目標bitなら
CAN送信せずAlreadySatisfiedとします。zは送信済みまで管理しますが、0x200に明示ACKや
緊急停止状態bitがないためCompletedにはしません。特にliftoff=0は起動直後にも成立するため
完了根拠に使用しません。
確認timeoutは暫定500 msで、これは実行失敗ではなくConfirmationTimedOut、すなわち
確認不能を意味します。実状態は最後の0x200のままです。0x200周期を実機測定後に再設定が
必要です。自動再送は冪等性未確認のため行いません。
同じカテゴリの新しい要求は古いqueued要求をsupersededにします。対象はsequence start/stop、
logging start/stop、parachute open/closeです。復旧後は各カテゴリの最新だけを送り、緊急停止は
専用Signalから通常FIFOより優先します。ただし一度失敗した緊急停止の自動再送はしません。
全39 byte、little endianです。offset 0..2はLoRa address/channel、3は0xaa、4は
制御基板0x200のraw status、5..8 latitude i32、9..12 longitude i32、13..14 height
i16、15..20 gyro、21..26 acceleration、27..32 integrated angle、33..35 pressure、
36 air speed、37 fin angle、38 checksumです。checksumはoffset 3..37のXORです。
形式、順序、checksumは変更していません。
0x110/0x12aの旧LiftOff/TOPは値の送信側仕様が未確認で、状態の唯一性を守るためPayloadへ
反映せず受信数だけ記録します。0x200 bit 0のTOP状態はPayloadへ反映しますが、立上り時の
即時送信には使用しません。
FinAngleはCAN [i16;3] とPayload i8の対応が未定義なので変換せず破棄数を記録します。
Payloadの0は実測0と未更新を区別できません。
StartSequence要求の受理時にSDのlogging_requestedを立て、GNSSをON要求しますが、
Payloadのsequence bitは変更しません。StopSequence確認だけでは停止せず、独立した
StartLogging/StopLoggingコマンドをログ開始・停止の基準にします。SDは
logging_activeを分離し、open/write/flush失敗時はactiveを解除してエラー・drop数を
記録します。CSV列は変更していません。GNSSは設定が全て成功してからON扱いにし、Invalid
fixを採用せず、overflowしたNMEA行全体を次の改行まで破棄します。
CAN Bus OffではTWAIを再起動し、TEC/RECと連続エラーを別に記録します。LoRa UARTの partial write、write/flush/read errorを処理し、AUXがHighでない場合も最大1000 msで 復帰します。このAUX値は現行E220設定での実測確認が必要です。SD、GNSS、LoRaの各失敗は カウンタへ残り、asyncタスクをpanicまたは永久停止させません。
test/gnss_setting_response.rsは、本番と同じUART1(TX GPIO14、RX GPIO21)、9600 baud、
8N1でGNSSを起動し、現在のINIT_COMMANDSと同じ設定を同じ順序で送信します。送受信byteを
HEXとASCIIで表示し、最後のUART_BAUD送信から50 ms後にESP32側も115200 baudへ変更します。
cargo test --test gnss_setting_response --features hardware-test実機へ書き込まず型検査だけを行う場合は次を実行します。
cargo check --test gnss_setting_response --features hardware-test