光と音で位置を求める仕組み
水上の親機が水中の子機を観測します。光源の方向と音響の距離に、両機の姿勢・取付け位置・時刻を対応付け、親機に対する子機の位置を求めます。
観測から相対位置まで
音の到達時間から距離を求める
親子機で時刻を対応させ、音の到達時間から親子の音響測定点間の距離を計算します。この解析では音速1500 m/s、時間オフセット0 µsを使用しています。音響距離は斜距離で、水圧から求めた深度とは区別します。
親機カメラで子機の光源を追跡する
画像で対象の光源を確認し、10 Hzの画像でLucas–Kanadeの前後整合、固定テンプレートとのNCC照合、局所光源の重心を組み合わせて追跡します。追跡を失った箇所は欠測とし、再捕捉・目視点による再初期化を記録します。予測は探索にだけ使用し、予測座標を観測に混ぜません。
画素の方向と機体の姿勢をそろえる
水中カメラの内部校正と歪み補正を用いて光点を方向に変換し、カメラと機体の取付け回転、IMUの姿勢、磁気方位の補正を通して共通の真ENU座標系(東・北・上)へ移します。カメラ・ライト・音響振動子・機体原点の位置の違いも考慮します。
水中内部校正は暫定値です。CAD参照点・取付け・磁気方位にも未校正の要素があり、確定精度を保証する条件とは扱いません。
同じ時刻の観測を対応付ける
有効な測距イベントごとに、時刻差75 ms以内の追跡画像を1枚対応付けます。同じ測距を重複して数えず、測距時刻の姿勢で位置を計算します。相対ベクトルは親機の機体原点から子機の機体原点までとし、両機に共通するGNSSの平行移動は差し引かれます。
静止RMSEは、何を表すか
各系列の平均位置を基準に、位置のばらつきを二乗平均平方根で求めます。3Dでは東・北・上の3成分、水平では東・北の2成分を使います。
3D RMSE = √{ (1/N) Σ ‖rᵢ − r̄‖² }
rᵢ:親機に対する子機の相対位置、r̄:その系列の区間平均、N:採用点数。
姿勢補正ありと、親機の回転のみを区間平均へ固定した比較条件に、同じ距離・光点・子機姿勢を使用します。それぞれの系列自身の平均まわりで算出し、平滑化やトレンド除去は行いません。
実際の動きや、光源同定・時刻同期・校正の誤差も含まれます。独立した位置真値に対する誤差ではなく、「絶対精度14 cm」とは表現しません。
深度約16 mの評価条件と結果 →位置推定からマッピングへ
子機の撮影画像からSfMで点群を復元し、局所的な三角形に写真を貼って表示します。2日分の7区間を解析し、5区間で写真付き地図を得ました。
- 親機GNSSを選ぶ。SPP・通常PPK・Float設定PPK・別基準局PPKを同時刻の静止60秒窓で比較し、各窓の平均まわり3D RMSEを等重みで集計。両日ともPPK Float設定・950437を採用しました。手動揺動の窓は選定に含めません。
- 地図とは独立に航法を求める。親機はGNSS・Doppler速度・Spresense、子機は光・音・圧力・BNOを融合します。SfM位置は航法へ入力しません。慣性補完は親機5秒・子機3秒までとし、それ以上は欠測です。
- 地図に尺度と姿勢を与える。10/31は既存形状・尺度・向きを保ち、航法へ平行移動を再推定。11/1は姿勢で回転し、圧力変化と取付け位置の補正で尺度を推定します。圧力で決まらない場合の航法による尺度も暫定値です。拘束が足りない断片は採用しません。
- 同じENU座標へ置く。元の共通座標を維持して表示します。見た目を合わせる日別の移動やICPは加えません。日をまたぐ写真の接続は確認されていません。
単眼再構成、動く魚・網・気泡、光源の欠測、未校正の要素が残るため、尺度・位置は暫定です。マッピングレポートに採用・除外と残差をまとめています。
写真付きマップを操作する →実装・設計資料
この説明は対象区間の解析レポートと仕様の要約です。数値と来歴は静止評価レポートにまとめています。