GNSSと航法
WAM-VとBlueROV2のアプリセッションはPOSIMの模擬衛星GNSS受信機を標準で有効にします。BlueROV2では設定で明示的に無効化できます。センサー仕様、アンテナリンク、トピックは共通です。GNSS測定状態とFCU推定位置を区別します。
実装一覧
| 段階 | 方法 | パラメーター・出力 |
|---|---|---|
| アンテナ運動 | ネイティブGazebo posim::Gnssが実リンクを観測し、機体回転とレバーアームを含めます。 |
link_name、pose、地理位置と有限差分速度。 |
| 計測誤差 | シード付きで独立なガウス位置・速度誤差を追加。 | horizontal_stddev、vertical_stddev、velocity_stddev、seed、対角共分散。 |
| 利用可否 | 波面に対する水没判定、ヒステリシス、連続再捕捉、明示的遮蔽入力。 | water_level、wave_topic、dry_margin、reacquire_seconds、enabled。測位、捕捉中、水没、遮蔽、利用不可。 |
| 時間 | シミュレーション時間の取得周期と遅延キュー。 | update_rate、latency。元の取得時刻を保持。 |
| ROS・FCU | エポック、時刻、有限値を検査し、測位・状態を発行。受理した測定をMAVLink GPS_INPUTへ変換。 |
センサー別名、FCU生GPS、融合推定を区別。 |
| 表示・ミッション | 鮮度とEKF状態から準備・ミッション条件を判定。 | 融合表示は状態の解釈で、全観測のイノベーションを公開するものではありません。 |
受信機実装とプロファイルがセンサーを定義し、WWW-POSIMがROS変換、航法源選択、ミッション連携を追加します。センサーモデルとパラメーターも参照してください。
計測と推定
| 出力 | 意味 |
|---|---|
/model/{robot}/gnss/fix |
NavSatFix。設定した誤差を含むアンテナ位置。 |
/model/{robot}/gnss/status |
受信状態と元の測定時刻。std_msgs/String内のJSON。 |
/vehicle/gnss/fix、/vehicle/gnss/status |
同じ測定のアクティブ機体用別名。2台目のGPS入力ではありません。 |
/mavros/global_position/raw/fix |
ArduPilotが受信しMAVROSで変換したGPS。 |
/mavros/global_position/global |
FCUの融合位置推定。 |
/mavros/local_position/pose |
FCUのローカル融合姿勢、ENU。 |
/model/{robot}/odometry |
3D表示・地形安全・検証用のシミュレーター参照値。地図の緯度経度には使用しない |
測定はGazebo内で生成し、アダプターが受理値を受信機ID 0のGPS_INPUTに変換します。ArduPilotはMAV受信機を選び、第2受信機とSITL合成GPSを無効にし、GPS水平位置・速度とコンパスヨーを使います。GNSSを無効にしても、真値由来のVision姿勢・速度をFCUへ注入しません。単一アンテナは静止時の方位を計測しません。移動中のGPS進行方向も機体の向きとは別です。
GNSSプロファイルはreceiver.velocity_stddevから水平速度ノイズの下限EK3_VELNE_M_NSEを設定し、文書化された0.05–5 m/sの範囲に制限します(既定値0.1 m/s)。受信機が報告する速度精度により、実効下限が高くなる場合があります。これはEKFの重み付けを設定し、シミュレーションの測定ノイズは変更しません。
WAM-VのGazebo IMUはJSONインターフェース経由で加速度・角速度を渡し、コンパスはSITL磁場モデルを使用します。これは理想化されたシミュレーション条件で、静止方位をGNSSアンテナから求めているわけではありません。
ウェイポイントはFCUの地理EKF原点を使い、到着判定には推定位置を使います。シミュレーター真値は軌跡評価と地形安全検査に残りますが、GNSS水平誤差を位置合わせで消しません。最新の測位だけでは航法フィルターの健全性は確定せず、UIはEKF有効性を別表示します。融合表示は選択源、センサー鮮度、EKFフラグの組合せで、観測ごとの残差記録ではありません。
GNSSを設定したミッションでは、アーム後、最新ローカル姿勢とGNSSまたは受理された外部航法の融合を実時間で連続2秒確認してからGUIDEDを要求します。条件を失うと計時をやり直し、35秒以内に安定しなければミッションを停止します。受信機の再捕捉は別のシミュレーション時間タイマーです。
Web・アプリは接続後、FCUのEKF・システム・ハートビートをシミュレーション時間5 Hzで要求します。実時間3秒より古い状態は拒否します。時計検証済み測位がある間、アダプターは元の取得時刻のまま実時間0.2秒ごとに有効状態を再通知します。GPS入力と測位は毎回新しく受理された測定から作ります。時計停止や測定の古さで受信機は無効になります。
設定と座標フレーム
posim_gz_gnss/config/profiles.jsonが受信設定と取付変換を定義します。SDFはbase_link → gnss_link → gnssを持ち、姿勢パブリッシャーが実階層をTFに公開します。WAM-Vのアンテナはbase_linkの上1.8 m、BlueROV2は0.3 mです。リンク質量は0.001 kgです。
真値はmapと機体リンク、推定はfcu_mapとmap → fcu_map → fcu_base_linkを使用します。最初の変換は報告された地理EKF原点を地形基準へ投影し、真値にフィッティングしません。鉛直移動はゼロを仮定し、ローカル気圧高度ゼロの近似を保持します。測量高度を意味しません。センサーTFは真値階層なので、測量処理では同じ取付外部パラメーターを推定機体姿勢へ適用し、取得時刻を保持してください。
| 量 | 既定値 |
|---|---|
| 座標 | WGS 84緯度・経度、度単位。ワールド球面座標が基準を定義。 |
| ローカル軸 | ENU:東・北・上、ワールド方位0°。 |
| 機体軸 | FLU。アンテナオフセットをFRDへx、−y、−zで変換。 |
| 速度 | 取得間隔中のアンテナ変位をENUへ回転。GPS_INPUTは北・東・下。 |
| レバーアーム | 計測前に幾何的に適用し、同じ機体オフセットをArduPilotへ渡す。 |
| 位置標準偏差 | 東・北それぞれ0.7 m、鉛直1.2 m。 |
| 速度標準偏差 | 各軸0.1 m/s。 |
| 共分散 | 既知のENU対角値0.49、0.49、1.44 m²。 |
| 周波数・遅延 | シミュレーション時間5 Hz・0.2 s。 |
| 有効性 | 重複、逆行、非有限、未来、0.6秒超の古い測定を拒否。時計進行は実時間0.8秒の監視。 |
| 時刻 | 遅延後も取得時刻を保持。GPS週2296+経過シミュレーション時間。 |
| 品質表示の固定値 | 衛星12、HDOP 1.0、VDOP 1.5。衛星配置計算は行わない。 |
| 乱数 | シード42、独立したガウス位置・速度誤差。 |
既定ワールドは海面標高0 m、合成ジオイド高ゼロです。この仮定でセンサー高度とGPS_INPUTのMSL高度は一致します。MAVROSの生GPSは導入済みEGM96変換で楕円体高を報告するため、センサートピックと差が出ることがあります。絶対鉛直測地は測量用として検証していません。深度はローカル水面基準です。GNSS・IMU・深度を使うマルチビーム処理でも、座標、取得時刻、鉛直基準を保持する必要があります。
水没・喪失・再捕捉
機体回転を含むワールドアンテナ高さを、局所水面と比較します。アプリは物理波ソルバーの局所高さ場を双線形補間します。水面サンプルがシミュレーション時間0.6秒より古ければ利用不可です。単体POSIMモデルは、波トピックがなければ設定した平均水面を使います。 アプリは元の取得時刻を保った波セルから、0.2–0.5シミュレーション秒前の測定を中継します。欠損セルは無効のままで、受信機は局所の有限値とアンテナの浸水を検査します。
水面以下になると即座に測位を無効化し、遅延測定を消去します。水面から0.05 mを超えて出ると捕捉を始め、連続3シミュレーション秒を要します。捕捉済みなら乾燥マージン内でも、水没境界に触れるまで有効です。ヒステリシスとタイマーが波による頻繁な切替えを防ぎます。
測位不可時の座標はNaNです。アダプターは有効位置を持たない明示的なno-fix GPS_INPUTを送り、古い座標の取得時刻だけを更新しません。リセットでキューと捕捉を消去し、受信機エポックを進めて時計検証を再開します。
水中でfixを失っても浮上用の手動姿勢・深度・推力制御は使用できます。絶対位置ミッションには新しく有効なセンサー由来FCU推定が必要です。WAM-Vの起動には最新GNSS fixまたは認定・受理済み外部ソースと、その他のアーム条件が必要です。
Gazebo Boolean /model/{robot}/gnss/blockedは明示的な受信遮蔽です。風速自体はGNSSを切りません。風が機体を動かし、傾け、波によってアンテナを水没させる場合があります。衛星配置、建物、マルチパス、大気、RF干渉、アンテナ指向性は物理的に再現しません。ガウス誤差、遮蔽スイッチ、水没規則は簡略試験モデルです。
BlueROV2の装備
選択可能な受信機はシミュレーション用ペイロードです。標準BlueROV2が衛星GNSSを標準搭載することや、メーカーの同名統合キットを意味しません。
Water Linked統合は水上の地理基準と水中音響測位を組み合わせ、DVLとUGPSの併用も説明しています。別の機器・測定経路であり、この衛星受信機は音響UGPSを実装しません。
GPS.govに実際の精度要因があります。ここでの標準偏差は設定値で、GPSサービス保証ではありません。外部ページは参考資料で、製品画像、マニュアル、ベンダーコードを受信機に同梱していません。
センサーに基づく地図位置
Ground Controlは新しいGNSSアンテナ測定、またはFCUゲートウェイが受理した有効な外部推定位置を使用し、シミュレーター座標で補いません。GPS fixedは緑、GPS lostは赤で、不明・期限切れ・無効も区別します。GPS fixと航法準備状態は別です。
GPS fixedではGPS表示のみです。GPS lostで検証済みの新しい推定値がある場合は位置推定 ONも表示します。水中推定が必要でも利用できない場合は位置推定不可と表示します。ON横のinfoボタンをクリック・タッチ・キーボードで開くと、方式と文書リンクを確認できます。Escapeで閉じます。座標数値は表示しません。支持装置・初期基準点・センサー初期化の状態は、地図の下の航法の詳細を開いて確認します。
IMU/DVL推定器は生の角速度、比力、有効な海底相対速度を使用し、センサー時刻・取付変換・共分散を保持します。Gazebo姿勢は使用しません。ローカルオドメトリだけでは地理位置と方位は決まりません。
内蔵BlueROV2 · KMOUはシナリオ指定の初期座標と、設定偏角を適用した磁力計の測定方位を使用します。初期基準点はGPSと区別して表示します。カメラ準備と静止初期化中は一時的なシミュレーション支持装置で機体を保持します。通常のALT_HOLDアームと航法受理後に支持を解除し、実際のジョイント除去を確認します。初期座標をシミュレーター真値で継続更新しません。
この静止プロファイルは当該内蔵デモ限定で、保存機体や任意ワールドには自動適用しません。一般のGNSS移動整合は地理出力用に未認定です。ローカル診断はnavigation_ready=falseのままです。共通ゲートウェイは新しいデータ、有効な原点と共分散、ソース選択応答、FCUのEKF・地理位置情報を別途確認して準備状態を決めます。
DVL喪失、古い入力、リセット、新区間は推定を無効にします。地図は推定座標を消し、失敗を表示します。DVL配信が戻っても初期基準点を再利用しないため、シミュレーションを再起動してください。浮上後の新しいGNSS fixは地図位置を再提供できますが、水中推定器を自動再初期化しません。
ArduPilot・QGCと交換可能な提供元
GNSSはGPS_INPUTとEKFソース1へ渡します。受理された外部位置・速度はMAVROS vision pose/speedとソース2へ渡します。既定GNSSのWAM-Vでは未使用の視覚オドメトリ入力を有効にしません。明示的な外部提供元の選択により両機体で同じ検証経路を利用できます。
QGCはGPS_RAW_INTでGPS有効性、GLOBAL_POSITION_INTで融合位置を受け取ります。GPSがno fixでも有効なFCU推定位置がある場合があります。推定値はGPS fixを書き換えません。QGCで制御で制御を渡す際はディスアームが必要なため、水中機体が浮力で上昇する場合があります。
インストール版の拡張は、承認済みハッシュに結び付けたSDF宣言ROS提供元を選択できます。/vehicle/navigation/estimateはnav_msgs/OdometryでENU姿勢と機体FLU速度を送り、/vehicle/navigation/statusは対応するセッション・時刻・原点・準備メタデータ・出所を送ります。ゲートウェイは古い値、不一致、重複発行者を拒否します。GNSS有効性は受信機が決めます。インストール版のワークスペースを制御を参照してください。読込みだけで地理精度やミッション準備は保証されません。