hector_exploration_planner: Debugging search position