1. Robotics and Multibody Mechanics Research Group, Department of Mechanical Engineering, Vrije Universiteit Brussel, Pleinlaan 2, 1050 Brussel, Belgium,
2. Robotics and Multibody Mechanics Research Group, Department of Mechanical Engineering, Vrije Universiteit Brussel, Pleinlaan 2, 1050 Brussel, Belgium