A Class of Bayesian Conjugate Distributions on SEn(3) for Motion Estimation
Authors: Shijie Wang, Haichao Gui, Rui Zhong
Organizations: School of Astronautics, Shenyuan Honors College, Beihang University, Beijing, 100191, China · School of Astronautics and the MOE Key Laboratory of Spacecraft Design, Optimization and Dynamic Simulation, Beihang University, Beijing, 100191, China
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.
Figures & tables
ki
TFG-IEKF
UKF-LG
BE-BCD
BE-BCD-RMSE
1
Att. RMSE(°)
12.38(100%) **
12.611(102%)
1.85(15.0%)
1.85(15.0%)
Pos. RMSE (m)
4.73(100%)
5.01(106%)
0.106(2.23%)
0.0994(2.10%)
Vel. RMSE (m/s)
3.64(100%)
3.63(100%)
0.1639(4.51%)
0.1495(4.11%)
5
Att. RMSE(°)
12.20(100%)
17.13(140%)
1.85(15.2%)
1.85(15.2%)
Pos. RMSE (m)
4.49(100%)
7.69(171%)
0.109(2.43%)
0.0970(2.16%)
Vel. RMSE (m/s)
3.42(100%)
5.23(153%)
0.166(4.86%)
0.142(4.14%)
Table 1: RMSE for simulation with different initial uncertainty* *
Figure 1: Effects of the initial uncertainty on RMSEs
Figure 2: Estimation errors of estimators from 0s to 100s with ki=100 and km=1
Figure 3: Estimation errors of estimators from 0s to 10s with ki=25 and km=1
ki
TFG-IEKF
UKF-LG
BE-BCD
BE-BCD-MSE
1
Att. RMSE(°)
12.38(100%) **
12.611(102%)
1.85(15.0%)
1.85(15.0%)
Pos. RMSE (m)
4.73(100%)
5.01(106%)
0.106(2.23%)
0.0994(2.10%)
Vel. RMSE (m/s)
3.64(100%)
3.63(100%)
0.1639(4.51%)
0.1495(4.11%)
5
Att. RMSE(°)
12.5(100%)
14.36(115%)
1.99(15.9%)
1.99(15.9%)
Pos. RMSE (m)
4.83(100%)
6.02(124%)
0.277(5.72%)
0.264(5.47%)
Vel. RMSE (m/s)
3.68(100%)
4.24(115%)
0.235(6.40%)
0.210(5.72%)
Table 2: RMSE for different measurement noise* *
Figure 4: Effects of the measurement noise on RMESs
While homographies are fundamental to many computer vision tasks, the majority of conventional estimation techniques provide only point estimates without directly quantifying uncertainty introduced by noisy observations. Uncertainty, though, propagates to subsequent processing steps such as camera calibration and 3D reconstruction and is particularly relevant in safety-critical and socially relevant fields including medical imaging, autonomous driving, and defense. We present a fast Bayesian formulation for homography estimation from point correspondences that explicitly incorporates measurement uncertainty and prior knowledge while providing a posterior distribution over the homography parameters. A closed-form solution of the posterior mean of the homography is derived in homogeneous coordinates and supplemented by an iterative Bayesian approach to handle non-linearities. Synthetic experiments demonstrate the applicability to projective transformations and show improved estimation accuracy over DLT under varying noise conditions. Image stitching experiments further demonstrate applicability to real image correspondences while additionally providing uncertainty information.
Accurate state estimation of nonlinear dynamical systems is fundamental to modern aerospace operations across air, sea, and space domains. Online tracking of adversarial unmanned aerial vehicles (UAVs) is especially challenging due to agile nonlinear motion, noisy and sparse sensor measurements, and unknown control inputs; conditions that violate key assumptions of classical Kalman filter variants and degrade estimation performance. Neural networks (NNs) can learn complex nonlinear relationships from data, but lack principled uncertainty quantification, which is critical for state estimation tasks where confidence bounds drive downstream decisions. We address this with Bayesian Neural Networks (BNNs), which model uncertainty through distributions over network weights and produce predictive means and uncertainties via Monte Carlo sampling. Building on this, we propose the Bayesian Neural Kalman Filter (BNKF): a hybrid framework coupling a trained BNN with a Kalman correction step for robust online UAV state estimation. Unlike related neural Kalman approaches, BNKF produces full state predictions and incorporates Bayesian uncertainty directly into covariance propagation, improving robustness under high noise conditions. We evaluate BNKF under varying radar noise levels and sampling rates using synthetic nonlinear UAV flight data. Five fold cross validation demonstrates that BNKF outperforms Extended and Unscented Kalman Filters in accuracy, precision, and truth containment under degraded sensing. An ensemble variant (BNKFe) further improves precision in high-noise edge cases at a slight accuracy tradeoff. Runtime analysis confirms minimal inference overhead, supporting real-time deployment feasibility.
Akhil Gupta, Erhan Guven
Whiting School of Engineering EP Program, Johns Hopkins University, Baltimore, Maryland, USA
Bayesian filtering is a cornerstone of state estimation in complex systems such as aerospace systems, yet exact solutions are available only for linear Gaussian models. In practice,nonlinear systems are handled through tractable approximations,with Gaussian filters such as the extended and unscented Kalman filters being among the most widely used methods. This tutorial revisits Gaussian filtering from an information-geometric perspective, viewing the prediction and measurement update steps as inference procedures over state distributions. Within this framework, we introduce a geometry-aware Gaussian filtering approach that leverages natural gradient descent on the statistical manifold of Gaussian distributions. The resulting Natural Gradient Gaussian Approximation (NANO) filter iteratively refines the posterior mean and covariance while respecting the intrinsic geometry of the Gaussian family and preserving the positive definiteness of the covariance matrix. We further highlight fundamental connections to the classical Kalman filtering, showing that a single natural-gradient step exactly recovers the Kalman measurement update in the linear-Gaussian case. The practical implications of the proposed framework are illustrated through case studies in representative nonlinear estimation problems,including satellite attitude estimation, simultaneous localization and mapping, and state estimation for robotic systems including quadruped and humanoid robots.
Chang Liu, Wenhan Cao, Zeju Sun +8
School of Advanced Manufacturing and Robotics, Peking University, China. · School of Vehicle and Mobility, Tsinghua University, China. · Beijing Institute of Mathematical Sciences and Applications (BIMSA), China. +3