Pick_and_place almost works with the updated robot_smach_states in commit 99933f0. Replaced SimpleDesignator with VariableDesignator that does exactly the same and is more generic