センサーモデルとパラメーター
Gazeboの描画・運動学センサー、POSIMの音響プラグイン、アプリのアダプターがどのように計測値を作るかを説明します。標準搭載は付属ロボット、エディターは新規作成した機体、プロバイダーは対応プラグインを必要とする機能です。保存済み機体の実際の設定は最終SDFとsensor-manifest.jsonで決まります。
計測値が届くまで
- 物理状態・描画形状
Gazeboがリンクの運動、ワールドの場、レイの交点を供給します。センサーごとに取り付け変換と取得周期を持ちます。
- 計測モデル
プラグインが画像投影、慣性計測、ビーム速度の推定、音響反射の計算を行います。ノイズと有効性もここで扱います。
- メッセージと座標系の変換
ROS–GazeboブリッジやPOSIMアダプターが計測値を保ち、座標系名、単位変換、データ欠落を扱います。
- アルゴリズム・画面表示
制御器や推定器は取得時刻付きの計測値を使用します。画面用画像には圧縮、バッファリング、配信頻度の制限があります。
共通設定と時刻
| パラメーター | 意味 |
|---|---|
sensor/@type、gz:type |
camera、rgbd_camera、gpu_lidar、imu、magnetometer、または独自GNSS/DVL/マルチビームを選択します。ワールド側にも対応システムが必要です。 |
pose |
親リンクに対するx/y/z(m)とロール/ピッチ/ヨー(rad)。エディターの位置は±10 m、各角度は±2πです。 |
update_rate |
シミュレーション1秒あたりの要求取得回数。エディターは0.1~30 Hz。物理ステップ、描画、通信により実際の頻度は下がります。値を上げてもステップ間の物理状態は増えません。 |
always_on、接続 |
動作条件。標準カメラは必要時に起動し、エディターのセンサーはalways_on=trueです。設定済みでも描画やプロバイダーが起動できなければデータは出ません。 |
topic、frame_id、TF |
エディターは/vehicle/sensors/{id}を使い、取り付けはvehicle/base_link基準です。カメラ光学軸は右/下/前、機体軸は前/左/上です。 |
| 取得タイムスタンプ | 計測時のシミュレーション時刻。記録・融合時も保持します。HLS再生時刻やブラウザー受信時刻は通信上の時刻です。 |
noise |
プラグインごとに意味が異なります。IMUは軸別の白色ノイズ、バイアス、動的バイアス、カメラは画像ノイズの平均と標準偏差を扱います。同じXMLタグでも同じ誤差モデルではありません。 |
基礎モデルはGazeboのセンサー実装に従います。エディターですべてのエンジン設定を変更できるわけではありません。WWW-POSIMのSDFアップロードは既存ブロックの対応値を編集し、構造を維持します。対応センサーの追加はエディターで行います。以下のGazebo任意ブロックはエンジンの機能説明であり、任意のXML拡張をアップロードできるという意味ではありません。
RGBカメラ:前方・下方
CameraSensorはピンホールモデルで形状をOgre2へ投影し、画像と校正情報を出力します。色はマテリアル、照明、遮蔽、海洋動力学と描画で決まります。付属カメラにはローリングシャッター、露光回路、レンズの汚れのモデルはありません。
| パラメーター | 設定 |
|---|---|
camera/image/width、height |
標準前方・エディター前方:640×480、エディター下方:800×600。各辺64~1920、幅×高さ×頻度は1台あたり毎秒3000万画素以下です。 |
camera/horizontal_fov |
標準前方:1.05 rad、エディター:1.4 rad、変更範囲0.1~3。解像度と画角が角度方向のサンプリングと校正を決めます。 |
camera/clip/near、far |
標準前方:0.1~5000 m、エディター:0.1~100 m。幾何的なクリップ範囲で、水中で実際に見える距離ではありません。 |
update_rate |
初期値5 Hz。配信側には別の制限があります。 |
camera/noise、distortion、lens/intrinsics |
Gazeboはガウス画像ノイズ、Brownの放射・接線歪み(k1、k2、k3、p1、p2)、指定内部パラメーターに対応します。生成カメラはノイズ・歪みブロックを追加しません。SDFとCameraInfoを保存してください。 |
出力はsensor_msgs/Image、sensor_msgs/CameraInfoです。JPEGは配信用表現です。観察用のワールド/機体カメラはロボットのセンサーではありません。実装。
表示アダプターは閲覧者などが画像を必要とする間だけ購読します。購読受付だけでは画像到着を確認できません。実時間10秒画像が来なければ、需要が続く限り再購読します。ライブ状態には新しいデコード済み画像が必要です。この復旧で取得頻度、取得時刻、航法データの鮮度判定は変わりません。
点検用RGB-Dカメラ
RgbdCameraSensorは同じカメラ形状と深度バッファから色、浮動小数点深度、点群を作ります。ステレオ対応付けや実機の構造化光・ToFを再現する方式ではありません。水中の色減衰だけでは数値深度に不確かさは加わりません。
| パラメーター | 標準BlueROV2 |
|---|---|
pose |
base_link上の(0.4, 0, −0.25) m、ピッチπ/4。独立した下向きレンズです。 |
| 画像と画角 | 640×480、水平1.05 rad。 |
| クリップ | 0.1~80 m。Gazeboには別のdepth_camera/clipもありますが、ここでは個別に上書きしません。 |
| 頻度と動作 | 要求5 Hz、必要時に起動。 |
ブリッジ構成に応じてROSのImage、CameraInfo、PointCloud2を出力します。無効値や範囲外深度を保持してください。カラーマップは深度データの代替ではありません。点群は1回の観測で、SLAMの蓄積地図ではありません。実装。
平面LiDAR
GpuLidarSensorは可視形状へGPUレイを投射し、設定済みの距離・ノイズ規則を適用します。幾何的な距離であり、受光電力や水中レーザー伝搬は計算しません。取り付け高さや走査平面から外れた物体は検出できない場合があります。
| パラメーター | 標準WAM-V/エディター |
|---|---|
lidar/scan/horizontal/samples |
360、角度方向resolution=1。 |
min_angle、max_angle |
−π~+π rad、水平1平面。 |
lidar/range/min、max、resolution |
標準:0.2 / 50 / 0.02 m、エディター:0.1 / 50 / 0.01 m。最大距離は1~100 mで変更可能。設定分解能は測定精度の保証ではありません。 |
| 頻度と取り付け | 通常5 Hz。標準は基部の2.5 m上、共有デモはブイを捉える船首(3.5, 0, 1.0) mです。エディターでは姿勢を明示保存します。 |
lidar/noise |
生成スキャナーには追加ノイズブロックがありません。Gazebo自体は距離ノイズに対応します。 |
出力はsensor_msgs/LaserScan。角度情報と非有限値を保持し、反射なしを距離ゼロとして扱わないでください。実装。
下向き単一Ping
Pingアダプターは5×5本のGPUレイから最も近い有効反射を選び、sensor_msgs/Rangeを出力します。有限のビーム照射範囲と距離の有効性を表し、音響強度、時系列波形、マルチパスは計算しません。
| パラメーター | エディター |
|---|---|
| レイと角度 | 5×5、各軸±0.00872665 rad(±0.5°)。専用デモのセンサーでは異なる扇形を使う場合があります。 |
| 最小/最大/分解能 | 0.1 / 30 / 0.01 m、最大は1~100 mで変更可能。 |
| 頻度と姿勢 | 初期5 Hz、保存済み設定に従う下向き取り付け。 |
出力field_of_view |
半角から計算した、正方形のレイ束を囲む円錐。どのレイの反射も代表値になり得ます。 |
近すぎる入力は−∞、反射なしは+∞、不明は有効反射がなければNaNです。取得時刻を保持します。現在のエディターでは下向きPingとDVLは選択式です。照射範囲内の距離1個だけでは海底の一意な点は決まりません。
ドップラー速度計(DVL)
DopplerVelocityLogは描画したビーム円錐内の海底を探し、センサーと対象の相対運動速度をビーム方向へ射影します。ビームノイズを加え、SVDによる最小二乗法で速度を求めます。音響搬送波の合成やドップラースペクトル推定ではありません。
<gz:dvl>パラメーター |
採用設定 |
|---|---|
type、arrangement |
phased_array、4ビーム。回転45°、135°、−45°、−135°、傾斜30°、開口2°。 |
tracking/bottom_mode/when |
best、ボトムトラッキング。水塊追跡はGazeboの機能ですが、この設定では無効です。 |
tracking/bottom_mode/noise/stddev |
ビーム速度のガウス標準偏差0.002 m/s。推定速度の共分散はビーム配置に依存します。 |
minimum_range、maximum_range、resolution |
0.1 / 20 / 0.01 m、最大は1~100 m。 |
update_rate、reference_frame |
初期1 Hz、基準姿勢0 0 0 0 0 0。取り付け回転とレバーアームも校正対象です。 |
アダプターは3本以上のロック済みビーム、有効な共分散、期待する座標系、進むタイムスタンプを要求します。geometry_msgs/Vector3Stampedと、std_msgs/StringのJSON状態を出力します。ロック喪失をゼロ速度に置き換えません。状態には各ビームの海底距離も含みます。円錐内の最小距離で、中心レイの交点とは限りません。距離分散がなければ不確かさは不明です。実装。
イメージング・マルチビームソナー
POSIMプロバイダーはレイ形状から音響後方散乱、ビーム補正済み周波数応答、距離ビン強度を計算します。Rust/WGPU・CUDA・CPUの構成と、音響観測と幾何点群の違いは物理モデルによるソナーのプレビューにまとめています。
| 設定群 | 値 |
|---|---|
| 水平ビーム | 256本、−π/3~+π/3 rad(120°)。 |
| 垂直レイ | 256本、−π/18~+π/18 rad(20°)。 |
sonarFreq、maxDistance、レイ距離 |
700 kHz、処理最大15 m、レイ0.2~15 m。 |
update_rate、raySkips |
初期2 Hz、間引き係数1。 |
soundSpeed、bandwidth、sourceLevel、sensorGain |
伝搬、距離処理、表示スケール用のプロバイダーSDF設定。すべてがエディター操作ではありません。生データと一緒に保存します。 |
探索的な比較図はより広い傾斜した扇形を使い、図の近くに設定を記載しています。エディターの生出力はmarine_acoustic_msgs/ProjectedSonarImageです。色付き扇形はその表示です。プロバイダーはホストの互換性確認を通る必要があります。
IMU:加速度と角速度
ImuSensorは運動状態からセンサー座標系の重力を差し引いて比力を求め、軸別ノイズを適用します。姿勢は指定基準に対するシミュレーターの姿勢から得られ、機上の姿勢推定器による推定値ではありません。
| パラメーター | 設定 |
|---|---|
update_rate |
WAM-Vは200 Hz、標準BlueROV2は1000 Hzを要求。どちらも物理ステップで制限されます。 |
pose、orientation_reference_frame |
軸と基準を決めます。ROS直接制御のBlueROV2は取り付け回転ゼロ、ArduPilotモデルは接続方式固有の向きを保持します。出力座標系とTFを使ってください。 |
imu/linear_acceleration/{x,y,z}/noise |
mean/stddevはm/s²、bias_mean/bias_stddevはバイアス、dynamic_bias_stddev/dynamic_bias_correlation_timeは時間変化です。標準IMUはこれらのノイズブロックを設定しません。 |
imu/angular_velocity/{x,y,z}/noise |
ジャイロの対応設定、単位rad/s。動的バイアスを有効にすると時間相関を持ちます。 |
出力はsensor_msgs/Imu。生IMUとMAVROSの融合済み姿勢は別の信号です。VIOや制御器の評価では、ノイズなし設定とシミュレーター真値由来の姿勢であることを明示してください。IMU、ガウスノイズ。
ArduPilotのJSONインターフェースは、計算済みの物理状態の間を補間してSITLの中間サンプルを生成します。サンプリング周波数と時間刻みを変更した場合の動作は経路計画と制御アルゴリズムを参照してください。ROS IMUの測定頻度は物理計算の刻みに制限され、補間されたSITLサンプルに新しい物理情報は追加されません。
磁力計
MagnetometerSensorはワールド磁場をセンサー座標系へ回転し、設定された軸別ノイズを加えます。BlueROV2にはbase_link原点の20 Hz磁力計があります。ワールドはテスラとENUを使用し、use_units_gauss=false、use_earth_frame_ned=falseです。
| パラメーター | 意味 |
|---|---|
ワールドのmagnetic_field |
磁場ベクトル。実験時はワールド定義も保存します。 |
pose、update_rate |
取り付けと要求頻度。 |
magnetometer/{x,y,z}/noise |
テスラ単位のガウス平均・標準偏差。追加磁力計には追加ノイズ設定がありません。 |
出力はsensor_msgs/MagneticField。機体のハードアイアン・ソフトアイアンや局所磁気異常は再現しません。WAM-VのArduPilotコンパスはSITL磁場を使うため、ROSトピックの存在だけではFCUが何を融合しているかは分かりません。実装。
GNSS受信機
posim::Gnssはアンテナのワールド位置を地理座標へ変換し、シード付き位置・速度ノイズ、配信遅延、浸水・遮蔽による測位条件を適用します。NavSatFix/状態、GNSS航法ではMAVLinkのGPS_INPUTに接続します。
| パラメーター | 役割 |
|---|---|
update_rate、latency、reacquire_seconds |
取得頻度、遅延、連続して水上にある必要時間。シミュレーション時刻基準です。 |
horizontal_stddev、vertical_stddev、velocity_stddev、seed |
ガウス誤差の大きさと再現性。 |
link_name、pose、water_level、wave_topic、dry_margin |
レバーアームと波を考慮した浸水判定。 |
enabled、遮蔽トピック |
受信機選択と指定した受信遮断。 |
値、共分散、ENU/NED、鉛直基準、EKFの違いはGNSSと航法を参照してください。衛星配置やマルチパスは含みません。
圧力と深度
画面のシミュレーター深度とArduSubの推定深度は、独立プラグインSubseaPressureSensorPluginとは別です。このプラグインはRexROVやSlocumなど別のPOSIMモデルで使われ、現在のWWW-POSIMエディターでは選択できません。
モデル原点の平均面z=0以下の深度を読み、水面より上はゼロに制限して、標準圧力に線形静水圧を加えます。sensor_msgs/FluidPressureをPaで、任意で逆算深度をgeometry_msgs/PointStampedとして出力します。
| パラメーター | 値・役割 |
|---|---|
namespace、topic |
モデル検索と出力。既定トピックはsea_pressure。 |
standard_pressure、kPa_per_meter |
101.325 kPa、9.80638 kPa/m。内部kPaをROS向けPaに変換します。 |
estimate_depth_on、update_rate |
深度逆算は既定で有効。頻度0はプラグイン独自の追加制限なしです。 |
saturation |
既定3000で読み取りますが、実装の計測処理では使用せず、測定上限にはなりません。 |
実際の圧力ノイズは加えない一方、標準偏差3 kPaに相当する分散を報告します。この分散は乱数ノイズを付与した証拠ではありません。校正済み圧力ポートではなくモデル原点を使い、波面圧力も測りません。実装。
POSIMのUSBL構成要素
UsblTransceiverとUsblTransponderは模擬位置と指令を交換し、相対位置を出力します。トランスポンダーはワールド座標にガウスノイズを加えます。位置ベースの試験用構成要素で、位相差アレイ受信機や音響伝搬ソルバーではありません。標準エディターのセンサーには含みません。
| 設定群 | 役割 |
|---|---|
namespace、名前/ID、関連オブジェクト |
装置、モデル、メッセージ経路を特定。 |
enable_ping_scheduler、ping_frequency、interrogation_mode |
定期問い合わせと共通/個別アドレス指定。 |
sound_speed |
初期1540 m/s。コールバックで深度・温度に基づく近似値に変わる場合があります。 |
トランスポンダーのmu、sigma |
位置ノイズ。平均0、標準偏差1 m。 |
伝搬待ちはコールバック内の実時間sleepなので、シミュレーション時刻で精密な飛行時間を測る計器としては扱えません。送受信機とトランスポンダーを参照してください。
オドメトリ・真値・実験記録
OdometryPublisherはシミュレーションの姿勢・速度を出力し、自動航海制御も計測したネイティブ状態を公開します。これらは参照信号で、車輪オドメトリやセンサー融合の推定値ではありません。親子座標系、配信頻度、原点移動を記録し、FCUやSLAMの推定値と区別してください。
再現性のため、最終SDF、センサーマニフェスト、TF外部パラメーター、校正情報、アプリ・プロバイダーの版、時間刻み、乱数シード、取得時刻、有効性、生観測値を保存します。動画、画面キャプチャ、カラーマップは補足資料です。