Cooperative Localization

Connected Autonomous Navigation

COOPERATIVE LOCALIZATION

자율주행 시스템은 서로의 정보로 위치를 어떻게 더 정확하게 알 수 있을까?

혼자 추정하는 위치보다, 함께 관측하고 함께 보정하는 위치가 더 견고할 수 있습니다. 센서 융합, 상대 측정, 통신 제약을 중심으로 Cooperative Localization의 흐름을 살펴봅니다.

Explore Technology
VehicleAVehicleBVehicleC
01

What is Localization?

“자율주행 시스템은 자신의 위치를 어떻게 알까?”

Localization은 자율주행 시스템이 현재 위치와 자세를 추정하는 기술입니다. GNSS, IMU, LiDAR, Camera 같은 센서로 전역 좌표, 움직임, 주변 구조를 해석합니다.

각 센서는 장점과 한계가 다릅니다. GNSS는 전역 위치를 주지만 차단과 multipath에 취약하고, IMU는 신호 없이 움직임을 추적하지만 drift가 누적됩니다. LiDAR와 Camera도 날씨·조명·주변 구조의 영향을 받습니다. 그래서 실제 시스템은 Sensor Fusion을 사용하며, 여러 센서가 동시에 불리하거나 정보가 부족할 때 주변 차량·로봇의 관측을 함께 쓰는 Cooperative Localization으로 확장됩니다.

02

Why Isn't Localization Perfect?

현실에서는 신호 차단, 센서 노이즈, 누적 오차 때문에 추정 위치가 실제 위치에서 벗어날 수 있습니다.

01

GNSS Signal Loss

터널, 도심 협곡, 수중에서는 위성 신호가 약해지거나 사라집니다.

02

Sensor Noise

모든 측정에는 환경과 센서 자체에서 비롯된 오차가 포함됩니다.

03

Dead Reckoning Drift

움직임을 누적 계산할수록 작은 오차가 시간이 지나며 커집니다.

04

Tunnel / Indoor Environment

전역 신호 없이 주변 관측만으로 위치를 추정해야 하는 공간입니다.

05

Underwater Environment

수중에서는 GNSS를 직접 사용할 수 없어 다른 측정 정보가 중요합니다.

Actual
Estimated

What if vehicles could help each other?

03

Cooperative Localization

Cooperative Localization은 여러 시스템이 자신의 상태와 다른 시스템을 관측한 Relative Measurement를 함께 사용해 위치 추정을 개선합니다. 단순히 GPS 좌표를 서로 알려주는 방식이 아닙니다.

Vehicle APositionVehicle BVelocityVehicle CRanging
Absolute PositionVelocityHeadingRelative DistanceRelative BearingSensor DataUncertainty
04

What Information Is Shared?

협력 위치추정에서는 어떤 정보를 서로 교환할까?

01

Absolute / State Information

각 시스템이 추정한 Position, Velocity, Heading 같은 상태 정보를 공유합니다.

02

Relative Distance

UWB, LiDAR, RF ranging을 사용하고 수중에서는 Acoustic Ranging으로 거리를 측정합니다.

03

Relative Bearing

Camera나 LiDAR로 다른 차량 또는 로봇이 어느 방향에 있는지 추정합니다.

04

Sensor / Uncertainty Information

측정값뿐 아니라 현재 추정이 얼마나 불확실한지도 활용합니다.

Packet Example

Vehicle A → Vehicle B

Position    (35.173, 129.075)
Velocity    12.4 m/s
Heading     87°
Range      18.6 m
Timestamp   14:22:31.042
실제 실험 데이터가 아닌 개념 이해를 위한 예시입니다.
05

How Does It Work?

Estimate

GNSS, IMU, LiDAR, Camera, DVL 등 자신의 센서로 현재 위치와 상태를 먼저 추정합니다.

GNSS + IMU + Sensor DataInitial Position Estimate

Communicate

주변 시스템과 위치, 속도, heading, 상대 거리 등의 정보를 교환합니다.

Vehicle A↔ CommunicationVehicle B

Cooperate & Update

예측 위치와 상대 측정값을 비교하고 State Estimation으로 위치를 다시 보정합니다.

Predict↓ Relative Measurement↓ Data Fusion↓ Corrected PositionState Estimation
EKFUKFParticle FilterFactor Graph

다른 차량의 위치를 그대로 믿는 것이 아니라, 추가적인 constraint로 사용해 내 위치 추정을 보정합니다.

06

Independent vs Cooperative

슬라이더를 움직여 독립 추정과 협력 추정의 차이를 비교해 보세요.

Independent Localization

