Core Concepts
The paper proposes a novel Hessian approximation for Maximum a Posteriori estimation problems in robotics involving Gaussian mixture likelihoods, which leads to better convergence properties compared to previous approaches.
Abstract
The paper addresses the challenge of incorporating Gaussian mixture likelihoods into nonlinear least squares (NLS) optimization frameworks, which is important for robust state estimation in robotics. Previous approaches, such as the Max-Mixture and Sum-Mixture methods, have limitations in accurately approximating the Hessian of the Gaussian mixture likelihood, leading to degraded convergence performance of gradient-based optimization methods.
The key contributions are:
- Derivation of a novel Hessian approximation, termed the Hessian-Sum-Mixture (HSM), that takes into account the nonlinearity of the LogSumExp expression in the Gaussian mixture negative log-likelihood. This Hessian approximation is more accurate than previous methods.
- A method to maintain compatibility with existing NLS solvers, such as Ceres, by defining an "error" and "error Jacobian" that result in the same descent direction as using Newton's method with the proposed HSM Hessian.
The proposed approach is evaluated on simulated examples, a point-set registration problem, and a SLAM problem with unknown data associations. The results demonstrate improved convergence properties of the HSM method compared to previous approaches, particularly in challenging scenarios with significant overlap between Gaussian mixture components.
Stats
The paper does not contain any explicit numerical data or statistics to support the key claims. The results are presented in the form of performance metrics such as RMSE, ANEES, and number of iterations on the evaluated problems.
Quotes
"The proposed Hessian approximation is more accurate, resulting in improved convergence properties that are demonstrated on simulated and real-world experiments."
"The key difference with respect to Max-Sum-Mixture is that the dominant and non-dominant components are all treated in the same manner. In the Max-Sum-Mixture the dominant component has a full-rank Hessian contribution, while the non-dominant components have a rank one Hessian contribution that is inaccurate as detailed in Sec. IV."