Mostly Pick and Place, and code maintenance

Mostly improved code for pick and place (besides other things, failure handling and retry counters were adapted). Also, fixed code formatting, indentation and friends.
The costmap visualization via MarkerArrays is looking nicer now (+ convenience options in the appropriate functions). Also, hooks for logging were nicified (e.g. using `define-hook` now).