传感器模型与参数
本章说明 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(米)和横滚/俯仰/偏航(弧度)。编辑器位置限制为 ±10 m,各角度为 ±2π。 |
update_rate |
每仿真秒请求的采样次数;编辑器范围 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,宽×高×频率每台不超过每秒 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。处理时保留无效和超范围深度;彩色映射不是深度原始值。点云是单次观测,不是累积的 SLAM 地图。实现。
平面 LiDAR
GpuLidarSensor 用 GPU 射线与可见几何求交,应用配置的量程和噪声规则。距离是几何量,不计算光学接收功率或水下激光传播。安装高度和扫描平面之外的物体可能无法检出。
| 参数 | 内置 WAM-V/编辑器 |
|---|---|
lidar/scan/horizontal/samples |
360,角度 resolution=1。 |
min_angle、max_angle |
−π 至 +π rad,单个水平扫描面。 |
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 二选一。足迹内一个距离不能确定唯一海底点。
多普勒测速仪(DVL)
DopplerVelocityLog 在渲染的波束锥内寻找海底目标,把传感器与目标的相对运动速度投影到各波束方向,加入波束噪声,再用 SVD 最小二乘求解速度。它不合成声学载波,也不估计其多普勒频谱。
<gz:dvl> 参数 |
所选配置 |
|---|---|
type、arrangement |
phased_array,四束旋转角 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。安装旋转和杆臂均属于标定内容。 |
适配器要求至少三束锁定、有效协方差、预期坐标系和递增时间戳。输出 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 平面的深度,水面以上截为零,在标准压力上叠加线性静水压力。发布 Pa 单位的 sensor_msgs/FluidPressure,可选输出 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。 |
传播等待在回调中使用实际时间休眠,不能当作基于仿真时间的精确飞行时间仪器。参见收发器和应答器。
里程计、真值与实验记录
OdometryPublisher 输出仿真位姿和速度,自动航行控制器也发布测得的原生状态。这些是参考信号,不是轮式里程计或融合估计。应记录父/子坐标系、发布频率和原点重设事件,并单独标识 FCU 或 SLAM 估计。
为保证可复现,应保存最终 SDF、传感器清单、TF 外参、标定消息、应用/提供程序版本、仿真步长、随机种子、采集时间戳、有效性消息与原始观测。视频、截图和彩色映射只是补充。
准备自定义载具 · 自定义传感器 · 仿真、渲染与传感器架构 · 海洋动力学与渲染