shoring behaviour added
Merge branch 'schunk_moveit' into box_detection_and_shoring
box_detection_and_shoring: implemented behaviour