Properly initialize variables
Added clarification comment
Make use of new grasping interface
Removed old code
Typo
Removal of old code
Deleted old function