CS Paper Radar

Trajectory CPHD Filtering for Multiple Turning Vehicles With Decoupled Orientation and Axial-Scale Estimation

Yunhe Cao, Yu Wan, Yuanhao Cheng, Tat-Soon Yeo, Jie Fu

eess.SP ·submitted 2026-09-15 14:21 UTC · v1

Abstract

Reliable estimation of vehicle orientation, centroid, and footprint is important for representing road-user occupancy during vehicle turns at intersections and other common road maneuvers. During a turn, the vehicle orientation and direction of motion may differ, and coupling the orientation with the axial scales can degrade both orientation and extent estimates. This paper proposes a trajectory cardinalized probability hypothesis density filter with a Decoupled Orientation and Axial-Scale Estimation (DOAM) model for multiple-vehicle tracking. The model represents the kinematic, orientation, and squared semi-axis-length states separately within each trajectory component, reducing the mutual interference between orientation variation and scale estimation without introducing an additional interacting multiple-model structure. A structured coordinate-ascent variational inference recursion jointly updates these state sequences and the measurement-source variables. The trajectory-component likelihood and weight update associated with the decoupled representation are derived while retaining the standard cardinality recursion. A fixed-lag trajectory implementation further uses current measurements to correct historical states within the smoothing window. Evaluation with signalized-intersection simulations and real onboard LiDAR measurements shows improved estimation of vehicle orientation, centroid, and extent, particularly during turns. The resulting vehicle-state and footprint estimates provide information for road-user occupancy perception and subsequent collision-risk assessment and motion planning.

Comment
32 pages in total, including a 15-page main article and 17 pages of supplementary material; 7 figures and 5 tables in the main article

Closest papers

Nearest neighbours by meaning across the whole index.

Observability Analysis of Joint Steering and Extrinsic Calibration

cs.RO ·2026-08-28 ·Subodh Mishra
similarity 0.60
Abstract

This technical report studies the local weak observability of a planar bicycle-model vehicle when vehicle pose, planar LiDAR extrinsic calibration, and steering-angle bias are estimated jointly. A Lie-derivative-based nonlinear observability analysis is used to examine stationary, straight-line, constant-curvature, and combined straight-plus-arc motion. The resulting observability matrices and nullspaces describe how pose, LiDAR translation and yaw offsets, and steering bias become coupled under different motion primitives. Stationary motion and individual motion primitives retain unobservable directions, whereas the combination of straight and curved motion removes the identified degeneracies and yields full local weak observability of the seven-state system. The analysis provides a theoretical basis for selecting calibration trajectories that sufficiently excite both steering and sensor-extrinsic parameters.

0.24

IMU-Centric Moving Horizon Estimation for Lateral Dynamics Estimation Across Vehicles and Grip Conditions

eess.SY cs.RO ·2026-09-09 ·Seuffo Akouan ha Ngoune, Alessandro Toschi, Paolo Burgio, Marko Bertogna
publishedcode/data similarity 0.58
Abstract · Accepted at the 29th IEEE International Conference on Intelligent Transportation Systems (ITSC 2026). 8 pages, 6 figures

Accurate estimation of lateral vehicle dynamics near the adhesion limit is important for stability control and high-performance driving, but lateral velocity is rarely measured directly because sensors such as optical sensors are costly. This paper presents an inertial measurement unit (IMU)-centric Moving Horizon Estimation framework that reconstructs lateral velocity using standard onboard signals, without relying on exteroceptive odometry or detailed tire-parameter tuning. Experimental validation on human-driven sports cars and an autonomous open-wheel race car across tracks, maneuvers, and conditions demonstrates accurate and robust lateral velocity and lateral acceleration estimates. The proposed framework is available at https://github.com/Aseuffo/IMU-Centric-MHE

0.48

Online Joint Calibration of Steering Offset and Planar LiDAR Extrinsics for Wheeled Mobile Robots

cs.RO ·2026-08-27 ·Subodh Mishra, Arindam Dhar, Suprotim Majumdar, Naveen Arulselvan
similarity 0.57
Abstract

