Fixed Bug in grasp generation. Collision Checker freezes