test sensor input for planning_scene
better approach and retreat strategy