CS Paper Radar

Moving Horizon Estimation for Underwater Target Tracking Based on Time-Difference-of-Arrival Measurements

Anton Tolstonogov, David Cabecinhas, Pedro Batista, Antonio Pascoal

eess.SY eess.SP ·submitted 2026-08-17 02:31 UTC · v1
published

Abstract

There has been a flurry of activity in the development of robotic systems to localize and track underwater man-made or natural targets based on sparse acoustic data. Compelling examples include the development of surface tracking systems to aid in the navigation of groups of underwater vehicles performing environmental monitoring missions or to study the motion patterns of large underwater fauna. With current technology, the latter case can only be tackled using Time-Difference-of-Arrival (TDoA) techniques. Recent progress in nonlinear state estimation indicates that optimization-based methods may overcome the limitations of classical recursive filtering. However, achieving reliable estimator performance in the case of nonlinear target dynamics and sparse measurements remains a key challenge. In this paper, we study a Moving Horizon Estimation (MHE) approach to TDoA-based underwater target tracking. Through a 2D simulation environment capturing typical marine conditions, we show that the MHE-based estimator maintains reliable tracking in the considered scenarios even when the classical EKF becomes unreliable. The results highlight that multi-step trajectory coupling and physically consistent constraints, which are key advantages of the MHE approach, significantly enhance estimator robustness. It is shown that the MHE approach offers promise as a practical and scalable building block for future multi-agent tracking systems based on TDoA measurements operating in real underwater missions.

Comment
6 pages, 2 figures. This work has been accepted to IFAC WC 2026 for publication

Closest papers

Nearest neighbours by meaning across the whole index.

A Computationally Efficient Likelihood Approximation for Target Tracking in Time-Varying Multipath Channels

eess.SP ·2026-08-20 ·Ashwani Koul, Gustaf Hendeby, Isaac Skog
similarity 0.68
Abstract

Active sonar target tracking in shallow-water environments is challenging when weak target echoes are embedded in a time-varying background containing structured multipath components. Conventional detect-before-track methods rely on thresholded detections, which may discard weak target evidence or generate false tracks from multipath-induced detections. At low signal-to-noise ratios, track-before-detect filtering can improve tracking performance by exploiting weak target information directly from raw sensor measurements, but directly accounting for the time-varying background leads to a joint target--background inference problem, which is computationally demanding. To address this, this paper develops a physics-motivated and computationally efficient approximation of the raw sensor measurement likelihood for Bernoulli track-before-detect filtering. The multipath components in the background are modeled in the raw sensor measurement domain and recursively tracked using an extended Kalman filter. By neglecting the posterior dependence between the target and background state, the predicted background statistics are used to construct approximate target-present and target-absent likelihoods for the Bernoulli filter. Evaluations using measurements generated from the statistical model and BELLHOP show improved target-confirmation and localization performance over constant-false-alarm-rate-based tracking. These results indicate that explicitly accounting for the background through a computationally tractable approximate likelihood can exploit weak target information without requiring full joint target--background inference.

0.20

On Distributed Sensing and Adversarial Localization of Narrowband Acoustic Sources for Offshore Data Center Monitoring

cs.RO ·2026-10-25 ·Adnan Abdullah, David Blow, Harsha Gundala Sureshbabu, Dongyoon Joung, Sara Rampazzi +1 more
similarity 0.67
Abstract · Technical report, 19 pages, 11 figures

This report investigates an acoustic surveillance framework for localizing and tracking narrowband adversarial acoustic sources that threaten offshore data centers. Unlike conventional sound source localization (SSL) methods that rely on broadband signals and compact receiver arrays, the considered scenario involves narrowband emissions and sparse sensors. In such scenarios, the observed time-difference-of-arrival (TDOA) measurements are aliased and produce an ambiguous solution space, rendering conventional localization methods ineffective. To address this challenge, we integrate a mobile receiver that temporarily forms anchor pairs with selected fixed receivers, constraining the feasible solution space. The proposed two-stage pipeline first estimates the initial source position using anchor constraints, then initializes a particle filter that jointly tracks source position and velocity using one live anchor measurement and quality-adaptive fixed-pair measurements. We evaluate the proposed method through Monte Carlo acoustic simulations, ROS-Gazebo robotic demonstrations, and open-water field experiments. Our framework achieves a localization success rate of 91% in simulation, while 9 of 10 field trials show tracking error below 2m under receiver-position uncertainty and noisy sensing conditions. These findings demonstrate the feasibility of passive acoustic surveillance for protecting large-scale infrastructure against acoustic threats.