Accurate steering sensing and LiDAR-to-vehicle extrinsics are crucial for reliable path tracking in warehouse mobile robots (WMRs); miscalibration often leads to snaking, weaving, and elevated cross-track error (CTE). In practice, steering ``zero'' is commonly set manually (e.g., eyeballing straightness via a PS4 joystick), while LiDAR extrinsics are assumed from CAD and may drift after maintenance. Such static, manual procedures frequently cause miscalibration in safety-critical environments. This paper presents an Extended Kalman Filter (EKF)--based method for online estimation of steering offset and planar LiDAR extrinsics within a bicycle-kinematics model, providing a principled alternative to manual calibration. Experiments on real datasets show that correcting steering offset reduces CTE substantially, validating the effectiveness of the proposed approach.

0.29

EgoNeMo: Transferable Map of Pedestrian Dynamics via Egocentric LiDAR Scan

cs.LG cs.RO ·2026-09-05 ·Azusa Sawada, Allan Wang, Hideo Saito, Aaron Steinfeld
similarity 0.57
Abstract · 16 pages, 9 figures

This paper proposes a transferable Map of Dynamics (MoD) framework that generalizes to unknown environments using only egocentric 3D LiDAR point clouds to overcome the long-standing limitation of traditional MoD methods. While MoDs are essential for encoding human motion characteristics to enable accurate pedestrian trajectory prediction or safe robot navigation, traditional approaches suffer from site-specificity, requiring exhaustive trajectory accumulation at every new location. Extending recent advances in neural implicit modeling, our framework trains a continuous, LiDAR-based MoD estimator across diverse environments. To mitigate the inherent sparsity and temporal bias of real-world trajectory data, we introduce a position-balanced sampling strategy and a multi-task learning architecture that jointly predicts motion distributions and a spatial frequency score map. The latter is further augmented by visibility-aware losses to compensate for incomplete observation data. Comprehensive experiments demonstrate that our method effectively reconstructs underlying motion maps even in unknown locations from a single instantaneous LiDAR scan, despite highly sparse training data. Finally, we show that our improvements enhance the reliability of downstream trajectory prediction.

0.20

Online Geometric Consistency Assessment of LiDAR Measurements via Recursive Bayesian Comparison

cs.RO eess.SY ·2026-11-07 ·Mingqiao Han, Qigeng Duan, Xuchen Liu, Jinqiang Cui, Xi Chen +1 more
similarity 0.57
Abstract

LiDAR-based localization and mapping systems produce registered point clouds that serve as geometric measurements for downstream estimation and navigation. Registration errors introduce duplicated surfaces and structural deformation into these measurements. In the absence of an independent reference, online assessment relies on geometry accumulated from earlier measurements. Such assessment requires tolerance to sampling variation and an accumulation process in which observations enter the history only after evaluation. We therefore formulate a recursive Bayesian comparison that couples geometric assessment with history maintenance. A Normal-Inverse-Wishart model represents historical voxel geometry and its uncertainty, while a weak isotropic reference adapts to current sampling. Comparing the marginal predictive support of the same current points under both models yields Normalized Drift Evidence (NDE). Assessment precedes assimilation: positive NDE triggers an alarm and preserves the preceding historical state; otherwise, the current observations update the history. Across 14 real-world sequences totaling approximately 73 min from four platform types, alarms identified all nine corrupted sequences and were absent from all five consistent sequences. In four representative scenarios with event references, first alarms occurred within 0.9 s of the reference times, with no preceding alarms. Cross-backend evaluation demonstrates consistent responses to reconstructed geometry. Ablation and controlled perturbation results establish the roles of uncertainty modeling, recursive history, displacement, and geometric support. Mean processing time is 4.2--6.1 ms per update at 1 Hz. In ten UAV trials, alarms initiated odometry isolation, landing, relocalization, and mission continuation.

0.27

Extending Ground-Constraint LiDAR-IMU Calibration to Tilted Surfaces in a Continuous-Time Framework

cs.RO ·2026-08-25 ·Vassili Korotkine, Pierre Chamoun, Mohammed Ayman Shalaby, James Richard Forbes
code/data similarity 0.57
Abstract · 8 pages, 13 figures. Submitted to Robotics & Automation Letters

