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