debug final grasping
final demo FUNCIONA en simulacio