1. LARM: Laboratory of Robotics and Mechatronics, DiMSAT – University of Cassino, Via Di Biasio 43, 03043 Cassino (Fr), Italy
2. Institute for Engineering Mathematics Geometry and Computer Science, University of Innsbruck, Technikerstr. 13, A-6020, Innsbruck, Austria