1. Tobias Egle and Christian Ott are with the Automation and Control Institute,Faculty of Electrical Engineering and Information Technology, TU Wien,Vienna,Austria,1040
2. Institute of Robotics and Mecha-tronics, German Aerospace Center (DLR),Wessling,Germany,82234