Architecture and methodology for sensor-based robotics on Lie algebras - Müller, Thomas (2013)