Characterizing Refraction-Induced Ranging Bias in Underwater Collaborative Localization

Through-water photogrammetry from UAV imagery enables shallow-water bathymetry, but refraction at the air--water interface violates the straight-ray assumption of Structure-from-Motion and causes systematic depth bias. We present BathyFacto, a refraction-aware two-media extension of Nerfacto in Nerfstudio for metrically consistent underwater point clouds on simulated data. BathyFacto uses a shared hash-grid density field with a medium-conditioned color head and traces each camera ray as two segments: a straight air segment to a planar water surface and a refracted water segment computed using Snell's law and known refractive indices. A single proposal-network sampler operates on a virtual straight ray, while a kinked density wrapper corrects water-segment positions before density evaluation. Our pipeline converts photogrammetric reconstructions to Nerfstudio format, estimates the water plane from boundary markers, provides per-pixel medium masks, and supports refraction-corrected point-cloud export with reversible transforms to world and global frames. On a simulated scene with ground truth, BathyFacto achieves a Cloud-to-Mesh signed median deviation of $-0.001$,m and 85.7,% completeness at 0.2,m tolerance in the absolute global frame without rigid-body alignment. This compares with $+1.370$,m / 11.6,% for Nerfacto and $+1.409$,m / 9.9,% for BathyFacto without refraction. Even after a naive refractive-index depth correction, both baselines remain offset by approximately 0.4,m. Unlike a refraction-corrected Multi-View Stereo reference, which is reliable mainly for near-nadir views, BathyFacto recovers consistent geometry across the full range of camera incidence angles.

Autonomous underwater navigation typically relies on complex and expensive multi-modal sensor suites designed to prioritize global Simultaneous Localization and Mapping (SLAM) accuracy. However, local reactive behaviors such as coarse navigation and obstacle avoidance require only local consistency---a capability that should be feasible using only a Forward-Looking Sonar (FLS), yet remains largely unaddressed, leaving a critical gap in FLS-only local SLAM. Moreover, existing acoustic SLAM frameworks predominantly rely on sparse feature extraction methods that discard substantial portions of the already information-sparse acoustic returns. To overcome these limitations, this work introduces a dense direct registration approach that aligns full acoustic intensity scans to a recursively updated local map. Real-time execution is achieved via an Inverse Compositional Gauss-Newton optimization strategy that minimizes computational overhead. Experimental evaluations show that this dense method yields significant improvements on translation error compared to sparse keypoint baselines, maintaining stable sub-meter tracking precision over wide displacement gaps. Moreover, this approach delivers odometry performance comparable to multi-sensor fusion pipelines (FLS, DVL, and IMU), bypassing expensive payload dependencies in feature-rich environments. We validate real-world applicability through AUV field trials, running the full local SLAM approach onboard an embedded, resource-constrained computer.

Reliable real-time 3D localization is essential for multi-UAV navigation, collision avoidance, and coordinated flight, yet onboard estimates can degrade under GNSS multipath, non-line-of-sight reception, vertical drift, and intentional interference. This paper presents a decentralized, lightweight 3D position-refinement layer that improves robustness by fusing each Unmanned Aerial Vehicle (UAV)'s local estimate with neighbor-shared state summaries and inter-UAV range or proximity constraints. The method performs uncertainty-aware neighborhood fusion by weighting each UAV's prior according to its reported covariance and weighting neighbor constraints according to link quality, ranging uncertainty, and a learned trust score. To support practical deployment, the framework explicitly handles cold start and temporary localization loss by inflating or substituting weak priors, allowing trusted neighborhood constraints to bootstrap and stabilize estimates until absolute sensing recovers. To mitigate the impact of faulty or malicious participants, each UAV applies a local range-consistency check, smoothed over time, to down-weight or exclude neighbors whose reported positions are incompatible with observed inter-UAV distances. Simulation experiments with 10 UAVs in a 3D volume show that the proposed refinement substantially reduces mean localization error during cold start, remains competitive after local estimators stabilize, and maintains lower error as the fraction of malicious nodes increases compared with fusion without trust. These results suggest that the approach can serve as a practical resilience layer for swarm operation in challenging environments.