0.27

Continuous-Time Estimation-Aware Optimal Control of Mobile Sensors for Target Tracking

eess.SY ·2026-10-05 ·Michael States, Sharveshwaran Umashankar, Minsen Yuan, Yue Yu
similarity 0.64
Abstract · 7 pages, 3 figures, submitted to American Control Conference (ACC) 2027

Target tracking is the problem of estimating the state of a target system using measurements collected (oftentimes) by mobile sensors. Trajectory optimization for mobile sensors must account not only for dynamical and operational constraints, but also for uncertainty in estimating the target system's state. We propose an estimation-aware optimal control method for target tracking that accounts for the nonlinear dynamics of both the mobile sensor and target system, the nonlinear covariance dynamics in extended Kalman filtering, and nonlinear measurement models. Furthermore, it ensures constraints on the mobile sensor are satisfied in continuous time (within numerical precision). In numerical simulations, the proposed method achieves estimation-aware target tracking while satisfying the mobile-sensor constraints in continuous time, even under sparse time discretization.

0.23

SVIn+: Multi-Modal Framework for Robust Underwater State Estimation using 3D Sonar, Visual-Inertial, Water-Pressure, and DVL

cs.RO ·2026-10-27 ·Chinmay Burgul, Xiaoming Zhao, Yewei Huang, Michalis Chatzispyrou, Marios Xanthidis +2 more
publishedcode/data similarity 0.62
Abstract · IROS 2026

As expansion and scalability in underwater oper- ations becomes more important and challenging, autonomous underwater vehicles (AUVs) become more relevant and the necessity for reliable autonomy more critical. A fundamental challenge in any autonomous underwater operation, from control to safe navigation and mapping, is state estimation; a notorious hard problem to address, especially in low visibility conditions. In this paper, we tackle this problem, by presenting SVIn+, a multi-sensor framework for robust state estimation of AUVs equipped with an IMU, cameras, a water-pressure sensor, a Doppler Velocity Log (DVL), and a compact 3D sonar. This framework extends an established open-source state-of-the-art visual-inertial SLAM, SVIn, by integrating water-pressure and DVL measurements into a tightly-coupled nonlinear optimiza- tion formulation resulting in improved estimates. To leverage the structural information of recently available 3D acoustic sonars while maintaining computational efficiency, we introduce a hierarchical architecture that incorporates estimates from a decoupled front-end via KISS-ICP, treated as relative pose factors within the factor graph. The proposed framework is validated through field deployments in a shipwreck and coral reef, demonstrating drift mitigation and global consistency. To support further research in underwater multi-modal fusion, the code and the datasets can be found on project website https://cmburgul.github.io/projects/svin+/ https://dartmouthrobotics.github.io/svin-plus

0.50

A bioinspired internal model-based online estimator for planar pursuit

cs.RO eess.SY ·2026-09-21 ·Tengyue Liu, Xincheng Li, Sofia Morales Ferreira, Kevin Galloway, Udit Halder
similarity 0.62
Abstract

Bioinspired feedback controls for pursuit, tracking, and collective motion are often expressed in terms of the relative configuration between interacting agents. In practice, however, onboard sensors may not directly provide all quantities required for feedback control, necessitating estimation of unobserved quantities. This paper develops a bioinspired internal model-based estimator for reconstructing those quantities from partial sensory observations and known self-motion. State reconstruction is posed as an optimization problem that treats the relative kinematics as constraints and minimizes the disagreement between the internal model outputs and measurements from onboard sensors. Pontryagin's Maximum Principle is used to derive the necessary optimality conditions. A forward-backward algorithm is used to provide a numerical solution and a moving horizon formulation is employed for online implementation. The estimator is evaluated numerically against classical state estimators. Real-time implementation of the proposed framework on robotic hardware is demonstrated through two pursuit strategies.

0.19

An Adaptive Fixed-Time Line-of-Sight Guidance Scheme for 3D Path Following of Underwater Vehicles: Theory and Experiment

cs.RO eess.SY ·2026-09-13 ·Hanzhi Yang, Jalil Chavez-Galaviz, Nina Mahmoudian
similarity 0.62
Abstract