자신의 센서만 사용합니다.

Cooperative Localization

이웃 시스템의 관측을 함께 사용합니다.

ComparisonIndependentCooperative
Information SourceOwn sensors onlyOwn sensors + neighbors
Relative MeasurementLimitedDistance / Bearing
GNSS FailureError may growNeighbor observations
CommunicationNot requiredRequired
Main ChallengeAccumulated driftDelay / Packet loss / overhead
07

Try Cooperative Localization

Illustrative Example: 본 시뮬레이션의 수치는 실제 논문 실험 결과가 아니라 개념 이해를 위한 예시입니다.

AUV A
AUV B
AUV C
08

Case Study — Autonomous Underwater Vehicle

“GPS가 닿지 않는 바닷속에서는 어떻게 위치를 찾을까?”

AUV는 수중에서 GNSS를 직접 이용하기 어렵기 때문에 INS, DVL, Acoustic Positioning 등을 사용합니다. 다른 AUV와 상대 측정과 항법 정보를 공유하는 Cooperative Localization이 특히 중요한 사례입니다.

Satellite / GNSS
Water Surface
×
AUV

GNSS 신호는 수중까지 안정적으로 전달되기 어렵습니다.

Why Underwater?

자동차·드론·로봇에도 쓰이지만, GNSS를 직접 사용할 수 없는 수중 환경에서 필요성이 더욱 커집니다.

09

How Does an AUV Know Where It Is?

GPS가 없는 수중에서 AUV는 어떤 센서를 사용할까?

INS

INS

IMU와 방향 센서로 움직임을 누적 계산합니다. 외부 신호 없이 쓸 수 있지만 drift가 누적됩니다.

DVL

DVL

Doppler 효과로 해저면 또는 수괴에 대한 속도를 측정해 INS drift를 줄입니다.

DEPTH

Depth Sensor

수압으로 깊이를 측정해 수중 3차원 위치 추정에 depth 정보를 제공합니다.

ACOUSTIC

Acoustic Positioning / Ranging

전달 시간을 이용해 다른 AUV, beacon, surface vehicle과의 거리를 측정합니다.

10

Acoustic Cooperative Localization

Acoustic Ranging은 통신 수단이면서 음향 신호의 전달 시간으로 다른 AUV까지의 거리를 측정하는 Relative Measurement입니다.

AUV A
AUV B
AUV Navigation DataAcoustic RangingOther AUV InformationCooperative LocalizationImproved Position Estimate
11

Why Acoustic Communication?

왜 수중에서는 Wi-Fi 대신 음향 통신을 사용할까?

RF 신호는 물속에서 빠르게 감쇠합니다. AUV와 수중 센서 네트워크는 Acoustic Modem으로 데이터를 교환하고 signal propagation time으로 상대 거리도 측정할 수 있습니다.

01

Long Propagation Delay

음파는 전파보다 느려 통신 지연이 큽니다.

02

Limited Bandwidth

전송할 수 있는 데이터 양이 제한적입니다.

03

Multipath

반사로 신호가 여러 경로로 도착합니다.

04

Packet Loss / Noise

잡음과 채널 변화로 패킷 손실과 ranging 오차가 생깁니다.

12

Cooperative Localization Architecture

수중 팀이 기준 위치와 상대 측정을 운영하는 대표적인 구조입니다.

01 · Surface-Aided

Surface-Aided

Surface Ship↓ acousticAUV A   AUV B

GNSS가 가능한 surface vehicle 또는 buoy가 기준 위치를 제공합니다.

02 · Leader–Follower

Leader–Follower

Leader → Follower → Follower

기준 위치를 가진 Leader가 Follower의 추정을 지원합니다.

03 · Mesh Cooperation

Mesh Cooperation

AUV ↔ AUV ↔ AUV

여러 AUV가 상대 거리와 상태 정보를 교환하며 분산 보정합니다.

04 · Periodic Surfacing

Periodic Surfacing

AUV ↑ surface → GNSS → dive

일부 AUV가 수면에서 GNSS를 얻어 팀에 공유합니다.

13

Research Spotlight

The International Journal of Robotics Research · 2009

Cooperative Localization for Autonomous Underwater Vehicles

Alexander Bahr, John J. Leonard, Maurice F. Fallon
Volume 28, Issue 6, Pages 714–728
DOI: 10.1177/0278364908100561

이동하는 AUV들이 acoustic ranging과 dead reckoning 정보를 공유해 서로의 위치 추정을 개선할 수 있음을 보여주는 대표적인 연구입니다.

#AUV#CooperativeLocalization#AcousticRanging#AutonomousNavigation
View Research
14

