J.  Berger, Neufeld, A., Becker, F., Lenzen, F., and Schnörr, C., ?Second Order Minimum Energy Filtering on SE(3) with Nonlinear Measurement Equations?, in Scale Space and Variational Methods in Computer Vision (SSVM 2015), 2015.