Reliable path tracking is crucial for autonomous underwater vehicles (AUVs) operating in dynamic and uncertain marine environments. However, traditional line-of-sight (LOS) guidance methods rely on asymptotic convergence, resulting in slow disturbance recovery and unpredictable tracking performance. Existing robust control methods typically require modifications to the underlying vehicle controller, limiting their practical application on commercial AUV platforms. This paper proposes a robust fixed-time adaptive LOS guidance framework for 3D path tracking for AUVs. By combining fixed-time stability theory with LOS guidance, this method guarantees path tracking convergence within a preset time range, with the convergence time independent of initial conditions. Furthermore, a fixed-time adaptive estimator is developed to rapidly compensate for time-varying sideslip disturbances caused by ocean currents. A time-varying look-ahead mechanism is also introduced to improve tracking performance on curved paths. Lyapunov analysis proves the fixed-time stability of the proposed framework, and numerical simulations and physical experiments demonstrate that, compared to state-of-the-art adaptive LOS methods, this framework exhibits superior tracking accuracy, convergence speed, and anti-interference capability. In simulation, the time-varying look-ahead variant reduced cross-track and vertical-track RMSE by 69.37\% and 67.46\%, respectively, during curved-path tracking. In field experiments with an Iver 3 AUV, the proposed fixed-time guidance reduced average tracking error by 56.35\% in straight-path evaluation and 27.59\% in curved-path evaluation compared with conventional adaptive LOS guidance.The proposed method provides a practical guidance-level solution for achieving reliable autonomous navigation of AUVs in complex marine environments.

0.19

Underwater Visual Target Tracking with Target-Specific Depth Estimation and Adaptive Model-Fusion Predictive Control

cs.RO ·2026-09-17 ·Yuheng Zhou, Haiyang Cheng, Yanqi Feng, Pangkit Fong, Mei Xuan Lee +3 more
similarity 0.61
Abstract · 9 pages,8 figures

Vision-based underwater target tracking is challenged by unreliable depth measurements and unknown target motion. This paper proposes a stereo visual-servoing framework for an autonomous underwater vehicle (AUV). For perception, the framework derives a stable 3D relative state from stereo images through target-specific depth extraction and Kalman filtering. It constructs a target-depth mask from color, disparity, and temporal cues to select reliable target pixels, and then filters the resulting depth measurement and detected image center separately. For control, the framework decouples yaw regulation from translational control, avoiding computationally expensive coupled multi-DOF optimization and enabling real-time translational MPC. The translational controller employs adaptive model-fusion predictive control, combining constant-velocity and zero-velocity target models to accommodate different target-motion patterns. It updates the model weights using historical prediction errors and computes translational commands subject to actuation, following-distance, and field-of-view constraints. Through simulations and real-world experiments, we validate the effectiveness of the proposed framework and show it has better performance than existing frameworks.

0.27

Odometry-Aided Real-Time Mapping for Underwater Robots Using Forward-Looking Sonar

cs.RO ·2026-09-21 ·Siyuan Du, Kanzhong Yao, Youdong Wang, Yingqi Liu, Qingwen Liu +3 more
similarity 0.60
Abstract · This work has been submitted to IEEE for possible publication

Reliable perception is essential for underwater vehicles operating in complex environments, where light attenuation and scattering often degrade visibility and compromise optical sensing. Forward-looking sonar (FLS) offers an alternative by providing high-frame-rate acoustic imaging under poor optical conditions. However, real-time FLS mapping remains challenging due to unresolved target elevation, spatially non-uniform noise, and fragmented target boundaries, which hinder feature extraction and introduce geometric ambiguity during projection. To address these challenges, we propose a cascaded feature reconstruction pipeline combining fast Fourier transform (FFT)-based denoising, fast multiscale constant false alarm rate (MCFAR) detection, and gradient-adaptive boundary connection to extract geometric features from degraded sonar images with low latency. We integrate attitude-aware geometric projection with incremental occupancy accumulation to construct a depth-referenced 2.5D map for local mapping in confined underwater environments. The sonar's vertical position is referenced to an external sensor, while target elevation is assigned under an explicit geometric assumption rather than measured directly by FLS. Experiments in a 3 m X 5 m pool demonstrate centimeter-scale planar mapping accuracy, with a root-mean-square error (RMSE) below 3 cm across three sequences and an average processing time of 42.4 ms per frame.

0.11