fixing inconsistency when using planner and vision. Grasping threshold is also changed
planner workd for hiding-cup scenario