Changed lots of interface functions, grasping code, and logging hooks

Sorry for the very long pull request.
This is mainly adressing
 * Dependencies
 * Logging Hooks
 * Grasping code
 * Reasoning about grasping and arm selection