Where Can It Be Used?

15

Benefits & Challenges

BENEFITS

  • +이웃 시스템의 추가적인 constraint를 얻습니다.
  • +GNSS-denied 환경에서 위치를 보조합니다.
  • +누적 drift와 다중 에이전트 간 불일치를 줄입니다.
  • +자동차, 드론, 로봇, AUV에 적용할 수 있습니다.

CHALLENGES

  • !Communication Delay: 오래된 위치 정보를 받을 수 있습니다.
  • !Packet Loss: 협력 정보가 일시적으로 사라질 수 있습니다.
  • !Communication Overhead / Scalability: 노드가 많을수록 통신량이 증가합니다.
  • !Measurement Reliability: 거리·방위에 noise와 outlier가 있습니다.
  • !Synchronization: 서로 다른 시각의 데이터를 합칠 때 오차가 생깁니다.
  • !Security / Trust: 잘못된 정보가 전체 추정에 영향을 줄 수 있습니다.
More Shared Information ≠ Always Better

더 많은 정보는 정확도를 높일 수 있지만 bandwidth, latency, computation cost도 증가합니다. Localization Accuracy와 Communication Cost의 균형이 중요합니다.

16

From Sensors to a Better Estimate

ALONE, A VEHICLE ESTIMATES.

TOGETHER, VEHICLES COOPERATE.

COOPERATIVE LOCALIZATION

각 시스템은 자신의 센서만 바라보는 대신 서로의 관측과 불확실성을 함께 사용해 더 견고한 위치 추정을 만들어 갑니다.Back to Top
11

Paper-Based Cooperative Localization

How Cooperative AUV Localization Actually Works

Bahr, Leonard & Fallon (2009)의 cooperative acoustic navigation 구조를 단순화한 개념 시각화입니다. 실제 논문 실험 결과를 재현하지 않으며, 모든 수치는 Illustrative Example입니다.

Conceptual Visualization

Dead Reckoning: INS / DVL 기반 추정이 시작됩니다.

CNA AKnown PositionMobile Navigation AidCNA BKnown PositionMobile Navigation AidDead-Reckoning EstimateCorrected PositionTarget AUVAcoustic Ping · ΔtRange rA: 12.4 m ± εAcoustic Ping · ΔtRange rB: 18.7 m ± ε
Actual trajectoryDead-Reckoning estimateRange-only constraintCandidate trajectory
Acoustic Time-of-Flightdistance ≈ sound speed × propagation time

Acoustic Modem이 작은 navigation message를 전달하고, 전달 시간 Δt로 CNA와 Target AUV 사이의 상대 거리를 계산합니다.

Trajectory Hypothesis Evaluation
Candidate AHigh
Candidate BLow
Candidate CMedium

Trajectory 전체가 Dead-Reckoning과 range constraint에 얼마나 부합하는지 residual/cost를 비교하는 개념입니다.

DEAD RECKONING + ACOUSTIC RANGE + MOBILE NAVIGATION AID → COOPERATIVE LOCALIZATIONResearch Note · Based on the cooperative acoustic navigation concept described by Bahr, Leonard & Fallon (2009), Cooperative Localization for Autonomous Underwater Vehicles, IJRR. DOI: 10.1177/0278364908100561
LAB

Interactive Cooperative Localization Lab

직접 AUV를 움직이고, acoustic range constraint로 위치를 보정해 보세요.

WASD·방향키·화면 버튼으로 Target AUV를 이동하고 CNA를 드래그할 수 있습니다. 이 데모는 simplified educational estimator이며 실제 논문 실험 결과를 재현하지 않습니다.

Move AUV
Acoustic Ranging & Update
Advanced Settings

Conceptual Simulation Value

CNA ADRAG · KNOWN NAV STATECNA BDRAG · KNOWN NAV STATEActual AUVDR EstimateCooperative Estimate
Range circle = 가능한 거리 제약, 절대 위치가 아님Move the AUV to accumulate dead-reckoning drift.

Navigation aid geometry affects how strongly range constraints determine position. CNA를 드래그한 뒤 다시 PING하여 geometry 변화를 비교해 보세요.

RESEARCH NOTEThis simplified educational demonstration is inspired by cooperative acoustic navigation concepts in Bahr, Leonard & Fallon, “Cooperative Localization for Autonomous Underwater Vehicles,” IJRR, 2009. Dead Reckoning + Acoustic Range-Only Measurements + Mobile Navigation Aid Information + Constraint / Cost Evaluation → Cooperative Position Estimate. Numerical values are generated for visualization and are not experimental results from the paper.