CS Paper Radar

The Multivariate Feedback Particle Filter for State-dependent Multiplicative Noises and Its Application to Attitude and Pose Estimations

Jingyao You, Xue Luo

cs.RO math.OC ·submitted 2026-11-17 10:11 UTC · v1

Abstract

Nonlinear filtering with state-dependent multiplicative measurement noise poses a notable challenge for spacecraft attitude determination and robotic pose estimation. This work develops the FPF-DM, a decomposition scheme for feedback particle filters tailored to this family of filtering problems. Extending prior decomposition techniques for additive noise and polynomial measurement models, the proposed method resolves the key difficulty that state-dependent multiplicative noise breaks the polynomial assumption and prevents Hermite spectral backward recursion for the weighted Poisson's equation. By measure transformation and importance reweighting, we incorporate the inverse measurement covariance into particle weights and rescale the feedback gain to restore the polynomial-form Poisson's equation, with the decomposition generalized to non-uniformly weighted mixtures for closed-form gain computation. This general FPF-DM is instantiated on quaternion and dual-quaternion manifolds for attitude tracking and point-cloud registration. Simulations on 4D attitude tracking and 8D point-cloud registration verify that the instantiated filters using only 10 particles achieve superior accuracy and computational performance relative to baseline filters.

Comment
14 pages, 5 figures, 3 tables

Closest papers

Nearest neighbours by meaning across the whole index.

Efficient Sensor Fusion Through Covariance-Constrained Observation Decimation (CCOD)

eess.SY ·2026-09-02 ·Andres Enriquez Fernandez, Erik Blasch, Angel Flores-Abad, John J. Bird
similarity 0.56
Abstract

Observation decimation is frequently employed in state estimation to reduce sensing, communication, and computational requirements, but decreasing the measurement assimilation frequency increases estimation uncertainty. Selecting an appropriate observation decimation factor therefore requires accurately predicting the resulting estimator performance. While the discrete algebraic Riccati equation (DARE) provides the steady-state estimation-error covariance for standard linear time-invariant Kalman filters, it is not directly applicable to estimators employing decimated measurement updates. Existing approaches address this limitation through lifted system representations or periodic Riccati equation formulations, both of which incur additional computational complexity. This paper presents a covariance-constrained observation decimation (CCOD) framework that reformulates the DARE inputs using equivalent decimated system and process-noise matrices that capture covariance growth between measurement updates. The proposed reformulation enables direct prediction of the steady-state estimation-error covariance through a single DARE evaluation without increasing the system dimension or solving coupled periodic Riccati equations. The resulting covariance prediction is used to determine the maximum observation decimation factor that satisfies a prescribed estimation uncertainty bound. Validation using a high dimensional linear time-invariant system and a space object tracking application demonstrates that the proposed approach accurately predicts steady-state estimator performance while reducing the measurement assimilation frequency required to satisfy specified covariance constraints.

0.21

The Iterative Equivariant Filter

eess.SY cs.RO ·2026-09-11 ·Pieter van Goor, James Richard Forbes
similarity 0.55
Abstract · 9 pages, 1 figure, submitted

