J.  Berger, Lenzen, F., Becker, F., Neufeld, A., and Schnörr, C., ?Second-Order Recursive Filtering on the Rigid-Motion Lie Group SE(3) Based on Nonlinear Observations?. 2015.