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; fix·획득 중·잠김·차단·사용 불가 상태입니다. |
| 시간 | 시뮬레이션 시간 기준 획득 주기와 지연 측정 큐입니다. | update_rate, latency; 전달 후에도 원래 획득 시각을 유지합니다. |
| ROS·비행제어기 | 어댑터가 epoch·시각·유한값을 검사하고 센서 fix·상태를 발행하며 유효 관측을 MAVLink GPS_INPUT으로 변환합니다. |
센서 별칭, FCU 원시 GPS와 융합 추정값을 각각 식별할 수 있습니다. |
| 화면·임무 | 신선도와 EKF 상태로 준비 여부와 임무 제한을 정합니다. | 융합 표시는 상태 해석이며 모든 필터 innovation을 제공하는 것은 아닙니다. |
수신기 구현과 프로파일이 센서를 정의합니다. WWW-POSIM은 ROS 변환, 제어기 항법 입력 선택과 임무 통합을 추가합니다. 아래에는 파라미터 값, 기준 좌표계와 측정 불가 동작을 설명합니다. 센서 구현과 파라미터.
측정값과 추정값
| 출력 | 의미 |
|---|---|
/model/{robot}/gnss/fix |
센서 NavSatFix · 설정한 측정 오차를 포함한 안테나 위치 |
/model/{robot}/gnss/status |
수신 상태와 원래 측정 시각 · std_msgs/String의 JSON |
/vehicle/gnss/fix, /vehicle/gnss/status |
같은 센서 메시지의 활성 차량 공통 ROS 별칭 · GPS 입력기를 추가하지 않음 |
/mavros/global_position/raw/fix |
ArduPilot이 받은 GPS · MAVROS 변환 적용 |
/mavros/global_position/global |
FCU의 융합 위치 추정값 |
/mavros/local_position/pose |
FCU의 로컬 위치·자세 추정값 · ENU |
/model/{robot}/odometry |
3D 렌더링·지형 안전·검증용 시뮬레이터 참값. 지도 위경도의 소스로 사용하지 않음 |
수신기는 네이티브 Gazebo 프로세스에서 측정값을 생성합니다. ROS 어댑터는 허용된 fix를 수신기 ID 0의 MAVLink GPS_INPUT으로 변환합니다. ArduPilot 설정은 MAV 수신기를 선택하고, 두 번째 수신기와 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는 ArduPilot JSON 인터페이스로 가속도와 각속도를 전달합니다. 나침반은 SITL 자기장 모델을 사용합니다. 이 방위 경로는 이상화된 시뮬레이션 의존성이며 GNSS 안테나에서 정지 방위를 얻지 않습니다.
경로 목표는 FCU의 지리 EKF 원점을 기준으로 변환합니다. GNSS 경로의 도착 판정은 추정 위치를 사용합니다. 참값은 궤적 평가와 지형 안전 검사에 사용하며 수신기의 수평 오차를 정렬 과정에서 상쇄하지 않습니다. 최신 fix만으로 항법 필터가 정상이라고 판단하지 않습니다. 화면은 EKF 유효 상태를 별도로 표시합니다. 융합 표시는 설정한 항법 소스, 최신 센서 상태, EKF 플래그를 결합한 지표이며 개별 관측의 innovation 기록은 아닙니다.
GNSS가 설정된 임무는 시동 후 최신 로컬 위치와 GNSS 또는 수용된 외부 항법의 센서 융합 상태가 실제 시간으로 2초 동안 연속 유지된 뒤 GUIDED를 요청합니다. 조건을 잃으면 다시 시간을 셉니다. 35초 안에 안정화되지 않으면 임무를 중단합니다. 수신기 재획득은 별도의 시뮬레이션 시간 타이머를 사용합니다.
웹과 설치형 작업공간은 비행 제어기 연결 후 EKF 상태, 시스템 상태, 하트비트를 시뮬레이션 시간 기준 5 Hz로 요청합니다. 물리 계산이 실시간보다 느릴 때도 상태가 자주 도착하도록 합니다. 실제 시간으로 3초를 넘은 상태는 거부합니다. 측정과 시계가 유효한 fix 상태일 때, GNSS 어댑터는 원래 측정 시각을 유지한 상태 정보를 실제 시간 기준 0.2초마다 알립니다. GPS 입력과 센서 fix는 새로 승인된 수신기 측정에서만 생성합니다. 시계가 멈추거나 측정이 오래되면 수신기를 무효 상태로 전환합니다.
공통 설정과 좌표계
POSIM의 posim_gz_gnss/config/profiles.json은 수신기 설정과 모델별 장착 변환을 정의합니다. 모델 SDF에는 base_link → gnss_link → gnss 구조가 있습니다. 기존 pose publisher가 실제 링크·센서 계층을 TF로 전달합니다. WAM-V 안테나는 base_link 위 1.8 m, BlueROV2 안테나는 위 0.3 m에 장착합니다. 안테나 링크 질량은 0.001 kg입니다.
시뮬레이터 참값은 map과 모델 링크 프레임을 사용합니다. GNSS 세션의 MAVROS 로컬 위치에는 별도 fcu_map을 사용하고, 추정값 TF는 map → fcu_map → fcu_base_link로 발행합니다. 첫 변환은 FCU가 보고한 EKF 지리 원점을 지형 datum에 투영하며 참값에 맞춰 보정하지 않습니다. 수직 이동은 0으로 가정하여 로컬 기압 고도 원점을 유지하며 측량 고도를 보장하지 않습니다. 센서 장착 TF는 참값 계층에 속합니다. 측량 처리는 같은 장착 외부 파라미터를 추정 몸체 위치에 적용하고 측정 시각을 보존해야 합니다.
| 항목 | 기본값과 해석 |
|---|---|
| 지리 좌표 | WGS 84 위·경도 · 도 단위 · 월드 spherical coordinates가 datum 정의 |
| 로컬 축 | ENU · 동·북·상 · 월드 heading 0° |
| 기체 축 | FLU · ArduPilot 안테나 오프셋은 FRD의 x, −y, −z로 변환 |
| 속도 | 측정 간격 동안의 안테나 변위 · ENU 회전 적용 · GPS_INPUT은 북·동·하 |
| 안테나 lever arm | 측정 전에 기하학적으로 적용 · 같은 기체 오프셋을 ArduPilot에도 전달 |
| 위치 표준편차 | 동·북 각각 0.7 m · 수직 1.2 m |
| 속도 표준편차 | 축별 0.1 m/s |
| 공분산 | ENU 대각 성분 0.49, 0.49, 1.44 m² · known diagonal |
| 측정 주기 / 지연 | 시뮬레이션 시간 기준 5 Hz / 0.2초 |
| 유효 시간 | 중복·역순·비유한 값·미래·0.6초 초과 측정 거부 · 시뮬레이션 시각 진행의 실제 시간 watchdog 0.8초 |
| 시각 | 지연 중에도 취득 시각 유지 · GPS week 2296 + 경과 시뮬레이션 시간 |
| 품질 대푯값 | 위성 12개 · HDOP 1.0 · VDOP 1.5 · 실제 위성 배치 계산 없음 |
| 난수 | seed 42 · 위치와 속도에 독립 가우시안 오차 |
기본 월드는 해수면 고도 0 m와 모의 geoid 분리값 0 m를 가정합니다. 이 가정에서 센서 고도와 GPS_INPUT의 평균해수면 고도는 같습니다. MAVROS의 raw GPS는 설치된 EGM96 geoid 변환을 통해 타원체 고도를 출력하므로 센서 토픽과 고도가 다를 수 있습니다. 절대 수직 datum의 측량 정밀도는 검증하지 않습니다. 수심은 로컬 수면을 기준으로 합니다. 향후 GNSS+IMU+수심 멀티빔 파이프라인에서도 좌표계, 취득 시각, 수직 datum 가정을 보존해야 합니다.
수면과 신호 중단·복귀
수신기는 기체 회전을 포함한 안테나의 월드 높이를 해당 위치의 수면과 비교합니다. 앱 월드는 물리 파도 계산기의 국소 높이장을 이중 선형 보간합니다. 수면 자료가 시뮬레이션 시간 기준 0.6초를 넘으면 수신 불가 상태가 됩니다. POSIM 모델을 단독 실행할 때는 wave 토픽을 지정하지 않으면 설정한 평균 수면을 사용합니다. 앱은 원래 취득 시각을 유지한 국소 파도 셀 중 0.2–0.5 시뮬레이션 초 전 자료를 전달합니다. 누락된 셀을 채우지 않으며, 수신기는 해당 위치의 유한한 수면 값과 안테나 침수 여부를 계속 검사합니다.
안테나가 수면 이하로 잠기면 fix를 즉시 무효화하고 지연 대기 측정을 폐기합니다. 재획득은 수면 위 여유 높이 0.05 m를 넘은 상태를 연속 3초간 유지해야 합니다. 이미 fix가 있으면 여유 높이 구간에서는 유지하고 실제 침수 경계에서 잃습니다. 히스테리시스와 재획득 타이머가 파도 경계의 빠른 상태 전환을 막습니다.
No-fix 메시지의 좌표는 NaN입니다. 어댑터는 유효 위치 필드가 없는 명시적 no-fix GPS_INPUT을 보냅니다. 마지막 유효 좌표에 새 취득 시각을 붙여 재출력하지 않습니다. Reset은 대기 측정과 재획득 상태를 비우고 수신기 epoch를 증가시키며 시각 검증을 다시 시작합니다.
수중 수신기가 fix를 잃어도 부상에 필요한 수동 자세·수심·추력 제어는 사용할 수 있습니다. 절대 위치 임무에는 최신의 유효한 센서 기반 FCU 항법 추정이 필요합니다. WAM-V 시작 검사는 최신 GNSS fix 또는 검증되고 수용된 외부 소스와 나머지 시동 조건을 확인합니다.
Gazebo Boolean /model/{robot}/gnss/blocked 입력은 시험자가 지정한 수신 가림을 나타냅니다. 풍속 자체는 GPS 차단 조건이 아닙니다. 바람은 기체 이동·자세와 파도에 영향을 주며 그 결과 안테나가 잠길 수 있습니다. 위성 배치, 건물, 다중 경로 반사, 대기 전파, RF 간섭, 안테나 방사 패턴은 물리적으로 계산하지 않습니다. 가우시안 오차, 가림 스위치, 침수 규칙은 간단한 시험 모델이며 실측 RF 성능 모델이 아닙니다.
BlueROV2 장비 구분
선택 위성 수신기는 시뮬레이션 탑재물입니다. 실제 BlueROV2의 기본 장비나 제조사의 GNSS 장착 키트를 설명하는 것은 아닙니다. 실제 하드웨어 구성은 BlueROV2 공식 카탈로그에서 확인하세요.
Water Linked Underwater GPS 통합 안내는 수상 지리 기준과 수중 음향 측위를 결합합니다. Water Linked는 UGPS와 DVL의 결합도 설명합니다. 각각 별도 장치와 측정 경로입니다. 이 위성 수신기는 음향식 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 상실·입력 지연·리셋·새 구간은 추정값을 무효화합니다. Ground Control은 추정 좌표를 제거하고 실패를 표시합니다. DVL 전달이 복구돼도 초기 기준점을 재사용하지 않으므로 시뮬레이션을 다시 시작해야 합니다. 수면에서 새로운 GNSS fix를 얻으면 지도 위치를 다시 제공할 수 있지만 수중 추정기가 자동 재초기화되지는 않습니다.
ArduPilot·QGC와 교체형 제공자
최신 GNSS는 GPS_INPUT과 EKF 소스 1로 전달합니다. 수용된 외부 위치·속도는 MAVROS vision pose/speed 인터페이스와 EKF 소스 2로 전달합니다. WAM-V 기본 GNSS 세션은 사용하지 않는 visual-odometry 입력을 켜지 않습니다. 외부 제공자를 명시적으로 선택하면 두 기체 모두 같은 검증 경로를 사용합니다.
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 유효성은 수신기가 결정합니다. 적용 범위와 신뢰 조건은 설치형 작업공간에서 제어을 참고하세요. 제공자 실행만으로 지리 정확도나 임무 준비가 보장되지는 않습니다.