Added environment representation to launch
Slightly adjusted the manipulation margins for location costmaps
Added handle information for mug grasping and moved aux functions to utils.lisp
Refined manipulation margins for location costmaps
Added mug displacement, i.e. placing of the mug on the table