This paper presents a novel method that extends targetless LiDAR-IMU calibration for ground vehicles to non- flat environments. Calibration typically necessitates full exci- tation of the sensor rig, a requirement that is not fulfilled by ground vehicles in normal operation. To address the degenerate planar motion, state-of-the-art methods propose residuals that assume the colinearity of the gravity and physical surface normal vectors, restricting usage to cases where the ground is assumed flat. This paper proposes ground-plane residuals that do not require this assumption, and are applicable for planar motion on a tilted surface. Results are demonstrated on a dataset collected from a Husky ground vehicle, on the M2DGR dataset, as well as on an offroad vehicle dataset. Repeatability is shown to be improved both in tilted and flat-ground scenarios, with strong improvement demonstrated for the tilted case. The implementation and experiments are open-sourced at https://github.com/vkorotkine/licalib_tilted_ground.

0.43

CT-SGAL-LIO: Causal Continuous Time Refinement of Discrete LiDAR Inertial Odometry

cs.RO ·2026-11-12 ·Nam Tran, Thu Tran, Toan Nguyen, William J Beksi, Tuan Dang
published similarity 0.57
Abstract · 7 pages, 4 figures, ICRA 2027 submissions

State-of-the-art LiDAR-inertial odometry methods, including those on richer state manifolds, achieve strong global accuracy, yet their pose stream alternates between propagation and correction and can oscillate over short horizons even when globally accurate. Most existing methods follow these approaches: they either modify the filter to enable faster updates or estimate a continuous-time trajectory from raw LiDAR and inertial data. The latter involves extra optimization, delaying state updates and becoming less robust during rapid rotations or accelerations. We propose CT-SGAL-LIO, a continuous-time refinement module that smooths the posterior pose stream of a discrete SGal(3) estimator without modifying the estimator itself. The key novelty is to perform continuous-time trajectory refinement directly on the projected SGal(3) posterior: we fit a cubic trajectory over a bounded window of recent poses and evaluate it at a small fixed lag. This places the query time within the observed interval, so the refined pose is obtained by interpolation rather than extrapolation, while preserving causal operation. CT-SGAL-LIO improves relative trajectory accuracy on 17 sequences from three public benchmarks. Across 17 sequences from GRAND-TOUR, MCD, and GEODE, CT-SGAL-LIO improves short-term motion accuracy while largely preserving global accuracy. RTE improves by up to 70% on GRAND-TOUR and on all seven GEODE sequences, with 9.9-51.1% reductions. A 19.5-min R-Campus run also reduces posterior jumps by 85.4% with only a 4.7 mm change in the end-to-start gap. We plan to release our source code and results to support community validation and reproducibility.

0.27

GLIO2: A GPU-Parallelized Tightly-Coupled LiDAR-Inertial-GNSS System for Robust and Real-Time Global Localization and Mapping

cs.RO ·2026-10-08 ·Qi Zhang, Xikun Liu, Qijun Qin, Xiangru Wang, Junzhe Wang +3 more
similarity 0.57
Abstract · 23 pages, 16 figures, 8 tables; includes appendices

Globally consistent, real-time state estimation in large-scale, perceptually degraded environments is essential for autonomous vehicles and aerial robots, and requires fusing LiDAR, inertial, and GNSS measurements. Existing fusion methods, however, share a scan-to-map front-end with two failure modes. First, each scan is aligned to an incrementally built map that drifts under degeneracy, and once the estimate diverges the error is irrecoverable. Second, even without divergence, a registration biased by dynamic objects or wrong correspondences is propagated as a single pose constraint with an over-confident covariance, leaving its correspondences unavailable for GNSS to re-weight or relinearize. We propose GLIO2, a tightly-coupled LiDAR-Inertial-GNSS system whose GPU-parallel front-end jointly optimizes scan-to-multiscan LiDAR, IMU pre-integration, and raw GNSS measurements in a single sliding-window factor graph, sustaining real-time operation on edge hardware. A complementary offline back-end reuses the same cached factors to refine the entire trajectory in batch, completing the 30-min, 4.51-km UrbanNav Whampoa sequence in about 24 s. Across three public benchmarks (UrbanNav, MARS-LVIG, M3DGR) and self-collected UAV and vehicle data, GLIO2 attains the best overall accuracy among evaluated systems. On a 5.66-km bridge traversed at up to 96 km/h, where every competing baseline diverges under LiDAR degeneracy, it maintains 1.6 m horizontal accuracy. On an NVIDIA Jetson Orin NX, the full pipeline runs at about 25 Hz (39.60 ms per scan). The source code and datasets will be released.

0.21