센서 구현과 파라미터
WWW-POSIM의 측정값을 만드는 Gazebo 렌더링 센서, 운동 상태 기반 센서, POSIM 음향 플러그인과 애플리케이션 어댑터를 정리합니다. 기본 기체 값은 제공된 로봇에, 빌더 값은 새로 생성하는 기체에 적용됩니다. 제공자(provider) 기능은 호환 플러그인이 설치되어 있어야 합니다. 저장한 기체의 실제 구성은 최종 모델 SDF와 sensor-manifest.json을 기준으로 확인하세요.
측정값 생성 흐름
- 물리 상태 또는 렌더링 형상
Gazebo가 링크 운동, 월드의 장 또는 광선 교차점을 제공합니다. 센서마다 장착 변환과 측정 시계가 있습니다.
- 측정 모델
플러그인이 영상 투영, 관성 측정, 빔 속도 추정 또는 음향 반향 계산을 수행합니다. 잡음과 유효성 판정도 이 단계에 속합니다.
- 메시지·좌표계 변환
ROS–Gazebo 브리지나 POSIM 어댑터가 측정값을 전달하면서 프레임 이름, 단위와 측정 불가 상태를 처리합니다.
- 연구 프로그램 또는 화면
제어기·추정기는 시각이 붙은 측정값을 사용합니다. GUI 영상은 압축·버퍼링하거나 더 낮은 속도로 전달할 수 있습니다.
공통 설정과 시간
| 파라미터·규약 | 의미와 적용 방식 |
|---|---|
sensor/@type, 사용자 정의 gz:type |
camera, rgbd_camera, gpu_lidar, imu, magnetometer 또는 GNSS·DVL·멀티빔 구현을 선택합니다. 월드에도 해당 시스템이 필요합니다. |
pose |
부모 링크 기준 x/y/z(m), roll/pitch/yaw(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 카메라: 전방·하향
Gazebo CameraSensor는 장면 형상을 카메라로 투영해 Ogre2 렌더 타깃을 만들고 영상과 보정 정보를 발행합니다. 재질, 조명, 가림과 수중 렌더링이 색상을 결정합니다. 제공된 카메라는 핀홀 투영 모델이며 물리적 롤링 셔터, 노출 회로와 렌즈 오염은 구현하지 않습니다.
| 파라미터 | WWW-POSIM 값과 효과 |
|---|---|
camera/image/width, height |
기본 전방 640 × 480, 빌더 전방 640 × 480, 빌더 하향 800 × 600픽셀입니다. 빌더는 각 변 64–1920픽셀, 카메라별 가로 × 세로 × 속도 3천만 픽셀/초 이내를 허용합니다. |
camera/horizontal_fov |
기본 전방 1.05 rad, 빌더 1.4 rad이며 0.1–3 rad로 설정합니다. 해상도와 시야각이 픽셀의 각도 간격과 보정값을 결정합니다. |
camera/clip/near, far |
기본 전방 0.1–5,000 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 카메라
Gazebo RgbdCameraSensor는 같은 카메라 형상에서 색상, 부동소수점 깊이 영상과 점군을 렌더링합니다. 스테레오 정합이나 실제 구조광·ToF 측정 대신 렌더링 깊이 버퍼를 사용합니다. 물의 색상 감쇠는 수치 깊이에 불확실성을 추가하지 않습니다.
| 파라미터 | 기본 BlueROV2 검사 카메라 |
|---|---|
pose |
base_link 기준 (0.4, 0, −0.25) m, pitch π/4의 별도 하향 렌즈입니다. |
camera/image, horizontal_fov |
640 × 480픽셀, 수평 시야각 1.05 rad입니다. |
camera/clip/near, far |
0.1–80 m입니다. Gazebo는 별도의 depth_camera/clip도 지원하지만 이 구성에서는 독립적으로 덮어쓰지 않습니다. |
update_rate, always_on |
요청 속도 5 Hz이며 필요할 때 활성화합니다. |
브리지 구성에 따라 ROS Image, CameraInfo, PointCloud2를 제공합니다. 처리할 때 유효하지 않거나 범위를 벗어난 깊이를 보존하세요. 색상으로 표시한 깊이 영상은 원본 수치 자료가 아닙니다. 이 점군은 한 카메라 관측이며 누적 SLAM 지도가 아닙니다. 구현.
평면 LiDAR
Gazebo GpuLidarSensor는 보이는 장면 형상에 GPU 광선을 쏘아 거리·잡음 규칙을 적용하고 스캔을 발행합니다. 광학 반사 세기나 수중 레이저 전파 대신 기하학적 거리를 계산합니다. 장착 높이나 스캔 평면 밖에 있는 물체는 감지하지 못할 수 있습니다.
| SDF 파라미터 | 기본 WAM-V / 빌더 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로 설정합니다. 해상도 항목은 모델 설정이며 측정 정확도 보증이 아닙니다. |
update_rate, pose |
일반적으로 5 Hz입니다. 기본 장착 높이는 2.5 m이며 공유 데모는 부표를 스캔하도록 선수의 (3.5, 0, 1.0) m에 배치합니다. 빌더 장착값은 저장한 구성을 따릅니다. |
lidar/noise |
앱이 생성하는 평면 스캐너에는 별도 잡음 블록이 없습니다. Gazebo 자체는 거리 잡음 모델을 지원합니다. |
ROS 출력은 sensor_msgs/LaserScan입니다. 각도 정보와 비유한 반환값을 보존하고, 반사 없음 상태를 거리 0으로 바꾸지 마세요. 구현.
하향 단일 Ping
앱의 Ping 어댑터는 Gazebo GPU 광선 5 × 5개의 스캔에서 가장 가까운 유효 반환값을 골라 sensor_msgs/Range 하나로 발행합니다. 유한한 빔 면적과 거리 유효성을 표현하며 음향 반향 세기, 시간 파형이나 다중 경로는 계산하지 않습니다.
| 파라미터 | 빌더 구성 |
|---|---|
| 수평·수직 표본 | 5 × 5개 광선, 각 축 ±0.00872665 rad(±0.5°)입니다. 별도 데모 센서는 더 넓은 팬을 사용할 수 있습니다. |
range/min, max, resolution |
0.1 / 30 / 0.01 m입니다. 최대 거리는 1–100 m로 설정합니다. |
update_rate, pose |
초기 5 Hz이며 저장한 기체 구성의 하향 장착을 따릅니다. |
발행 field_of_view |
사각 광선 묶음을 감싸는 원뿔 각도를 반각에서 계산합니다. 반환점은 그 면적 안의 어느 광선에나 있을 수 있습니다. |
너무 가까운 입력은 음의 무한대, 반사 없음은 양의 무한대가 됩니다. 유효한 반사가 없고 알 수 없는 입력이 있으면 NaN을 유지합니다. 원래 측정 시각도 유지합니다. 현재 빌더에서는 Ping과 DVL 중 하나를 선택합니다. 단일 거리는 빔 면적 안의 거리를 제한하며 하나의 해저 좌표를 특정하지 않습니다.
도플러 속도계 DVL
Gazebo DopplerVelocityLog는 렌더링한 빔 원뿔 안에서 해저 표적을 찾습니다. 센서와 표적의 상대 운동 속도를 빔 방향으로 투영하고 빔 잡음을 더한 뒤 SVD 최소제곱법으로 속도를 구합니다. 빔·운동 상태 기반 측정 모델이며 실제 음향 반송파를 합성해 도플러 스펙트럼을 추정하지는 않습니다.
사용자 정의 <gz:dvl> 파라미터 |
앱의 선택된 구성 |
|---|---|
type, arrangement |
phased_array, 빔 4개, 회전각 45°·135°·−45°·−135°, 기울기 30°, 개구각 2°입니다. |
tracking/bottom_mode/when |
best로 해저 추적을 구성합니다. 상위 라이브러리의 수층 추적 기능은 이 구성에서 활성화하지 않습니다. |
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, 기준 pose는 0 0 0 0 0 0입니다. 장착 회전과 레버 암도 보정에 포함해야 합니다. |
ROS 어댑터는 잠긴 빔이 3개 이상이고 공분산·프레임·증가하는 시각이 유효할 때 해저 속도를 받아들입니다. geometry_msgs/Vector3Stamped와 JSON std_msgs/String 상태를 발행하며 추적이 끊겼을 때 속도 0을 만들어 내지 않습니다. 상태에는 빔별 해저 거리도 있습니다. 거리는 빔 원뿔 안의 최솟값이며 중심 광선 교차점과 같다고 볼 수 없습니다. 거리 분산이 없으면 불확실성을 모르는 것입니다. Gazebo 구현.
영상 멀티빔 소나
별도 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: 가속도와 각속도
Gazebo ImuSensor는 시뮬레이션 운동 상태에서 센서 좌표계로 표현한 중력을 빼 비력을 만들고, 설정된 축별 잡음을 적용해 가속도와 각속도를 발행합니다. 자세는 설정된 기준에 대한 시뮬레이터 자세에서 얻으며 기체 안의 자세 추정기 결과가 아닙니다.
| 파라미터 | 의미와 앱 설정 |
|---|---|
update_rate |
WAM-V 200 Hz, 기본 BlueROV2 1,000 Hz 요청입니다. 실제 측정은 물리 시간 간격의 제한을 받습니다. |
pose, orientation_reference_frame |
장착과 기준이 축을 정합니다. BlueROV2 ROS 직접 제어는 IMU 장착 회전을 0으로 설정하며 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입니다. dynamic_bias_stddev, dynamic_bias_correlation_time은 활성화한 시간 상관 바이어스를 정의합니다. |
출력은 sensor_msgs/Imu입니다. 원시 IMU와 MAVROS 융합 자세를 구분하세요. VIO나 제어기 평가에는 잡음 없는 구성과 참값에서 얻은 자세의 사용 여부를 명시해야 합니다. IMU · 가우시안 잡음 구현.
ArduPilot JSON 인터페이스는 계산이 끝난 물리 상태 사이를 보간해 SITL 중간 샘플을 만듭니다. 샘플링 주파수와 물리 간격 변경 시 동작은 경로 계획과 제어 알고리즘에서 설명합니다. ROS IMU의 실제 측정 빈도는 물리 계산 간격의 제한을 받으며, 보간한 SITL 샘플에 새로운 물리 정보가 추가되지는 않습니다.
자력계
Gazebo MagnetometerSensor는 월드 자기장 벡터를 센서 좌표계로 회전하고 축별 잡음을 더합니다. 앱의 BlueROV2 모델은 20 Hz 자력계를 추가합니다. 앱 월드는 Gazebo 시스템의 use_units_gauss=false, use_earth_frame_ned=false로 SI 테슬라와 ENU 월드 자기장 규약을 선택합니다.
| 파라미터 | 의미 |
|---|---|
월드 magnetic_field |
시뮬레이터가 사용하는 자기장 벡터입니다. 실험과 함께 월드 정의를 보관하세요. |
pose, update_rate |
장착 위치와 요청 속도입니다. 추가한 BlueROV2 센서는 base-link 원점, 20 Hz입니다. |
magnetometer/{x,y,z}/noise |
가우시안 평균·표준편차의 단위는 테슬라입니다. 추가한 센서에는 별도 잡음 블록이 없습니다. |
출력은 sensor_msgs/MagneticField입니다. 기체의 hard-iron·soft-iron 자기 왜곡이나 국부 자기 이상은 구현하지 않습니다. WAM-V ArduPilot 나침반은 SITL 자기장 모델을 사용하므로 ROS 자력계 토픽만으로 FCU가 실제 무엇을 융합하는지 판단하면 안 됩니다. 구현.
위성 GNSS 수신기
POSIM의 사용자 정의 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 추정 수심과 POSIM의 별도 SubseaPressureSensorPlugin을 구분해야 합니다. 이 플러그인은 RexROV·Slocum 등 추가 POSIM 모델에서 사용하며 현재 WWW-POSIM 빌더의 선택형 압력 센서는 아닙니다.
플러그인은 평균 z=0 면 아래의 모델 원점 깊이를 읽고 수면 위의 깊이를 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 |
기본 3,000으로 읽지만 이 구현의 측정 경로에 적용하지 않습니다. 실제 거리 차단값으로 볼 수 없습니다. |
현재 구현은 압력 잡음을 0만큼 더하면서 표준편차 3 kPa에 해당하는 분산을 보고합니다. 그 필드가 실제 표본에 잡음이 있다는 근거는 아닙니다. 보정된 압력 포트 대신 모델 위치를 사용하며 파도 수면의 압력을 계산하지 않습니다. 구현.
POSIM의 USBL 구성 요소
POSIM에는 UsblTransceiver, UsblTransponder도 있습니다. 시뮬레이션 장치 위치·명령을 교환하고 상대 위치 메시지를 만듭니다. 트랜스폰더는 월드 좌표에 가우시안 잡음을 더합니다. 위치 기반 음향 측위 시험 구성 요소이며 위상차 배열 수신기나 음향 전파 해석기는 아닙니다. WWW-POSIM의 기본 빌더 센서로 노출하지 않습니다.
| 파라미터 묶음 | 의미 |
|---|---|
namespace, 장치 이름·ID, 연결 물체 |
송수신기, 트랜스폰더, 모델과 메시지 경로를 정합니다. |
enable_ping_scheduler, ping_frequency, interrogation_mode |
주기적 질의와 공통·개별 주소 지정을 정합니다. |
sound_speed |
초기 전파 속도 기본값은 1,540 m/s입니다. 콜백이 깊이·수온 근사값으로 바꿀 수 있습니다. |
트랜스폰더 mu, sigma |
위치 잡음의 평균·표준편차이며 기본값은 0, 1 m입니다. |
전파 대기는 콜백 안의 실제 시간 sleep을 사용하므로 정밀한 시뮬레이션 시간 기준 비행시간 계측기로 취급할 수 없습니다. 정확한 메시지 경로와 필수 설정은 송수신기와 트랜스폰더를 참고하세요.
오도메트리·참값과 연구 기록
Gazebo OdometryPublisher는 시뮬레이션 자세·속도를 제공합니다. 자동 항해 제어기도 실제 엔진 상태를 발행합니다. 이는 기준 신호이며 바퀴 오도메트리나 센서 융합 추정값이 아닙니다. 부모·자식 프레임, 발행 속도와 좌표 원점 이동을 기록하고 FCU·SLAM 추정값은 별도 경로로 구분하세요.
재현 가능한 센서 실험에는 최종 SDF, 센서 명세, TF 외부 파라미터, 보정 메시지, 앱·제공자 리비전, 물리 시간 간격, 난수 시드, 측정 시각, 유효성 상태와 원시 관측을 남기세요. 동영상·화면 캡처·색상 맵은 이를 보충합니다. 선택 센서와 공급자 · 시뮬레이션·렌더링·센서 구조 · 해양 동역학과 렌더링.