この手順は次の順序を守ります。
Avi_ESP_Libsの公開APIをMission Board実機で検証する- 制御・推定・filter係数を決めるためのraw dataを取得する
- PASSしたdriverだけを後段のMission実装へ引き渡す
bring-up commandによる完全なMission FSM、LQR、ZeroHold gain、TorqueMapper tuningは対象外です。物理方向または係数が未確定の場合は推測せずUnconfiguredのまま扱います。ComBoard/Groundを含むproduction通信は3.5.1/3.5.2で別試験とし、actuator motionを伴わない経路だけを確認します。
-
作業tree、branch、HEAD、submoduleを記録する。
git status --short git branch --show-current git rev-parse HEAD git submodule status git -C lib/Avi_ESP_Libs status --short git -C lib/Avi_ESP_Libs branch --show-current git -C lib/Avi_ESP_Libs rev-parse HEAD
-
buildする。
pio run pio run -e avi_99l_missionboard_bringup pio run -e avi_99l_missionboard_can_diag
-
portを列挙し、確認したpathを入力する。
pio device list ls -l /dev/ttyACM* read -r MISSION_PORT test -c "$MISSION_PORT" pio pkg exec -p tool-esptoolpy -c "esptool.py --chip esp32s3 --port $MISSION_PORT chip_id"
-
uploadしてmonitorを開く。
pio run -t upload --upload-port "$MISSION_PORT" pio device monitor --port "$MISSION_PORT" --baud 115200 --eol LF
-
boot logで次を確認する。
- safe output初期化が
ESP_OK - GPIO38、39、40、44がLOWで、motor、+5 V、para電源が意図せず動作していない
- physical Flashが16 MiB
- PSRAMが初期化済みで8 MiB
- custom partition tableが選択されている
statusでmotorがdisarm
- safe output初期化が
-
python3 tools/capture_bringup.py --self-testをPASSさせる。
各試験の前後でstatusを確認します。同じdeviceを同時に操作するcommandを実行せず、1つの試験が終了してから次へ進みます。失敗時は次のactuator試験へ進みません。
spi-testを実行します。
- encoder bus: SPI2_HOST、MOSI GPIO4、MISO GPIO5、SCLK GPIO6
- IMU bus: SPI3_HOST、MOSI GPIO17、MISO GPIO16、SCLK GPIO18
- 両busの
beginとendが成功する
spi-testが直接確認するのは両hostのbegin、device count、endです。transport errorの注入は行わないため、このcommandだけでerror/timeout pathをPASSにしません。sensor commandの有限timeoutまたは専用fault injectionを別途実施し、hangしないことを記録します。
-
encoder-testでbegin、getStatus、read、pipeline開始/停止、error flag read/clear、endを確認する。 -
monitorを閉じ、60秒streamを取得する。
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \ --duration 65 --command "encoder-stream 60"
-
sensorを手で1回転し、0/360度境界を跨ぐことを確認する。motor回転中の確認はmotor試験段階で行う。
PASS条件は1 kHzで60秒、angle_rawが0..16383、degree/radian変換が整合、sequence gapなし、parity/framing errorなし、sensor error flagなしです。jitter、AGC、magnitude、磁界low/high、CORDIC overflow、sample数、error数、最大read latencyを記録します。pipelineがerrorで解除された場合は、その事実と再初期化結果を記録します。
status responseの磁界low/high、CORDIC overflow、offset compensation finishedが全てfalse、かつAGCとmagnitudeがともに0ならall-zeroです。angle_raw == 0は正常な0度を表せるためpresence判定へ使いません。transportがESP_OKでもall-zeroなら共通health判定はESP_ERR_INVALID_RESPONSEを返します。
production runtimeもstartupと明示reinitialize時に同じ判定を通し、begin、status、pipeline開始の結果を別々に表示します。statusが不良ならpipelineを開始せず、encoderをcleanupし、fin angle/rateをunavailable、motorをcoastに保ちます。制御周期へgap/jitterを加えないため、1 kHz loop内でpipeline停止、DIAG read、再開を周期実行しません。飛行中にMISOがstuck-lowへ遷移した場合を既存read error以外で検出する方法は残TODOであり、angle 0の連続を故障扱いしてはいけません。
production実機確認では、正常statusでpipeline開始まで完走することに加え、一時診断buildで取得済みstatusだけをall-zeroへ置換し、ESP_ERR_INVALID_RESPONSEとpipeline未開始を確認します。診断用置換や専用environmentは検証後にsourceへ残しません。MissionRealtimeTaskの大型history/FIFO storageはtask stack外へ置き、1 kHz loop開始前までのstack最小空きを記録します。
-
imu-selftestを先に実行する。self-test時はFIFOを有効化しない。 -
monitorを閉じ、60秒streamを取得する。
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \ --duration 65 --command "imu-stream 60"
-
60秒試験がPASSした後、5分stationary logを取得する。
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \ --duration 305 --command "imu-static 300"
timestamp_ticks、timestamp_us、timestamp単調性/wrap、accel/gyro validity、ODR change、FIFO full、lost packet、FIFO fault、sample数、read latencyを確認します。body_z = -sensor_zだけが確定済みで、X/Yは変換しません。通常動作のlost packetを先にゼロへすることを優先し、1 sample補間候補の評価はraw data取得後に行います。
productionのfreshness判定は、FIFO sampleをhostが取得したhost_timestamp_usと判定時のesp_timer_get_time()を比較します。ICM sensor timestampをhostへ写像した時刻はhistoryと姿勢計算へ使用しますが、sensor clockとhost clockには実機driftがあるため、3 ms freshness gateへ直接使いません。2026-08-14の修正前productionではclock domain混在によりnow < last_sampleとなり、約100 msごとに不要なIMU再初期化を繰り返しました。修正後の10秒boot観測では再初期化、panic、resetを認めませんでした。sensor→hostの固定offset写像にclock scale補正を加えるかは、飛行enable前の長時間試験TODOです。
i2c-probeを実行します。I2C_NUM_0、SDA GPIO47、SCL GPIO48、300 kHz、internal pull-upなし、lock noWait、有限operation timeoutを使います。
現在の基板ではSSCは未接続、LPS25HBは接続済みです。aux5v-onを明示実行し、100 ms以上待ってからi2c-probeを実行します。終了後はaux5v-offで必ずOFFへ戻します。aux5v-onは自動cleanupされず、OFF commandまたはresetまでGPIO40をHIGHに保持します。
- SSC
0x28 - LPS
0x5C - LPS
0x5D
SSC 0x28が見つからない結果は正常です。各未接続addressへの100回のaccessが有限時間で戻り、bus hangとresource leakが無いことをPASS条件とします。LPS25HBはODRを25 Hzへ設定して25回readし、I2C transactionの成功数、error数、最大latency、cleanupだけを評価します。45 ms間隔のpollは実効25 Hzを証明しません。
現在のLPS25HB個体はpressure/temperatureの妥当性を保証できないため、物理値を表示・合否判定・parameter決定へ使いません。実効ODR、sample更新、averaging delay、freshness、離床・頂点判定も本試験ではNOT EVALUATEDです。
CANCREATEとESP-IDF driverを同一hardware、同一ESP-IDFで比較するため、診断を次の3層に分けます。実際にcompileされたESP-IDF versionはbuild logまたはESP_IDF_VERSIONで確認し、PlatformIO platform versionから推測しません。さらにlocal framework-espidf/components/esp_driver_twai/esp_twai_onchip.cにEspressif issue #18803のflush修正6e0d480b2a630419456a04e3eb71d1a4062063ae相当があるか、version番号とは別に確認します。
CAN診断前にstatusを実行し、motor armed=no、IN1/IN2 0、AUX5V 0、PARA 0を確認します。診断command自身もmotor coast、AUX5V OFF、Para電源OFFを再設定します。診断中はmotor-arm、motor test、sts-hold、sts-small-move、aux5v-on、その他actuator出力commandを実行しません。
can-lifecycle-test 100を実行する。各iterationでCANCREATE objectを生成し、125 kbit/s normal modeでbegin、initialized、getStatus、noWaitreadのno-data path、end、破棄、1 tick yieldを確認する。TXしないため、node callbackを使う診断と単純begin/end lifecycleを分離できる。100回完走と各集計が一致した場合だけPASSとする。avi_99l_missionboard_can_diagをflashし、can-idf-lifecycle-testを実行する。このcommandはCANCREATEを使わず、ESP-IDF 6以降のpublic TWAI APIだけでself-test/loopback frameを1回送信し、有限timeoutでTX完了を待ってnodeをdisable/deleteし、50 ms待つ。panicしなければ最大20回反復してtiming依存性を確認する。private APIや解放済みmemoryへの書込みによる再現強化は行わない。- 必要ならreset/reflash後、同じ
can_diagbuildでcan-testを実行する。これはCANCREATE::test(TestResult&)そのものを測る。通信基板が無い場合、修正済みdriverでの正常完走はAPIESP_OK、stateno_peer_response、restored=trueを意味し、normal TXのACK成功は期待しない。Avi_ESP_LibsはESP-IDF 6以上を既知safe release確認までESP_ERR_NOT_SUPPORTEDで拒否するため、これはPASSではなくNOT_SUPPORTEDと記録する。
MISSION_CAN_UNSAFE_DIAG=1は専用avi_99l_missionboard_can_diagだけに定義します。通常のproduction/bring-up buildではcan-testとcan-idf-lifecycle-testを実行できません。panicした場合はGuru Meditationと完全なbacktrace、直前phaseを保存し、build ELFでsymbolicateします。無限に再実行せず、reboot後に安全出力を再確認します。
通信基板が無い試験ではcan-load-test 100 60を合格判定に使いません。peer接続後に実施する場合は、bring-up専用標準ID 0x7FE、payload内sequence counterを使い、requested、driver queue投入成功、write error、RX error、bus error、dropped RX、bus-off回数、recovery成否、平均/最大write latencyを記録します。write == ESP_OKはdriver queue投入成功であり、物理ACK完了数ではありません。
CAN診断終了後は通常bring-up firmwareを再flashし、boot後にsafe output、motor disarm、AUX5V OFF、Para電源OFFを確認します。
Mission/ComBoardを同じ125 kbit/s busへ接続した試験では、先にcurrent MissionStateとscheduleから送信対象IDを導出します。CommandReceiveでは0x100 Kinematicsと0x109 Airspeedが100 Hz、0x108 LPSが25 Hz、0x102 MissionStatus、0x103 PowerTime、0x107 AttitudeTiltが10 Hz、時刻未同期中の0x012 TimeRequestが1 Hzです。0x020 MissionEventはevent発生時だけです。0x101 Control、0x104 DescentCore、0x105/0x106 Recoveryは現在stateで送信されないため、0件をFAILにしません。
productionのCAN controllerはTX完了callbackまで1枠を占有します。100 Hz tickで複数IDをnoWait連続投入すると、最初のframe以外がESP_ERR_NOT_FINISHEDとなるため、writeFrameは5 msの有限timeoutで同一owner内の送信を直列化します。timeoutを無限化せず、受信側でID別count、DLC/decode error、sequence gap、freshnessを再確認します。2026-08-14の修正後30秒では次を実測しました。
| CAN ID | count | 実測rate | sequence gap | 判定 |
|---|---|---|---|---|
0x012 |
30 | 1 Hz | 対象外 | PASS |
0x020 |
1 | event 1回 | 0 | PASS |
0x100 |
3,000 | 100 Hz | 0 | PASS |
0x102 |
301 | 約10 Hz | 0 | PASS |
0x103 |
300 | 10 Hz | 0 | PASS |
0x107 |
300 | 10 Hz | 0 | PASS |
0x108 |
750 | 25 Hz | 0 | PASS |
0x109 |
3,000 | 100 Hz | 0 | PASS |
0x101/0x104/0x105/0x106 |
0 | state依存 | 対象外 | NOT_EXERCISED |
同区間のComBoard側CAN receive/decode error、TEC、RECは0でした。ComBoardのraw logging queue dropはComBoard microSD初期化失敗時に発生した別問題であり、CAN wire receive/decode errorと混同しません。
Ground→LoRa→ComBoard→CAN→Mission→CAN→ComBoard→LoRa→Groundを確認するときは、motionを起こさないerror pathから実行します。CommandReceiveでは未知generic command 0x7FはRejected/NotSupported、CancelSequence 0x02とLiftoff EmergencyはRejected/InvalidStateが期待値です。ActuatorEmergencyは全通常試験の最後に、motor coastとPara電源OFFを確認してから1回だけ実行します。
nonzero transactionのEmergencyを受信したCanTaskは、state_mutexのnoWait取得成否で受理可否を決めません。commandをlatchし、MissionRealtimeTaskがmutexを取得して実stateを判定することで、一時競合によるfalse rejectionを防ぎます。2026-08-14の実機ではActuatorEmergency transaction 11がCompleted/Noneとなり、MissionEvent 0x2000を確認しました。試験後はMissionをresetしてproduction通常bootへ戻します。
final B0の到達とComBoard内部のresult処理は別判定にします。Liftoff/Actuator Emergencyはgeneric trackerに登録せず安全優先CAN queueへ直接送る設計です。修正前の「pending requestに一致しないCommandResult」は過剰warningで、Groundへのfinal B0はPASSしていました。ComBoardはuntracked F0/F1を専用priority LoRa queueへnon-blocking投入し、CAN TX失敗時もFailed/Timeoutのterminal B0を返します。修正後のLiftoff Emergencyも実機でfinal B0とwarningなしを確認済みです。
sd-testはSDMMC 4-bitで実行し、SPI modeへ変更しません。1 MiBの決定的patternについてmount、create、sequential write、flush/fsync、close、reopen、readback、CRC/内容一致、unmountを確認します。速度と最大blocking時間を記録し、失敗してもapplicationをabortしません。
flash-testは次の二段階です。
- partition type/subtype/label/address/sizeを確認してから、
flightlog先頭の試験範囲だけをerase/write/readbackする。 reboot_required表示後にresetし、もう一度flash-testを実行する。再起動後readback/CRCを確認して試験範囲をeraseする。
NVS、PHY、factory appをeraseしてはいけません。flightlog内に必要なdataがある状態では実行しません。
monitorを閉じ、標準試験として10秒取得します。
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \
--duration 15 --command "adc-stream 10"GPIO1 logicとGPIO2 motorを100 Hzで取得します。ESP-IDF calibration APIによるpin電圧と、V_source = V_pin * 5.7によるsource電圧を記録します。raw * 3.3 / 4095だけの換算は禁止です。battery present thresholdはこの試験では決定しません。
calibrateを実行し、gyro biasとgravity vectorを取得します。SSC未接続時は差圧zeroだけvalid=falseでよく、attempt全体を失敗扱いにしません。calibration-repeat <count>で再現性を確認します。
採用するのは常に最新attemptだけです。最新attemptで失敗した項目を過去の値へrollbackしません。gravity vectorはtilt判定に使い、gravityだけでroll zeroを決めません。
周囲の安全を確認し、servoを目視できる状態で次の順に1 commandずつ実行します。
sts-probests-readsts-freeを実行し、可能な範囲でhand-movable状態を確認sts-hold- faultが無い場合だけ
sts-small-move 3またはsts-small-move -3
STSCREATE UART1はbring-up shell初期化時、Para電源OFFのまま一度だけbeginし、shell lifetime中はopenしたまま保持します。各commandはPara電源ON、100 ms安定待ち、起動中のtimeoutまたは不完全応答だけを1.5秒のdeadline内で再PING、STS3215 begin、必要なoperation、disableTorque、STS3215 end、Para電源OFFの順で処理します。STSCREATEはcommand終了時にendしません。PING、STS begin、cleanupはそれぞれresult、latency、device errorを個別に記録します。
tx/response timeoutは切り分け用に100 ms / 100 msとしますが、起動deadlineとともにTODO(HW_TEST)の暫定値です。2026-08-13の実機では最初の6回がtimeoutし、同じ電源cycleの7回目でPINGに成功しました。続くSTS3215 begin、sts-readの50 sample、cleanupが成功し、2 command目でもGPIO 42 is not usableは再発していません。PINGが1.5秒間すべてtimeoutする場合は物理UART/RS-485を、PING成功後のSTS beginだけ失敗する場合はconfiguration readを次段階で調査します。
response latency、timeout数、lastDeviceError、overload、overcurrent、overtemperature、encoder/voltage fault、position、speed、current、voltage、temperatureを記録します。最初の移動は絶対値3度以下、低speed、低torqueです。
- 動翼とstopperが無く、軸が自由に回ることを再確認する
- 人、配線、工具を回転部から離す
statusでdisarmを確認してからmotor-armを明示実行する- PWM carrierは30 kHz、IN1 GPIO39、IN2 GPIO38
- duty絶対値は15%以下、1 commandの時間は45秒以下。
combined-motor-imu-testは41秒 - encoderから得る速度がbring-up上限を超えた場合は直ちに停止する
- test終了、error、timeoutのすべてでPWM=0、IN1/IN2 LOWへ戻す
- 飛行用fin software limitをこの試験へ流用しない
- binary capture中の
Ctrl-Cはportを閉じる前にmotor-disarmを最大0.5秒試行する - USB通信不能時に備え、物理resetまたはmotor電源遮断を直ちに実行できる状態にする
motor-polarity: 正負方向について2、4、6、8、10%の短いpulseを実行し、AS5047Dの符号からpolarityを記録する。polarityを事前に推測しない。この段階のlevel列をdead-zone候補にも使う。motor-step: 正負5、10、15%の短いstepを取得する。motor-coast: 一定速度後にHi-Zとして減衰を取得する。motor-brake-test: 一定速度後にshort brakeとして減衰を取得する。motor-prbs: 固定seedで最初の10秒は正負5%、sensor/error/速度条件を満たした場合だけ後半10秒を正負10%で実行する。15% PRBSは現commandでは実装しない。combined-motor-imu-testを1回だけ実行する。先頭30秒はmotor-off baseline、続く10秒は正負5% PRBS、最後の1秒はcoastで、AS5047DとICM42688を1 kHz同時取得する。baseline用とexcitation用に二重実行しない。motor-disarmを実行し、statusでdisarmと安全出力を確認する。
binary dataを残す場合、monitorを閉じてhost toolからcommandを送ります。armは最初の短いcaptureで行い、各testのhost durationにはfirmware実行時間より数秒の余裕を持たせます。次はcombined試験の例です。
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \
--duration 2 --command "motor-arm"
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \
--duration 46 --command "combined-motor-imu-test"
python3 tools/capture_bringup.py "$MISSION_PORT" data/bringup \
--duration 2 --command "motor-disarm"Ctrl-Cを受けたhost toolはmotor-disarmを送信してからportを閉じ、summaryへ試行結果を残します。送信失敗または反応不明時は、待たずに物理resetまたはmotor電源遮断を行います。
高回転、異音、過電流、sensor error、stream overflow、timeoutを検出したら即中止します。無制限Gaussian white noiseはPWMへ入力しません。現在の個体をMotorProfile候補Aとして記録し、同じcommandとcapture形式を予備motor Bにも再利用します。
記録対象はtimestamp、command duty/direction、motor bus電圧、encoder raw/unwrapped angle/角速度/status、IMU raw accel/gyro/timestamp/FIFO status/errorです。
1 kHz dataを大量にprintfせず、固定長queueを介したexplicit little-endian frameとして送ります。C++ structのpaddingやhost endianには依存しません。
| offset | size | field | 内容 |
|---|---|---|---|
| 0 | 2 | magic | A5 5A |
| 2 | 1 | version | 現在は1 |
| 3 | 1 | record type | 1=encoder, 2=imu, 3=adc, 4=motor, 5=calibration |
| 4 | 2 | payload length | little-endian、最大96 byte |
| 6 | 4 | sequence | little-endian uint32、capture開始時に0へ戻る |
| 10 | 可変 | payload | fieldごとに明示serialize |
| 10+N | 2 | CRC | CRC-16/CCITT-FALSE、little-endian |
CRC対象はversionからpayload末尾までで、magicを含みません。parameterはpolynomial 0x1021、initial 0xFFFFです。queue depthは64で、enqueueはnoWaitです。overflow時は黙って捨てずdrop counterを増やし、送信前にsequenceが進むためhost側でもgapとして検出できます。
tools/capture_bringup.pyは明示された/dev/ttyACM<N>だけを開き、raw byte保存、magic再同期、length上限、CRC、32 bit sequence wrap、gap/duplicate/out-of-orderを検査します。ASCII shell outputが混在してもmagicまで読み飛ばします。type 1〜5をすべてdecodeし、payload sizeはencoder 23 byte、IMU 69 byte、ADC 41 byte、motor 78 byte、calibration 57 byteです。未知typeはpayloadを失わずunknown CSVへ残し、既知typeの長さ不一致はunknown CSVとsummaryのdecode errorへ残します。
IMU recordはCSV変換と同時に、gyro 3軸の平均・標本標準偏差・時間に対する最小二乗drift、acceleration 3軸の平均・標本標準偏差・norm、1/3/10秒の非重複windowごとのgyro biasばらつきをonline集計し、_summary.jsonのimu_statisticsへ保存します。valid flagがfalseまたはNaN/Infのsampleは統計から除外し、除外数を残します。
capture中のCtrl-Cではmotor-disarm送信を最大0.5秒試行します。_summary.jsonのemergency_disarm_attemptedとemergency_disarm_errorを確認し、送信失敗またはUSB通信断時は物理resetまたは電源遮断を行います。
PASS: 要求されたdurationとsample数を満たし、driver error、sensor fault、予期しないsequence gap、hangが無いFAIL: API/build/upload/verifyが失敗した、errorが非ゼロ、無限待ち相当の挙動、安全cleanupに失敗したNOT_SUPPORTED: 現在のbuild/driverで意図的に安全拒否した。実行成功を意味しないBLOCKED: peer未接続や安全条件不足などにより必要な試験を完了できない。PASSと混同しないSKIP: 接続されていないdeviceのsensor値検証など、既知の試験条件不足PENDING: 実施前。SKIPと混同しない
各試験後、bringup_results.mdへdate/time、両HEAD、firmware build、port、duration、sample/error数、最大latency、観察、判定、原因、library修正、残TODOを記録します。library責務のbugはMission Board側へworkaroundせず、submodule側を修正してlibrary build、Mission Board build、実機再試験の順に確認します。