This paper presents the iterative equivariant filter (IterEqF). The iterative extended Kalman filter (IterEKF) replaces the standard EKF correction step with an iterative correction step that is the Gauss-Newton solution to a nonlinear weighted least squares problem. The standard equivariant filter (EqF) exploits and respects the underlying symmetry of state estimation problems posed on homogeneous spaces and Lie groups. The motivation behind the IterEqF is to combine the features of both the IterEKF and the EqF, thus leading to a high-performance state estimation solution that is well suited to navigation problems. This paper derives the iteration procedure for the IterEqF update step and shows how the intrinsic nonlinearity of the approach naturally results in a `reset' of the filter's covariance into new coordinates. Monte-Carlo simulations of range-based localisation for a mobile robot demonstrate the improvement in performance relative to a standard EqF, especially during the transient convergence.

0.36

Equivariant Filter Design for Acoustic and Depth Aided Inertial Navigation Systems

cs.RO ·2026-09-17 ·Arihant Lunawat, Pieter van Goor, Frank Dellaert, Stefan B. Williams
benchmark similarity 0.55
Abstract · 12 pages, 6 figures, submitted to ICRA 2027

Autonomous Underwater Vehicles (AUVs) navigating without GPS typically fuse inertial measurements with acoustic Doppler Velocity Log (DVL) velocities and pressure-derived depth. Posing the navigation state on a Lie group improves accuracy and consistency. However, state-of-the-art filters based on the Invariant Extended Kalman Filter (IEKF) append the Inertial Measurement Unit (IMU) biases as a Euclidean extension, which breaks the group-affine structure required for exact log-linear error dynamics, causing the reported covariance to degrade alongside the estimate. We apply the Tangent-Group (TG) symmetry, which carries the biases within the geometry of the state space, to derive an Equivariant Filter (EqF) for this system, leaving zero linearization error in the navigation states and second-order error only in the biases. We develop an equivariant output model for the DVL, whose update incurs only third-order linearization error, together with a direct pressure output. Monte Carlo simulations benchmark the TG-EqF against a Two-Frame-Group IEKF and a Multiplicative EKF. The TG-EqF reduces error by 18--25\% against both alternatives in each of attitude, velocity, and position. The main benefit is in the covariance it estimates: its Average Normalized Estimation Error Squared (ANEES) stays closer to its nominal value of one than that of the others. Offline analysis on AUV field data corroborates the findings of the simulations, demonstrating reduced position drift.

0.19

A Catalog of Probability Generating Functionals for Multitarget Tracking and Data Assignment Problems

eess.SY ·2026-08-29 ·Roy L. Streit
similarity 0.54
Abstract · 21 pages

This paper studies the class of Bayesian tracking filters for which the probability generating functional of the joint target-measurement process can be derived from the statistical assumptions that define the problem. The class includes filters for labeled and unlabeled targets, as well as hybrid filters in which both labeled and unlabeled targets are present. New results include the probability generating functional for interval filtering of target trajectories for both labeled an unlabeled targets, and a novel method for computing the probability generating function of measurement-to-target assignment probabilities. Probability generating functionals give exact expressions for calculating the importance weights in particle filter implementations. Low computational complexity approximations to the particle weights are derived from the probability generating functionals via the saddle point method.

0.27

A Modified Rao-Blackwellised Particle Filter Based on Updated Process Noise Covariance for Chemical Reaction Networks

eess.SY ·2026-09-25 ·Suryasnata Dash, Abhishek Dey
similarity 0.53
Abstract · archived for conference paper

It is necessary to characterize chemical reaction networks (CRNs) accurately to facilitate engineering of both synthetic and naturally occurring biological systems. Estimation of multiple unknown parameters and states in CRNs requires first, an identifiability analysis, and then adoption of a suitable estimation technique. In this paper, we took an example of a reduced order gene expression system, performed parameter sensitivity analysis for multiple unknown parameters, and used a modified Rao-Blackwellised particle filter (RBPF) to estimate parameters and states. The proposed framework estimates parameters using a particle filter and states using an extended Kalman filter (EKF) with process noise covariance updated recursively based on chemical Langevin equation (CLE). We compared the accuracy of parameter estimation, error in state estimation, and whiteness of the innovation sequence for the proposed filter with fixed choices of noise covariance. We found that the RBPF with updated noise covariance finds a balance between these three criteria, demonstrating its suitability for joint state and parameter estimation for stochastic CRNs.

0.21

A Class of Bayesian Conjugate Distributions on $SE_n(3)$ for Motion Estimation

cs.RO stat.ME ·2026-11-12 ·Shijie Wang, Haichao Gui, Rui Zhong
similarity 0.53
Abstract · 17 pages, 4 figures

This paper proposes a novel class of Bayesian Conjugate Distributions (BCDs) on extended special Euclidean groups SE_n(3) for global motion uncertainty representation and estimation. BCDs are constructed by restricting matrix Gaussian distributions on ambient Euclidean space to SE_n(3), avoiding singularity of local coordinates. The unique feature of BCDs is their conjugacy to a broad class of sampling distributions arising in motion estimation, enabling exact closed-form Bayesian inference. Optimal estimation with respect to BCDs is further investigated for implementing motion estimation. Two means are extracted as random state estimates, which maximize probability and minimize mean squared error, respectively. Moreover, within the BCD class, moment matching is shown to minimize the Kullback-Leibler divergence, and maximum likelihood estimation is also derived, which provide analytical methods to approximate underlying distributions with the optimality guarantee. As an application, a Bayesian estimator for pose and velocity estimation of an Unmanned Aerial Vehicle (UAV) is developed within an assumed density filtering architecture. The propagation and estimate extraction leverage the optimal estimation related to BCDs, and the landmark measurements are exactly fused with the BCD prior in closed form due to the conjugacy. Numerical simulations of a UAV flight indicate the advantages of BCD-based estimators over two classic Kalman filters on Lie groups with various initial uncertainties and measurement noise.

0.27

A simple derivation of the Kalman filter

eess.SP math.OCeess.SYmath.ST+1 ·2026-09-02 ·Marco Chiani, Giovanni Petris, Moe Z. Win
published similarity 0.52
Abstract · To be published in IEEE Signal Processing Magazine

In this lecture note, we present a concise and self-contained derivation of the discrete-time Kalman filter equations that requires only a basic understanding of least squares estimation. The treatment is designed to minimize mathematical overhead while preserving both rigor and generality.

0.33

Consensus-Based Distributed Filtering for Angles-Only Tracking in Cislunar Space

eess.SY cs.MA ·2026-10-22 ·Giovanni Romagnoli, Fabrizio Pilone, Giordana Bucchioni
publishedbenchmark similarity 0.52
Abstract · Accepted for presentation at IEEE NAVICON 2026

This paper investigates consensus-based distributed filtering strategies for multi-observer angles-only navigation in the cislunar space. The objective is to estimate the inertial state of a target spacecraft using only line-of-sight measurements collected by a network of observer spacecraft. This problem is particularly relevant for autonomous cislunar navigation, where ground support may be limited, and centralized fusion architectures may be problematic due to communication and computational constraints, and single-point failure risks. Three distributed filtering approaches are considered: the Distributed Extended Kalman Filter, the Information-Weighted Consensus Filter, and the Kalman Consensus Filter. All methods share the same local prediction and measurement-processing steps, but differ in the way information is exchanged and fused across the network. Their performance is evaluated and compared to a centralized Extended Kalman Filter, adopted as benchmark, and independent local filters in a high-fidelity cislunar scenario. Numerical simulations show that the distributed approaches significantly improve estimation accuracy with respect to independent filters. Monte Carlo sensitivity analyses are then conducted to characterize the robustness of the considered methods to finite consensus iterations and prior misalignment among the agents.

0.21